Distance measure example

Author: lucianjames

distanceMeasure/distanceMeasure.ino

@@ -0,0 +1,49 @@
+/*
+    Ultrasonic sensor Pins:
+        VCC: +5VDC
+        Trig : Trigger (INPUT) - Pin11
+        Echo: Echo (OUTPUT) - Pin 12
+        GND: GND
+*/
+
+#define trigPin 11
+#define echoPin 12
+
+long duration;
+int cm;
+
+void setup() {
+  //Serial Port begin
+  Serial.begin (9600);
+  //Define inputs and outputs
+  pinMode(trigPin, OUTPUT);
+  pinMode(echoPin, INPUT);
+  pinMode(LED_BUILTIN, OUTPUT);
+  digitalWrite(LED_BUILTIN, LOW);
+}
+
+
+void measureDistance(){
+  // The sensor is triggered by a HIGH pulse of 10 or more microseconds.
+  // Give a short LOW pulse beforehand to ensure a clean HIGH pulse:
+  digitalWrite(trigPin, LOW);
+  delayMicroseconds(5);
+  digitalWrite(trigPin, HIGH);
+  delayMicroseconds(10);
+  digitalWrite(trigPin, LOW);
+  
+  // Read the signal from the sensor: a HIGH pulse whose
+  // duration is the time (in microseconds) from the sending
+  // of the ping to the reception of its echo off of an object.
+  duration = pulseIn(echoPin, HIGH);
+  
+  // Convert the time into a distance
+  cm = (duration/2) / 29.1;     // Divide by 29.1 or multiply by 0.0343
+  Serial.print(cm);
+  Serial.println();
+}
+
+void loop() {
+  measureDistance();
+  delay(50);
+}

main.cpp

@@ -1,17 +1,20 @@
-#include<unistd.h> // Just for sleep()
+#include <chrono>
+#include <thread>
 
 #include <iostream>
 #include <string>
 
 #include "arduinoSerial.h"
 
 int main(){
-    arduinoSerial serial("/dev/ttyACM0", true);
+    arduinoSerial serial("/dev/ttyACM0", false);
     serial.begin(B9600);
-    // ParseFloat test
     while(true){
-        std::cout << serial.parseFloat() << std::endl;
-        sleep(1);
+        if(serial.available()){
+            std::this_thread::sleep_for(std::chrono::milliseconds(10)); // Wait for the data to come in, otherwise it will be incomplete
+            std::cout << serial.parseFloat() << std::endl;
+            serial.flush();
+        }
     }
     return 0;
 }