Diff: main.cpp

Revision:

0:62e31c266471

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Tue Mar 14 15:07:15 2017 +0000
@@ -0,0 +1,96 @@
+#include "mbed.h"
+#include "motordriver.h"
+
+BusOut myled(LED1,LED2,LED3,LED4);
+Serial blue(p28,p27);
+
+Motor A(p23, p6, p5, 1); // pwm, fwd, rev, can brake 
+Motor B(p21, p7, p8, 1); // pwm, fwd, rev, can brake
+
+int main()
+{
+    char bnum=0;
+    char bhit=0;
+    //float sL=1;
+    //float sR=1;
+    while(1) {
+            
+            if (blue.getc()=='!') {
+                if (blue.getc()=='B') { //button data packet
+                    bnum = blue.getc(); //button number
+                    bhit = blue.getc(); //1=hit, 0=release
+                    if (blue.getc()==char(~('!' + 'B' + bnum + bhit))) { //checksum OK?
+                        myled = bnum - '0'; //current button number will appear on LEDs
+                        switch (bnum) {
+                            case '1': //number button 1
+                                if (bhit=='1') {
+                                    //add hit code here
+                                } else {
+                                    //add release code here
+                                }
+                                break;
+                            case '2': //number button 2
+                                if (bhit=='1') {
+                                    //add hit code here
+                                } else {
+                                    //add release code here
+                                }
+                                break;
+                            case '3': //number button 3
+                                if (bhit=='1') {
+                                    //add hit code here
+                                } else {
+                                    //add release code here
+                                }
+                                break;
+                            case '4': //number button 4
+                                if (bhit=='1') {
+                                    //add hit code here
+                                } else {
+                                    //add release code here
+                                }
+                                break;
+                            case '5': //button 5 up arrow
+                                if (bhit=='1') {
+                                    A.speed(1); 
+                                    B.speed(1);
+                                    wait(0.02);
+                                } else {
+                                    //add release code here
+                                }
+                                break;
+                            case '6': //button 6 down arrow
+                                if (bhit=='1') {
+                                    A.speed(-1); 
+                                    B.speed(-1);
+                                    wait(0.02);
+                                } else {
+                                    //add release code here
+                                }
+                                break;
+                            case '7': //button 7 left arrow
+                                if (bhit=='1') {
+                                    A.speed(0); 
+                                    B.speed(1);
+                                    wait(0.02);
+                                } else {
+                                    //add release code here
+                                }
+                                break;
+                            case '8': //button 8 right arrow
+                                if (bhit=='1') {
+                                    A.speed(1); 
+                                    B.speed(0);
+                                    wait(0.02);
+                                } else {
+                                    //add release code here
+                                }
+                                break;
+                            default:
+                                break;
+                        }
+                    }
+                }
+            }
+    }
+}
\ No newline at end of file