我們提出了一種使用激光雷達生成的強度圖進行魯棒、實時位置識別的方法，利用激光雷達的投影點云并獲得強度圖，該方法可以生成高分辨率的三維點云強度圖。從圖像中提取ORB特征描述子，并將其編碼到一個詞袋向量中，用于識別點云的向量插入到數(shù)據(jù)庫中，該數(shù)據(jù)庫由DBoW維護，用于快速位置識別查詢，通過匹配視覺特征描述子進一步驗證返回的候選對象，為了剔除匹配的異常值，這里使用PnP方法，該方法使用RANSAC最小化了視覺特征在歐幾里德空間中的位置及其在二維圖像空間中的對應(yīng)關(guān)系的重投影誤差。結(jié)合了基于相機和激光雷達的位置識別方法的優(yōu)點，我們的方法具有真正的旋轉(zhuǎn)不變性，能夠處理閉環(huán)檢測。在不同規(guī)模和環(huán)境下從不同平臺收集的數(shù)據(jù)集上對所提出的方法進行了評估。

位置識別在許多移動機器人應(yīng)用中扮演著非常重要的角色，例如解決綁架機器人問題、在已知地圖中定位機器人以及保持同步定位和建圖（SLAM）的準確性。在過去的二十年中，各種各樣的位置識別方法已經(jīng)在使用相機、激光雷達和其他感知傳感器解決此類問題方面取得了巨大的成功?；跀z像頭的位置識別方法通常從紋理場景中提取視覺特征，并使用詞袋的方法找到候選位置，但是，這些方法會受到照明和視點變化的影響。另一方面，基于激光雷達的位置識別方法（通常從點云中提取局部或全局描述子）對此類變化具有不變性，激光雷達的長探測范圍和寬孔徑允許捕捉環(huán)境中的許多結(jié)構(gòu)細節(jié)。然而，在描述子提取過程中，這些細節(jié)常常被丟棄，這可能導(dǎo)致在被重復(fù)結(jié)構(gòu)附近時出現(xiàn)誤報檢測，由于低激光雷達分辨率的普遍存在，基于相機的方法通常不能應(yīng)用于激光雷達數(shù)據(jù)，相反，由于缺乏結(jié)構(gòu)信息，基于激光雷達的方法通常不能應(yīng)用于圖像數(shù)據(jù)中。

然而，隨著高分辨率激光雷達的出現(xiàn)，例如Outster OS1-128和Velodyne VLS-128，開始彌補了基于相機和基于激光雷達的位置識別方法之間的差距。我們將這種提供圖像質(zhì)量3D掃描點云的高分辨率激光雷達稱為成像激光雷達，基于這項技術(shù)的前景，我們提出了一種使用成像激光雷達進行魯棒位置識別的方法。首先將具有強度信息的高分辨率點云投影到強度圖像上，然后，從強度圖像中提取ORB特征描述子，提取的描述符子轉(zhuǎn)換成一個單詞包（BoW）向量，這形成了原始點云的緊湊表示，使用這些向量建立DBoW數(shù)據(jù)庫，并查詢以進行位置識別。如果找到了候選對象，將匹配ORB描述子，以確保這兩個位置之間能夠匹配足夠的特征。為了剔除匹配的異常值，我們通過應(yīng)用透視n點（PnP）隨機樣本一致性（RANSAC）將匹配問題描述為一個優(yōu)化問題。該方法的一個代表性示例如圖1所示。

我們的工作結(jié)合了攝像機和基于激光雷達的位置識別方法的技術(shù)，其主要貢獻如下：

• 為成像激光雷達設(shè)計的實時魯棒位置識別，據(jù)我們所知，第一個使用投影激光雷達強度圖像進行位置識別的方法。

• 該方法對傳感器姿態(tài)變化具有不變性，可檢測正向閉環(huán)，甚至反向閉環(huán)。

• 我們的方法通過跨不同規(guī)模、平臺和環(huán)境收集的數(shù)據(jù)得到了廣泛驗證。

我們的工作借鑒了基于相機和基于激光雷達的位置識別方法中使用的概念。由于其低硬件成本要求和在紋理豐富的環(huán)境中的魯棒性，基于攝像頭的方法已廣泛應(yīng)用于各種SLAM框架中，用于閉環(huán)檢測，此類方法通常從圖像中提取視覺特征描述子，并使用DBoW在預(yù)先訓(xùn)練的視覺詞匯表上將其轉(zhuǎn)換為詞袋向量。假設(shè)圖像之間存在視覺重疊，DBoW查詢數(shù)據(jù)庫并基于向量之間的相似性得分返回回環(huán)詞袋的候選對象。由于DBoW中的閉環(huán)候選對象容易出現(xiàn)錯誤檢測，因此還可以引入額外的驗證步驟來剔除此類檢測，例如，可以引入了幾何驗證方法，對視覺特征進行三角化，以驗證候選對象。然而，基于相機的方法的檢測性能在很大程度上取決于環(huán)境外觀，如果重新訪問某個地方時亮度和視點發(fā)生劇烈變化，則它們無法提供可靠的檢測。

基于激光雷達的位置識別方法可以分為直接方法和基于描述子的方法。盡管直接法可以在激光雷達的原始點云上操作，而無需任何預(yù)處理，但其性能對點云數(shù)據(jù)大小、初始對齊位姿和遮擋非常敏感，因此，我們將重點討論基于描述子的方法，它可以提供改進的匹配魯棒性，基于描述符子的方法可以分為局部描述子方法和全局描述子方法。

本文針對成像激光雷達提出的位置識別方法執(zhí)行一系列處理步驟包括：強度圖像投影、特征提取、DBoW查詢、特征匹配和PnP RANSAC。圖2顯示了每個流程步驟的示例。

圖2：本文方法的演示：（a）高分辨率點云顏色變化表示強度變化；（b） 從點云投影的強度圖像；（c） 提取的ORB特征（綠點）和從DBoW查詢返回的一對候選對象；（d） 兩個候選對象之間匹配的ORB描述子；（e） PnP RANSAC異常值剔除后匹配的ORB描述符。

A.強度圖像

來自激光雷達的強度信息表示激光束返回的能量值，該能量值通常受物體表面反射率的影響，并且對環(huán)境光保持不變，當接收到3D點云P時，我們將其投影到圓柱形強度圖像I上，I中的每個有效像素都可以與P中的一個點相關(guān)聯(lián)，像素的值由接收點的強度值確定，然后，我們將所有像素值標準化為介于0和255之間，這基本上將強度圖像視為灰度圖像，使我們能夠使用強度圖像對其進行處理，沒有關(guān)聯(lián)有效點的像素被指定為零值，三維點云的示例如圖2（a）所示，其中顏色變化表示強度變化，得到的強度圖像如圖2（b）所示，其中亮像素和暗像素分別對應(yīng)于高強度值和低強度值。

B.特征提取

接下來對強度圖像I執(zhí)行特征提取，假設(shè)激光雷達傳感器可能會經(jīng)歷劇烈的方向變化，這大大擴展了我們方法的應(yīng)用場景，而不是假設(shè)固定的傳感器安裝解決方案，我們選擇提取ORB特征，因為它們的效率和對旋轉(zhuǎn)變化的不變性，ORB特征描述子是通過首先提取快速角點特征，然后使用簡短描述子對其進行描述獲得，由于傳感器的運動，在強度圖像中觀察到的物體的比例是傳感器和物體之間距離的函數(shù)，同樣，物體的外觀方向也受傳感器方向的影響，為了提高在不同尺度和方向上的提取魯棒性，采用下采樣率為1.2的八倍圖像金字塔來獲得八個不同分辨率的強度圖像，在每個圖像中使用快速算法檢測ORB特征，通過計算以特征為中心的圓形區(qū)域中的強度變化來確定特征的方向，然后使用簡短算法將角點特征轉(zhuǎn)換為描述子。

C.DBoW查詢

我們利用DBoW將ORB特征描述符O轉(zhuǎn)換為一個詞袋向量，使用DBow中提出的視覺詞袋表，此時3D點云現(xiàn)在可以使用稀疏的詞袋向量高效地表示，該向量用于使用DBoW構(gòu)建數(shù)據(jù)庫，當接收到一個新的詞向量時，我們通過使用L1距離計算新向量和先前向量之間的相似度來查詢數(shù)據(jù)庫，如果兩個向量之間的相似性大于閾值λ ，說明找到了潛在的閉環(huán)候選。

D.特征匹配

通常，DBoW查詢中的候選項包含許多錯誤檢測，為了驗證檢測，匹配Oi和Oj中的描述子，注意到匹配Oi和Oj中的每個描述子不僅計算量大，而且常常導(dǎo)致大量錯誤匹配，為了提高匹配成功率，根據(jù)Oi的角點得分將所有描述子按降序排列，選擇角點得分最大作為最優(yōu)的結(jié)果。

E.PnP RANSAC

如果DBoW查詢返回的候選項不正確，仍然可以特征匹配的過程中獲得足夠的匹配項，為了進一步驗證候選項，我們將驗證問題表述為PnP問題。PnP知道Oi中特征的3D位置和Oj中特征的2D圖像位置，從而最小化3D點及其2D對應(yīng)的重投影誤差，并估計i和j之間的相對傳感器位姿。為了提高PnP的穩(wěn)健性，在這里使用RANSAC來剔除匹配中的異常值。圖2（e）顯示了異常值剔除后的正確特征匹配。

現(xiàn)在我們描述了一系列實驗來定量分析所提出的方法，本文使用的傳感器是Outster OS1-128成像激光雷達，傳感器的水平和垂直視野為360度 和45度，傳感器在兩個方向上的分辨率均為0.35度。當它在10Hz下工作時，從而產(chǎn)生分辨率為1024×128的強度圖像，將提出的方法與SC、ISC和IRIS進行了比較，所有的方法都是在C++中實現(xiàn)的，并在配備英特爾I7 10710U 1.1GHz CPU的筆記本上執(zhí)行。

圖3：每種方法檢測到的閉環(huán)，數(shù)據(jù)集的軌跡是紅色的，綠點和藍色表示回環(huán)的閉合匹配，其中綠點表示回路的位置。

圖4（a）顯示了我們的方法檢測到的四個具有代表性的回環(huán)。對于每個檢測，頂行和底行圖像指示在當前和以前時間捕獲的強度圖像，匹配的ORB特征使用綠線連接，第二個示例顯示了當我們將傳感器繞其前進軸旋轉(zhuǎn)近90度時的檢測結(jié)果，第三個和第四個示例顯示了我們的方法，該方法在傳感器倒置的情況下檢測閉合回路，即繞其前軸旋轉(zhuǎn)180度。注意，在第四個示例中，我們的方法從懸掛在走廊上的海報中提取特征，以幫助檢測。

圖4：使用我們的方法的十二個代表性回環(huán)檢測示例，對于每個示例，頂行和底行圖像分別指示在當前和以前時間捕獲的強度圖像，匹配的ORB特征使用綠線連接。

圖5：所有方法的ROC曲線和AUC，通過將報告的環(huán)路閉合檢測與地面真值環(huán)路閉合進行比較，得到了結(jié)果。在所有方法中，所提出的方法在各種數(shù)據(jù)集上實現(xiàn)了最高的AUC。

對于每種方法，每個數(shù)據(jù)集上每個查詢的平均計算時間如表I的最后一列所示。

不同分辨率激光雷達檢測結(jié)果如表所示。當使用較少的激光雷達通道時，檢測成功率顯著降低，這是因為從低分辨率強度圖像中提取的ORB特征數(shù)量有限，DBoW查詢和特征匹配的性能相應(yīng)降低。我們的方法對可用的激光雷達分辨率非常敏感，最適合與高分辨率成像激光雷達一起使用。

我們提出了一種使用成像激光雷達進行位置識別的新方法，該方法在各種環(huán)境下都具有魯棒性。我們的方法結(jié)合了基于相機和激光雷達的位置識別方法的優(yōu)點，與基于相機的方法類似，從3D點云投影的強度圖像中提取ORB特征描述符，使用DBoW來表示點云，使用詞袋向量，并運行位置識別查詢，這類似于基于激光雷達的全局描述子方法。當從查詢中接收到候選對象時，進行ORB描述子匹配以驗證其合法性，再使用PnP RANSAC剔除匹配描述符中的異常值，在不同尺度的室內(nèi)和室外環(huán)境中收集的數(shù)據(jù)集上對所提出的方法進行了評估，結(jié)果表明，與其他基于激光雷達的位置識別方法相比，該方法具有更高的精度和魯棒性。

本文僅做簡單分享介紹，詳情可查看具體論文！

掃描下方微信視頻號二維碼可查看最新研究成果及相關(guān)開源方案的演示：