Jorn Dokter / Mbed 2 deprecated TEB_branch2

Dependencies:   mbed QEI HIDScope biquadFilter MODSERIAL FastPWM

Revision:
31:d1bd16a05148
Parent:
30:161f748a1cce
Child:
32:da34d27a13f3
--- a/motorAndSensorControl.cpp	Wed Oct 09 13:40:50 2019 +0000
+++ b/motorAndSensorControl.cpp	Wed Oct 09 13:50:32 2019 +0000
@@ -72,13 +72,7 @@
         //Velocity calculation
             velocityMotor1 = ((countsMotor1[1]-countsMotor1[0])/countsToRadians)/dt; //rad/s
             velocityMotor2 = ((countsMotor2[1]-countsMotor2[0])/countsToRadians)/dt; //rad/s
-              /* 
-    countsMotor1Return = countsMotor1[1];
-    countsMotor2Return = countsMotor2[1];
-    velocityMotor1Return = velocityMotor1;
-    velocityMotor2Return = velocityMotor2;
-    */
-    /*
+    
     motorReturn.motor1.counts = countsMotor1[1];
     motorReturn.motor2.counts = countsMotor2[1];