|
|
@ -18,7 +18,7 @@ class CarState(CarStateBase): |
|
|
|
can_define = CANDefine(DBC[CP.carFingerprint]["pt"]) |
|
|
|
can_define = CANDefine(DBC[CP.carFingerprint]["pt"]) |
|
|
|
self.shifter_values = can_define.dv["ECMPRDNL2"]["PRNDL2"] |
|
|
|
self.shifter_values = can_define.dv["ECMPRDNL2"]["PRNDL2"] |
|
|
|
self.loopback_lka_steering_cmd_updated = False |
|
|
|
self.loopback_lka_steering_cmd_updated = False |
|
|
|
self.camera_lka_steering_cmd_counter = 0 |
|
|
|
self.pt_lka_steering_cmd_counter = 0 |
|
|
|
self.buttons_counter = 0 |
|
|
|
self.buttons_counter = 0 |
|
|
|
|
|
|
|
|
|
|
|
def update(self, pt_cp, cam_cp, loopback_cp): |
|
|
|
def update(self, pt_cp, cam_cp, loopback_cp): |
|
|
@ -33,7 +33,7 @@ class CarState(CarStateBase): |
|
|
|
# Variables used for avoiding LKAS faults |
|
|
|
# Variables used for avoiding LKAS faults |
|
|
|
self.loopback_lka_steering_cmd_updated = len(loopback_cp.vl_all["ASCMLKASteeringCmd"]["RollingCounter"]) > 0 |
|
|
|
self.loopback_lka_steering_cmd_updated = len(loopback_cp.vl_all["ASCMLKASteeringCmd"]["RollingCounter"]) > 0 |
|
|
|
if self.CP.networkLocation == NetworkLocation.fwdCamera: |
|
|
|
if self.CP.networkLocation == NetworkLocation.fwdCamera: |
|
|
|
self.camera_lka_steering_cmd_counter = cam_cp.vl["ASCMLKASteeringCmd"]["RollingCounter"] |
|
|
|
self.pt_lka_steering_cmd_counter = pt_cp.vl["ASCMLKASteeringCmd"]["RollingCounter"] |
|
|
|
|
|
|
|
|
|
|
|
ret.wheelSpeeds = self.get_wheel_speeds( |
|
|
|
ret.wheelSpeeds = self.get_wheel_speeds( |
|
|
|
pt_cp.vl["EBCMWheelSpdFront"]["FLWheelSpd"], |
|
|
|
pt_cp.vl["EBCMWheelSpdFront"]["FLWheelSpd"], |
|
|
@ -113,13 +113,11 @@ class CarState(CarStateBase): |
|
|
|
if CP.networkLocation == NetworkLocation.fwdCamera: |
|
|
|
if CP.networkLocation == NetworkLocation.fwdCamera: |
|
|
|
signals += [ |
|
|
|
signals += [ |
|
|
|
("AEBCmdActive", "AEBCmd"), |
|
|
|
("AEBCmdActive", "AEBCmd"), |
|
|
|
("RollingCounter", "ASCMLKASteeringCmd"), |
|
|
|
|
|
|
|
("ACCSpeedSetpoint", "ASCMActiveCruiseControlStatus"), |
|
|
|
("ACCSpeedSetpoint", "ASCMActiveCruiseControlStatus"), |
|
|
|
("ACCCruiseState", "ASCMActiveCruiseControlStatus"), |
|
|
|
("ACCCruiseState", "ASCMActiveCruiseControlStatus"), |
|
|
|
] |
|
|
|
] |
|
|
|
checks += [ |
|
|
|
checks += [ |
|
|
|
("AEBCmd", 10), |
|
|
|
("AEBCmd", 10), |
|
|
|
("ASCMLKASteeringCmd", 10), |
|
|
|
|
|
|
|
("ASCMActiveCruiseControlStatus", 25), |
|
|
|
("ASCMActiveCruiseControlStatus", 25), |
|
|
|
] |
|
|
|
] |
|
|
|
|
|
|
|
|
|
|
@ -180,6 +178,15 @@ class CarState(CarStateBase): |
|
|
|
("ECMAcceleratorPos", 80), |
|
|
|
("ECMAcceleratorPos", 80), |
|
|
|
] |
|
|
|
] |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
# Used to read back last counter sent to PT by camera |
|
|
|
|
|
|
|
if CP.networkLocation == NetworkLocation.fwdCamera: |
|
|
|
|
|
|
|
signals += [ |
|
|
|
|
|
|
|
("RollingCounter", "ASCMLKASteeringCmd"), |
|
|
|
|
|
|
|
] |
|
|
|
|
|
|
|
checks += [ |
|
|
|
|
|
|
|
("ASCMLKASteeringCmd", 0), |
|
|
|
|
|
|
|
] |
|
|
|
|
|
|
|
|
|
|
|
if CP.transmissionType == TransmissionType.direct: |
|
|
|
if CP.transmissionType == TransmissionType.direct: |
|
|
|
signals.append(("RegenPaddle", "EBCMRegenPaddle")) |
|
|
|
signals.append(("RegenPaddle", "EBCMRegenPaddle")) |
|
|
|
checks.append(("EBCMRegenPaddle", 50)) |
|
|
|
checks.append(("EBCMRegenPaddle", 50)) |
|
|
|