MISTLab / Swarm-SLAM

Sparse Decentralized Collaborative Simultaneous Localization and Mapping Framework for Multi-Robot Systems
https://lajoiepy.github.io/cslam_documentation/html/index.html
MIT License
391 stars 40 forks source link

Real-time problem & trajectory problem on Graco dataset #35

Closed ResearcherYan closed 5 months ago

ResearcherYan commented 5 months ago

Real-time problem

As I mentioned in issue #31, my personal computer couldn't handle the computation burden of the algorithm. So I deployed the docker container on a server, with 2 AMD EPYC 9174F CPUs.

However, I found the algorithm still can't run in real time. The odometry ran only at around 2Hz when no loop closure was involved, while all the 64 CPU cores were running almost at max capacity.

2024-03-29_16-02 2024-03-29_16-01

Since the CPU on that server is strong enough, I'd like to know if your code is so computation-demanding or if I did some wrong setups that led to this real-time problem.

Trajectory problem

Nevertheless, running on the server side does make the trajectory more reasonable. It's more continuous compared to my PC running result. Yet the trajectories are still not on the same plane.

2024-03-29_16-25 2024-03-29_16-28

I'd like to know if your experiment results on Graco are the same or if my trajectories are wrong.

Thanks a lot.

mjforan commented 5 months ago

The resource hog is rtabmap's icp_odometry. In my preliminary testing FAST-LIO2 is an order of magnitude faster and provides accurate odometry.

ResearcherYan commented 5 months ago

I'll try a new odometry later. Thx!