diff --git a/sw/airborne/firmwares/fixedwing/main_ap.c b/sw/airborne/firmwares/fixedwing/main_ap.c index 7c26ebd2dd..97dcd81ca0 100644 --- a/sw/airborne/firmwares/fixedwing/main_ap.c +++ b/sw/airborne/firmwares/fixedwing/main_ap.c @@ -681,6 +681,7 @@ static inline void on_gyro_event( void ) { LED_ON(AHRS_CPU_LED); #endif +#ifdef USE_AHRS_ALIGNER // Run aligner on raw data as it also makes averages. if (ahrs.status == AHRS_UNINIT) { ImuScaleGyro(imu); @@ -690,6 +691,7 @@ static inline void on_gyro_event( void ) { ahrs_align(); return; } +#endif #if PERIODIC_FREQUENCY == 60 ImuScaleGyro(imu);