Toyota: fill stockFcw signal (#24324)

* fill stockFcw

* only TSS2 car for now
old-commit-hash: a05487cdf5
taco
Shane Smiskol 3 years ago committed by GitHub
parent 957d0c2767
commit 846b8fe0bb
  1. 13
      selfdrive/car/toyota/carstate.py

@ -115,6 +115,9 @@ class CarState(CarStateBase):
ret.genericToggle = bool(cp.vl["LIGHT_STALK"]["AUTO_HIGH_BEAM"])
ret.stockAeb = bool(cp_cam.vl["PRE_COLLISION"]["PRECOLLISION_ACTIVE"] and cp_cam.vl["PRE_COLLISION"]["FORCE"] < -1e-5)
if self.CP.carFingerprint in TSS2_CAR:
ret.stockFcw = bool(cp_cam.vl["ACC_HUD"]["FCW"])
ret.espDisabled = cp.vl["ESP_CONTROL"]["TC_DISABLED"] != 0
# 2 is standby, 10 is active. TODO: check that everything else is really a faulty state
self.steer_state = cp.vl["EPS_STATUS"]["LKA_STATE"]
@ -220,7 +223,13 @@ class CarState(CarStateBase):
]
if CP.carFingerprint in TSS2_CAR:
signals.append(("ACC_TYPE", "ACC_CONTROL"))
checks.append(("ACC_CONTROL", 33))
signals += [
("ACC_TYPE", "ACC_CONTROL"),
("FCW", "ACC_HUD"),
]
checks += [
("ACC_CONTROL", 33),
("ACC_HUD", 1),
]
return CANParser(DBC[CP.carFingerprint]["pt"], signals, checks, 2)

Loading…
Cancel
Save