rampscenario

Dependencies:   MODSERIAL QEI mbed

Fork of check_motoren_buttons by Daniqe Kottelenberg

Committer:
sivuu
Date:
Fri Sep 30 12:34:46 2016 +0000
Revision:
11:757787c47d3c
Parent:
8:432dc3ed8ea3
Child:
12:20b8999018df
voordat danique de "s" en 'd' vervangt door knopjes

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 0:b7cb5d3978b5 4 DigitalOut led(LED_RED);
sivuu 0:b7cb5d3978b5 5 DigitalOut led2(LED_BLUE);
sivuu 2:4dcdf7755a04 6 InterruptIn sw3(SW3);
sivuu 0:b7cb5d3978b5 7 Serial pc(USBTX, USBRX);
sivuu 6:e6a048f541ee 8 DigitalOut richting_motor1(D4);
sivuu 4:2b3fbd7ef1cf 9 PwmOut pwm_motor1(D5);
sivuu 6:e6a048f541ee 10 DigitalOut richting_motor2(D7);
sivuu 4:2b3fbd7ef1cf 11 PwmOut pwm_motor2(D6);
sivuu 6:e6a048f541ee 12 int n = 0; //start van de teller wordt op nul gesteld
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 11:757787c47d3c 17
sivuu 2:4dcdf7755a04 18
sivuu 0:b7cb5d3978b5 19 int main()
sivuu 0:b7cb5d3978b5 20 {
sivuu 6:e6a048f541ee 21 pc.baud(115200); // zorgt voor de link voor putty, 115200 is snelheid
sivuu 6:e6a048f541ee 22
sivuu 3:34f7c16a6a7f 23 while (true) { // zorgt er voor dat de code oneindig doorgelopen wordt
sivuu 2:4dcdf7755a04 24
sivuu 6:e6a048f541ee 25 sw3.fall(&SwitchN); // zorgt er voor dat void switch wordt gedaan als switch 3 wordt ingedrukt
sivuu 0:b7cb5d3978b5 26
sivuu 11:757787c47d3c 27
sivuu 3:34f7c16a6a7f 28 char c = pc.getc(); // zorgt ervoor dat er in het toetsenboard characters gebruikt kunnen worden
sivuu 11:757787c47d3c 29 pc.printf("%c \n\r",c);
sivuu 0:b7cb5d3978b5 30
sivuu 3:34f7c16a6a7f 31 if (c=='s') // als s ingedrukt wordt gebeurd het volgende
sivuu 3:34f7c16a6a7f 32 {
sivuu 3:34f7c16a6a7f 33 if (n%2==0) // als s ingedrukt wordt en het getal is even gebeurd het onderstaande
sivuu 3:34f7c16a6a7f 34 {
sivuu 3:34f7c16a6a7f 35 pc.printf("n is even \n\r"); // print lijn "n is even"
sivuu 4:2b3fbd7ef1cf 36 pc.printf("up \n\r"); // print lijn "up"
sivuu 6:e6a048f541ee 37 richting_motor1 = 1;
sivuu 6:e6a048f541ee 38 pwm_motor1 = 1;
sivuu 4:2b3fbd7ef1cf 39 wait (0.05);
sivuu 3:34f7c16a6a7f 40 }
sivuu 6:e6a048f541ee 41
sivuu 3:34f7c16a6a7f 42 else // als s is ingedrukt maar het getal is niet even (dus oneven) gebeurdt het onderstaande
sivuu 3:34f7c16a6a7f 43 {
sivuu 3:34f7c16a6a7f 44 pc.printf("n is odd \n\r"); // print lijn "n is odd"
sivuu 3:34f7c16a6a7f 45 pc.printf("left \n\r"); // print lijn "left"
sivuu 6:e6a048f541ee 46 richting_motor2 = 1;
sivuu 4:2b3fbd7ef1cf 47 pwm_motor2 = 1;
sivuu 4:2b3fbd7ef1cf 48 wait (0.05);
sivuu 6:e6a048f541ee 49 }
sivuu 6:e6a048f541ee 50
sivuu 3:34f7c16a6a7f 51 }
sivuu 3:34f7c16a6a7f 52 else if (c=='d') // als d ingedrukt wordt gebeurd het volgende
sivuu 3:34f7c16a6a7f 53 {
sivuu 3:34f7c16a6a7f 54 if (n%2==0) // als d is ingedrukt en n is even dan gebeurd het volgende
sivuu 3:34f7c16a6a7f 55 {
sivuu 3:34f7c16a6a7f 56 pc.printf("n is even \n\r"); // print lijn "n is even"
sivuu 3:34f7c16a6a7f 57 pc.printf("down \n\r"); // print lijn "down"
sivuu 6:e6a048f541ee 58 richting_motor1 = 0;
sivuu 4:2b3fbd7ef1cf 59 pwm_motor1 = 1;
sivuu 4:2b3fbd7ef1cf 60 wait (0.05);
sivuu 6:e6a048f541ee 61
sivuu 3:34f7c16a6a7f 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 6:e6a048f541ee 67 richting_motor2 = 0;
sivuu 4:2b3fbd7ef1cf 68 pwm_motor2 = 1;
sivuu 6:e6a048f541ee 69 wait (0.05);
sivuu 8:432dc3ed8ea3 70 }
sivuu 11:757787c47d3c 71 }
sivuu 11:757787c47d3c 72 else{
sivuu 11:757787c47d3c 73 pc.printf("motor staat stil \n\r");
sivuu 11:757787c47d3c 74 pwm_motor2=0;
sivuu 8:432dc3ed8ea3 75 pwm_motor1=0;
sivuu 6:e6a048f541ee 76 }
sivuu 8:432dc3ed8ea3 77
sivuu 3:34f7c16a6a7f 78
sivuu 0:b7cb5d3978b5 79 }
sivuu 3:34f7c16a6a7f 80 }
sivuu 3:34f7c16a6a7f 81