![](/media/cache/group/default_image.jpg.50x50_q85.jpg)
code for the speed robot
Dependencies: MPU6050-DMP mbed PololuQTRSensors vl53l0x
Diff: tof.h
- Revision:
- 1:b188e27eb7da
- Child:
- 3:9b2f15b0d47b
diff -r c3a27228c31b -r b188e27eb7da tof.h --- /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