Comments (4)
https://en.wikipedia.org/wiki/Extended_Kalman_filter#Non-additive_noise_formulation_and_equations
In the notation of that Wikipedia article, dydx
is dydq
is
from hybvio.
https://en.wikipedia.org/wiki/Extended_Kalman_filter#Non-additive_noise_formulation_and_equations In the notation of that Wikipedia article,
dydx
is$F$ anddydq
is$L$ .
Thanks for your quick replay. However, follow the equaction. I found the F and the Q should be:
This equation is from the Paper"Robust Stereo Visual Inertial Odometry for Fast Autonomous Flight" and it is as the same as "Quaternion kinematics for the error-state Kalman filter".
However, there some differences in the code. Like the:
dydx.block(VEL, BGA, 3, 3) = -dydq.block(VEL, Q_GYRO, 3, 3);
The derivatives of bga about the velocity should be same in the two equation. I don't know where the "minus" come from?Another problem is that why multiply the A matrix twice Like this:
dydq.block(VEL, Q_GYRO, 3, 3) = dydx.block(VEL, ORI, 3, 4) * dydq.block(ORI, Q_GYRO, 4, 3);
I know the unit test proved that the matrix should right. But I don't know how to derivate the analytical equation about the F and Q. Could you please help me and give me some advice?
from hybvio.
dydx.block(VEL, BGA, 3, 3) = -dydq.block(VEL, Q_GYRO, 3, 3);
These blocks have different signs simply because in Q_GYRO
). I'm not very familiar with the formalism of the papers you referred to, but there may very well be some sign difference since we handle the orientations differently, without reducing their dimensionality from 4 to 3.
https://github.com/SpectacularAI/HybVIO/blob/main/src/odometry/ekf.cpp#L480-L485
As you must have noticed, the code comments about the possibly duplicated matrix
If I recall correctly, we also tried removing the possibly duplicated matrix A
and the derivative check unit test still passed. The VIO performance was the same or slightly worse.
from hybvio.
dydx.block(VEL, BGA, 3, 3) = -dydq.block(VEL, Q_GYRO, 3, 3);
These blocks have different signs simply because in
$\hat{\omega} = \omega_m - b_g + n_g$ the two last terms have different signs. Here$n_g$ represents the gyroscope measurement noise (Q_GYRO
). I'm not very familiar with the formalism of the papers you referred to, but there may very well be some sign difference since we handle the orientations differently, without reducing their dimensionality from 4 to 3.https://github.com/SpectacularAI/HybVIO/blob/main/src/odometry/ekf.cpp#L480-L485 As you must have noticed, the code comments about the possibly duplicated matrix
$A = \exp{S}$ — this is not clear to me either. As I understand it, the derivative of the matrix exponential is not simply$\frac{d}{dx} \exp{S} = (\exp{S}) \frac{d}{dx}S$ , but that is some kind of approximation. See for example https://en.wikipedia.org/wiki/Derivative_of_the_exponential_mapIf I recall correctly, we also tried removing the possibly duplicated matrix
A
and the derivative check unit test still passed. The VIO performance was the same or slightly worse.
Thank you for your quick reply. I'll check it again and make it more clearly to understand.
from hybvio.
Related Issues (20)
- Question about parameter visualR HOT 1
- Question about the world to local quaternion
- Visual inertial ekf slam HOT 1
- Recreating Online Arxiv Paper Results for TUM-VI HOT 4
- KERNEL.HASWELL file missing? HOT 3
- Most Faithful Real-time Settings HOT 2
- Question about the input data. HOT 1
- Question about the paper HOT 1
- Question about the parameters HOT 4
- Question about distortion coefficients HOT 1
- Question about triangulateLinear HOT 1
- Question about jacobian in triangulation HOT 1
- Can't compile on any of the systems HOT 2
- question about the processing queues HOT 1
- visualUpdateForEveryNFrame Quality Worse Than Skipping Entire Frame HOT 2
- Problem with triangulation【More importantly about how to understand PIVO】? HOT 2
- Test without additional sensor data HOT 1
- Problem about IMU noise unit HOT 7
- HybVIO assume/tuned for parallel stereo cameras? HOT 3
Recommend Projects
-
React
A declarative, efficient, and flexible JavaScript library for building user interfaces.
-
Vue.js
🖖 Vue.js is a progressive, incrementally-adoptable JavaScript framework for building UI on the web.
-
Typescript
TypeScript is a superset of JavaScript that compiles to clean JavaScript output.
-
TensorFlow
An Open Source Machine Learning Framework for Everyone
-
Django
The Web framework for perfectionists with deadlines.
-
Laravel
A PHP framework for web artisans
-
D3
Bring data to life with SVG, Canvas and HTML. 📊📈🎉
-
Recommend Topics
-
javascript
JavaScript (JS) is a lightweight interpreted programming language with first-class functions.
-
web
Some thing interesting about web. New door for the world.
-
server
A server is a program made to process requests and deliver data to clients.
-
Machine learning
Machine learning is a way of modeling and interpreting data that allows a piece of software to respond intelligently.
-
Visualization
Some thing interesting about visualization, use data art
-
Game
Some thing interesting about game, make everyone happy.
Recommend Org
-
Facebook
We are working to build community through open source technology. NB: members must have two-factor auth.
-
Microsoft
Open source projects and samples from Microsoft.
-
Google
Google ❤️ Open Source for everyone.
-
Alibaba
Alibaba Open Source for everyone
-
D3
Data-Driven Documents codes.
-
Tencent
China tencent open source team.
from hybvio.