   rx_read();
   bno_get_values();
   control_update();
-  print_motors();
+  print_pitch_and_roll();
 }

float pitch_speed, pitch_angle;
float yaw_speed, yaw_angle;
Adafruit_BNO055 bno = Adafruit_BNO055();


////fonctions de lecture du gyro et accel



//RX
int throttle = THROTTLE_RMIN;
volatile int input[4];
unsigned long timer[4];
byte last_channel[4];

