From 5ace6188609094d0b0c23f4d9f36d45369eafd63 Mon Sep 17 00:00:00 2001 From: firestar5683 <168790843+firestar5683@users.noreply.github.com> Date: Sat, 2 May 2026 15:02:44 -0500 Subject: [PATCH] Update latcontrol_pid.py --- selfdrive/controls/lib/latcontrol_pid.py | 14 +++++++------- 1 file changed, 7 insertions(+), 7 deletions(-) diff --git a/selfdrive/controls/lib/latcontrol_pid.py b/selfdrive/controls/lib/latcontrol_pid.py index 468b91a33b..04ae4a3510 100644 --- a/selfdrive/controls/lib/latcontrol_pid.py +++ b/selfdrive/controls/lib/latcontrol_pid.py @@ -15,15 +15,15 @@ def civic_bosch_modified_lateral_testing_ground_active() -> bool: def get_civic_bosch_modified_pid_output_scale(desired_angle_deg: float, desired_angle_delta_deg: float, v_ego: float) -> float: abs_angle = abs(desired_angle_deg) speed_weight = min(max((v_ego - 4.0) / 10.0, 0.0), 1.0) - center_weight = min(max((4.0 - abs_angle) / 4.0, 0.0), 1.0) - angle_weight = min(max((abs_angle - 8.0) / 24.0, 0.0), 1.0) + center_weight = min(max((6.0 - abs_angle) / 6.0, 0.0), 1.0) + angle_weight = min(max((abs_angle - 6.0) / 22.0, 0.0), 1.0) phase = desired_angle_deg * desired_angle_delta_deg is_left = desired_angle_deg > 0.0 - center_taper = 0.06 - base_scale = 0.08 if is_left else 0.10 - turn_in_scale = 0.08 if is_left else 0.10 - unwind_scale = 0.10 if is_left else 0.14 + center_taper = 0.08 + base_scale = 0.10 if is_left else 0.12 + turn_in_scale = 0.10 if is_left else 0.14 + unwind_scale = 0.14 if is_left else 0.20 scale = 1.0 - (speed_weight * center_weight * center_taper) scale += speed_weight * angle_weight * base_scale @@ -32,7 +32,7 @@ def get_civic_bosch_modified_pid_output_scale(desired_angle_deg: float, desired_ elif phase < -0.2: scale -= speed_weight * angle_weight * unwind_scale - return max(scale, 0.84) + return max(scale, 0.78) class LatControlPID(LatControl):