hku-mars / FAST_LIO

A computationally efficient and robust LiDAR-inertial odometry (LIO) package
GNU General Public License v2.0
2.4k stars 824 forks source link

Support ROS2 #234

Closed Ericsii closed 4 months ago

Ericsii commented 1 year ago

Is any plan to support ROS2? I'm porting FAST_LIO into ROS2-humble. Wondering if you have a plan to support ROS2. If so could you please create a new branch ros2? I'll take a few PRs to port my ros2 code to this branch

Ecstasy-EC commented 1 year ago

Absolutely yes! Our team has been busy these days. We will create the branch for you in the coming week.

Ericsii commented 1 year ago

Very appreciate. I made a simple port of FAST_LIO to ros2 version. Please feel free to check it on my fork. https://github.com/Ericsii/FAST_LIO

Ecstasy-EC commented 1 year ago

Very appreciate. I made a simple port of FAST_LIO to ros2 version. Please feel free to check it on my fork. https://github.com/Ericsii/FAST_LIO

Thanks! We will reach you as soon as we finish the test.

Ecstasy-EC commented 1 year ago

@Ericsii Could you please provide me with your email for communicating more efficiently about some problems I met when testing your branch?

stale[bot] commented 1 year ago

This issue has been automatically marked as stale because it has not had recent activity. It will be closed if no further activity occurs. Thank you for your contributions.

TheodorPatrickZ commented 1 year ago

Very appreciate. I made a simple port of FAST_LIO to ros2 version. Please feel free to check it on my fork. https://github.com/Ericsii/FAST_LIO

Hi are you able to run the provided rosbags when convertet to ros2? It is not working for me.

Ecstasy-EC commented 1 year ago

Very appreciate. I made a simple port of FAST_LIO to ros2 version. Please feel free to check it on my fork. https://github.com/Ericsii/FAST_LIO

Hi are you able to run the provided rosbags when convertet to ros2? It is not working for me.

Hi. I also tried this repo but I could not run successfully yet. I was trying to contact the author but got no response.

Ericsii commented 1 year ago

@Ecstasy-EC Sorry for the late reply. Here is my email ericfengx@foxmail.com.

Ericsii commented 1 year ago

Very appreciate. I made a simple port of FAST_LIO to ros2 version. Please feel free to check it on my fork. https://github.com/Ericsii/FAST_LIO

Hi are you able to run the provided rosbags when convertet to ros2? It is not working for me.

rosbags for ros1 is not compatible in ros2. You can follow this tutorial to convert rosbags to ros2. https://ternaris.gitlab.io/rosbags/topics/convert.html

Ericsii commented 1 year ago

@Ecstasy-EC Can you reopen this issue? So that others can communicate about ros2 migration.

Ecstasy-EC commented 1 year ago

@Ecstasy-EC Can you reopen this issue? So that others can communicate about ros2 migration.

Reopened.

andy-zhuo-02 commented 1 year ago

I'm also interested in the ROS2 version of FAST-LIO. Is there a stable version yet?

andy-zhuo-02 commented 1 year ago

I have successfully run through the data stream, but there seems to be a problem with the results of the mapping. The appearance of point clouds is very strange. The range of point clouds is very small and their positioning is easy to drift. I don't know if there are any suggestions. 01 02

Ecstasy-EC commented 1 year ago

I have successfully run through the data stream, but there seems to be a problem with the results of the mapping. The appearance of point clouds is very strange. The range of point clouds is very small and their positioning is easy to drift. I don't know if there are any suggestions. 01 02

Are you able to run FAST-LIO2 in ros1 using the same config on the data?

andy-zhuo-02 commented 1 year ago

I have successfully run through the data stream, but there seems to be a problem with the results of the mapping. The appearance of point clouds is very strange. The range of point clouds is very small and their positioning is easy to drift. I don't know if there are any suggestions. 01 02

Are you able to run FAST-LIO2 in ros1 using the same config on the data?

It seems that, YES.

here is the fast-lio in ROS noetic. I compared all config in mid70.yaml, or I missed something?

2023-05-26 19-39-09 的屏幕截图

Ecstasy-EC commented 1 year ago

@Ericsii Would you please provide some help if you have any ideas?

Ericsii commented 1 year ago

I have successfully run through the data stream, but there seems to be a problem with the results of the mapping. The appearance of point clouds is very strange. The range of point clouds is very small and their positioning is easy to drift. I don't know if there are any suggestions. 01 02

Are you able to run FAST-LIO2 in ros1 using the same config on the data?

Can you give me your configuration file? This may be because publish.dense_publish_en is set to false.

stale[bot] commented 1 year ago

This issue has been automatically marked as stale because it has not had recent activity. It will be closed if no further activity occurs. Thank you for your contributions.

Ericsii commented 1 year ago

Please keep this issue open.

stale[bot] commented 11 months ago

This issue has been automatically marked as stale because it has not had recent activity. It will be closed if no further activity occurs. Thank you for your contributions.

Taeyoung96 commented 11 months ago

@Ecstasy-EC @Ericsii

I got the FAST-LIO2 ros2 version up and running in docker based on the ros2 branch created by Ericsii and it works pretty well!

The dockerized repository is shown below. I even added a function to save the trajectory and 3D map.

After converting the M2DGR dataset to a ros2 bagfile, I performed experiments using the velodyne and handsfree imu.

See below for more details, https://github.com/Taeyoung96/FAST_LIO_ROS2/tree/ros2

Result

stale[bot] commented 10 months ago

This issue has been automatically marked as stale because it has not had recent activity. It will be closed if no further activity occurs. Thank you for your contributions.

stale[bot] commented 9 months ago

This issue has been automatically marked as stale because it has not had recent activity. It will be closed if no further activity occurs. Thank you for your contributions.

stale[bot] commented 9 months ago

This issue has been automatically marked as stale because it has not had recent activity. It will be closed if no further activity occurs. Thank you for your contributions.

stale[bot] commented 8 months ago

This issue has been automatically marked as stale because it has not had recent activity. It will be closed if no further activity occurs. Thank you for your contributions.

ryanpdoc57 commented 8 months ago

@Ericsii Hello! I was able to successfully run ROS2 version of fast-lio in Humble, but am having issues building the package using ROS2 foxy. Have you tested this in foxy? If so did you run into any build issues? It is specifically with a service and a service callback from the lasermapping.cpp file.

stale[bot] commented 7 months ago

This issue has been automatically marked as stale because it has not had recent activity. It will be closed if no further activity occurs. Thank you for your contributions.

Ericsii commented 7 months ago

I was able to successfully run ROS2 version of fast-lio in Humble, but am having issues building the package using ROS2 foxy. Have you tested this in foxy? If so did you run into any build issues? It is specifically with a service and a service callback from the lasermapping.cpp file.

@ryanpdoc57 Sorry, I didn't test this on ROS Foxy. Can you provide a build log on foxy?

Ericsii commented 7 months ago

@Ecstasy-EC Perhaps we can now create a new branch for ROS2?

wyb17js commented 6 months ago

Hello, we use this transplanted fast-lio2 algorithm to realize the robot's positioning function on humble, but we encounter a problem: the positioning is lost after a period of time. We find that: the time that the positioning can be maintained is related to the radar release frequency, the higher the frequency, the longer the duration; With the operation of the program, there will be an interval in the use of radar data. For example, I am publishing a point cloud at a frequency of 10HZ. Originally, my radar data is matched with imu data every 0.1s and used by the algorithm, but with the operation of the program, my radar data may be used at an interval of 0.2s and 0.3s, and this interval gradually increases. When the interval reaches 1s, the location is lost. I was wondering if you had the same problem.Do you have any good suggestions on this matter? I'm looking forward to your reply.

Ericsii commented 6 months ago

For example, I am publishing a point cloud at a frequency of 10HZ. Originally, my radar data is matched with imu data every 0.1s and used by the algorithm, but with the operation of the program, my radar data may be used at an interval of 0.2s and 0.3s, and this interval gradually increases. When the interval reaches 1s, the location is lost.

@wyb17js have you tested this on the original version of FAST_LIO for ROS1? If the result is the same, you may check whether the timestamps of IMU and lidar are aligned.

wyb17js commented 6 months ago

Not yet, but I have tested it in a simulation environment, using radar and imu plugins, and there is also a loss of location, but the location lasts longer than it actually does. So how do I align the radar and imu timestamps? The radar I use is mid360, no external imu

Ericsii commented 6 months ago

I have tested it in a simulation environment

Which simulator did you use? I have tested on Gazebo the lidar output frequency is not usable for common SLAM algorithms. Please use real environment

wyb17js commented 6 months ago

I have tested it in a simulation environment

Which simulator did you use? I have tested on Gazebo the lidar output frequency is not usable for common SLAM algorithms. Please use real environment

I use Gazebo,too. Does time synchronization refer to hardware synchronization? I noticed that there is code in the program to handle timestamp deviation, and it takes effect when time_sync_en is turned on. I tried this feature but it didn't work well.

Ericsii commented 6 months ago

I have tested it in a simulation environment

Which simulator did you use? I have tested on Gazebo the lidar output frequency is not usable for common SLAM algorithms. Please use real environment

I use Gazebo,too. Does time synchronization refer to hardware synchronization? I noticed that there is code in the program to handle timestamp deviation, and it takes effect when time_sync_en is turned on. I tried this feature but it didn't work well.

Please test it in a real-world environment. The online time synchronization algorithm only estimates the fixed timestamp offset between lidar and IMU. For dynamic time offset, it may not work as expected

wyb17js commented 6 months ago

I have tested it in a simulation environment

Which simulator did you use? I have tested on Gazebo the lidar output frequency is not usable for common SLAM algorithms. Please use real environment

I use Gazebo,too. Does time synchronization refer to hardware synchronization? I noticed that there is code in the program to handle timestamp deviation, and it takes effect when time_sync_en is turned on. I tried this feature but it didn't work well.

Please test it in a real-world environment. The online time synchronization algorithm only estimates the fixed timestamp offset between lidar and IMU. For dynamic time offset, it may not work as expected

So how do I deal with dynamic time offset? I don't know much about it. Could you give me some advice?

Ericsii commented 6 months ago

So how do I deal with dynamic time offset? I don't know much about it. Could you give me some advice?

Sorry, I'm not an expert in timestamp calibration. You can search for some academic papers in these related fields.

stale[bot] commented 5 months ago

This issue has been automatically marked as stale because it has not had recent activity. It will be closed if no further activity occurs. Thank you for your contributions.

stale[bot] commented 4 months ago

This issue has been automatically marked as stale because it has not had recent activity. It will be closed if no further activity occurs. Thank you for your contributions.

Ecstasy-EC commented 4 months ago

The issue is closed. A new branch for ROS2 has been created and the pull request from @Ericsii is merged. Please open new issues if any other problems are found in the ROS2 version.