For Publish

Dependencies:   Motordriver mbed

main.cpp

Committer:
zmcpro2
Date:
2017-03-14
Revision:
0:62e31c266471

File content as of revision 0:62e31c266471:

#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;
                        }
                    }
                }
            }
    }
}