From 734d3e4aa03e3d9aff84c98a15dfa361ba58848a Mon Sep 17 00:00:00 2001 From: Ben Berry Date: Fri, 26 Aug 2022 17:47:20 -0700 Subject: [PATCH] Reverted changes that broke Level Horizon calibration --- src/modules/commander/Commander.cpp | 5 +++-- 1 file changed, 3 insertions(+), 2 deletions(-) diff --git a/src/modules/commander/Commander.cpp b/src/modules/commander/Commander.cpp index 2ca19f3e17..10c428ab25 100644 --- a/src/modules/commander/Commander.cpp +++ b/src/modules/commander/Commander.cpp @@ -1447,8 +1447,9 @@ Commander::handle_command(const vehicle_command_s &cmd) answer_command(cmd, vehicle_command_ack_s::VEHICLE_CMD_RESULT_ACCEPTED); _vehicle_status_flags.calibration_enabled = true; _worker_thread.startTask(WorkerThread::Request::AccelCalibration); - answer_command(cmd, vehicle_command_ack_s::VEHICLE_CMD_RESULT_ACCEPTED); - _vehicle_status_flags.calibration_enabled = true; + + } else if ((int)(cmd.param5) == 2) { + // board offset calibration answer_command(cmd, vehicle_command_ack_s::VEHICLE_CMD_RESULT_ACCEPTED); _vehicle_status_flags.calibration_enabled = true; _worker_thread.startTask(WorkerThread::Request::LevelCalibration);