From 78089b60e0cc3769a535bd431f654041f0b5f37c Mon Sep 17 00:00:00 2001 From: Don Gagne Date: Thu, 26 Mar 2015 12:32:35 -0700 Subject: [PATCH] Refresh all params after cal --- src/AutoPilotPlugins/PX4/SensorsComponentController.cc | 4 ++++ 1 file changed, 4 insertions(+) diff --git a/src/AutoPilotPlugins/PX4/SensorsComponentController.cc b/src/AutoPilotPlugins/PX4/SensorsComponentController.cc index 509e760ce..6238d683e 100644 --- a/src/AutoPilotPlugins/PX4/SensorsComponentController.cc +++ b/src/AutoPilotPlugins/PX4/SensorsComponentController.cc @@ -267,6 +267,7 @@ void SensorsComponentController::_handleUASTextMessage(int uasId, int compId, in void SensorsComponentController::_refreshParams(void) { + // Pull specified params first so red/green indicators update quickly _autopilot->refreshParameter("CAL_MAG0_ID"); _autopilot->refreshParameter("CAL_GYRO0_ID"); _autopilot->refreshParameter("CAL_ACC0_ID"); @@ -276,6 +277,9 @@ void SensorsComponentController::_refreshParams(void) _autopilot->refreshParameter("CAL_MAG1_ROT"); _autopilot->refreshParameter("CAL_MAG2_ROT"); _autopilot->refreshParameter("SENS_BOARD_ROT"); + + // Pull full set in order to get all cal values back + _autopilot->refreshAllParameters(); } bool SensorsComponentController::fixedWing(void) -- 2.22.0