   Serial.print(",");
   Serial.println(pid_yaw_setpoint);
 }
-
 void print_imu() {
   Serial.print(pid_roll_speed_in);
   Serial.print(",");


//TODO: fonction qui lit les interrupts pour une execution plus rapide(pas encore)
void rx_initialize() {
  pinMode(A0, INPUT);
  pinMode(A1, INPUT);
  pinMode(A2, INPUT);
  pinMode(A3, INPUT);
}

// Fonction qui lit les valeurs de la radio
void rx_read() {
  input[0] = pulseIn(A0, HIGH);
  input[1] = pulseIn(A1, HIGH);
  input[2] = pulseIn(A2, HIGH);
  input[3] = pulseIn(A3, HIGH);
}

// Fonction qui s'execute une fois et au début

// RX
int throttle = THROTTLE_RMIN;
volatile int input[4];
volatile unsigned long chrono_start0;
volatile unsigned long chrono_start1;
volatile unsigned long chrono_start2;
volatile unsigned long chrono_start3;
volatile int last_interrupt_time0;
volatile int last_interrupt_time1;
volatile int last_interrupt_time2;
volatile int last_interrupt_time3;

// IMU
float roll_speed, roll_angle;
