br g5

Dependencies:   mbed QEI HIDScope Motor biquadFilter MODSERIAL FastPWM

Revision:
12:597f6b8224e5
Parent:
11:5171ac607099
--- a/main.cpp	Fri Sep 20 12:51:20 2019 +0000
+++ b/main.cpp	Fri Sep 20 13:02:15 2019 +0000
@@ -15,7 +15,7 @@
 int pulses = 131;
 QEI wheel (D13,D12,NC,pulses);
 
-int pin;
+int pin = 1;
 
 void flip()
 {
@@ -32,16 +32,18 @@
             if (pin == 1)
                 {
                 led.write(pot);
+                wait(0.1);
                 motor.write(pot);
-                printf("motor speeed is (%f)\n\r",pot.read());
-                printf("pulse number is (%i)\n\r",wheel.getPulses());
+                //printf("motor speeed is (%f)\n\r",pot.read());
+                //printf("pulse number is (%i)\n\r",wheel.getPulses());
                 }
             else
                 {
-                led.write(pot);
+                led.write(1-pot);
+                wait(0.1);
                 motor.write(-pot);
-                printf("motor speeed is (%f)\n\r",pot.read());
-                printf("pulse number is (%i)\n\r",wheel.getPulses());
+                //printf("motor speeed is (%f)\n\r",pot.read());
+                //printf("pulse number is (%i)\n\r",wheel.getPulses());
                 }
         }
 }
\ No newline at end of file