Update disturbance_controller.py

This commit is contained in:
infiniteCable
2025-04-20 18:34:55 +02:00
committed by GitHub
parent d3d1617a10
commit 7fc2b5ea26
@@ -60,7 +60,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)