Ramon Waninge / Mbed 2 deprecated Milestone1

Dependencies:   FastPWM mbed QEI biquadFilter HIDScope MODSERIAL

Revision:
40:1be9dfad0a10
Parent:
39:dcf3e5019a63
Child:
41:ca00cbb02f92
Child:
42:cef1b3187e4c
Child:
43:e8f2193822b7
--- a/main.cpp	Wed Oct 31 11:26:49 2018 +0000
+++ b/main.cpp	Wed Oct 31 13:42:39 2018 +0000
@@ -195,18 +195,22 @@
                 
     while   (true)
     {   
-        float* motoroutcomel = turnl();
-        float motorl1 = motoroutcomel[0];
-        float motorl2 = motoroutcomel[1];
-        float motorl3 = motoroutcomel[2];
-        pc.printf("     errorl:  %f      refl: %f     anglel:  %f \r\n",motorl1,motorl2,motorl3);
+        turnl();
+        turnr();
+        wait(dt);
+        //float* motoroutcomel = turnl();
+        //float motorl1 = motoroutcomel[0];
+        //float motorl2 = motoroutcomel[1];
+        //float motorl3 = motoroutcomel[2];
+        //pc.printf("     errorl:  %f      refl: %f     anglel:  %f \r\n",motorl1,motorl2,motorl3);
         
-        float* motoroutcomer = turnr();
-        float motorr1 = motoroutcomer[0];
-        float motorr2 = motoroutcomer[1];
-        float motorr3 = motoroutcomer[2];              
-        pc.printf("     errorr:  %f      refr: %f     angler:  %f \r\n",motorr1,motorr2,motorr3);
-        wait(dt);
+        //float* motoroutcomer = turnr();
+        //float motorr1 = motoroutcomer[0];
+        //float motorr2 = motoroutcomer[1];
+        //float motorr3 = motoroutcomer[2];              
+        //pc.printf("     errorr:  %f      refr: %f     angler:  %f \r\n",motorr1,motorr2,motorr3);
+        
+        //wait(dt);
         //wait(dt*10);
         //wait(printingfreq);  --> still needs to be defined   
     }