From 993383a53da0c1fdc0d3ad703702e124ef6395ab Mon Sep 17 00:00:00 2001
From: EmaMaker <emamaker0@gmail.com>
Date: Tue, 12 Nov 2019 09:03:18 +0100
Subject: [PATCH] corretta una boiata

---
 src/drivecontroller.cpp | 7 +------
 1 file changed, 1 insertion(+), 6 deletions(-)

diff --git a/src/drivecontroller.cpp b/src/drivecontroller.cpp
index 111ac35..853ddf9 100644
--- a/src/drivecontroller.cpp
+++ b/src/drivecontroller.cpp
@@ -36,15 +36,10 @@ void DriveController::drive(int dir, int speed, int tilt){
     speed3 = -(speed1);
     speed4 = -(speed2);
 
-    /*speed1 = ((-(sins[((direzione - 45) + 360) % 360])) * vMot);          // mot 1
-    speed2 = ((-(sins[((direzione - 135) + 360)% 360])) * vMot);          // mot 2
-    speed3 = -(speed1);                                                   // mot 3
-    speed4 = -(speed2);*/ 
-
     // calcola l'errore di posizione rispetto allo 0
     delta = compass->getValue();
     if(delta > 180) delta = delta-360;
-    delta = delta - pTilt;
+    delta = delta - tilt;
 
     // calcola correzione proporzionale
     errorP = KP * delta;