|
|
|
@ -6,7 +6,7 @@ from opendbc.can.can_define import CANDefine |
|
|
|
|
from selfdrive.car.interfaces import CarStateBase |
|
|
|
|
from opendbc.can.parser import CANParser |
|
|
|
|
from selfdrive.config import Conversions as CV |
|
|
|
|
from selfdrive.car.toyota.values import CAR, DBC, STEER_THRESHOLD, NO_STOP_TIMER_CAR, TSS2_CAR |
|
|
|
|
from selfdrive.car.toyota.values import ToyotaFlags, CAR, DBC, STEER_THRESHOLD, NO_STOP_TIMER_CAR, TSS2_CAR |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
class CarState(CarStateBase): |
|
|
|
@ -38,7 +38,9 @@ class CarState(CarStateBase): |
|
|
|
|
ret.gas = (cp.vl["GAS_SENSOR"]["INTERCEPTOR_GAS"] + cp.vl["GAS_SENSOR"]["INTERCEPTOR_GAS2"]) / 2. |
|
|
|
|
ret.gasPressed = ret.gas > 15 |
|
|
|
|
else: |
|
|
|
|
ret.gas = cp.vl["GAS_PEDAL"]["GAS_PEDAL"] |
|
|
|
|
# TODO: find a new, common signal |
|
|
|
|
msg = "GAS_PEDAL_HYBRID" if (self.CP.flags & ToyotaFlags.HYBRID) else "GAS_PEDAL" |
|
|
|
|
ret.gas = cp.vl[msg]["GAS_PEDAL"] |
|
|
|
|
ret.gasPressed = cp.vl["PCM_CRUISE"]["GAS_RELEASED"] == 0 |
|
|
|
|
|
|
|
|
|
ret.wheelSpeeds = self.get_wheel_speeds( |
|
|
|
@ -130,7 +132,6 @@ class CarState(CarStateBase): |
|
|
|
|
("STEER_ANGLE", "STEER_ANGLE_SENSOR", 0), |
|
|
|
|
("GEAR", "GEAR_PACKET", 0), |
|
|
|
|
("BRAKE_PRESSED", "BRAKE_MODULE", 0), |
|
|
|
|
("GAS_PEDAL", "GAS_PEDAL", 0), |
|
|
|
|
("WHEEL_SPEED_FL", "WHEEL_SPEEDS", 0), |
|
|
|
|
("WHEEL_SPEED_FR", "WHEEL_SPEEDS", 0), |
|
|
|
|
("WHEEL_SPEED_RL", "WHEEL_SPEEDS", 0), |
|
|
|
@ -163,13 +164,19 @@ class CarState(CarStateBase): |
|
|
|
|
("ESP_CONTROL", 3), |
|
|
|
|
("EPS_STATUS", 25), |
|
|
|
|
("BRAKE_MODULE", 40), |
|
|
|
|
("GAS_PEDAL", 33), |
|
|
|
|
("WHEEL_SPEEDS", 80), |
|
|
|
|
("STEER_ANGLE_SENSOR", 80), |
|
|
|
|
("PCM_CRUISE", 33), |
|
|
|
|
("STEER_TORQUE_SENSOR", 50), |
|
|
|
|
] |
|
|
|
|
|
|
|
|
|
if CP.flags & ToyotaFlags.HYBRID: |
|
|
|
|
signals.append(("GAS_PEDAL", "GAS_PEDAL_HYBRID", 0)) |
|
|
|
|
checks.append(("GAS_PEDAL_HYBRID", 33)) |
|
|
|
|
else: |
|
|
|
|
signals.append(("GAS_PEDAL", "GAS_PEDAL", 0)) |
|
|
|
|
checks.append(("GAS_PEDAL", 33)) |
|
|
|
|
|
|
|
|
|
if CP.carFingerprint in (CAR.LEXUS_IS, CAR.LEXUS_RC): |
|
|
|
|
signals.append(("MAIN_ON", "DSU_CRUISE", 0)) |
|
|
|
|
signals.append(("SET_SPEED", "DSU_CRUISE", 0)) |
|
|
|
|