mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-13 07:43:33 +08:00
update range sensor angle parameters in case they have changed
Signed-off-by: Roman <bapstroman@gmail.com>
This commit is contained in:
@@ -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);
|
||||
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user