   }
 }
 
-//void readSensorWriteLEDs(int servoPosition, int i){
-//  servo.write(servoPosition);
-//  delay(servoMSPerDegree*servoStepAngle);
-//  
-//  triggerSensor();
-//  int distance = readSensor();
-//  printDistance(distance);
-//  
-//  distance = max(minDistance, distance);
-//  distance = min(maxDistance, distance);
-//  distanceValues[i] = distance;
-//
-//  visualizeWithDirection();
-//
-//  delay(35);
-//}
-
-
 /**
  * VISUALIZATION TYPE 2
  *


//Hardware constants
#define PIN_STRIP 5
//#define PIN_SENSOR 7
//#define PIN_SERVO 8

#define NUMBER_LEDS 48
#define NUMBER_STRIPS 3

#define PIN_SWITCH 2

Adafruit_NeoPixel strip = Adafruit_NeoPixel(NUMBER_LEDS, PIN_STRIP, NEO_GRB + NEO_KHZ800);


//Store of the measured distances of each servo step
int distanceValues[3];

void setup() {  
  //Init distance store to far away
  for(int i=0; i<NUMBER_STRIPS; i+=1){
    distanceValues[i] = 0;
  }
  
  pinMode(PIN_SWITCH, INPUT_PULLUP); // set pin to input with internal pullup resistor
  
  pingTimer1 = millis() + pingSpeed; // Sensor 1 fires after 100ms (pingSpeed)
  pingTimer2 = pingTimer1 + (pingSpeed / 2); // Sensor 2 fires 50ms later
  pingTimer3 = pingTimer2 + (pingSpeed / 2); // Sensor 3 fires 50ms later
