statemachine

Dependencies:   mbed QEI HIDScope biquadFilter MODSERIAL FastPWM

Revision:
16:0ff43ed4d259
Parent:
10:9101c7a4f219
Child:
17:3751c2c685ca
--- a/main.cpp	Fri Sep 20 12:07:59 2019 +0000
+++ b/main.cpp	Mon Sep 23 10:09:32 2019 +0000
@@ -1,40 +1,30 @@
 #include "mbed.h"
-#include "MODSERIAL.h";
-#include "FastPWM.h" ;
-#include "QEI.h" ;
+#include "MODSERIAL.h"
+#include "FastPWM.h" 
+#include "QEI.h" 
 
 Serial pc(USBTX,USBRX);
 
-InterruptIn button1(PTC2);
-InterruptIn button2(PTC3);
-InterruptIn button3(PTA4);
-InterruptIn button4(PTC6);
+AnalogIn pot(PTB2);
+InteruptIn button(PTB3)
 
-AnalogIn pot(PTB2);
-
-FastPWM motor(D5);
 FastPWM led(PTA1);
-//DigitalOut richting(D4);
+FastPWM motor(D5);
+DigitalOut direction(D4);
 
-//int direction = 0;
-//void flip() {
-//    direction = !direction;
-//}
-
-//DigitalOut richting(D4);
-
-int pulses = 131;
+int pulses = 4200;
 QEI wheel (D13,D12,NC,pulses);
 
 int main()
 { 
-    printf("Controll with dial\n");
+    printf("Control with dial\n");
         while(true)
             {
                 wait(0.1);
                 printf("motor speeed is (%f)\n\r",pot.read());
                 wait(0.1);
                 led.write(pot);
+                wait(0.1);
                 motor.write(pot);
                 wait(0.1);
                 printf("pulse number is (%i)\n\r",wheel.getPulses());