最新の3Dレーザーレンジスキャナはデータレートが高いため、オンラインでの同時定位とマッピング(SLAM)は計算量的に難しいものとなっている。再帰的な状態推定技術は効率的であるが、新しいスキャンが行われた直後に状態推定にコミットしてしまうため、測定値のずれにつながる可能性がある。我々は、オンラインマッピング中にアライメントを再調整することを可能にする3D SLAMアプローチを提示する。この手法は、効率的なローカルマッピングと階層的最適化バックエンドに基づいている。3Dレーザースキャナーの測定値は、サーフェルベースのレジストレーションによってローカルな多解像度マップに集約される。このローカルマップは、多値化されたグラフの中で使用される。アライメントを精緻化する際に補正を組み込むために、ローカルマップ内の個々の3Dスキャンはサブグラフとしてモデル化され、ローカルマップ内のドリフトやミスアラインメントを考慮してグラフの最適化が実行される。さらに、各サブグラフでは、センサの軌跡を連続時間で表現することで、スキャンポーズ間の計測値を補正することができる。本研究では、複数の実験を行い、定性的な結果を示すことで、本研究のアプローチを評価する。さらに、エントロピーに基づく測定値を用いてマップの品質を定量化する。
Modern 3D laser-range scanners have a high data rate, making online simultaneous localization and mapping (SLAM) computationally challenging. Recursive state estimation techniques are efficient but commit to a state estimate immediately after a new scan is made, which may lead to misalignments of measurements. We present a 3D SLAM approach that allows for refining alignments during online mapping. Our method is based on efficient local mapping and a hierarchical optimization back-end. Measurements of a 3D laser scanner are aggregated in local multiresolution maps by means of surfel-based registration. The local maps are used in a multi-level graph for allocentric mapping and localization. In order to incorporate corrections when refining the alignment, the individual 3D scans in the local map are modeled as a sub-graph and graph optimization is performed to account for drift and misalignments in the local maps. Furthermore, in each sub-graph, a continuous-time representation of the sensor trajectory allows to correct measurements between scan poses. We evaluate our approach in multiple experiments by showing qualitative results. Furthermore, we quantify the map quality by an entropy-based measure.