From f9aca05eded22c102d8e8ff2ca6fa3df20d6b7df Mon Sep 17 00:00:00 2001
From: Daniel Agar <daniel@agar.ca>
Date: Mon, 17 Aug 2020 16:15:35 -0400
Subject: [PATCH] commander: gyro calibration use all queued data

 - print calibration status when finished
---
 src/modules/commander/gyro_calibration.cpp | 4 +++-
 1 file changed, 3 insertions(+), 1 deletion(-)

diff --git a/src/modules/commander/gyro_calibration.cpp b/src/modules/commander/gyro_calibration.cpp
index 04afa4c8ac..9d290407ab 100644
--- a/src/modules/commander/gyro_calibration.cpp
+++ b/src/modules/commander/gyro_calibration.cpp
@@ -130,7 +130,7 @@ static calibrate_return gyro_calibration_worker(gyro_worker_data_t &worker_data)
 
 					sensor_gyro_s gyro_report;
 
-					if (gyro_sub[gyro_index].update(&gyro_report)) {
+					while (gyro_sub[gyro_index].update(&gyro_report)) {
 
 						// fetch optional thermal offset corrections in sensor/board frame
 						Vector3f offset{0, 0, 0};
@@ -298,6 +298,8 @@ int do_gyro_calibration(orb_advert_t *mavlink_log_pub)
 			if (calibration.device_id() != 0) {
 				calibration.set_offset(worker_data.offset[uorb_index]);
 
+				calibration.PrintStatus();
+
 			} else {
 				calibration.Reset();
 			}