Toyota LTA: prevent high driver torque fault (#28850)

LTA also suffers from this fault
pull/28780/head
Shane Smiskol 2 years ago committed by GitHub
parent b349a8c940
commit 54ca26ab26
No known key found for this signature in database
GPG Key ID: 4AEE18F83AFDEB23
  1. 4
      selfdrive/car/toyota/carcontroller.py

@ -81,7 +81,7 @@ class CarController:
# Angular rate limit based on speed # Angular rate limit based on speed
apply_angle = apply_std_steer_angle_limits(apply_angle, self.last_angle, CS.out.vEgo, self.params) apply_angle = apply_std_steer_angle_limits(apply_angle, self.last_angle, CS.out.vEgo, self.params)
if not CC.latActive: if not lat_active:
apply_angle = CS.out.steeringAngleDeg + CS.out.steeringAngleOffsetDeg apply_angle = CS.out.steeringAngleDeg + CS.out.steeringAngleOffsetDeg
self.last_angle = clip(apply_angle, -MAX_STEER_ANGLE, MAX_STEER_ANGLE) self.last_angle = clip(apply_angle, -MAX_STEER_ANGLE, MAX_STEER_ANGLE)
@ -93,7 +93,7 @@ class CarController:
# on consecutive messages # on consecutive messages
can_sends.append(create_steer_command(self.packer, apply_steer, apply_steer_req)) can_sends.append(create_steer_command(self.packer, apply_steer, apply_steer_req))
if self.frame % 2 == 0 and self.CP.carFingerprint in TSS2_CAR: if self.frame % 2 == 0 and self.CP.carFingerprint in TSS2_CAR:
lta_active = CC.latActive and self.CP.steerControlType == SteerControlType.angle lta_active = lat_active and self.CP.steerControlType == SteerControlType.angle
can_sends.append(create_lta_steer_command(self.packer, self.last_angle, lta_active, self.frame // 2)) can_sends.append(create_lta_steer_command(self.packer, self.last_angle, lta_active, self.frame // 2))
# *** gas and brake *** # *** gas and brake ***

Loading…
Cancel
Save