Play safe with calibration done messages

This commit is contained in:
Lorenz Meier
2016-04-09 11:50:50 -07:00
parent 0abc792d96
commit 275fe8ee2d
@@ -216,14 +216,17 @@ int do_mag_calibration(orb_advert_t *mavlink_log_pub)
calibration_log_info(mavlink_log_pub, CAL_QGC_PROGRESS_MSG, 100); calibration_log_info(mavlink_log_pub, CAL_QGC_PROGRESS_MSG, 100);
usleep(20000); usleep(20000);
calibration_log_info(mavlink_log_pub, CAL_QGC_DONE_MSG, sensor_name); calibration_log_info(mavlink_log_pub, CAL_QGC_DONE_MSG, sensor_name);
usleep(20000);
break; break;
} else { } else {
calibration_log_critical(mavlink_log_pub, CAL_ERROR_SAVE_PARAMS_MSG); calibration_log_critical(mavlink_log_pub, CAL_ERROR_SAVE_PARAMS_MSG);
usleep(20000);
} }
// Fall through // Fall through
default: default:
calibration_log_critical(mavlink_log_pub, CAL_QGC_FAILED_MSG, sensor_name); calibration_log_critical(mavlink_log_pub, CAL_QGC_FAILED_MSG, sensor_name);
usleep(20000);
break; break;
} }
} }