來(lái)源：GR-Fusion Multi-Sensor Fusion SLAM for Ground Robots with High Robustness and Low Drift IROS 2021

單位：中科院沈陽(yáng)自動(dòng)化研究所

針對(duì)問(wèn)題：

針對(duì)地面機(jī)器人的多傳感器融合SLAM系統(tǒng)

提出方法：

系統(tǒng)融合緊耦合IMU、輪速計(jì)、視覺(jué)、LiDAR和GNSS多源觀測(cè)信息，并結(jié)合地面機(jī)器人平面運(yùn)動(dòng)約束，構(gòu)建了融合多模態(tài)觀測(cè)信息的因子圖優(yōu)化模型，針對(duì)各種傳感器退化場(chǎng)景提出了有效的運(yùn)動(dòng)退化檢測(cè)方法，使得系統(tǒng)能夠在復(fù)雜環(huán)境中仍保持較強(qiáng)的魯棒性和較低的漂移。

達(dá)到效果：

所提出系統(tǒng)在室內(nèi)數(shù)據(jù)集、地下數(shù)據(jù)集、開(kāi)放式草坪數(shù)據(jù)集以及校園場(chǎng)景數(shù)據(jù)集中進(jìn)行了廣泛測(cè)試，與現(xiàn)有方案對(duì)比達(dá)到了最先進(jìn)的效果。數(shù)據(jù)集開(kāi)源地址https://drive.google.com/drive/folders/110Hko3z PcDmY0_bnZdXxJXJKe6wr3t10?usp=sharing

Abstract

本文提出了一個(gè)緊耦合LiDAR、相機(jī)、IMU、輪速計(jì)和GNSS信息的SLAM系統(tǒng)。系統(tǒng)通過(guò)將LiDAR點(diǎn)云和地面投影到圖像中恢復(fù)視覺(jué)特征深度，選擇跟蹤的高質(zhì)量視覺(jué)特征和LiDAR特征，并緊耦合IMU和輪速計(jì)的預(yù)積分值來(lái)優(yōu)化機(jī)器人的狀態(tài)增量。我們使用估計(jì)的相對(duì)位姿來(lái)重新度量局部滑窗中特征之間的關(guān)聯(lián)距離，并去除動(dòng)態(tài)物體和異常值。在建圖節(jié)點(diǎn)中，我們使用精煉的特征，并緊耦合GNSS測(cè)量值、增量因子和局部平面約束，通過(guò)將LiDAR特征與全局地圖對(duì)齊，進(jìn)一步優(yōu)化機(jī)器人的全局狀態(tài)。此外，該方法可以檢測(cè)傳感器的退化情況并自動(dòng)重新配置優(yōu)化過(guò)程。系統(tǒng)基于一個(gè)六輪地面機(jī)器人在室內(nèi)和室外環(huán)境中進(jìn)行了廣泛的實(shí)驗(yàn)，證明了所提出的GR-Fusion在精度和魯棒性方面優(yōu)于最先進(jìn)的SLAM方法。

Introduction

主要貢獻(xiàn)：

本文提出了一個(gè)可以融合來(lái)自LiDAR、相機(jī)、IMU、輪速計(jì)、GNSS和局部平面約束的多模態(tài)觀測(cè)的框架，用于機(jī)器人狀態(tài)估計(jì)；

系統(tǒng)將LiDAR點(diǎn)云和地面被投影到圖像中，以提取視覺(jué)特征的深度。該方法可以檢測(cè)每個(gè)傳感器的退化情況，并重新配置優(yōu)化過(guò)程，以應(yīng)對(duì)各種具有挑戰(zhàn)性的情況；

所構(gòu)建系統(tǒng)在真實(shí)的地面機(jī)器人上進(jìn)行了廣泛的實(shí)驗(yàn)，表明GR-Fusion具有高魯棒性和低漂移性。

The proposed GR-Fusion

1.系統(tǒng)概述

所提方法的流程圖如上圖所示，系統(tǒng)包含四個(gè)節(jié)點(diǎn)。每個(gè)傳感器的測(cè)量量分別為：輪速計(jì)100HZ，IMU 100HZ，相機(jī)30HZ，LiDAR 10HZ，GNSS 5HZ。測(cè)量預(yù)處理節(jié)點(diǎn)首先進(jìn)行數(shù)據(jù)緩存和同步。然后根據(jù)時(shí)間戳對(duì)輪速計(jì)和IMU的測(cè)量進(jìn)行預(yù)積分，以消除LiDAR點(diǎn)云的運(yùn)動(dòng)失真。根據(jù)我們之前研究中提出的地面測(cè)量模型，提取地面點(diǎn)，并擬合地平面參數(shù)。然后將計(jì)算出的局部平面和LiDAR點(diǎn)云投影到圖像中，計(jì)算出視覺(jué)特征的深度。里程計(jì)節(jié)點(diǎn)通過(guò)緊耦合多模態(tài)的局部約束因素來(lái)估計(jì)機(jī)器人在滑動(dòng)窗口中的運(yùn)動(dòng)增量。建圖節(jié)點(diǎn)將LiDAR特征與全局地圖對(duì)齊，并將本地約束和GNSS約束緊耦合起來(lái)，以優(yōu)化機(jī)器人的全局狀態(tài)。閉環(huán)節(jié)點(diǎn)接收來(lái)自GR-mapping的位姿和特征，并進(jìn)行閉環(huán)檢測(cè)和優(yōu)化以消除漂移。

2.Measurement pre-processing 測(cè)量數(shù)據(jù)預(yù)處理

(1)輪速計(jì)IMU預(yù)積分

我們使用了[10]中提出的流形上的輪速計(jì)增量模型，它可以融合輪速計(jì)和IMU的測(cè)量值，計(jì)算機(jī)器人在復(fù)雜地形（如斜坡、樓梯和草坪）上的三維位置增量，如下圖所示。接下來(lái)，輪速計(jì)和IMU的測(cè)量結(jié)果根據(jù)LiDAR和圖像的時(shí)間戳進(jìn)行預(yù)積分，以計(jì)算幀之間的位姿增量。在正常情況下，位置增量由輪速計(jì)提供，旋轉(zhuǎn)增量由IMU提供。如果檢測(cè)到機(jī)器人的車輪在打滑，則由IMU提供全部增量。

（2）LiDAR和相機(jī)觀測(cè)預(yù)處理

首先，根據(jù)幀間的運(yùn)動(dòng)增量，去除點(diǎn)云的運(yùn)動(dòng)失真。為了去除噪聲和不穩(wěn)定的點(diǎn)，我們按照[13]提出的方法進(jìn)行點(diǎn)云分割。根據(jù)粗糙度提取了角和平面特征。由于機(jī)器人總是在地面上運(yùn)行，我們提出使用局部平面約束來(lái)優(yōu)化機(jī)器人的位姿。我們使用之前研究中提出的地面測(cè)量模型來(lái)提取地面點(diǎn)，之后我們擬合地面平面參數(shù)來(lái)計(jì)算當(dāng)前可見(jiàn)的地面區(qū)域。

對(duì)于來(lái)自雙目相機(jī)的圖像，進(jìn)行角點(diǎn)檢測(cè)。通過(guò)設(shè)置兩個(gè)相鄰特征之間的最小像素間隔，實(shí)現(xiàn)了特征的均勻分布。這些特征使用KLT光流算法進(jìn)行追蹤，同時(shí)我們還使用KLT跟蹤器來(lái)匹配左右圖像之間的特征。

在大規(guī)模環(huán)境中，由于基線較小，使用視覺(jué)特征的三角測(cè)量法得到的深度有很大的誤差。因此，我們通過(guò)[20]介紹的方法，將LiDAR點(diǎn)云投射到圖像中，以提取視覺(jué)特征的更魯棒的深度。地面點(diǎn)被投影到圖像中，以分割地面上的視覺(jué)特征。相機(jī)投影模型被用來(lái)計(jì)算地面特征的深度。實(shí)驗(yàn)發(fā)現(xiàn)，位于地面的視覺(jué)特征移動(dòng)速度快，跟蹤時(shí)間短，往往無(wú)法通過(guò)三角測(cè)量法獲得準(zhǔn)確的深度。因此，利用LiDAR擬合的地面參數(shù)可以直接計(jì)算出地面特征的深度。此外，它還隱式地提供了地面視覺(jué)特征的共面約束。

3.GR-odometry

里程計(jì)節(jié)點(diǎn)被設(shè)計(jì)為選擇少量但高質(zhì)量的特征，以快速估計(jì)機(jī)器人在局部滑窗內(nèi)的運(yùn)動(dòng)增量。同時(shí)，優(yōu)化過(guò)程根據(jù)傳感器的退化情況進(jìn)行了重新配置。此外，在當(dāng)前LiDAR幀被發(fā)送到建圖線程之前，利用里程計(jì)的結(jié)果對(duì)當(dāng)前幀的特征進(jìn)行細(xì)化調(diào)整，位于動(dòng)態(tài)目標(biāo)上的特征和不穩(wěn)定的特征點(diǎn)將被剔除。

（1）狀態(tài)向量

本文所提出的方法以LiDAR幀為優(yōu)化節(jié)點(diǎn)，選擇最近的圖像作為視覺(jué)約束。狀態(tài)向量表示如下：

我們使用IMU時(shí)間戳作為基準(zhǔn)，將LiDAR和相機(jī)的測(cè)量時(shí)間對(duì)齊IMU的時(shí)間戳。然后與IMU的觀測(cè)一起進(jìn)行優(yōu)化，以估計(jì)傳感器之間的時(shí)間偏移。

（2）因子圖優(yōu)化模型

我們?cè)诶锍逃?jì)部分維護(hù)一個(gè)滑窗，如上圖所示。有n+1個(gè)節(jié)點(diǎn)，優(yōu)化窗口包含三個(gè)最新的連續(xù)節(jié)點(diǎn)。其他節(jié)點(diǎn)根據(jù)移動(dòng)距離被選為關(guān)鍵幀，并將其保留在滑動(dòng)窗口中，為優(yōu)化窗口提供約束?；瑒?dòng)窗口中的LiDAR特征被用來(lái)維護(hù)本地點(diǎn)云地圖，最新的幀被投影到圖像中。對(duì)于每個(gè)視覺(jué)特征，相鄰的點(diǎn)云塊被提取出來(lái)并進(jìn)行深度估計(jì)。對(duì)于深度已經(jīng)從地面參數(shù)獲得的特征點(diǎn)，其深度值保持不變。此外，當(dāng)從新的圖像中提取特征時(shí)，在點(diǎn)云覆蓋的區(qū)域，視覺(jué)特征間距被設(shè)定為其他區(qū)域的一半。這種策略能夠從點(diǎn)云覆蓋的圖像區(qū)域中提取更多的特征，而且深度可以直接估算，更加魯棒。

一個(gè)特征點(diǎn)被追蹤的次數(shù)越多，它的質(zhì)量就越高。因此，我們將跟蹤次數(shù)超過(guò)閾值的點(diǎn)加入到優(yōu)化中。接下來(lái)，根據(jù)跟蹤結(jié)果構(gòu)建了以下重投影誤差約束：

我們將從LiDAR點(diǎn)云中提取的角點(diǎn)和平面特征與當(dāng)前的局部地圖相匹配，并使用點(diǎn)到線和點(diǎn)到面的距離來(lái)構(gòu)建LiDAR約束因子。此外，輪速計(jì)和IMU的測(cè)量結(jié)果通過(guò)預(yù)積分構(gòu)建一個(gè)增量約束因子。

（3）局部平面約束

我們認(rèn)為，當(dāng)機(jī)器人在地面上移動(dòng)時(shí)，局部平面在兩個(gè)連續(xù)的幀之間是不變的，如果平坦的地面被擬合，那么在局部平面的Z軸上的位移接近于零。為了確保我們的公式的魯棒性，我們考慮了法向量、地面粗糙度和地面連續(xù)性等因素來(lái)決定是否添加地面約束。

地面的法向量和機(jī)器人的Z軸之間的角度必須小于設(shè)定的閾值;

分割的地面點(diǎn)與擬合的地面之間的距離的平方之和必須小于設(shè)定的閾值;

最遠(yuǎn)點(diǎn)和最近點(diǎn)地面之間的距離必須小于設(shè)定的閾值。

（4）傳感器退化檢測(cè)

在弱紋理環(huán)境或黑暗環(huán)境中，相機(jī)無(wú)法提取魯棒的特征進(jìn)行跟蹤。當(dāng)場(chǎng)景中存在大量的動(dòng)態(tài)目標(biāo)時(shí)，也會(huì)出現(xiàn)較大的跟蹤誤差。首先，我們統(tǒng)計(jì)了當(dāng)前幀中每個(gè)特征的跟蹤時(shí)間，如果小于設(shè)定的閾值，就降低視覺(jué)特征的權(quán)重。如果所有特征的跟蹤時(shí)間之和小于設(shè)定的閾值，則被認(rèn)為是不穩(wěn)定的，這時(shí)，視覺(jué)約束將不被用于后續(xù)的優(yōu)化過(guò)程。

LiDAR在高度重復(fù)的場(chǎng)景中會(huì)退化，例如走廊或開(kāi)放的戶外環(huán)境。因此，我們區(qū)分了最新一幀點(diǎn)云的深度和優(yōu)化窗口外的第一幀點(diǎn)云的深度，并計(jì)算出平均深度差。接下來(lái)，我們得到了所有點(diǎn)深度差的直方圖統(tǒng)計(jì)。如果深度差大于閾值點(diǎn)的數(shù)量很少，則LiDAR被認(rèn)為是退化的。這時(shí)，LiDAR約束將不會(huì)被添加到優(yōu)化中，優(yōu)化滑窗的大小也被調(diào)整。該系統(tǒng)退化為GR-SLAM，并將相機(jī)、輪速計(jì)和IMU緊耦合在一起進(jìn)行狀態(tài)估計(jì)。然而，局部的點(diǎn)云仍然被維護(hù)，建圖節(jié)點(diǎn)仍然運(yùn)行以維護(hù)全局地圖。

由于IMU是一個(gè)內(nèi)置的傳感器，不受外部環(huán)境的影響，在短時(shí)間內(nèi)的估計(jì)結(jié)果是相對(duì)準(zhǔn)確的。機(jī)器人車輪的滑動(dòng)不可避免地增加了輪速計(jì)的預(yù)積分值。因此，我們計(jì)算了輪速計(jì)的預(yù)積分值與IMU的預(yù)積分值比率。如果它大于設(shè)定的閾值，則認(rèn)為車輪在打滑，輪速計(jì)的約束就不會(huì)被添加到優(yōu)化中。此外，實(shí)驗(yàn)結(jié)果顯示，機(jī)器人在轉(zhuǎn)彎時(shí)很容易打滑，而輪速計(jì)在直線運(yùn)動(dòng)時(shí)的精度更高。因此，我們也用機(jī)器人的轉(zhuǎn)動(dòng)來(lái)調(diào)整輪速計(jì)的優(yōu)化權(quán)重。

（5）局部因子圖優(yōu)化

通過(guò)BA優(yōu)化所有因素的殘差，并獲得機(jī)器人狀態(tài)的最大后驗(yàn)估計(jì)，如下所示。

其中ro(.)代表局部地面約束。值得注意的是，這里優(yōu)化的是圖4所示優(yōu)化窗口中節(jié)點(diǎn)的狀態(tài)增量。只有當(dāng)節(jié)點(diǎn)滑出優(yōu)化窗口后，才會(huì)被送至建圖節(jié)點(diǎn)進(jìn)行全局優(yōu)化。

另外，我們使用GR-odometry的結(jié)果來(lái)去除動(dòng)態(tài)物體和不穩(wěn)定的特征。首先，當(dāng)前的LiDAR特征被投影到局部滑窗的起始幀，以計(jì)算匹配距離。對(duì)于靜態(tài)環(huán)境，投影的LiDAR點(diǎn)是重合的，或者匹配距離很小。對(duì)于移動(dòng)物體，投影點(diǎn)的匹配距離較大。因此，根據(jù)匹配距離對(duì)LiDAR特征進(jìn)行排序，匹配距離超過(guò)設(shè)定閾值的點(diǎn)被判斷為動(dòng)態(tài)物體而被剔除。最大剔除率被設(shè)定為10%。這一策略利用了動(dòng)態(tài)物體的運(yùn)動(dòng)特征，并使用滑動(dòng)窗口的時(shí)間跨度，這樣可以突出動(dòng)態(tài)物體的投影誤差。最后，提煉出的特征點(diǎn)將被送到GR-Mapping節(jié)點(diǎn)。

4.GR-建圖和閉環(huán)檢測(cè)

（1）GNSS 權(quán)重

盡管我們可以融合多模態(tài)的測(cè)量來(lái)進(jìn)行機(jī)器人的狀態(tài)估計(jì)，但長(zhǎng)期運(yùn)行仍會(huì)產(chǎn)生累積誤差。GNSS可以提供絕對(duì)位置。然而，實(shí)驗(yàn)結(jié)果顯示，當(dāng)GNSS受到建筑物或樹(shù)木的阻擋時(shí)，GNSS的測(cè)量會(huì)發(fā)生跳躍，導(dǎo)致大的誤差甚至失敗。因此，我們根據(jù)衛(wèi)星使用數(shù)量、精度衰減因子、局部增量方差評(píng)估GNSS的質(zhì)量。

搜索的衛(wèi)星越多，GNSS的測(cè)量就越準(zhǔn)確。然而，這也與衛(wèi)星的空間幾何分布有關(guān)。因此，我們也使用GNSS輸出的DOP值來(lái)評(píng)估測(cè)量誤差。此外，我們還計(jì)算了局部GNSS增量和里程計(jì)增量的方差來(lái)評(píng)價(jià)GNSS的測(cè)量質(zhì)量。盡管里程計(jì)測(cè)量法會(huì)產(chǎn)生累積誤差，但其局部精度相對(duì)較高。因此，里程計(jì)可以用來(lái)確定GNSS測(cè)量是否有跳躍，以及本地測(cè)量的質(zhì)量是否下降，以避免大的誤差。

（2）全局因子圖優(yōu)化

我們?cè)谌謨?yōu)化中加入的制約因素有里程計(jì)增量因子、局部平面約束因子、來(lái)自IMU的角度預(yù)測(cè)因子、GNSS因子、地圖因子。閉環(huán)因子使用里程計(jì)測(cè)量的估計(jì)結(jié)果作為初始值，我們將LiDAR特征與全局地圖對(duì)齊，同時(shí)耦合其他局部約束和全局約束，以優(yōu)化機(jī)器人的全局狀態(tài)。閉環(huán)因子來(lái)自于閉環(huán)檢測(cè)節(jié)點(diǎn)，我們使用了[21]提出的點(diǎn)云描述符進(jìn)行位置識(shí)別。它還可以保存和重用地圖，并快速重定位到當(dāng)前地圖，值得注意的是，我們的方法支持只包含輪速計(jì)、IMU和GNSS的低成本配置，并對(duì)地面機(jī)器人進(jìn)行有效的狀態(tài)估計(jì)。

Experiments

我們?cè)诓煌沫h(huán)境中收集了多個(gè)數(shù)據(jù)集。這些數(shù)據(jù)集分別被稱為室內(nèi)、地下、露天草坪和校園。

1.室內(nèi)數(shù)據(jù)集

這個(gè)數(shù)據(jù)集包含了室內(nèi)走廊環(huán)境，以及樓梯。軌跡的起點(diǎn)和終點(diǎn)是重合的，我們用離線批量?jī)?yōu)化和閉環(huán)優(yōu)化的結(jié)果作為真值。結(jié)果顯示在圖6中。機(jī)器人在圖6(b)中圓圈標(biāo)記的地方上下樓。由于LiDAR視角的急劇變化，LIO_SAM和LOAM_IMU都產(chǎn)生了很大的誤差。LIOM[14]與IMU緊耦合，誤差很小。GR_Fusion將攝像頭、IMU、輪速計(jì)和LiDAR緊耦合在前端，快速估計(jì)機(jī)器人的狀態(tài)增量，可以應(yīng)對(duì)觀察角度急劇變化的情況。圖6(b)底部的曲線是算法在Z軸上的位移。由于GR_Fusion在優(yōu)化時(shí)考慮了局部平面的約束，所以它的精度更高。

所有方法的絕對(duì)平移誤差見(jiàn)表二。LOAM_IMU是優(yōu)化的LOAM。我們?cè)黾恿薎MU的局部姿態(tài)增量和全局重力約束，以提高其估計(jì)的準(zhǔn)確性。

2.地下數(shù)據(jù)集

在這個(gè)數(shù)據(jù)集中，機(jī)器人從校園出發(fā)，經(jīng)過(guò)地下車庫(kù)，然后返回地面校園。地下車庫(kù)的通道有一個(gè)旋轉(zhuǎn)通道和一個(gè)直線通道，如圖7(a)所示。這些通道的環(huán)境是高度重復(fù)的，造成LiDAR的退化。

圖7(b)中顯示了每種算法的結(jié)果?？梢钥闯?，LIOM、LIO_SAM和LOAM_IMU由于LiDAR的退化，在地下通道中都有明顯的錯(cuò)誤。GR_Fusion仍然可以依靠視覺(jué)、IMU和輪速計(jì)增量模型進(jìn)行連續(xù)狀態(tài)估計(jì)。當(dāng)GR_Fusion檢測(cè)到LiDAR的退化時(shí)，它將減少LiDAR的優(yōu)化權(quán)重。而在現(xiàn)有狀態(tài)的基礎(chǔ)上，局部滑動(dòng)窗口的大小將逐漸增加，并包含更多的數(shù)據(jù)進(jìn)行優(yōu)化。在保證位姿不跳躍的同時(shí)，保證了狀態(tài)估計(jì)的準(zhǔn)確性。

3.開(kāi)放式草坪數(shù)據(jù)集

在這個(gè)測(cè)試中，我們?cè)u(píng)估了所提方法在戶外大規(guī)模開(kāi)放環(huán)境中的表現(xiàn)。在開(kāi)放草坪數(shù)據(jù)集中，機(jī)器人穿越了一個(gè)非常開(kāi)放的草坪，在遠(yuǎn)處只能看到一些稀疏的樹(shù)木，如圖8所示。在穿越草坪時(shí)，從LiDAR中提取的大部分特征都分布在地面上，使運(yùn)動(dòng)估計(jì)發(fā)生退化。從圖8(b)中可以看出，LIOM和LOAM_IMU由于LiDAR的退化而產(chǎn)生了明顯的誤差。因?yàn)長(zhǎng)IO_SAM融合了GNSS測(cè)量，所以估計(jì)的全局姿態(tài)可以保證一定的精度。但是當(dāng)我們?nèi)サ鬐NSS測(cè)量時(shí)，LIO_SAM估計(jì)的狀態(tài)會(huì)出現(xiàn)跳變，由此產(chǎn)生的誤差比LOAM_IMU更大。這是因?yàn)長(zhǎng)IO_SAM在估計(jì)時(shí)使用的特征比LOAM_IMU少。此外，我們發(fā)現(xiàn)在室外環(huán)境中，從LiDAR中提取的特征相對(duì)稀疏，所以與室內(nèi)環(huán)境相比，所評(píng)估的其他算法的性能有所下降。GR_Fusion結(jié)合了LiDAR、相機(jī)、IMU和輪速計(jì)的測(cè)量結(jié)果，以確保無(wú)論在室內(nèi)還是室外環(huán)境下都有相同的精度。而通過(guò)融合GNSS測(cè)量，GR_Fusion可以輸出全局無(wú)漂移的估算結(jié)果。

4.校園數(shù)據(jù)集

在這個(gè)測(cè)試中，我們?cè)u(píng)估了GR_Fusion在不同配置下的性能。GR_Fusion_Local使用LiDAR、照相機(jī)、IMU和輪速計(jì)作為傳感器。GR_Fusion_GNSS進(jìn)一步融合了GNSS測(cè)量。GR_Fusion_Low_Cost只使用低成本的傳感器配置，包括GNSS、IMU和輪速計(jì)。GR_Fusion_Loop有閉環(huán)優(yōu)化。應(yīng)該注意的是，在以前的實(shí)驗(yàn)中沒(méi)有使用閉環(huán)優(yōu)化。

結(jié)果顯示在圖9中。GR_Fusion_Loop的精度最高，可以消除累積誤差。GR_Fusion_Local的精度比GR_Fusion_GNSS的精度高。這是因?yàn)樵谲壽E的某一段中，GNSS的測(cè)量質(zhì)量降低了，這導(dǎo)致了全局優(yōu)化的誤差。然而，GR_Fusion_GNSS在長(zhǎng)時(shí)間運(yùn)行時(shí)具有更高的精度。GR_Fusion_LowCost只使用IMU和輪速計(jì)增量模型進(jìn)行局部估計(jì)，并使用GNSS進(jìn)行全局狀態(tài)優(yōu)化。它的精度很容易受到GNSS測(cè)量的影響，但它仍然可以提供可接受的結(jié)果，對(duì)低成本機(jī)器人非常有用。

5.動(dòng)態(tài)物體剔除

我們還測(cè)試了環(huán)境中出現(xiàn)動(dòng)態(tài)物體時(shí)GR_Fusion的建圖性能。圖10顯示了車輛經(jīng)過(guò)時(shí)的建圖結(jié)果?？梢钥闯觯渌惴ㄔ诘貓D中包括了所有移動(dòng)車輛的點(diǎn)云。GR_Fusion可以有效地消除動(dòng)態(tài)物體，建立一個(gè)更合理的靜態(tài)環(huán)境地圖。

此外，我們還對(duì)算法的實(shí)時(shí)性能進(jìn)行了統(tǒng)計(jì)，如下表所示?？梢钥闯?，雖然GR_Fusion融合了更多的傳感器，但通過(guò)對(duì)信息的仔細(xì)處理和選擇，以及工程實(shí)施中的有效策略，它可以提供高效和準(zhǔn)確的估計(jì)結(jié)果。

Conclusions And Future work

我們提出了一種多模態(tài)的傳感器融合方法，可以魯棒且準(zhǔn)確地估計(jì)機(jī)器人的狀態(tài)。通過(guò)對(duì)各傳感器數(shù)據(jù)的精心選擇和細(xì)化，在提高精度的同時(shí)，還可以消除動(dòng)態(tài)目標(biāo)和不穩(wěn)定的特征。它可以實(shí)時(shí)檢測(cè)傳感器的退化情況，并可以靈活地配置為多種工作模式。目前，視覺(jué)信息僅在前端用于估計(jì)機(jī)器人的局部狀態(tài)。在未來(lái)，我們將結(jié)合視覺(jué)和LiDAR來(lái)創(chuàng)建具有全局描述符的地標(biāo)，以進(jìn)一步優(yōu)化機(jī)器人的全局狀態(tài)。

備注：作者也是我們「3D視覺(jué)從入門到精通」特邀嘉賓：一個(gè)超干貨的3D視覺(jué)學(xué)習(xí)社區(qū)