Revert "Try centering gain"

This reverts commit 7c1cad687c.
This commit is contained in:
firestar5683
2025-11-29 22:29:43 -06:00
parent caeeb30cc3
commit 038a5e20e2
2 changed files with 2 additions and 9 deletions
+2 -2
View File
@@ -98,8 +98,8 @@ class DesireHelper:
# LaneChangeState.laneChangeStarting
elif self.lane_change_state == LaneChangeState.laneChangeStarting:
# fade out over 1s
self.lane_change_ll_prob = max(self.lane_change_ll_prob - 1.0 * DT_MDL, 0.0)
# fade out over .5s
self.lane_change_ll_prob = max(self.lane_change_ll_prob - 2 * DT_MDL, 0.0)
# 98% certainty
if lane_change_prob < 0.02 and self.lane_change_ll_prob < 0.01:
@@ -82,13 +82,6 @@ class LatControlTorque(LatControl):
measurement = measured_curvature * CS.vEgo ** 2
error = setpoint - measurement
# Lane centering correction for better center-lane keeping
CENTERING_GAIN_BP = [0, 10, 20, 30] # m/s breakpoints
CENTERING_GAIN_V = [0.15, 0.12, 0.08, 0.05] # correction gains
centering_gain = np.interp(CS.vEgo, CENTERING_GAIN_BP, CENTERING_GAIN_V)
lane_centering_correction = centering_gain * error
error += lane_centering_correction
# do error correction in lateral acceleration space, convert at end to handle non-linear torque responses correctly
pid_log.error = float(error)
ff = gravity_adjusted_future_lateral_accel