Ilya Khorosh
/
Lab3_Robot
Robot code
Embed:
(wiki syntax)
Show/hide line numbers
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 }
Generated on Fri Jul 29 2022 02:31:16 by 1.7.2