Controlsd: fix bug in curv rate limit (#23250)

* Controlsd: fix bug in curv rate limit

* update ref
pull/23404/head
HaraldSchafer 3 years ago committed by GitHub
parent 15be8a8c1f
commit d3f064f5ca
No known key found for this signature in database
GPG Key ID: 4AEE18F83AFDEB23
  1. 4
      selfdrive/controls/lib/drive_helpers.py
  2. 2
      selfdrive/test/process_replay/ref_commit

@ -119,6 +119,6 @@ def get_lag_adjusted_curvature(CP, v_ego, psis, curvatures, curvature_rates):
-max_curvature_rate,
max_curvature_rate)
safe_desired_curvature = clip(desired_curvature,
current_curvature - max_curvature_rate/DT_MDL,
current_curvature + max_curvature_rate/DT_MDL)
current_curvature - max_curvature_rate * DT_MDL,
current_curvature + max_curvature_rate * DT_MDL)
return safe_desired_curvature, safe_desired_curvature_rate

@ -1 +1 @@
67534ae58a87b6993a0a9653d255e629785a07c3
e0ac3ca09baaf0d791d0e7734799bb297ad91f79
Loading…
Cancel
Save