 #include <utility/imumaths.h>
 
 // Mise en place des variables
-
 Servo esc_1; //FRONT RIGHT (avant droit)
 Servo esc_2; //BACK LEFT (arrière gauche)
 Servo esc_3; //FRONT LEFT (avant gauche)

}

// Fonctions de debug

void print_motors() {
  Serial.print(motorFR);
  Serial.print(",");

  rx_read();
  bno_get_values();
  control_update();
  print_rx();
}
