 #define INTERVAL_DURATION 0
 #define INTERVAL_LAST 1
 
+#define DEFAULT_NUNCHUK_FREQUENCY 50 // Hertz
+#define DEFAULT_DISPLAY_FREQUENCY 30 // Hertz
+#define DEFAULT_RC2_FREQUENCY 30 // Hertz
+#define DEFAULT_SERVO_FREQUENCY 25 // Hertz
+
 #define SERVO_ANGLE_THRESHOLD 2 // minimum difference angle to send a rotation signal to the servo
 
 // ID of the settings block

    for(int i = 0; i < 16 - line_length; ++i) {
      lcd.write(" ");
    }

    execution_intervals[INTERVAL_LCD][INTERVAL_DURATION] = wait;
  }
}


  reset_avg_values();

  // Time references init:
  execution_intervals[INTERVAL_NUNCHUK][INTERVAL_DURATION] = DEFAULT_NUNCHUK_INTERVAL; // poll nunchuk every n ms
  execution_intervals[INTERVAL_NUNCHUK][INTERVAL_LAST] = 0;

  execution_intervals[INTERVAL_SERVO][INTERVAL_DURATION] = DEFAULT_SERVO_INTERVAL; // write servo position every n ms
  execution_intervals[INTERVAL_SERVO][INTERVAL_LAST] = 0;

  execution_intervals[INTERVAL_BLUETOOTH][INTERVAL_DURATION] = DEFAULT_RC2_INTERVAL; // send rc2 message every n ms
  execution_intervals[INTERVAL_BLUETOOTH][INTERVAL_LAST] = 0;

  execution_intervals[INTERVAL_LCD][INTERVAL_DURATION] = DEFAULT_DISPLAY_INTERVAL; // wait n ms before writing on the screen again
  execution_intervals[INTERVAL_LCD][INTERVAL_LAST] = 0;

  set_horizon_value();
