SLRC-2019 / Mbed 2 deprecated speed_robot

code for the speed robot

Dependencies:   MPU6050-DMP mbed PololuQTRSensors vl53l0x

tof.h

Committer:
deepanaishtaweera174
Date:
2019-09-30
Revision:
1:b188e27eb7da
Child:
3:9b2f15b0d47b

File content as of revision 1:b188e27eb7da:

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");
    }
}