diff --git a/selfdrive/controls/lib/disturbance_controller.py b/selfdrive/controls/lib/disturbance_controller.py index 586cf8474..fa5373a7c 100644 --- a/selfdrive/controls/lib/disturbance_controller.py +++ b/selfdrive/controls/lib/disturbance_controller.py @@ -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)