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 sibren vuurberg

Committer:
sivuu
Date:
Fri Sep 30 11:29:25 2016 +0000
Revision:
9:4870f0e789f8
Parent:
7:9dc08a9a5991
Child:
10:06d0fe6b3bcf
met de meest optimale wait van 0.3 seconde. dit zorgt ervoor dat de hapering weg is maar zorgt ook voor een vertraging van de motoren.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
sivuu 0:b7cb5d3978b5 1 #include "mbed.h"
sivuu 3:34f7c16a6a7f 2 //#include "MODSERIAL.h"
sivuu 2:4dcdf7755a04 3
sivuu 9:4870f0e789f8 4 //DigitalOut led(LED_RED);
sivuu 9:4870f0e789f8 5 //DigitalOut led2(LED_BLUE);
sivuu 2:4dcdf7755a04 6 InterruptIn sw3(SW3);
sivuu 0:b7cb5d3978b5 7 Serial pc(USBTX, USBRX);
sivuu 4:2b3fbd7ef1cf 8 DigitalOut motor1(D4);
sivuu 4:2b3fbd7ef1cf 9 PwmOut pwm_motor1(D5);
sivuu 4:2b3fbd7ef1cf 10 DigitalOut motor2(D7);
sivuu 4:2b3fbd7ef1cf 11 PwmOut pwm_motor2(D6);
sivuu 2:4dcdf7755a04 12 int n = 0;
sivuu 2:4dcdf7755a04 13
sivuu 3:34f7c16a6a7f 14 void SwitchN() { // maakt simpele functie die 1 bij n optelt
sivuu 2:4dcdf7755a04 15 n++;
sivuu 2:4dcdf7755a04 16 }
sivuu 2:4dcdf7755a04 17
sivuu 0:b7cb5d3978b5 18 int main()
sivuu 0:b7cb5d3978b5 19 {
sivuu 3:34f7c16a6a7f 20 pc.baud(115200); // zorgt voor de link voor putty
sivuu 3:34f7c16a6a7f 21
sivuu 3:34f7c16a6a7f 22 while (true) { // zorgt er voor dat de code oneindig doorgelopen wordt
sivuu 2:4dcdf7755a04 23
sivuu 3:34f7c16a6a7f 24 sw3.fall(&SwitchN); // zorrgt er voor dat void switch wordt gedaan als switch 3 wordt ingedrukt
sivuu 0:b7cb5d3978b5 25
sivuu 3:34f7c16a6a7f 26 char c = pc.getc(); // zorgt ervoor dat er in het toetsenboard characters gebruikt kunnen worden
sivuu 0:b7cb5d3978b5 27
sivuu 3:34f7c16a6a7f 28 if (c=='s') // als s ingedrukt wordt gebeurd het volgende
sivuu 3:34f7c16a6a7f 29 {
sivuu 3:34f7c16a6a7f 30 if (n%2==0) // als s ingedrukt wordt en het getal is even gebeurd het onderstaande
sivuu 3:34f7c16a6a7f 31 {
sivuu 3:34f7c16a6a7f 32 pc.printf("n is even \n\r"); // print lijn "n is even"
sivuu 4:2b3fbd7ef1cf 33 pc.printf("up \n\r"); // print lijn "up"
sivuu 4:2b3fbd7ef1cf 34 motor1 = 1;
sivuu 4:2b3fbd7ef1cf 35 pwm_motor1 = 1;
sivuu 9:4870f0e789f8 36 wait (0.03);
sivuu 7:9dc08a9a5991 37 pwm_motor1 = 0;
sivuu 3:34f7c16a6a7f 38 }
sivuu 7:9dc08a9a5991 39
sivuu 3:34f7c16a6a7f 40 else // als s is ingedrukt maar het getal is niet even (dus oneven) gebeurdt het onderstaande
sivuu 3:34f7c16a6a7f 41 {
sivuu 3:34f7c16a6a7f 42 pc.printf("n is odd \n\r"); // print lijn "n is odd"
sivuu 3:34f7c16a6a7f 43 pc.printf("left \n\r"); // print lijn "left"
sivuu 4:2b3fbd7ef1cf 44 motor2 = 1;
sivuu 4:2b3fbd7ef1cf 45 pwm_motor2 = 1;
sivuu 9:4870f0e789f8 46 wait (0.03);
sivuu 7:9dc08a9a5991 47 pwm_motor2 = 0;
sivuu 4:2b3fbd7ef1cf 48 }
sivuu 7:9dc08a9a5991 49
sivuu 3:34f7c16a6a7f 50 }
sivuu 3:34f7c16a6a7f 51 else if (c=='d') // als d ingedrukt wordt gebeurd het volgende
sivuu 3:34f7c16a6a7f 52 {
sivuu 3:34f7c16a6a7f 53 if (n%2==0) // als d is ingedrukt en n is even dan gebeurd het volgende
sivuu 3:34f7c16a6a7f 54 {
sivuu 3:34f7c16a6a7f 55 pc.printf("n is even \n\r"); // print lijn "n is even"
sivuu 3:34f7c16a6a7f 56 pc.printf("down \n\r"); // print lijn "down"
sivuu 4:2b3fbd7ef1cf 57 motor1 = 0;
sivuu 4:2b3fbd7ef1cf 58 pwm_motor1 = 1;
sivuu 9:4870f0e789f8 59 wait (0.03);
sivuu 7:9dc08a9a5991 60 pwm_motor1 = 0;
sivuu 3:34f7c16a6a7f 61 }
sivuu 7:9dc08a9a5991 62
sivuu 3:34f7c16a6a7f 63 else // als d is ingedrukt maar het getal is niet even (dus oneven) gebeurdt het onderstaande
sivuu 3:34f7c16a6a7f 64 {
sivuu 3:34f7c16a6a7f 65 pc.printf("n is odd \n\r"); // print lijn "n is odd"
sivuu 3:34f7c16a6a7f 66 pc.printf("right \n\r"); // print lijn "right"
sivuu 4:2b3fbd7ef1cf 67 motor2 = 0;
sivuu 4:2b3fbd7ef1cf 68 pwm_motor2 = 1;
sivuu 9:4870f0e789f8 69 wait (0.03);
sivuu 7:9dc08a9a5991 70 pwm_motor2=0;
sivuu 4:2b3fbd7ef1cf 71 }
sivuu 7:9dc08a9a5991 72
sivuu 3:34f7c16a6a7f 73 }
sivuu 3:34f7c16a6a7f 74
sivuu 0:b7cb5d3978b5 75 }
sivuu 3:34f7c16a6a7f 76 }
sivuu 3:34f7c16a6a7f 77