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);