ekf_att_pos_estimator: local position reference fixed

This commit is contained in:
Anton Babushkin
2014-04-28 19:15:58 +02:00
parent f78005bcb6
commit 11a1053b73
@@ -1004,8 +1004,8 @@ FixedwingEstimator::task_main()
_ekf->InitialiseFilter(_ekf->velNED, math::radians(lat), math::radians(lon) - M_PI, gps_alt, declination);
// Initialize projection
_local_pos.ref_lat = _gps.lat;
_local_pos.ref_lon = _gps.alt;
_local_pos.ref_lat = lat;
_local_pos.ref_lon = lon;
_local_pos.ref_alt = _baro_ref + _baro_gps_offset;
_local_pos.ref_timestamp = _gps.timestamp_position;