statemachine
Dependencies: mbed QEI HIDScope biquadFilter MODSERIAL FastPWM
Diff: main.cpp
- 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); } - } +}