1、導(dǎo)讀

SLAM是機(jī)器人和自動(dòng)駕駛領(lǐng)域中的一個(gè)基本問題，旨在在探索環(huán)境的同時(shí)重建地圖并估計(jì)機(jī)器人在其中的位置。激光雷達(dá)的點(diǎn)云數(shù)據(jù)被廣泛應(yīng)用于捕捉環(huán)境的復(fù)雜三維結(jié)構(gòu)。然而，現(xiàn)有的SLAM方法要么依賴于密集的點(diǎn)云數(shù)據(jù)以實(shí)現(xiàn)高精度定位，要么使用通用的描述符來減小地圖的大小。這兩個(gè)方面似乎存在沖突。因此，我們提出了一種統(tǒng)一的架構(gòu)，DeepPointMap（DPM），在這兩個(gè)方面都具有出色的優(yōu)勢(shì)。

2、研究?jī)?nèi)容

我們提出了一種名為DeepPointMap的深度學(xué)習(xí)框架，用于解決LiDAR SLAM中的定位和地圖構(gòu)建問題。傳統(tǒng)的LiDAR SLAM方法要么依賴于密集的點(diǎn)云數(shù)據(jù)以實(shí)現(xiàn)高精度定位，要么使用通用的描述符來減小地圖的大小。然而，這兩個(gè)方面似乎存在沖突。為了解決這個(gè)問題，我們提出了一種統(tǒng)一的架構(gòu)，即DeepPointMap，既能實(shí)現(xiàn)高效的內(nèi)存使用的地圖表示，又能實(shí)現(xiàn)準(zhǔn)確的多尺度定位任務(wù)（如里程計(jì)和閉環(huán)檢測(cè)）。

3、創(chuàng)新

本研究的創(chuàng)新性主要體現(xiàn)在以下幾個(gè)方面：

統(tǒng)一的神經(jīng)網(wǎng)絡(luò)描述符：本研究提出了DeepPointMap（DPM）框架，其中包括DPM編碼器和DPM解碼器兩個(gè)神經(jīng)網(wǎng)絡(luò)。DPM編碼器能夠從點(diǎn)云數(shù)據(jù)中提取高度代表性且稀疏的神經(jīng)描述符，實(shí)現(xiàn)了對(duì)環(huán)境的高效編碼。與傳統(tǒng)的手工設(shè)計(jì)特征相比，這些神經(jīng)描述符既能夠減小地圖的內(nèi)存占用，又能夠保持高精度的定位和重建能力。

多尺度匹配和注冊(cè)：DPM解碼器能夠基于神經(jīng)描述符進(jìn)行多尺度的匹配和注冊(cè)，包括里程計(jì)和閉環(huán)檢測(cè)。與其他基于神經(jīng)描述符的方法相比，DPM解碼器能夠在統(tǒng)一的框架下完成多個(gè)SLAM子任務(wù)，實(shí)現(xiàn)了定位精度、內(nèi)存效率、地圖保真度和實(shí)時(shí)處理的統(tǒng)一優(yōu)化。

多智能體協(xié)作SLAM：本研究將DPM框架擴(kuò)展到多智能體協(xié)作SLAM領(lǐng)域。每個(gè)智能體都維護(hù)自己的SLAM系統(tǒng)，并在本地進(jìn)行里程計(jì)和閉環(huán)檢測(cè)。通過將觀測(cè)數(shù)據(jù)進(jìn)行合并和優(yōu)化，實(shí)現(xiàn)了全局一致性的軌跡估計(jì)和地圖重建。這在通信帶寬有限的多智能體系統(tǒng)中具有重要意義。

4、方法

該框架包括兩個(gè)神經(jīng)網(wǎng)絡(luò)：DPM編碼器和DPM解碼器。DPM編碼器從點(diǎn)云中提取高度代表性和稀疏的神經(jīng)描述符，實(shí)現(xiàn)了內(nèi)存高效的地圖表示和準(zhǔn)確的多尺度定位任務(wù)。DPM解碼器基于這些神經(jīng)描述符進(jìn)行多尺度匹配和注冊(cè)。與其他神經(jīng)描述符方法不同的是，DPM描述符可以統(tǒng)一地用于SLAM任務(wù)的多個(gè)子任務(wù)，具有出色的定位精度、內(nèi)存效率、地圖保真度和實(shí)時(shí)處理能力。

4.1、DPM編碼器

DPM編碼器使用稀疏描述符來表示復(fù)雜的點(diǎn)云數(shù)據(jù)，這些描述符包含了壓縮的語(yǔ)義信息。輸入是一個(gè)點(diǎn)云，可以表示為一組3D點(diǎn)。DPM編碼器實(shí)際上是一個(gè)PointNeXt的主干網(wǎng)絡(luò)，主干網(wǎng)絡(luò)從密集的點(diǎn)云P中采樣稀疏的關(guān)鍵點(diǎn)，并提取它們的鄰域幾何特征，其中是特征向量的維度。主干網(wǎng)絡(luò)的最終輸出是統(tǒng)一的描述符云，用于表示密集的點(diǎn)云。我們可以通過并集操作將多個(gè)描述符云合并成一個(gè)，用于表示地圖級(jí)別的描述符云，而無需重新提取特征。

4.2、DPM解碼器

DPM解碼器用于預(yù)測(cè)兩個(gè)描述符云之間的變換關(guān)系，它包括四個(gè)部分：（1）描述符級(jí)變換塊，用于融合兩個(gè)輸入描述符云之間的深度相關(guān)特征；（2）相似性頭，用于計(jì)算兩個(gè)描述符云之間的對(duì)應(yīng)關(guān)系；（3）偏移頭，用于預(yù)測(cè)描述符云之間的偏移量；（4）旋轉(zhuǎn)頭，用于預(yù)測(cè)描述符云之間的旋轉(zhuǎn)矩陣。這些部分共同工作，實(shí)現(xiàn)了描述符云之間的匹配和配準(zhǔn)，從而實(shí)現(xiàn)了定位和閉環(huán)檢測(cè)等多尺度的定位任務(wù)。

4.3、訓(xùn)練

在訓(xùn)練DeepPointMap時(shí)，作者使用了幾個(gè)不同的數(shù)據(jù)集。其中包括SemanticKITTI、KITTI-360和MulRan。作者還使用了KITTI-Carla數(shù)據(jù)集進(jìn)行訓(xùn)練。訓(xùn)練集和測(cè)試集的劃分是根據(jù)幀數(shù)的比例進(jìn)行的，大約是6:4的比例。在訓(xùn)練過程中，作者使用了絕對(duì)姿態(tài)誤差（APE）來評(píng)估預(yù)測(cè)軌跡的全局準(zhǔn)確性。在定位準(zhǔn)確性方面，DeepPointMap與其他6種最新的里程計(jì)和SLAM方法進(jìn)行了比較，包括KISS-ICP、LeGO-LOAM、SC-LeGO-LOAM、MULLS、CT-ICP和GeoTransformer。作者還進(jìn)行了轉(zhuǎn)移實(shí)驗(yàn)，將DeepPointMap在KITTI-360和KITTI-Carla上訓(xùn)練，并直接在SemanticKITTI上評(píng)估其性能。在內(nèi)存效率方面，DeepPointMap相對(duì)于原始點(diǎn)云、Voxel Hashmap和Mesh等方法能夠節(jié)省大約50%至70%的內(nèi)存。最后，作者還進(jìn)行了多智能體合作SLAM實(shí)驗(yàn)，展示了DeepPointMap在多智能體場(chǎng)景下的優(yōu)越性能。

4.4、損失函數(shù)

訓(xùn)練DeepPointMap模型時(shí)使用了以下?lián)p失函數(shù)和策略：

Pairing Loss（配對(duì)損失）：使用InfoNCE損失函數(shù)作為配對(duì)損失函數(shù)，用于訓(xùn)練DPM Encoder和Decoder。配對(duì)損失函數(shù)用于衡量描述符之間的相似性，以促進(jìn)正確的匹配。具體而言，對(duì)于每個(gè)描述符，根據(jù)其與描述符的距離來確定是正樣本還是負(fù)樣本。配對(duì)損失函數(shù)的目標(biāo)是最大化正樣本的相似性，同時(shí)最小化負(fù)樣本的相似性。

Coarse Pairing Loss（粗配對(duì)損失）：為了確保DPM Encoder提取的統(tǒng)一描述符云能夠初步區(qū)分描述符的對(duì)應(yīng)關(guān)系，采用了類似于配對(duì)損失的粗配對(duì)損失。粗配對(duì)損失函數(shù)的定義與配對(duì)損失函數(shù)類似，但是將負(fù)樣本分為兩類：一類是距離大于閾值的負(fù)樣本，另一類是中性樣本，不參與損失的計(jì)算。這樣做的目的是為了更好地處理那些接近但不是最接近的描述符對(duì)，因?yàn)檫@些對(duì)在不同的時(shí)間可能會(huì)作為正樣本和負(fù)樣本，從而引起歧義。

Offset Loss（偏移損失）：使用Offset Loss訓(xùn)練Offset Head。根據(jù)前面定義的三種配對(duì)類型，使用正樣本和中性樣本來訓(xùn)練Offset Head，以預(yù)測(cè)描述符對(duì)之間的偏移量。偏移損失函數(shù)的目標(biāo)是最小化預(yù)測(cè)偏移量與真實(shí)偏移量之間的差異。

Overlap Loss（重疊損失）：使用交叉熵?fù)p失函數(shù)訓(xùn)練Overlap Head。重疊損失函數(shù)用于預(yù)測(cè)輸入的描述符對(duì)是否重疊，即它們之間的距離是否小于閾值。

Overall Loss（總損失）：DeepPointMap的方向損失由總損失函數(shù)定義?？倱p失函數(shù)是配對(duì)損失、粗配對(duì)損失和偏移損失的加權(quán)和。通過調(diào)整權(quán)重參數(shù)、和，可以平衡不同損失函數(shù)的重要性。

此外，還使用了數(shù)據(jù)增強(qiáng)和課程學(xué)習(xí)策略來提高模型的性能。數(shù)據(jù)增強(qiáng)策略包括隨機(jī)遮擋，用于模擬激光雷達(dá)掃描受到遮擋的情況。課程學(xué)習(xí)策略逐漸增加描述符云的規(guī)模，從簡(jiǎn)單到復(fù)雜的場(chǎng)景進(jìn)行訓(xùn)練，以逐步學(xué)習(xí)大規(guī)模注冊(cè)任務(wù)的能力。

5、實(shí)驗(yàn)結(jié)果

實(shí)驗(yàn)設(shè)置：使用了四個(gè)自動(dòng)駕駛相關(guān)的數(shù)據(jù)集進(jìn)行實(shí)驗(yàn)評(píng)估，分別是SemanticKITTI、KITTI-360、MulRan和KITTI-Carla。在訓(xùn)練過程中，使用AdamW優(yōu)化器、初始學(xué)習(xí)率、權(quán)重衰減和余弦學(xué)習(xí)率調(diào)度器。網(wǎng)絡(luò)在6個(gè)RTX 3090 GPU上進(jìn)行訓(xùn)練，共訓(xùn)練12個(gè)epochs。

定位準(zhǔn)確性：與六種最新的里程計(jì)和SLAM方法進(jìn)行比較，包括KISS-ICP、LeGO-LOAM、SC-LeGO-LOAM、MULLS、CT-ICP和GeoTransformer。在SemanticKITTI、KITTI-360和MulRan數(shù)據(jù)集上比較了DeepPointMap與這些方法的定位準(zhǔn)確性。結(jié)果顯示，DeepPointMap在不同數(shù)據(jù)集上都能取得類似的定位準(zhǔn)確性，并且在大規(guī)模地圖上表現(xiàn)出更好的性能。

內(nèi)存效率：評(píng)估了DeepPointMap的內(nèi)存效率，并與其他常用方法進(jìn)行比較，包括原始點(diǎn)云、Voxel Hashmap和Mesh。結(jié)果顯示，DeepPointMap相比其他方法能夠節(jié)省高達(dá)70%的內(nèi)存空間。

多智能體合作SLAM實(shí)驗(yàn)：將DeepPointMap擴(kuò)展到多智能體合作SLAM任務(wù)中，模擬了真實(shí)世界的多智能體合作SLAM場(chǎng)景。在SemanticKITTI數(shù)據(jù)集上選擇了三個(gè)子序列，并將它們分配給三個(gè)獨(dú)立的智能體進(jìn)行重建。實(shí)驗(yàn)結(jié)果顯示，DeepPointMap能夠成功重建多智能體觀測(cè)到的點(diǎn)云，并保持全局一致性。

通過這些實(shí)驗(yàn)驗(yàn)證了DeepPointMap在定位準(zhǔn)確性、內(nèi)存效率和多智能體合作SLAM方面的優(yōu)越性能。

6、根據(jù)這項(xiàng)研究，后續(xù)可能的研究方向有哪些?

根據(jù)這項(xiàng)研究，可能的后續(xù)研究方向包括但不限于以下幾個(gè)方面：

網(wǎng)絡(luò)結(jié)構(gòu)改進(jìn)：可以進(jìn)一步改進(jìn)DeepPointMap的網(wǎng)絡(luò)結(jié)構(gòu)，以提高其性能和效率。例如，可以探索更復(fù)雜的神經(jīng)網(wǎng)絡(luò)架構(gòu)或引入注意力機(jī)制來提取更具代表性的神經(jīng)描述符。

多模態(tài)融合：可以將深度學(xué)習(xí)方法與其他傳感器數(shù)據(jù)（如相機(jī)圖像）進(jìn)行融合，以提高SLAM系統(tǒng)的魯棒性和準(zhǔn)確性。通過融合多種傳感器數(shù)據(jù)，可以更好地理解環(huán)境并實(shí)現(xiàn)更準(zhǔn)確的定位和地圖重建。

魯棒性改進(jìn)：可以研究如何提高DeepPointMap在復(fù)雜環(huán)境和動(dòng)態(tài)場(chǎng)景下的魯棒性。例如，可以探索如何處理遮擋、動(dòng)態(tài)物體和不完整的點(diǎn)云數(shù)據(jù)，以提高系統(tǒng)的魯棒性和適應(yīng)性。

實(shí)時(shí)性優(yōu)化：可以進(jìn)一步優(yōu)化DeepPointMap的計(jì)算效率，以實(shí)現(xiàn)實(shí)時(shí)的SLAM系統(tǒng)?？梢酝ㄟ^模型壓縮、硬件加速或并行計(jì)算等方法來減少計(jì)算復(fù)雜度，提高系統(tǒng)的實(shí)時(shí)性能。

多智能體合作SLAM：可以進(jìn)一步研究如何在多智能體合作SLAM中應(yīng)用DeepPointMap。可以探索如何實(shí)現(xiàn)智能體之間的信息共享和協(xié)作，以實(shí)現(xiàn)全局一致性的地圖重建和定位。

這些是可能的后續(xù)研究方向，通過進(jìn)一步的研究和實(shí)驗(yàn)，可以進(jìn)一步提升DeepPointMap的性能和應(yīng)用范圍。

7、總結(jié)

我們提出了一種基于深度學(xué)習(xí)的LiDAR SLAM框架，稱為DeepPointMap（DPM）。該框架包括兩個(gè)神經(jīng)網(wǎng)絡(luò)：DPM編碼器和DPM解碼器。與其他神經(jīng)描述符方法不同的是，DPM描述符可以統(tǒng)一地用于SLAM任務(wù)的多個(gè)子任務(wù)，具有出色的定位精度、內(nèi)存效率、地圖保真度和實(shí)時(shí)處理能力。DeepPointMap在定位精度、地圖重建質(zhì)量和內(nèi)存消耗方面取得了新的最優(yōu)結(jié)果。此外，該框架還在多智能體協(xié)作SLAM方面展示了其靈活性和潛力。因此，DeepPointMap為L(zhǎng)iDAR SLAM領(lǐng)域的發(fā)展提供了一種有效的解決方案。

審核編輯：黃飛