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

numerical unstable in preintegration #246

Open
Neoyning opened this issue May 28, 2024 · 1 comment
Open

numerical unstable in preintegration #246

Neoyning opened this issue May 28, 2024 · 1 comment

Comments

@Neoyning
Copy link

Neoyning commented May 28, 2024

Hi there,

I am testing the VINS-Fusion with stereo inertial config, the code run properly and the GUI (rivz) is showing the correct results, but it always suddenly goes into warning "numerical unstable in preintegration", and from this on the estimation of trajectory diverges.

Screenshot from 2024-05-28 16-58-01

Screenshot from 2024-05-28 17-05-08

[ WARN] [1716886222.055879229]: numerical unstable in preintegration [ WARN] [1716886222.057814121]: numerical unstable in preintegration [ WARN] [1716886222.059318981]: numerical unstable in preintegration

This phenomenon does not always happen on the same rosbag. When I use VINS-Mono for the same rosbag, this issue is never triggered and shows robust performance. So now I only use mono inertial instead of stereo inertial when testing VINS.

Does anyone know the reason for this phenomenon?

Thanks

@Neoyning
Copy link
Author

The "numerical unstable in preintegration" happens when computing the Jacobian of IMU preintegration.

if (jacobian_pose_i.maxCoeff() > 1e8 || jacobian_pose_i.minCoeff() < -1e8) { ROS_WARN("numerical unstable in preintegration"); }

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