Werkend motorscript met led feedback
Dependencies: Encoder MODSERIAL mbed HIDScope
Fork of frdm_Motortryout2 by
main.cpp
- Committer:
- Margreeth95
- Date:
- 2015-09-21
- Revision:
- 8:44d4f2eb6a81
- Parent:
- 7:7fce8b4db9d8
File content as of revision 8:44d4f2eb6a81:
#include "mbed.h" #include "encoder.h" #include "MODSERIAL.h" #include "HIDScope.h" Serial pc(USBTX, USBRX); // tx, rx DigitalOut led(LED_RED); DigitalOut motor2direction(D4); //D4 en D5 zijn motor 2 (op het motorshield) PwmOut motor2speed(D5); DigitalIn button1(SW3); HIDScope scope(1); Ticker ScopeTime; void ScopeSend()//Functie die de gegevens voor de scope uitleest en doorstuurt { scope.set(0, motor2direction.read()); scope.send(); } int main() { motor2direction = 0; motor2speed = 0; led = 1; pc.baud(9600); pc.printf("Tot aan loop werkt"); ScopeTime.attach_us(&ScopeSend, 10e4); while(true) { char c = pc.getc(); switch(c) { case 'f': { motor2direction = 1; motor2speed = 0.5f; pc.printf("het werkt\n"); wait(1); led = 0; wait(0.2f); motor2speed = 0; led = 1; break; } case 'r': { motor2direction = 0; motor2speed = 0.5f; pc.printf("dit werkt ook\n"); wait(1); led = 0; wait(0.2f); motor2speed = 0; led = 1; break; } } } }