SLRC-2019 / Mbed 2 deprecated speed_robot

code for the speed robot

Dependencies:   MPU6050-DMP mbed PololuQTRSensors vl53l0x

Diff: tof.h

Revision:
1:b188e27eb7da
Child:
3:9b2f15b0d47b
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/tof.h	Mon Sep 30 08:43:34 2019 +0000
@@ -0,0 +1,26 @@
+void InitTOFSensors()
+{
+    sensorFront.init();
+    sensorFront.setTimeout(500);
+    sensorFront.setMeasurementTimingBudget(40000);
+    sensorFront.setSignalRateLimit(0.9);
+    sensorFront.startContinuous();
+}
+
+void ReadTOFDistance()
+{
+    int distance = sensorFront.readRangeContinuousMillimeters();
+    float distanceCM = (float)(distance / 10.0);
+    frontDistance = distanceCM;
+}
+
+void PrintTOFDistance()
+{
+    int distance = sensorFront.readRangeContinuousMillimeters();
+    float distanceCM = (float)(distance / 10.0);
+    printf("%.2f\n",distanceCM);
+    if (sensorFront.timeoutOccurred())
+    {
+        PrintSerial(" TIMEOUT");
+    }
+}
\ No newline at end of file