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