mirror of
https://github.com/firestar5683/StarPilot.git
synced 2026-07-01 03:22:07 +08:00
Controlsd: fix bug in curv rate limit (#23250)
* Controlsd: fix bug in curv rate limit * update ref old-commit-hash: d3f064f5ca2563ab139687550eb5d3139b6b8fea
This commit is contained in:
@@ -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
|
||||
Reference in New Issue
Block a user