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

Question about mid-point integration in integration_base.h #14

Open
highlightz opened this issue Jun 6, 2017 · 4 comments
Open

Question about mid-point integration in integration_base.h #14

highlightz opened this issue Jun 6, 2017 · 4 comments

Comments

@highlightz
Copy link

In your paper TRO VINS-Mono: A Robust and Versatile Monocular Visual-Inertial State Estimator, you've demonstrated the Euler integration procedure in an understandable and elegant manner. At the same time, your implementation chooses Mid-point integration, as is shown in VINS-Mono project.
In method IntegrationBase::midPointIntegration(), I see that you propagate jacobian and covariance with similar formular as (10) and (11) in TRO,
1766
17661
I mean,
1766661

What I do not understand is that how F and V are computed?
176665253

Are there corresponding formulas in your other papers? I'd appreciate it if you can provide any information about this. Thank much again for your outstanding work.

@qintonguav
Copy link
Member

image
image

Second order approximation, derived by myself.

@highlightz
Copy link
Author

@QinTony Yeah, your derivation exactly matches your implementation. I am still confused about the calculation of f01, f31, etc. Forgive me for my poor math, however, could you please give me an example of the computation of f01? Thanks a lot.

@qintonguav
Copy link
Member

You maybe confuse about quaternion derivate.
You can refer to the following papers.

Quaternion kinematics for the error-state KF
http://www.iri.upc.edu/people/jsola/JoanSola/objectes/notes/kinematics.pdf

Similiar step in Page.51

@highlightz
Copy link
Author

Thanks for your great help. You're correct, the quaternion derivate does confuse me. I read through the kienmatics.pdf paper, and know the meaning of your formula. Best wishes.

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

2 participants