Jesus Fausto / Mbed 2 deprecated VL53L1X_Filter

Median of 3 filter for multiple time of flight sensors translated from arduino by pololu

Dependencies:   mbed

Dependents:   wheelchaircontrol wheelchaircontrol2 wheelchaircontrol3 wheelchaircontrol4 ... more

main.cpp

Committer:
jvfausto
Date:
2018-08-09
Revision:
0:617f20c6b21d
Child:
1:0038ad0a63af

File content as of revision 0:617f20c6b21d:

#include "mbed.h"
#include "VL53L1X.h"

Serial pc(USBTX,USBRX);
bool s1_init = false;
bool s2_init = false;
bool s3_init = false;
bool s4_init = false;
VL53L1X sensor1(D14, D15, D0);
VL53L1X sensor2(D14, D15, D1);
VL53L1X sensor3(D14, D15, D2);
VL53L1X sensor4(D14, D15, D3);

int main()
{  
    sensor1.initReading(0x25,50000);
    sensor2.initReading(0x27,50000);
    sensor3.initReading(0x35,50000);
    sensor4.initReading(0x37,50000);

    while(1)
    {
      pc.printf("%d, ", sensor1.readFromOneSensor());
      pc.printf("%d, ", sensor2.readFromOneSensor());
      pc.printf("%d, ", sensor3.readFromOneSensor());
      pc.printf("%d\r\n", sensor4.readFromOneSensor()); 
    }
}