diff --git a/src/modules/src/stabilizer.c b/src/modules/src/stabilizer.c index 28d42ef260..6963c774fa 100644 --- a/src/modules/src/stabilizer.c +++ b/src/modules/src/stabilizer.c @@ -141,6 +141,8 @@ static void stabilizerTask(void* param) //Wait for the system to be fully started to start stabilization loop systemWaitStart(); + DEBUG_PRINT("Wait for sensor calibration...\n"); + // Wait for sensors to be calibrated lastWakeTime = xTaskGetTickCount (); while(!sensorsAreCalibrated()) { @@ -149,6 +151,8 @@ static void stabilizerTask(void* param) // Initialize tick to something else then 0 tick = 1; + DEBUG_PRINT("Ready to fly.\n"); + while(1) { // The sensor should unlock at 1kHz sensorsWaitDataReady();