|
|
@ -38,7 +38,6 @@ class CarController(): |
|
|
|
self.last_standstill = False |
|
|
|
self.last_standstill = False |
|
|
|
self.standstill_req = False |
|
|
|
self.standstill_req = False |
|
|
|
|
|
|
|
|
|
|
|
self.last_fault_frame = -200 |
|
|
|
|
|
|
|
self.steer_rate_limited = False |
|
|
|
self.steer_rate_limited = False |
|
|
|
|
|
|
|
|
|
|
|
self.fake_ecus = set() |
|
|
|
self.fake_ecus = set() |
|
|
@ -73,12 +72,8 @@ class CarController(): |
|
|
|
apply_steer = apply_toyota_steer_torque_limits(new_steer, self.last_steer, CS.out.steeringTorqueEps, SteerLimitParams) |
|
|
|
apply_steer = apply_toyota_steer_torque_limits(new_steer, self.last_steer, CS.out.steeringTorqueEps, SteerLimitParams) |
|
|
|
self.steer_rate_limited = new_steer != apply_steer |
|
|
|
self.steer_rate_limited = new_steer != apply_steer |
|
|
|
|
|
|
|
|
|
|
|
# only cut torque when steer state is a known fault |
|
|
|
# Cut steering while we're in a known fault state (2s) |
|
|
|
if CS.steer_state in [9, 25]: |
|
|
|
if not enabled or CS.steer_state in [9, 25]: |
|
|
|
self.last_fault_frame = frame |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
# Cut steering for 2s after fault |
|
|
|
|
|
|
|
if not enabled or (frame - self.last_fault_frame < 200): |
|
|
|
|
|
|
|
apply_steer = 0 |
|
|
|
apply_steer = 0 |
|
|
|
apply_steer_req = 0 |
|
|
|
apply_steer_req = 0 |
|
|
|
else: |
|
|
|
else: |
|
|
|