diff --git a/prog/prog.ino b/prog/prog.ino index d8c2005..103ab10 100644 --- a/prog/prog.ino +++ b/prog/prog.ino @@ -166,6 +166,8 @@ void wifisetup() { struct tube all_tubes[6] = {0}; +Adafruit_VL53L0X tofs_talk_through[6] = {Adafruit_VL53L0X(), Adafruit_VL53L0X(), Adafruit_VL53L0X(), Adafruit_VL53L0X(), Adafruit_VL53L0X(), Adafruit_VL53L0X()}; + void init_tube(struct tube *tube, char id, char servo_pin, char gpio, char xshut) { Serial.print(" Initialiazing tube #"); @@ -177,8 +179,7 @@ void init_tube(struct tube *tube, char id, char servo_pin, char gpio, char xshut tube->height = 250.0; tube->target = 250.0; - tube->tof.hard = Adafruit_VL53L0X(); - if (!tube->tof.hard.begin()) { + if (!tofs_talk_through[id].begin()) { Serial.println(F("Failed to boot VL53L0X")); while(1); }