 };
 
 byte buffer[6]; // Buffer containing the 6 bytes coming from the nunchuk
-byte cnt = 0; // current buffer index. NOTE: maybe doesn't need to be global...
+byte cnt = 0; // Current buffer index. NOTE: maybe doesn't need to be global...
 int acc_horiz_x_axis = 0;
 int acc_cw90_x_axis = 0;
 int acc_acw90_x_axis = 0;
 float acc2servo_ratio = 0;
 
-unsigned long execution_intervals[4][2]; // 4 intervals(servo bluetooth, drawscreen & nunchuk), with 2 values each(duration, last)
-
+// ############# Servo related variables ###################
+Servo cam_servo;
 int last_servo_angle = 0; // last known position
-// Servo
-Servo cam_servo;
 
 
 // Timer2 Service (bluetooth related)

void set_brake_ratio() {
  float delta =(float)(settings.max_brake - settings.min_brake);
  float ratio = 100/delta;
  if (ratio < 0) {
    settings.brake_ratio = -1.0*ratio;
  } else {
    settings.brake_ratio = ratio;

    current_button = BP_LEFT;
  } else if (val < 800) { // SELECT (720)
    current_button = BP_SELECT;
  }

  if ((millis() - prev_button_timestamp) < BUTTONS_DELAY) {
    return BP_NONE;
  }

  if (current_button != BP_NONE) {
    last_none_null_button_timestamp = millis();
  }

  prev_button_timestamp = millis();
  prev_button = current_button;

