Sooner Competitive Robotics / Mbed 2 deprecated IEEE_14_Freescale

Dependencies:   mbed

Fork of IEEE_14_Freescale by IEEE 2014 Mbed

main.cpp

Committer:
soonerbot
Date:
2013-11-17
Revision:
2:7c6b494f9005
Parent:
1:c28fac16a109
Child:
3:a223b0bf8256

File content as of revision 2:7c6b494f9005:

#include "mbed.h"
#include "dbgprint.h"
#include "robot.h"

BusOut leds(LED_RED,LED_GREEN,LED_BLUE);
Serial pc(USBTX, USBRX);

robot bot;
int main() {
    DBGPRINT("AA\n\r",1);
    char tmpchar = 0;
    leds = 0x2;
    const int* constbuf;
    while(1) {
        DBGPRINT("BB\n\r",1);
        leds = leds^0x7;
        tmpchar = pc.getc();
        
        switch(tmpchar){
            case 'q':
                constbuf = bot.bigenc.getVals();
                DBGPRINT("\n\r%d\t%d\t%d\t%d\n\r",constbuf[0],constbuf[1],constbuf[2],constbuf[3]);
                break;
            case 'w':
                bot.left.setPower(0.2);
                bot.right.setPower(0.2);
                break;
            case 'a':
                bot.left.setPower(-0.1);
                bot.right.setPower(0.2);
                break;
            case 'd':
                bot.left.setPower(0.2);
                bot.right.setPower(0.1);
                break;
            default:
                bot.left.brake();
                bot.right.brake();
                break;
                
        }
    }
}