mirror of
https://github.com/firestar5683/StarPilot.git
synced 2026-07-03 20:42:09 +08:00
controlsd: fix steer saturation premature warning (#31909)
fix last actuators old-commit-hash: 4ecbaa41fae93d13fd0de805e216b670541a0084
This commit is contained in:
@@ -143,6 +143,7 @@ class Controls:
|
||||
self.logged_comm_issue = None
|
||||
self.not_running_prev = None
|
||||
self.steer_limited = False
|
||||
self.last_actuators = car.CarControl.Actuators.new_message()
|
||||
self.desired_curvature = 0.0
|
||||
self.experimental_mode = False
|
||||
self.personality = self.read_personality_param()
|
||||
@@ -620,7 +621,7 @@ class Controls:
|
||||
undershooting = abs(lac_log.desiredLateralAccel) / abs(1e-3 + lac_log.actualLateralAccel) > 1.2
|
||||
turning = abs(lac_log.desiredLateralAccel) > 1.0
|
||||
good_speed = CS.vEgo > 5
|
||||
max_torque = abs(actuators.steer) > 0.99
|
||||
max_torque = abs(self.last_actuators.steer) > 0.99
|
||||
if undershooting and turning and good_speed and max_torque:
|
||||
lac_log.active and self.events.add(EventName.steerSaturated)
|
||||
elif lac_log.saturated:
|
||||
@@ -727,6 +728,7 @@ class Controls:
|
||||
|
||||
if not self.CP.passive and self.initialized:
|
||||
self.card.controls_update(CC)
|
||||
self.last_actuators = CO.actuatorsOutput
|
||||
if self.CP.steerControlType == car.CarParams.SteerControlType.angle:
|
||||
self.steer_limited = abs(CC.actuators.steeringAngleDeg - CO.actuatorsOutput.steeringAngleDeg) > \
|
||||
STEER_ANGLE_SATURATION_THRESHOLD
|
||||
|
||||
Reference in New Issue
Block a user