Browse Source

update range sensor angle parameters in case they have changed

Signed-off-by: Roman <bapstroman@gmail.com>
master
Roman 8 years ago
parent
commit
7e2597ec28
  1. 5
      EKF/terrain_estimator.cpp

5
EKF/terrain_estimator.cpp

@ -96,6 +96,11 @@ void Ekf::runTerrainEstimator() @@ -96,6 +96,11 @@ void Ekf::runTerrainEstimator()
if (_range_data_ready) {
fuseHagl();
// update range sensor angle parameters in case they have changed
// we do this here to avoid doing those calculations at a high rate
_sin_tilt_rng = sinf(_params.rng_sens_pitch);
_cos_tilt_rng = cosf(_params.rng_sens_pitch);
}
}
}

Loading…
Cancel
Save