   Serial.print(" cm");
   Serial.println();
 }
+
+void printDistanceValues(){
+  for(int i=0; i<servoSteps; i++){
+    Serial.print(distanceValues[i]);
+    Serial.print(" ");
+  }
+  Serial.println();
+}
  
 int microsecondsToCentimeters(long microseconds)
 {

  }
}

void readSensorWriteLEDs(int servoPos, int i){
  servo.write(servoPos);
  
  triggerSensor();
  int distance = readSensor();;
  printDistance(distance);
 
  distanceValues[i] = distance; 
  visualizeCircle();
  
  delay(servoMSPerDegree*servoStepAngle);
}


#include <Adafruit_NeoPixel.h>
#include <Servo.h> 
#include <avr/power.h>

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

#define NUMBER_LEDS 48
#define NUMBER_STRIPS 3

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

//Servo variables
int servoPos = 0;
int servoSteps = 6;
int servoMinAngle = 0;
int servoMaxAngle = 90;
int servoStepAngle = (servoMaxAngle-servoMinAngle)/(servoSteps-1);
int servoMSPerDegree = 5;

//Max and Min value for the distance sensor
float maxDistance = 50;
float minDistance = 10;

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

void setup() {
  //Init distance store to far away
  for(int i=0; i<servoSteps; i+=1){
    distanceValues[i] = 0;
  }
  
  //For console output
  Serial.begin(9600);
  
  //Init led strips
  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){
