Update disturbance_controller.py

This commit is contained in:
infiniteCable
2025-04-20 21:08:25 +02:00
committed by GitHub
parent 545a6595d6
commit 084f7d4bad
@@ -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)