Median of 3 filter for multiple time of flight sensors translated from arduino by pololu
Dependents: wheelchaircontrol wheelchaircontrol2 wheelchaircontrol3 wheelchaircontrol4 ... more
main.cpp
00001 #include "mbed.h" 00002 #include "VL53L1X.h" 00003 00004 Serial pc(USBTX,USBRX); 00005 VL53L1X sensor1(PD_13, PD_12, PA_15); // Block 1 00006 VL53L1X sensor2(PD_13, PD_12, PC_7); 00007 VL53L1X sensor3(PD_13, PD_12, PB_5); 00008 00009 VL53L1X sensor4(PD_13, PD_12, PE_11); // Block 2 00010 VL53L1X sensor5(PD_13, PD_12, PF_14); 00011 VL53L1X sensor6(PD_13, PD_12, PE_13); 00012 00013 VL53L1X sensor7(PD_13, PD_12, PG_15); // Block 3 00014 VL53L1X sensor8(PD_13, PD_12, PG_14); 00015 VL53L1X sensor9(PD_13, PD_12, PG_9); 00016 00017 VL53L1X sensor10(PD_13, PD_12, PE_10); // Block 4 00018 VL53L1X sensor11(PD_13, PD_12, PE_12); 00019 VL53L1X sensor12(PD_13, PD_12, PE_14); 00020 int main() 00021 { 00022 sensor1.initReading(0x27,50000); 00023 sensor2.initReading(0x35,50000); 00024 sensor3.initReading(0x37,50000); 00025 sensor4.initReading(0x39,50000); 00026 sensor5.initReading(0x41,50000); 00027 sensor6.initReading(0x43,50000); 00028 sensor7.initReading(0x45,50000); 00029 sensor8.initReading(0x47,50000); 00030 sensor9.initReading(0x49,50000); 00031 sensor10.initReading(0x51,50000); 00032 sensor11.initReading(0x53,50000); 00033 sensor12.initReading(0x55,50000); 00034 while(1) 00035 { 00036 pc.printf("%d, ", sensor1.readFromOneSensor()); 00037 pc.printf("%d, ", sensor2.readFromOneSensor()); 00038 pc.printf("%d, ", sensor3.readFromOneSensor()); 00039 pc.printf("%d, ", sensor4.readFromOneSensor()); 00040 pc.printf("%d, ", sensor5.readFromOneSensor()); 00041 pc.printf("%d, ", sensor6.readFromOneSensor()); 00042 pc.printf("%d, ", sensor7.readFromOneSensor()); 00043 pc.printf("%d, ", sensor8.readFromOneSensor()); 00044 pc.printf("%d, ", sensor9.readFromOneSensor()); 00045 pc.printf("%d, ", sensor10.readFromOneSensor()); 00046 pc.printf("%d, ", sensor11.readFromOneSensor()); 00047 pc.printf("%d, ", sensor12.readFromOneSensor()); 00048 pc.printf("\r\n"); 00049 /* 00050 pc.printf("%d hello\r\n", frontRight.readFromOneSensor()); 00051 pc.printf("%d hello\r\n", frontRight2.readFromOneSensor()); 00052 pc.printf("%d hello\r\n", frontRight3.readFromOneSensor()); 00053 pc.printf("%d hello\r\n", frontRight4.readFromOneSensor()); */ 00054 } 00055 }
Generated on Fri Jul 15 2022 03:32:03 by 1.7.2