Skip to content
New issue

Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.

By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.

Already on GitHub? Sign in to your account

EKF2: vision attitude error filter #21791

Merged
merged 2 commits into from Jul 3, 2023
Merged

EKF2: vision attitude error filter #21791

merged 2 commits into from Jul 3, 2023

Conversation

bresch
Copy link
Member

@bresch bresch commented Jul 3, 2023

Solved Problem

When the vision frame is not NED, we need to rotate the EV data by the attitude difference between the two frames. The issue is that any noise in that difference will be transferred on the EV position and velocity measurements.
This can in some extreme case cause a constant reset of the estimator as the data can often fail the innovation check.
ev_sawtooth_sitl

Solution

Since the attitude error is almost constant (really slow drift), it can be heavily low-passed to remove most of the noise.
ev_sawtooth_fixed_sitl

Changelog Entry

For release notes:

Add vision attitude error filter
New parameter: -
Documentation: -

Alternatives

estimate the attitude error

Test coverage

unit and sitl tests

@dagar dagar merged commit 288e3ae into main Jul 3, 2023
82 of 86 checks passed
@dagar dagar deleted the pr-ekf2-ev-q-error-filt branch July 3, 2023 15:14
antbre pushed a commit to BioMorphic-Intelligence-Lab/PX4-Autopilot that referenced this pull request Sep 14, 2023
* ekf2-ev: filter q_error for frame correction
* ekf2: filter EV attitude error centrally
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Projects
None yet
Development

Successfully merging this pull request may close these issues.

None yet

2 participants