ethz-asl / ethzasl_msf

MSF - Modular framework for multi sensor fusion based on an Extended Kalman Filter (EKF)
Other
982 stars 434 forks source link

Drift in pose estimation #174

Open clmpng opened 5 years ago

clmpng commented 5 years ago

Hi,

Currently we are using a Velodyne 3D Lidar in combination with the “loam_velodyne” package for localization. To combine the lidar and the IMU data, I decided to use your msf framework but unfortunately I have some difficulties setting it up. For testing purposes, I implemented a model of a MAV and the Velodyne sensor in RotorS and tried to fuse the pose information from the lidar with the ground-truth IMU. The pose output of loam is pretty accurate and in combination with the perfect IMU information, a very good pose estimation should be the result. But, as you can see the in the image - the msf output looses accuracy over time, even though the MAV is not changing its position at all: image

How is it possible that there is such a drift in the pose estimation if all my sensors deliver (almost) perfect data, are there any special settings that I have to consider? Also, I was not sure how to set the pose delay – how can I determine this value? This is my .yaml file:

image

Thanks in advance!

AntonioCarralero commented 2 years ago

Did you find a solution of the problem? I