br g5

Dependencies:   mbed QEI HIDScope Motor biquadFilter MODSERIAL FastPWM

Revision:
9:cdcf30051100
Parent:
7:d5e07647dfea
Child:
10:9101c7a4f219
--- a/main.cpp	Fri Sep 20 09:57:41 2019 +0000
+++ b/main.cpp	Fri Sep 20 11:48:08 2019 +0000
@@ -1,6 +1,7 @@
 #include "mbed.h"
 #include "MODSERIAL.h";
 #include "FastPWM.h" ;
+#include "QEI.h" ;
 
 Serial pc(USBTX,USBRX);
 
@@ -12,12 +13,26 @@
 AnalogIn pot(PTB2);
 
 FastPWM motor(D5);
+FastPWM led(PTA1);
+DigitalOut richting(D4);
+
+int direction = 0;
+void flip() {
+    direction = !direction;
+}
 
 int main(){ 
     printf("Controll with dial\n");    
-        while(true){
+    
+    button2.rise(&flip);
+        
+        while(true)
+{
             wait(0.1);
-            printf("motor speed is (%f)\n\r",pot.read()); wait(0.1);
+            printf("motor speed is (%f)\n\r",pot.read()); 
+            wait(0.1);
+            richting.write(direction);
+            led.write(pot);
             motor.write(pot);
             }
-    }
+}