This library allows you to read from multiple VL53L1X sensors.
Fork of VL53L1X_Pololu by
Diff: main.cpp
- Revision:
- 1:e54ded4af43a
- Child:
- 2:f570ff03fb81
diff -r 76ea242a637f -r e54ded4af43a main.cpp --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/main.cpp Wed Aug 08 21:44:33 2018 +0000 @@ -0,0 +1,78 @@ +#include "mbed.h" +#include "VL53L1X.h" +void resetPin(int pin); + +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 count = 0; +int main() +{ + sensor1.turnOff(); + sensor2.turnOff(); + sensor3.turnOff(); + sensor4.turnOff(); + if (sensor2.initReading(0x25, 25000)) + { + s2_init = true; + } + if (sensor1.initReading(0x27, 25000)) + { + s1_init = true; + } + if (sensor3.initReading(0x35, 25000)) + { + s3_init = true; + } + if (sensor4.initReading(0x37, 50000)) + { + s4_init = true; + } + while(1) + { + + sensor1.startContinuous(50); + sensor2.startContinuous(50); + sensor3.startContinuous(50); + sensor4.startContinuous(50); + + if (s1_init) + pc.printf("%d", sensor1.read()); + else + pc.printf("-1"); + + pc.printf(","); + + if (s2_init) + pc.printf("%d", sensor2.read()); + else pc.printf("-1"); + + pc.printf(","); + + if (s3_init) + pc.printf("%d", sensor3.read()); + else pc.printf("-1"); + + pc.printf(","); + + if (s4_init) + pc.printf("%d", sensor4.read()); + else pc.printf("-1"); + + pc.printf("\r\n"); + sensor1.stopContinuous(); + sensor2.stopContinuous(); + sensor3.stopContinuous(); + sensor4.stopContinuous(); + wait(.02); + } +}