HKUST-Aerial-Robotics / VINS-Fusion

An optimization-based multi-sensor state estimator
GNU General Public License v3.0
3.45k stars 1.37k forks source link

possible solution to drift when using stereo+imu #201

Open gzhxxx opened 1 year ago

gzhxxx commented 1 year ago
Hello! Thanks for your excellent work.0
As is disscussed in many other issues, when using vins fusion with stereo+imu mode, we also suffers huge drift. After many experiments, we find that by setting sqrt_info matrix to be identical or divided by its norm, the drift seems disappeared. However, there seems a cordinate mismatch. For example, when we move the vehicle horizontally, the path of the algorithm indicates that vehicle drops first and rises when go back. The resulted path is below, in which the path should be at the same altitude.

1670154538267

tulingcheng86 commented 8 months ago

hello,how to set sqrt_info matrix,i am not find this matrix.where can i set it.thinks