mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-07-07 19:40:37 +08:00
ekf2: use correct AlphaFilter for 3D rotations
This commit is contained in:
committed by
Mathieu Bresciani
parent
15bb8c0f2e
commit
1128ada90a
@@ -88,7 +88,7 @@ void Ekf::controlExternalVisionFusion()
|
||||
|
||||
void Ekf::updateEvAttitudeErrorFilter(extVisionSample &ev_sample, bool ev_reset)
|
||||
{
|
||||
const AxisAnglef q_error((_state.quat_nominal * ev_sample.quat.inversed()).normalized());
|
||||
const Quatf q_error((_state.quat_nominal * ev_sample.quat.inversed()).normalized());
|
||||
|
||||
if (!q_error.isAllFinite()) {
|
||||
return;
|
||||
|
||||
Reference in New Issue
Block a user