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

Questions about marginalization in BatchFixedLagSmoother #1956

Open
EricX-Zhao opened this issue Jan 1, 2025 · 0 comments
Open

Questions about marginalization in BatchFixedLagSmoother #1956

EricX-Zhao opened this issue Jan 1, 2025 · 0 comments

Comments

@EricX-Zhao
Copy link

EricX-Zhao commented Jan 1, 2025

When using BatchFixedLagSmoother, if the robot remains stationary for a period of time (e.g., the first few seconds of Euroc MH03 dataset), the factor graph in the sliding window evolves as follows:

Before reaching the sliding window limit, there are approximately 40 factors, and these factors are observable from X0 to X5,

image

When X6 is added and X0 is marginalized, many factors associated with X0 are removed, and because the robot is stationary, there are few new factors.

image

By the time X10 is added, only two factors remain, leading to insufficient constraints.

image

My question is: after marginalizing a variable, do I need to re-add the measurement data of the smart factors associated with every variable in the sliding window?

For example, after adding X6 and marginalizing out X0, all the factors related to X0 will be removed. However, if these factors are still observable by the variables within the sliding window X1,X2,X3,X4,X5,X6 do I need to re-add these factors?

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

No branches or pull requests

1 participant