Cooper Liu / Mbed 2 deprecated Sonar_Robot

Dependencies:   mbed RFSRF05

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



    }
}