Median of 3 filter for multiple time of flight sensors translated from arduino by pololu
Dependents: wheelchaircontrol wheelchaircontrol2 wheelchaircontrol3 wheelchaircontrol4 ... more
Diff: main.cpp
- Revision:
- 0:617f20c6b21d
- Child:
- 1:0038ad0a63af
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/main.cpp Thu Aug 09 22:06:49 2018 +0000 @@ -0,0 +1,28 @@ +#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()); + } +}