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

Regarding geometric observer equations #58

Open
VRichardJP opened this issue Jun 14, 2024 · 0 comments
Open

Regarding geometric observer equations #58

VRichardJP opened this issue Jun 14, 2024 · 0 comments

Comments

@VRichardJP
Copy link
Contributor

VRichardJP commented Jun 14, 2024

In the geometric observer paper ("A Contracting Hierarchical Observer for Pose-Inertial Fusion"), the state update is described by the following equations:

image

image

From these derivative equations, how to you get yours?

image

I understand your update comes from a first order derivative approximation, where the correction is applied a posteriori on the latest state, using the total integration time Dt:

s_hat(t + Dt) = s_hat(t) + Dt * s_hat'(t)
              = s_hat(t) + Dt * [s_imu'(t) + s_err'(t)]
              = s_hat(t) + Dt * s_imu'(t) + Dt * s_err'(t)
              = s_imu(t+dt) + Dt * s_err'(t)

where s_imu is the state computed from imu integration, based on the following equations:

image

and s_err' are the "correction" part of the geometric obserser equations:

image

image

The correction factors looks the same on both papers for q, bw, and p. However for v and ba, I think your implementation is missing a few factors:

image

Why is that? are these factors experimentaly negligible?

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