マルチビームLiDARセンサーは、ロボット工学、特に自動運転車の位置特定と知覚タスクでますます使用されています。ただし、知覚は、ローカリゼーションタスクと、ロボットが環境の詳細なマップを作成する能力と密接に関連しています。このために、CT-ICPと呼ばれる新しいリアルタイムLiDARオドメトリ法と、ループクロージャを備えた完全なSLAMを提案します。 CT-ICPの原理は、スキャン内のポーズの連続性とスキャン間の不連続性を備えた軌道の弾性定式化を使用して、センサーの動きの高周波に対してよりロバストにすることです。登録は、リアルタイムで動作するようにスパースボクセルで構造化されたマップとしての高密度ポイントクラウドを使用したスキャンツーマップに基づいています。同時に、標高画像を使用したループ閉鎖検出の高速な方法とグラフによるポーズの最適化により、純粋にLiDARで完全なSLAMを取得できます。メソッドの堅牢性を示すために、7つのデータセット(KITTI、KITTI-raw、KITTI-360、KITTI-CARLA、ParisLuco、Newer College、およびNCLT)で、運転および高周波モーションのシナリオでテストしました。 CT-ICPオドメトリはC ++で実装されており、オンラインで入手できます。ループ検出とポーズグラフの最適化は、PythonのフレームワークpyLiDAR-SLAMにあり、オンラインでも利用できます。 CT-ICPは現在、公開コードへのアクセスを提供するものの中で、KITTIオドメトリリーダーボードで最初であり、平均相対変換エラー(RTE)は0.59%、スキャンあたりの平均時間はシングルスレッドのCPUで60msです。
Multi-beam LiDAR sensors are increasingly used in robotics, particularly for autonomous cars for localization and perception tasks. However, perception is closely linked to the localization task and the robot's ability to build a fine map of its environment. For this, we propose a new real-time LiDAR odometry method called CT-ICP, as well as a complete SLAM with loop closure. The principle of CT-ICP is to use an elastic formulation of the trajectory, with a continuity of poses intra-scan and discontinuity between scans, to be more robust to high frequencies in the movements of the sensor. The registration is based on scan-to-map with a dense point cloud as map structured in sparse voxels to operate in real time. At the same time, a fast method of loop closure detection using elevation images and an optimization of poses by graph allows to obtain a complete SLAM purely on LiDAR. To show the robustness of the method, we tested it on seven datasets: KITTI, KITTI-raw, KITTI-360, KITTI-CARLA, ParisLuco, Newer College, and NCLT in driving and high-frequency motion scenarios. The CT-ICP odometry is implemented in C++ and available online. The loop detection and pose graph optimization is in the framework pyLiDAR-SLAM in Python and also available online. CT-ICP is currently first, among those giving access to a public code, on the KITTI odometry leaderboard, with an average Relative Translation Error (RTE) of 0.59% and an average time per scan of 60ms on a CPU with a single thread.