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

Dependencies:   mbed

Dependents:   wheelchaircontrol wheelchaircontrol2 wheelchaircontrol3 wheelchaircontrol4 ... more

Embed: (wiki syntax)

« Back to documentation index

Show/hide line numbers main.cpp Source File

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 }