ekf2: fixed call to save parameter

This commit is contained in:
Roman
2016-02-14 22:00:13 +01:00
committed by tumbili
parent af5bbc916c
commit 15b0baf555

View File

@@ -569,7 +569,7 @@ void Ekf2::task_main()
if ((_params->mag_declination_source & (1 << 1)) && _prev_motors_armed && !vehicle_control_mode.flag_armed) { if ((_params->mag_declination_source & (1 << 1)) && _prev_motors_armed && !vehicle_control_mode.flag_armed) {
float decl_deg; float decl_deg;
_ekf->copy_mag_decl_deg(&decl_deg); _ekf->copy_mag_decl_deg(&decl_deg);
param_set(param_find("EKF2_MAG_DECL"), &decl_deg); _mag_declination_deg->set(decl_deg);
} }
_prev_motors_armed = vehicle_control_mode.flag_armed; _prev_motors_armed = vehicle_control_mode.flag_armed;