Delta for AGV

Dependencies:   mbed HC-SR04 ros_lib_kinetic

main.cpp

Committer:
tbjazic
Date:
2015-12-07
Revision:
3:3297ea6e3ae1
Parent:
2:f86b1e3609b3
Child:
4:052ac3f5c938

File content as of revision 3:3297ea6e3ae1:

#include "mbed.h"
#include "HCSR04.h"

Serial pc(USBTX, USBRX);

int main() {
    HCSR04 sensor(p5, p7);
    sensor.setRanges(10, 110);
    pc.printf("Min. range = %g cm\n\rMax. range = %g cm\n\r",
     sensor.getMinRange(), sensor.getMaxRange());
    while(1) {
        pc.printf("Distance: %5.1f mm\r", sensor.getDistance_mm());
        wait_ms(500);
    }
}