EMG check. met knopjes en toetsenboard emg signalen simuleren om de code te testen. groepje 12
Dependencies: MODSERIAL QEI mbed
Fork of EMG_check by
Diff: main.cpp
- Revision:
- 4:2b3fbd7ef1cf
- Parent:
- 3:34f7c16a6a7f
- Child:
- 5:d1d65e16fd9e
- Child:
- 7:9dc08a9a5991
--- a/main.cpp Sun Sep 25 12:13:20 2016 +0000 +++ b/main.cpp Fri Sep 30 09:16:26 2016 +0000 @@ -5,6 +5,10 @@ DigitalOut led2(LED_BLUE); InterruptIn sw3(SW3); Serial pc(USBTX, USBRX); +DigitalOut motor1(D4); +PwmOut pwm_motor1(D5); +DigitalOut motor2(D7); +PwmOut pwm_motor2(D6); int n = 0; void SwitchN() { // maakt simpele functie die 1 bij n optelt @@ -26,13 +30,21 @@ if (n%2==0) // als s ingedrukt wordt en het getal is even gebeurd het onderstaande { pc.printf("n is even \n\r"); // print lijn "n is even" - pc.printf("up \n\r"); // print lijn "up" + pc.printf("up \n\r"); // print lijn "up" + motor1 = 1; + pwm_motor1 = 1; + wait (0.05); } + pwm_motor1 = 0; else // als s is ingedrukt maar het getal is niet even (dus oneven) gebeurdt het onderstaande { pc.printf("n is odd \n\r"); // print lijn "n is odd" pc.printf("left \n\r"); // print lijn "left" - } + motor2 = 1; + pwm_motor2 = 1; + wait (0.05); + } + pwm_motor2 = 0; } else if (c=='d') // als d ingedrukt wordt gebeurd het volgende { @@ -40,12 +52,21 @@ { pc.printf("n is even \n\r"); // print lijn "n is even" pc.printf("down \n\r"); // print lijn "down" + motor1 = 0; + pwm_motor1 = 1; + wait (0.05); + } + pwm_motor1 = 0; else // als d is ingedrukt maar het getal is niet even (dus oneven) gebeurdt het onderstaande { pc.printf("n is odd \n\r"); // print lijn "n is odd" pc.printf("right \n\r"); // print lijn "right" - } + motor2 = 0; + pwm_motor2 = 1; + wait (0.05); + } + pwm_motor2=0; } }