diff --git a/selfdrive/controls/controlsd.py b/selfdrive/controls/controlsd.py index 967f7da31..c19733b87 100644 --- a/selfdrive/controls/controlsd.py +++ b/selfdrive/controls/controlsd.py @@ -715,9 +715,8 @@ class Controls: desired_lateral_accel = model_v2.action.desiredCurvature * (clipped_speed**2) undershooting = abs(desired_lateral_accel) / abs(1e-3 + actual_lateral_accel) > 1.2 turning = abs(desired_lateral_accel) > 1.0 - good_speed = CS.vEgo > 5 commanded_torque_at_max = abs(lac_log.output) > 0.99 - if undershooting and turning and good_speed and commanded_torque_at_max: + if undershooting and turning and (lac_log.saturated or commanded_torque_at_max): if self.frogpilot_toggles.goat_scream_alert: self.frogpilot_events.add(FrogPilotEventName.goatSteerSaturated) else: