rampscenario
Dependencies: MODSERIAL QEI mbed
Fork of check_motoren_buttons by
main.cpp@9:4870f0e789f8, 2016-09-30 (annotated)
- 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?
User | Revision | Line number | New 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 |