|
|
@ -28,7 +28,6 @@ class CarState(CarStateBase): |
|
|
|
ret.vEgo, ret.aEgo = self.update_speed_kf(ret.vEgoRaw) |
|
|
|
ret.vEgo, ret.aEgo = self.update_speed_kf(ret.vEgoRaw) |
|
|
|
ret.standstill = ret.vEgoRaw < 0.01 |
|
|
|
ret.standstill = ret.vEgoRaw < 0.01 |
|
|
|
|
|
|
|
|
|
|
|
ret.steeringAngleDeg = pt_cp.vl["PSCMSteeringAngle"]['SteeringWheelAngle'] |
|
|
|
|
|
|
|
ret.gearShifter = self.parse_gear_shifter(self.shifter_values.get(pt_cp.vl["ECMPRDNL"]['PRNDL'], None)) |
|
|
|
ret.gearShifter = self.parse_gear_shifter(self.shifter_values.get(pt_cp.vl["ECMPRDNL"]['PRNDL'], None)) |
|
|
|
ret.brake = pt_cp.vl["EBCMBrakePedalPosition"]['BrakePedalPosition'] / 0xd0 |
|
|
|
ret.brake = pt_cp.vl["EBCMBrakePedalPosition"]['BrakePedalPosition'] / 0xd0 |
|
|
|
# Brake pedal's potentiometer returns near-zero reading even when pedal is not pressed. |
|
|
|
# Brake pedal's potentiometer returns near-zero reading even when pedal is not pressed. |
|
|
@ -38,9 +37,16 @@ class CarState(CarStateBase): |
|
|
|
ret.gas = pt_cp.vl["AcceleratorPedal"]['AcceleratorPedal'] / 254. |
|
|
|
ret.gas = pt_cp.vl["AcceleratorPedal"]['AcceleratorPedal'] / 254. |
|
|
|
ret.gasPressed = ret.gas > 1e-5 |
|
|
|
ret.gasPressed = ret.gas > 1e-5 |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
ret.steeringAngleDeg = pt_cp.vl["PSCMSteeringAngle"]['SteeringWheelAngle'] |
|
|
|
|
|
|
|
ret.steeringRateDeg = pt_cp.vl["PSCMSteeringAngle"]['SteeringWheelRate'] |
|
|
|
ret.steeringTorque = pt_cp.vl["PSCMStatus"]['LKADriverAppldTrq'] |
|
|
|
ret.steeringTorque = pt_cp.vl["PSCMStatus"]['LKADriverAppldTrq'] |
|
|
|
|
|
|
|
ret.steeringTorqueEps = pt_cp.vl["PSCMStatus"]['LKATorqueDelivered'] |
|
|
|
ret.steeringPressed = abs(ret.steeringTorque) > STEER_THRESHOLD |
|
|
|
ret.steeringPressed = abs(ret.steeringTorque) > STEER_THRESHOLD |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
# 0 inactive, 1 active, 2 temporarily limited, 3 failed |
|
|
|
|
|
|
|
self.lkas_status = pt_cp.vl["PSCMStatus"]['LKATorqueDeliveredStatus'] |
|
|
|
|
|
|
|
ret.steerWarning = self.lkas_status not in [0, 1] |
|
|
|
|
|
|
|
|
|
|
|
# 1 - open, 0 - closed |
|
|
|
# 1 - open, 0 - closed |
|
|
|
ret.doorOpen = (pt_cp.vl["BCMDoorBeltStatus"]['FrontLeftDoor'] == 1 or |
|
|
|
ret.doorOpen = (pt_cp.vl["BCMDoorBeltStatus"]['FrontLeftDoor'] == 1 or |
|
|
|
pt_cp.vl["BCMDoorBeltStatus"]['FrontRightDoor'] == 1 or |
|
|
|
pt_cp.vl["BCMDoorBeltStatus"]['FrontRightDoor'] == 1 or |
|
|
@ -65,10 +71,6 @@ class CarState(CarStateBase): |
|
|
|
ret.cruiseState.enabled = self.pcm_acc_status != AccState.OFF |
|
|
|
ret.cruiseState.enabled = self.pcm_acc_status != AccState.OFF |
|
|
|
ret.cruiseState.standstill = self.pcm_acc_status == AccState.STANDSTILL |
|
|
|
ret.cruiseState.standstill = self.pcm_acc_status == AccState.STANDSTILL |
|
|
|
|
|
|
|
|
|
|
|
# 0 - inactive, 1 - active, 2 - temporary limited, 3 - failed |
|
|
|
|
|
|
|
self.lkas_status = pt_cp.vl["PSCMStatus"]['LKATorqueDeliveredStatus'] |
|
|
|
|
|
|
|
ret.steerWarning = self.lkas_status not in [0, 1] |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
return ret |
|
|
|
return ret |
|
|
|
|
|
|
|
|
|
|
|
@staticmethod |
|
|
|
@staticmethod |
|
|
@ -88,12 +90,14 @@ class CarState(CarStateBase): |
|
|
|
("CruiseState", "AcceleratorPedal2", 0), |
|
|
|
("CruiseState", "AcceleratorPedal2", 0), |
|
|
|
("ACCButtons", "ASCMSteeringButton", CruiseButtons.UNPRESS), |
|
|
|
("ACCButtons", "ASCMSteeringButton", CruiseButtons.UNPRESS), |
|
|
|
("SteeringWheelAngle", "PSCMSteeringAngle", 0), |
|
|
|
("SteeringWheelAngle", "PSCMSteeringAngle", 0), |
|
|
|
|
|
|
|
("SteeringWheelRate", "PSCMSteeringAngle", 0), |
|
|
|
("FLWheelSpd", "EBCMWheelSpdFront", 0), |
|
|
|
("FLWheelSpd", "EBCMWheelSpdFront", 0), |
|
|
|
("FRWheelSpd", "EBCMWheelSpdFront", 0), |
|
|
|
("FRWheelSpd", "EBCMWheelSpdFront", 0), |
|
|
|
("RLWheelSpd", "EBCMWheelSpdRear", 0), |
|
|
|
("RLWheelSpd", "EBCMWheelSpdRear", 0), |
|
|
|
("RRWheelSpd", "EBCMWheelSpdRear", 0), |
|
|
|
("RRWheelSpd", "EBCMWheelSpdRear", 0), |
|
|
|
("PRNDL", "ECMPRDNL", 0), |
|
|
|
("PRNDL", "ECMPRDNL", 0), |
|
|
|
("LKADriverAppldTrq", "PSCMStatus", 0), |
|
|
|
("LKADriverAppldTrq", "PSCMStatus", 0), |
|
|
|
|
|
|
|
("LKATorqueDelivered", "PSCMStatus", 0), |
|
|
|
("LKATorqueDeliveredStatus", "PSCMStatus", 0), |
|
|
|
("LKATorqueDeliveredStatus", "PSCMStatus", 0), |
|
|
|
("TractionControlOn", "ESPStatus", 0), |
|
|
|
("TractionControlOn", "ESPStatus", 0), |
|
|
|
("EPBClosed", "EPBStatus", 0), |
|
|
|
("EPBClosed", "EPBStatus", 0), |
|
|
|