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

Find a mistake about FEJ in the home page #428

Open
TianzeXie opened this issue Mar 7, 2024 · 3 comments
Open

Find a mistake about FEJ in the home page #428

TianzeXie opened this issue Mar 7, 2024 · 3 comments
Labels
question Theory or implementation question

Comments

@TianzeXie
Copy link

in this page https://docs.openvins.com/fej.html
At the last equation ,should it be
$$\tilde{z_{k+1}}= z_{k+1}-h(x_{k+1})=\bar{H_k}(x_{k+1}-\hat{x}_k)$$
Because every time the filter update, we assume that the robot is at the true state of the k+1 timestamp where it observe the features.

@goldbattle goldbattle added the question Theory or implementation question label Mar 25, 2024
@goldbattle
Copy link
Member

The equation on the website should be correct as this is a linearization equation. We do not know the true state, so it is not possible to evaluate the equation you have posted. Thus we linearize the true equations z = h(x) + n to get our z = h(x_hat) + H (x - x_hat) + n. The key to FEJ is about what point to evaluate the Jacobian at the ensure correct observability properties. Hope this helps.

@TianzeXie
Copy link
Author

true, just like you said, the ture equation is :
$z_{k}=h(x_k)+n$. In my context, it is $z_{k+1}=h(x_{k+1})+n$, so I have my first equation: $\tilde{z_{k+1}}=z_{k+1}-h(x_{k+1})$, right? And then consider the FEJ, I linearize it at the point $\hat{x_h}$, so I get my second equation.

@goldbattle
Copy link
Member

Typically the residual is defined after linearization. The third equation you wrote is just directly equal to noise not the residual.

Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
question Theory or implementation question
Projects
None yet
Development

No branches or pull requests

2 participants