Cooper Liu
/
Sonar_Robot
main.cpp
- Committer:
- xiaxia686
- Date:
- 2012-03-14
- Revision:
- 0:9352a72a9d85
File content as of revision 0:9352a72a9d85:
#include "mbed.h" #include "RFSRF05.h" DigitalOut Led_1(LED1); DigitalOut Led_2(LED2); RFSRF05 my_srf(p13,p21,p22,p23,p24,p25,p26,p5,p6,p7,p8,p9); Serial pc(USBTX, USBRX); // tx, rx float Distance[3],Distance_Shortest,Distance_Largest; volatile char SendByte; int main() { pc.printf("Robot Side Side \n"); while (1) { Led_2 = 1; wait_ms(100); Distance[0] = my_srf.read0(); Distance[1] = my_srf.read1(); Distance[2] = my_srf.read2(); pc.printf("%.1f, %.1f, %.1f \n",Distance[0],Distance[1],Distance[2]); // pc.printf("Distance0 = %.1f\n",Distance[0]); // pc.printf("Distance1 = %.1f\n",Distance[1]); // pc.printf("Distance2 = %.1f\n",Distance[2]); // pc.printf("\n\r"); Led_2 = 0; wait_ms(50); } }