Median of 3 filter for multiple time of flight sensors translated from arduino by pololu
Dependents: wheelchaircontrol wheelchaircontrol2 wheelchaircontrol3 wheelchaircontrol4 ... more
main.cpp
- Committer:
- jvfausto
- Date:
- 2018-10-08
- Revision:
- 1:0038ad0a63af
- Parent:
- 0:617f20c6b21d
- Child:
- 4:f6f0c2b9120a
File content as of revision 1:0038ad0a63af:
#include "mbed.h" #include "VL53L1X.h" Serial pc(USBTX,USBRX, 115200); VL53L1X sensor1(D4, D5, D6); VL53L1X sensor2(D4, D5, D9); VL53L1X sensor3(D4, D5, D10); VL53L1X sensor4(D4, D5, D11); VL53L1X sensor5(D4, D5, D12); VL53L1X sensor6(D4, D5, D13); int main() { sensor1.initReading(0x25,50000); sensor2.initReading(0x27,50000); sensor3.initReading(0x35,50000); sensor4.initReading(0x39,50000); sensor5.initReading(0x41,50000); sensor6.initReading(0x43,50000); while(1) { pc.printf("6,"); pc.printf("%d,", sensor1.readFromOneSensor()); pc.printf("%d,", sensor2.readFromOneSensor()); pc.printf("%d,", sensor3.readFromOneSensor()); pc.printf("%d,", sensor4.readFromOneSensor()); pc.printf("%d,", sensor5.readFromOneSensor()); pc.printf("%d", sensor6.readFromOneSensor()); pc.printf("\r\n"); } }