From fc840b84be21160273372a1ff3ee3159c1264edb Mon Sep 17 00:00:00 2001
From: EmaMaker <emamaker0@gmail.com>
Date: Mon, 10 Feb 2020 19:55:56 +0100
Subject: [PATCH] corrected a few errors, Furio plays is more precise than ever
 when playing

---
 include/drivecontroller.h |  3 +--
 src/drivecontroller.cpp   | 15 ---------------
 2 files changed, 1 insertion(+), 17 deletions(-)

diff --git a/include/drivecontroller.h b/include/drivecontroller.h
index 6b5c4d3..d5d20af 100755
--- a/include/drivecontroller.h
+++ b/include/drivecontroller.h
@@ -18,8 +18,7 @@ class DriveController{
         DriveController(Motor* m1_, Motor* m2_, Motor* m3_, Motor* m4_);
         
         void drive(int dir=0, int speed=0, int tilt=0);
-        void prepareDrive(int dir, int speed, int tilt);
-        void prepareDrive(int dir, int speed);
+        void prepareDrive(int dir, int speed, int tilt=0);
         void drivePrepared();
         float updatePid();
         float torad(float f);
diff --git a/src/drivecontroller.cpp b/src/drivecontroller.cpp
index 1f5be34..a0a8373 100755
--- a/src/drivecontroller.cpp
+++ b/src/drivecontroller.cpp
@@ -15,9 +15,6 @@ DriveController::DriveController(Motor* m1_, Motor* m2_, Motor* m3_, Motor* m4_)
     pDir = 0;
     pSpeed = 0;
     pTilt = 0;
-    gDir = 0;
-    gSpeed = 0;
-    gTilt = 0;
 
     vx = 0;
     vy = 0;
@@ -51,12 +48,6 @@ void DriveController::prepareDrive(int dir, int speed, int tilt){
     pTilt = tilt;
 }
 
-void DriveController::prepareDrive(int dir, int speed){
-    pDir = dir;
-    pSpeed = speed;
-    pDir = gTilt;
-}
-
 void DriveController::drivePrepared(){
     drive(pDir, pSpeed, pTilt);
 }
@@ -66,10 +57,6 @@ float DriveController::torad(float f){
 }
 
 void DriveController::drive(int dir, int speed, int tilt){
-    gDir = dir;
-    gSpeed = speed;
-    gTilt = tilt;
-
     vx = ((speed * cosins[dir]));
     vy = ((-speed * sins[dir]));
 
@@ -100,9 +87,7 @@ void DriveController::drive(int dir, int speed, int tilt){
     }
 
     input = delta;
-
     pid->Compute();             
-
     pidfactor = delta > 180 ? output*-1 : output;
 
     speed1 += pidfactor;