Delta for AGV

Dependencies:   mbed HC-SR04 ros_lib_kinetic

Revision:
3:3297ea6e3ae1
Parent:
2:f86b1e3609b3
Child:
4:052ac3f5c938
--- a/main.cpp	Sat Dec 05 09:07:15 2015 +0000
+++ b/main.cpp	Mon Dec 07 09:38:35 2015 +0000
@@ -1,17 +1,15 @@
-/** Revision 2: Separating the class declaration, implementation and main() function into files.  */
-
 #include "mbed.h"
 #include "HCSR04.h"
 
-Serial pc(USBTX, USBRX);    // communication with terminal
+Serial pc(USBTX, USBRX);
 
 int main() {
-    HCSR04 sensor(p5, p7);     // instantiate the sensor object
+    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) {
-         /** Print the result in cm to the terminal with 1 decimal place
-         *  (number 5 after % means that total of 5 digits will be reserved
-         *  for printing the number, including the dot and one decimal place). */
-        pc.printf("Distance: %5.1f cm\r", sensor.getDistance_cm());
-        wait_ms(1000-25);
+        pc.printf("Distance: %5.1f mm\r", sensor.getDistance_mm());
+        wait_ms(500);
     }
 }
\ No newline at end of file