Robot code

Dependencies:   mbed

Embed: (wiki syntax)

« Back to documentation index

Show/hide line numbers main.cpp Source File

main.cpp

00001 #include "mbed.h"
00002 
00003 Serial xbee1(p9, p10);
00004 DigitalOut rst1(p11);
00005 
00006 DigitalOut rev(p22);
00007 DigitalOut fwd(p20);
00008 DigitalOut Led1(LED1);
00009 DigitalOut Led2(LED2);
00010 
00011 PwmOut pwmout(p21);
00012 
00013 Serial pc(USBTX, USBRX);
00014 
00015 int main() {
00016 
00017     rst1 = 0;   //Set reset pin to 0
00018     wait(.5);
00019     rst1 = 1;   //Set reset pin to 1
00020     int X = 0;
00021     wait(.5);
00022     pc.printf("starting rec");
00023     rev = 1;
00024     fwd = 0;
00025     char b = 'c';
00026     while(1) {
00027         if(xbee1.readable()) {
00028             char X = xbee1.getc(); //XBee read
00029             wait(.25);
00030             pc.printf("b = %f", X/100.0);
00031             pwmout = X/100.0;
00032     }
00033     }
00034 }