 
     long laserOne = GetRange(1);
     long laserTwo = GetRange(2);
-    long laserThree = GetRange(3);
-    long laserFrour = GetRange(4);
 
     SendData("One", servoPos, laserOne);
-    SendData("Two", (servoPos+90%360), laserTwo);
-    SendData("Three", (servoPos+180%360), laserThree);
-    SendData("Four", (servoPos+270%360), laserFour);
+    SendData("Two", (servoPos+180%360), laserTwo);
 }
 
+


long GetRange(int id)
{
    if(id == 1)
    {
        return Sensor1.readRangeContinuousMillimeters();
    }

    if(id == 2)
    {
        return Sensor2.readRangeContinuousMillimeters();
    }

    if(id == 2)
    {
        return Sensor3.readRangeContinuousMillimeters();
    }

    if(id == 2)
    {
        return Sensor4.readRangeContinuousMillimeters();
    }

    return 0;


void setup()
{
    pinMode(Sensor1_xshut, OUTPUT);
    pinMode(Sensor2_xshut, OUTPUT);
    digitalWrite(Sensor1_xshut, LOW);
    digitalWrite(Sensor2_xshut, LOW);

    Wire.begin();
    Serial.begin(115200);

    pinMode(Sensor1_xshut, INPUT);
    Sensor1.init();
    Sensor1.setAddress(Sensor1_address);
    Sensor1.setTimeout(500);
    Sensor1.startContinuous();
  
    pinMode(Sensor2_xshut, INPUT);
    Sensor2.init();
    Sensor2.setAddress(Sensor2_address);
    Sensor2.setTimeout(500);
    Sensor2.startContinuous();

    // attach servo pin and set to initial direction
    ServoMotor.attach(servoPin, 450, 2400); // 400, 2600 to fix rotation issues
