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

Fixing strength of bias constraints in IMUKittiExampleGPS.cpp #1735

Merged
merged 2 commits into from
Mar 22, 2024

Conversation

MichalNowicki
Copy link

@MichalNowicki MichalNowicki commented Mar 18, 2024

This is a follow-up of a question at gtsam's Google group.

included_imu_measurement_count variable was not zeroed making each consecutive bias constraint weaker. This PR zeroes it when a new node is placed in the graph. For default parameters, included_imu_measurement_count is equal to 100 for all added bias constraints.

This change impacts the final estimate, which I am not sure if was ever compared to ground truth.

Previously, State at 469:
t: 43.0073055 74.1530101 -0.426735268

Currently, State at 469:
t: 44.1523951 74.9626438 0.170519702

Copy link
Collaborator

@varunagrawal varunagrawal left a comment

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

LGTM. Thanks for the fix!

@varunagrawal
Copy link
Collaborator

Looks like the PPA servers are down. I'll re-run the CI later today.

@varunagrawal varunagrawal merged commit 16346ca into borglab:develop Mar 22, 2024
31 checks passed
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
None yet
Projects
None yet
Development

Successfully merging this pull request may close these issues.

2 participants