mirror of
https://github.com/infiniteCable2/openpilot.git
synced 2026-08-05 00:05:57 +08:00
Update disturbance_controller.py
This commit is contained in:
@@ -61,7 +61,7 @@ class DisturbanceController:
|
||||
reaction_delayed = self.reaction_hist[0]
|
||||
disturbance = self.highpass_filter(actual_curvature, reaction)
|
||||
|
||||
error = desired_curvature + (reaction_delayed + disturbance)
|
||||
error = desired_curvature - (reaction_delayed - disturbance)
|
||||
output_curvature = self.pid.update(error, feedforward=desired_curvature, speed=CS.vEgo)
|
||||
|
||||
return float(output_curvature)
|
||||
|
||||
Reference in New Issue
Block a user