Test2

Dependencies:   Motor mbed

Fork of Motor_HelloWorld_withblue by Brandon Weiner and Carlos Tallard

Committer:
bdragon52
Date:
Tue Nov 14 16:00:21 2017 +0000
Revision:
4:9714f4b9f081
Parent:
3:1c6163bd4363
df

Who changed what in which revision?

UserRevisionLine numberNew contents of line
simon 0:7bbc230e00d6 1 // Sweep the motor speed from full-speed reverse (-1.0) to full speed forwards (1.0)
simon 0:7bbc230e00d6 2
simon 0:7bbc230e00d6 3 #include "mbed.h"
simon 0:7bbc230e00d6 4 #include "Motor.h"
simon 0:7bbc230e00d6 5
bdragon52 1:294379552123 6
bdragon52 1:294379552123 7
bdragon52 1:294379552123 8 //int main() {
bdragon52 1:294379552123 9 // for (float s= -1.0; s < 1.0 ; s += 0.01) {
bdragon52 1:294379552123 10 // RW.speed(s);
bdragon52 1:294379552123 11 // wait(0.02);
bdragon52 1:294379552123 12 // }
bdragon52 1:294379552123 13 //}
bdragon52 1:294379552123 14
simon 0:7bbc230e00d6 15
bdragon52 1:294379552123 16 BusOut myled(LED1,LED2,LED3,LED4);
bdragon52 1:294379552123 17 Serial blue(p28,p27);
bdragon52 1:294379552123 18 Motor RW(p24, p12, p13); // pwm, fwd, rev
bdragon52 2:acb41f5ed1d0 19
bdragon52 1:294379552123 20 int main()
bdragon52 1:294379552123 21 {
bdragon52 4:9714f4b9f081 22 int i=0;
bdragon52 1:294379552123 23 char bnum=0;
bdragon52 1:294379552123 24 char bhit=0;
bdragon52 1:294379552123 25 while(1) {
bdragon52 1:294379552123 26
bdragon52 1:294379552123 27 if (blue.getc()=='!') {
bdragon52 1:294379552123 28 if (blue.getc()=='B') { //button data packet
bdragon52 1:294379552123 29 bnum = blue.getc(); //button number
bdragon52 1:294379552123 30 bhit = blue.getc(); //1=hit, 0=release
bdragon52 1:294379552123 31 if (blue.getc()==char(~('!' + 'B' + bnum + bhit))) { //checksum OK?
bdragon52 1:294379552123 32 myled = bnum - '0'; //current button number will appear on LEDs
bdragon52 1:294379552123 33 switch (bnum) {
bdragon52 1:294379552123 34 case '1': //number button 1
bdragon52 1:294379552123 35 if (bhit=='1') {
bdragon52 1:294379552123 36 RW.speed(1);
bdragon52 1:294379552123 37 //add hit code here
bdragon52 1:294379552123 38 } else {
bdragon52 1:294379552123 39 //add release code here
bdragon52 1:294379552123 40 }
bdragon52 1:294379552123 41 break;
bdragon52 1:294379552123 42 case '2': //number button 2
bdragon52 1:294379552123 43 if (bhit=='1') {
bdragon52 1:294379552123 44 RW.speed(0);
bdragon52 1:294379552123 45 //add hit code here
bdragon52 1:294379552123 46 } else {
bdragon52 1:294379552123 47 //add release code here
bdragon52 1:294379552123 48 }
bdragon52 1:294379552123 49 break;
bdragon52 1:294379552123 50 case '3': //number button 3
bdragon52 1:294379552123 51 if (bhit=='1') {
bdragon52 1:294379552123 52 //add hit code here
bdragon52 1:294379552123 53 } else {
bdragon52 1:294379552123 54 //add release code here
bdragon52 1:294379552123 55 }
bdragon52 1:294379552123 56 break;
bdragon52 1:294379552123 57 case '4': //number button 4
bdragon52 1:294379552123 58 if (bhit=='1') {
bdragon52 1:294379552123 59 //add hit code here
bdragon52 1:294379552123 60 } else {
bdragon52 1:294379552123 61 //add release code here
bdragon52 1:294379552123 62 }
bdragon52 1:294379552123 63 break;
bdragon52 1:294379552123 64 case '5': //button 5 up arrow
bdragon52 1:294379552123 65 if (bhit=='1') {
bdragon52 1:294379552123 66 //add hit code here
bdragon52 1:294379552123 67
bdragon52 1:294379552123 68 RW.speed(1);
bdragon52 1:294379552123 69
bdragon52 1:294379552123 70 } else {
bdragon52 1:294379552123 71
bdragon52 1:294379552123 72 RW.speed(0);
bdragon52 1:294379552123 73 //add release code here
bdragon52 1:294379552123 74 }
bdragon52 1:294379552123 75 break;
bdragon52 1:294379552123 76 case '6': //button 6 down arrow
bdragon52 1:294379552123 77 if (bhit=='1') {
bdragon52 1:294379552123 78 RW.speed(-1);
bdragon52 1:294379552123 79 //add hit code here
bdragon52 1:294379552123 80 } else {
bdragon52 1:294379552123 81 RW.speed(0);
bdragon52 1:294379552123 82 //add release code here
bdragon52 1:294379552123 83 }
bdragon52 1:294379552123 84 break;
bdragon52 1:294379552123 85 case '7': //button 7 left arrow
bdragon52 1:294379552123 86 if (bhit=='1') {
bdragon52 1:294379552123 87 //add hit code here
bdragon52 1:294379552123 88 } else {
bdragon52 1:294379552123 89 //add release code here
bdragon52 1:294379552123 90 }
bdragon52 1:294379552123 91 break;
bdragon52 1:294379552123 92 case '8': //button 8 right arrow
bdragon52 1:294379552123 93 if (bhit=='1') {
bdragon52 1:294379552123 94 //add hit code here
bdragon52 1:294379552123 95 } else {
bdragon52 1:294379552123 96 //add release code here
bdragon52 1:294379552123 97 }
bdragon52 1:294379552123 98 break;
bdragon52 1:294379552123 99 default:
bdragon52 1:294379552123 100 break;
bdragon52 1:294379552123 101 }
bdragon52 1:294379552123 102 }
bdragon52 1:294379552123 103 }
bdragon52 1:294379552123 104 }
simon 0:7bbc230e00d6 105 }
bdragon52 1:294379552123 106 }