Skip to content

Commit

Permalink
Merge pull request #413 from whoenig/feature_printCalib
Browse files Browse the repository at this point in the history
Add status messages in stabilizer for sensor calibration
  • Loading branch information
tobbeanton authored Mar 28, 2019
2 parents 76251a2 + 262fff1 commit d76981f
Showing 1 changed file with 4 additions and 0 deletions.
4 changes: 4 additions & 0 deletions src/modules/src/stabilizer.c
Original file line number Diff line number Diff line change
Expand Up @@ -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()) {
Expand All @@ -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();
Expand Down

0 comments on commit d76981f

Please sign in to comment.