   strip.show();
 }
 
-/** 
- *
- * DISTANCE SENSOR
- *
- **/
-
-//long readSensor(){
-//  // The same pin is used to read the signal from the PING))): a HIGH
-//  // pulse whose duration is the time (in microseconds) from the sending
-//  // of the ping to the reception of its echo off of an object.
-//  pinMode(PIN_SENSOR, INPUT);
-//  long duration = pulseIn(PIN_SENSOR, HIGH);
-//  
-//  // convert the time into a distance
-//  return microsecondsToCentimeters(duration);
-//}
-
-//void triggerSensor(){
-//  // The PING))) is triggered by a HIGH pulse of 2 or more microseconds.
-//  // Give a short LOW pulse beforehand to ensure a clean HIGH pulse:
-//  pinMode(PIN_SENSOR, OUTPUT);
-//  digitalWrite(PIN_SENSOR, LOW);
-//  delayMicroseconds(2);
-//  digitalWrite(PIN_SENSOR, HIGH);
-//  delayMicroseconds(5);
-//  digitalWrite(PIN_SENSOR, LOW);  
-//}
-
-/** 
- * 
- * HELPER FUNCTIONS
- *
- **/
- 
+
 //void printDistance(int distance){
 //  Serial.print(distance);
 //  Serial.print(" cm");

  strip.begin();
  strip.setBrightness(64);
  strip.show();
  
  //Set servo to init position
  //And wait for the servo reaching the position
//  servo.attach(PIN_SERVO);
//  servo.write(servoPos);
//  delay(5*360);
}

/**
 *
 *  MAIN
 *  Move servo, read sensor and write leds
 *
 */
void loop(){
//  int i = 0;
//  for(servoPos = servoMinAngle; servoPos < servoMaxAngle; servoPos += servoStepAngle){
//    readSensorWriteLEDs(servoPos, i);
//    i+=1;
//  }
//  
//  for(servoPos = servoMaxAngle; servoPos>servoMinAngle; servoPos-=servoStepAngle)
//  {                
//    readSensorWriteLEDs(servoPos, i);
//    i-=1;
//  }
   if (millis() >= pingTimer1) {
   pingTimer1 += pingSpeed; // Make sensor 1 fire again 100ms later (pingSpeed)
   distanceValues[0] = sonar1.ping_cm();
   Serial.print("Ping 1: ");
   Serial.print(distanceValues[0]); // Convert ping time to distance and print result (0 = outside set distance range, no ping echo)
   Serial.println("cm");
   
 }
 if (millis() >= pingTimer2) {
   pingTimer2 = pingTimer1 + (pingSpeed / 2); // Make sensor 2 fire again 50ms after sensor 1 fires

  }
}

/**
 * VISUALIZATION TYPE 2
 *
