version: sunnypilot v2026.002.000 (staging) date: 2026-07-21T07:44:02 master commit: 2c334ede443d7391d27575af8c854a095ba702a8
56 lines
2.2 KiB
Python
56 lines
2.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 enum import StrEnum
|
|
|
|
from opendbc.car import Bus, create_button_events, structs
|
|
from opendbc.can.parser import CANParser
|
|
from opendbc.car.common.conversions import Conversions as CV
|
|
from opendbc.car.tesla.values import DBC, CANBUS
|
|
from opendbc.sunnypilot.car.tesla.values import TeslaFlagsSP
|
|
|
|
ButtonType = structs.CarState.ButtonEvent.Type
|
|
|
|
|
|
class CarStateExt:
|
|
def __init__(self, CP: structs.CarParams, CP_SP: structs.CarParamsSP):
|
|
self.CP = CP
|
|
self.CP_SP = CP_SP
|
|
|
|
self.infotainment_3_finger_press = 0
|
|
|
|
def update(self, ret: structs.CarState, ret_sp: structs.CarStateSP, can_parsers: dict[StrEnum, CANParser]) -> None:
|
|
if self.CP_SP.flags & TeslaFlagsSP.HAS_VEHICLE_BUS:
|
|
cp_adas = can_parsers[Bus.adas]
|
|
|
|
prev_infotainment_3_finger_press = self.infotainment_3_finger_press
|
|
self.infotainment_3_finger_press = int(cp_adas.vl["UI_status2"]["UI_activeTouchPoints"])
|
|
|
|
ret.buttonEvents = [*create_button_events(self.infotainment_3_finger_press, prev_infotainment_3_finger_press,
|
|
{3: ButtonType.lkas})]
|
|
|
|
cp_party = can_parsers[Bus.party]
|
|
cp_ap_party = can_parsers[Bus.ap_party]
|
|
|
|
speed_units = self.can_define.dv["DI_state"]["DI_speedUnits"].get(int(cp_party.vl["DI_state"]["DI_speedUnits"]), None)
|
|
speed_limit = cp_ap_party.vl["DAS_status"]["DAS_fusedSpeedLimit"]
|
|
if self.can_define.dv["DAS_status"]["DAS_fusedSpeedLimit"].get(int(speed_limit), None) in ["NONE", "UNKNOWN_SNA"]:
|
|
ret_sp.speedLimit = 0
|
|
else:
|
|
if speed_units == "KPH":
|
|
ret_sp.speedLimit = speed_limit * CV.KPH_TO_MS
|
|
elif speed_units == "MPH":
|
|
ret_sp.speedLimit = speed_limit * CV.MPH_TO_MS
|
|
|
|
@staticmethod
|
|
def get_parser(CP: structs.CarParams, CP_SP: structs.CarParamsSP) -> dict[StrEnum, CANParser]:
|
|
messages = {}
|
|
|
|
if CP_SP.flags & TeslaFlagsSP.HAS_VEHICLE_BUS:
|
|
messages[Bus.adas] = CANParser(DBC[CP.carFingerprint][Bus.adas], [], CANBUS.vehicle)
|
|
|
|
return messages
|