Files
sunnypilot-byd/opendbc_repo/opendbc/sunnypilot/car/rivian/mads.py
T
github-actions[bot] de77c89cf6 sunnypilot v2026.002.000
version: sunnypilot v2026.002.000 (staging)
date: 2026-07-21T07:44:02
master commit: 2c334ede443d7391d27575af8c854a095ba702a8
2026-07-21 07:44:02 +00:00

37 lines
1.2 KiB
Python

"""
Copyright (c) 2021-, Haibin Wen, sunnypilot, and a number of other contributors.
This file is part of sunnypilot and is licensed under the MIT License.
See the LICENSE.md file in the root directory for more details.
"""
from collections import namedtuple
from opendbc.car import structs
from opendbc.car.interfaces import CarStateBase
MAX_STEERING_ANGLE = 90.0
MadsDataSP = namedtuple("MadsDataSP",
["lka_icon_states", "lat_active"])
class MadsCarController:
def __init__(self):
self.mads = MadsDataSP(False, False)
self.lka_icon_states = False
self.lat_active = False
def mads_status_update(self, CC: structs.CarControl, CC_SP: structs.CarControlSP, CS: CarStateBase) -> MadsDataSP:
if CC_SP.mads.available:
self.lka_icon_states = self.lat_active
self.lat_active = CC.latActive and abs(CS.out.steeringAngleDeg) < MAX_STEERING_ANGLE
else:
self.lka_icon_states = CC.enabled
self.lat_active = CC.latActive
return MadsDataSP(self.lka_icon_states, self.lat_active)
def update(self, CC: structs.CarControl, CC_SP: structs.CarControlSP, CS: CarStateBase) -> None:
self.mads = self.mads_status_update(CC, CC_SP, CS)