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: use bias corrected angular velocity #23335

Merged
merged 3 commits into from
Jul 11, 2024

Conversation

dagar
Copy link
Member

@dagar dagar commented Jun 27, 2024

When correcting velocity for position offsets (eg GNSS antenna) we were using uncorrected gyro stored during state predict). This pull request updates it to use bias corrected gyro (angular velocity) computed in place with the delayed IMU sample passed around.

I would guess this largely goes unnoticed as the majority of setups don't bother setting GNSS antenna positions, and typically the gyro bias is minimal (especially with autocal).

@haumarco
Copy link
Contributor

haumarco commented Jul 8, 2024

looks good, resolve conflicts then I'll approve

@dagar dagar force-pushed the pr-ekf2_angular_velocity_raw_usage branch from c1fb142 to bf7f5e1 Compare July 8, 2024 15:27
@dagar
Copy link
Member Author

dagar commented Jul 8, 2024

I've added a protection on delta_ang_dt/delta_vel_dt right before it's pushed into the IMU buffer. 95f3f06

@dagar dagar force-pushed the pr-ekf2_angular_velocity_raw_usage branch 3 times, most recently from 8694255 to 95f3f06 Compare July 8, 2024 17:07
bresch
bresch previously approved these changes Jul 10, 2024
@dagar
Copy link
Member Author

dagar commented Jul 10, 2024

Needs another rebase...

 - avoid unnecessarily storing _ang_rate_delayed_raw
 - I think this helps make it clear we're using a sensor sample
   corresponding with a particular IMU sample
@dagar dagar force-pushed the pr-ekf2_angular_velocity_raw_usage branch from 95f3f06 to 1c6810e Compare July 10, 2024 16:40
@dagar dagar merged commit 9124a7b into main Jul 11, 2024
85 of 94 checks passed
@dagar dagar deleted the pr-ekf2_angular_velocity_raw_usage branch July 11, 2024 01:20
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Projects
Status: ✅ Done
Development

Successfully merging this pull request may close these issues.

3 participants