Ericsii / FAST_LIO_ROS2

ROS2 version of FAST_LIO2. Welcome to the technical communication discord server discord: https://discord.gg/U3B65MGH8m
GNU General Public License v2.0
128 stars 29 forks source link

Point Cloud Output "Fuzzy" and Path is not correct #9

Closed ryanpdoc57 closed 6 months ago

ryanpdoc57 commented 7 months ago

I am using ROS2 Foxy to run the package. Pictured below is the Velodyne bag file output in RViz for "20120615-001", however, the same result happens no matter what LiDAR type/bag file I use. The output is extremely "fuzzy" and shows a significantly lower-quality image as the ROS1 version of the same bag file. Also, the path is not completely accurate, as seen in the images below. There is some drift in Odometry that appears in the ROS2 version, but not the ROS1 version. Does anyone have any input on this? The first Image is ROS1, while the second image is ROS2. Thanks in advance! ROS1 ROS2

Ericsii commented 7 months ago

I did not migrate the RVIZ config from the original version. The RVIZ config is a handmade one. Due to FASTLIO being only a lidar odometry if the trajectory is correct then everything is working correctly.

You should disable the pointcloud view in RVIZ and compare only the trajectories generated from ROS1 and ROS2.

ryanpdoc57 commented 7 months ago

As you can see in the following picture, the path is also not correct. Measuring with a protractor, the angle of the path using ROS2 (left image) is about 30 degrees, while the angle for ROS1 (right image) is about 40 degrees. The red line being flat in both images (a wall or something like that) proves the difference in the angles. The trajectories should be the exact same. Have you done any data set testing that proves the full functionality of ROS2 FAST-LIO? Through my testing using different data sets, I have reason to believe the package does not function as expected. I would love to be wrong though.

ROS1 vs ROS2
Ericsii commented 7 months ago

Could you please test it on some open-source datasets with ground-truth odometry? In this way, we can compare the effects of these two versions.

ryanpdoc57 commented 7 months ago

Could you please test it on some open-source datasets with ground-truth odometry? In this way, we can compare the effects of these two versions.

I am trying to use the M2GDR data set (https://github.com/SJTU-ViSYS/M2DGR?tab=readme-ov-file) which contains ground truth information. I am using plot juggler to plot the trajectory of the odometry from FAST-LIO, but I don't know how to overlay this plot with the ground truth (.txt file). Do you have any advice on how to do this? The bag files are too big for Matlab.

Ericsii commented 7 months ago

You can use EVO. This is a well-used toolbox for SLAM evaluation

Ericsii commented 6 months ago

Close for no update