version: sunnypilot v2026.002.000 (staging) date: 2026-07-21T07:44:02 master commit: 2c334ede443d7391d27575af8c854a095ba702a8
49 lines
1.8 KiB
Python
49 lines
1.8 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 enum import StrEnum
|
|
from opendbc.car import Bus, structs
|
|
|
|
from opendbc.car.subaru.values import SubaruFlags
|
|
from opendbc.sunnypilot.mads_base import MadsCarStateBase
|
|
from opendbc.can.parser import CANParser
|
|
|
|
ButtonType = structs.CarState.ButtonEvent.Type
|
|
|
|
|
|
class MadsCarState(MadsCarStateBase):
|
|
def __init__(self, CP: structs.CarParams, CP_SP: structs.CarParamsSP):
|
|
super().__init__(CP, CP_SP)
|
|
|
|
@staticmethod
|
|
def create_lkas_button_events(cur_btn: int, prev_btn: int,
|
|
buttons_dict: dict[int, structs.CarState.ButtonEvent.Type]) -> list[structs.CarState.ButtonEvent]:
|
|
events: list[structs.CarState.ButtonEvent] = []
|
|
|
|
if cur_btn == prev_btn:
|
|
return events
|
|
|
|
state_changes = [
|
|
{"pressed": prev_btn != cur_btn and cur_btn != 2 and not (prev_btn == 2 and cur_btn == 1)},
|
|
{"pressed": prev_btn != cur_btn and cur_btn == 2 and cur_btn != 1},
|
|
]
|
|
|
|
for change in state_changes:
|
|
if change["pressed"]:
|
|
events.append(structs.CarState.ButtonEvent(pressed=change["pressed"],
|
|
type=buttons_dict.get(cur_btn, ButtonType.unknown)))
|
|
return events
|
|
|
|
def update_mads(self, ret: structs.CarState, can_parsers: dict[StrEnum, CANParser]) -> None:
|
|
cp_cam = can_parsers[Bus.cam]
|
|
|
|
self.prev_lkas_button = self.lkas_button
|
|
if not self.CP.flags & SubaruFlags.PREGLOBAL:
|
|
self.lkas_button = cp_cam.vl["ES_LKAS_State"]["LKAS_Dash_State"]
|
|
|
|
ret.buttonEvents = self.create_lkas_button_events(self.lkas_button, self.prev_lkas_button, {1: ButtonType.lkas})
|