fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-04-14 10:07:39 +08:00
Code Issues Packages Projects Releases Wiki Activity

mag_calibration: small fix for non QURT

Browse Source
This commit is contained in:
Julian Oes 2016-03-10 17:13:31 -08:00
parent 1b5210ca13
commit 10ce1c19a2
1 changed files with 9 additions and 6 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

15
src/modules/commander/mag_calibration.cpp
View File

@ -686,12 +686,15 @@ calibrate_return mag_calibrate_all(int mavlink_fd, int32_t (&device_ids)[max_mag
(void)sprintf(str, "CAL_MAG%u_ZOFF", cur_mag);
failed |= (OK != param_set_no_notification(param_find(str), &(mscale.z_offset)));
(void)sprintf(str, "CAL_MAG%u_XSCALE", cur_mag);
// FIXME: scaling is not used right now
//failed |= (OK != param_set_no_notification(param_find(str), &(mscale.x_scale)));
//(void)sprintf(str, "CAL_MAG%u_YSCALE", cur_mag);
//failed |= (OK != param_set_no_notification(param_find(str), &(mscale.y_scale)));
//(void)sprintf(str, "CAL_MAG%u_ZSCALE", cur_mag);
//failed |= (OK != param_set_no_notification(param_find(str), &(mscale.z_scale)));
// FIXME: scaling is not used right now on QURT
#ifndef __PX4_QURT
failed |= (OK != param_set_no_notification(param_find(str), &(mscale.x_scale)));
(void)sprintf(str, "CAL_MAG%u_YSCALE", cur_mag);
failed |= (OK != param_set_no_notification(param_find(str), &(mscale.y_scale)));
(void)sprintf(str, "CAL_MAG%u_ZSCALE", cur_mag);
failed |= (OK != param_set_no_notification(param_find(str), &(mscale.z_scale)));
#endif
if (failed) {
mavlink_and_console_log_critical(mavlink_fd, CAL_ERROR_SET_PARAMS_MSG, cur_mag);