 
 void setup()
 {
-    pinMode(XSHUT_pin1, OUTPUT);
-    pinMode(XSHUT_pin2, OUTPUT);
-    pinMode(XSHUT_pin3, OUTPUT);
-    pinMode(XSHUT_pin4, OUTPUT);
+    pinMode(Sensor1_xshut, OUTPUT);
+    pinMode(Sensor2_xshut, OUTPUT);
+    digitalWrite(Sensor1_xshut, LOW);
+    digitalWrite(Sensor2_xshut, LOW);
 
+    Wire.begin();
     Serial.begin(115200);
 
-    Wire.begin();
-
-    Sensor4.setAddress(Sensor4_newAddress);
-    pinMode(XSHUT_pin3, INPUT);
-    delay(10);
-
-    Sensor3.setAddress(Sensor3_newAddress);
-    pinMode(XSHUT_pin2, INPUT);
-    delay(10);
-
-    Sensor2.setAddress(Sensor2_newAddress);
-    pinMode(XSHUT_pin1, INPUT);
-    delay(10);
-
+    pinMode(Sensor1_xshut, INPUT);
     Sensor1.init();
+    Sensor1.setAddress(Sensor1_address);
+    Sensor1.setTimeout(500);
+    Sensor1.startContinuous();
+  
+    pinMode(Sensor2_xshut, INPUT);
     Sensor2.init();
-    Sensor3.init();
-    Sensor4.init();
-
-    Sensor1.setTimeout(500);
+    Sensor2.setAddress(Sensor2_address);
     Sensor2.setTimeout(500);
-    Sensor3.setTimeout(500);
-    Sensor4.setTimeout(500);
-
-    Sensor1.startContinuous();
     Sensor2.startContinuous();
-    Sensor3.startContinuous();
-    Sensor4.startContinuous();
 
     // attach servo pin and set to initial direction
     ServoMotor.attach(servoPin, 450, 2400); // 400, 2600 to fix rotation issues

#include "VL53L0X.h"

// Laser
#define XSHUT_pin4 8
#define XSHUT_pin3 7
#define XSHUT_pin2 6
#define XSHUT_pin1 5

//ADDRESS_DEFAULT 0b0101001 or 41
//#define Sensor1_newAddress 41 not required address change
#define Sensor2_newAddress 42
#define Sensor3_newAddress 43
#define Sensor4_newAddress 44

VL53L0X Sensor1;
VL53L0X Sensor2;
VL53L0X Sensor3;
VL53L0X Sensor4;


// Servo


    long laserOne = GetRange(1);
    long laserTwo = GetRange(2);

    SendData("One", servoPos, laserOne);
    SendData("Two", (servoPos+180%360), laserTwo);
}


