Browse Source

mtecs/wind: store wind variance

sbg
Thomas Gubler 11 years ago
parent
commit
d45cc69d1d
  1. 4
      src/modules/ekf_att_pos_estimator/ekf_att_pos_estimator_main.cpp

4
src/modules/ekf_att_pos_estimator/ekf_att_pos_estimator_main.cpp

@ -1345,8 +1345,8 @@ FixedwingEstimator::task_main() @@ -1345,8 +1345,8 @@ FixedwingEstimator::task_main()
_wind.timestamp = _global_pos.timestamp;
_wind.windspeed_north = _ekf->states[14];
_wind.windspeed_east = _ekf->states[15];
_wind.covariance_north = 0.0f; // XXX get form filter
_wind.covariance_east = 0.0f;
_wind.covariance_north = _ekf->P[14][14];
_wind.covariance_east = _ekf->P[15][15];
/* lazily publish the wind estimate only once available */
if (_wind_pub > 0) {

Loading…
Cancel
Save