From 2ab3c6106979a3e4a3ef6f3f5bf4f6831272a3c2 Mon Sep 17 00:00:00 2001
From: infiniteCable <75014343+infiniteCable@users.noreply.github.com>
Date: Mon, 21 Apr 2025 10:38:46 +0200
Subject: [PATCH] Update disturbance_controller.py

---
 selfdrive/controls/lib/disturbance_controller.py | 2 +-
 1 file changed, 1 insertion(+), 1 deletion(-)

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