亚洲免费av电影一区二区三区,日韩爱爱视频,51精品视频一区二区三区,91视频爱爱,日韩欧美在线播放视频,中文字幕少妇AV,亚洲电影中文字幕,久久久久亚洲av成人网址,久久综合视频网站,国产在线不卡免费播放

        ?

        一種基于地磁信號的激光同時定位與建圖的閉環(huán)檢測方法

        2020-09-28 10:15:38陳貝章李慧云
        集成技術(shù) 2020年5期
        關(guān)鍵詞:建圖激光雷達(dá)閉環(huán)

        陳貝章 李慧云

        1(中國科學(xué)院深圳先進(jìn)技術(shù)研究院 深圳 518055)

        2(粵港澳人機(jī)智能協(xié)同系統(tǒng)聯(lián)合實(shí)驗室 深圳 518055)

        1 引 言

        同時定位與建圖(Simultaneous Localization and Mapping,SLAM)技術(shù)自 1988 年被提出以來,主要用于研究移動機(jī)器人的智能化。目前配備了激光雷達(dá)、攝像頭、慣性導(dǎo)航模塊(Inertial Measurement Unit,IMU)等關(guān)鍵傳感設(shè)備的智能載體借助 SLAM 技術(shù)已經(jīng)能滿足室內(nèi)場景的自主導(dǎo)航任務(wù)[1]。SLAM 技術(shù)是在未知環(huán)境中實(shí)現(xiàn)自主定位的關(guān)鍵技術(shù),而基于激光雷達(dá)同時定位與地圖構(gòu)建(激光 SLAM)的技術(shù)廣泛應(yīng)用在無人駕駛、室內(nèi)外機(jī)器人導(dǎo)航及三維重建等領(lǐng)域[2]。激光 SLAM 之所以能作為無人駕駛定位方案中不可或缺的技術(shù),其主要原因在于:(1)激光 SLAM 無需對定位場景進(jìn)行預(yù)先布置,即能在未知的環(huán)境中進(jìn)行定位服務(wù);(2)激光能準(zhǔn)確測量障礙點(diǎn)的角度與距離;(3)能在光線較差、光照變化較大的環(huán)境下工作;(4)能夠生成便于導(dǎo)航的柵格地圖與直觀的點(diǎn)云地圖。

        前谷歌無人車領(lǐng)導(dǎo)者 Sebastian Thrun 在其 2005 年出版的經(jīng)典著作《概率機(jī)器人》[3]一書中介紹了如何基于概率濾波的方法使用二維激光雷達(dá)進(jìn)行地圖構(gòu)建和定位。該書詳細(xì)闡述了從基于 RB 粒子濾波(Rao-Blackwellised Particle Filter,RBPF)的經(jīng)典 FastSLAM 算法,逐步發(fā)展成為基于激光雷達(dá)建圖標(biāo)準(zhǔn) GMapping 算法的過程[4]。2016 年,Google 開源其優(yōu)化的激光 SLAM 算法 Cartographer[5],該算法改進(jìn)了 GMapping 計算耗時且無法有效處理閉環(huán)的缺點(diǎn),利用幀間點(diǎn)云地圖匹配與子地圖構(gòu)建思想有效地彌補(bǔ)了 GMapping 的缺陷。

        盡管激光 SLAM 技術(shù)可以在一定場景下滿足定位精度的要求,但是難以在全工況的自動駕駛場景中提供持續(xù)、穩(wěn)定的高精度定位輸出。另外,由于定位場景的結(jié)構(gòu)相似性且激光點(diǎn)云對環(huán)境的描述能力不足,容易發(fā)生 SLAM 的閉環(huán)檢測誤報(False Positives)現(xiàn)象,從而降低系統(tǒng)定位與建圖性能[6]。本研究旨在通過將地磁信號與激光 SLAM 的閉環(huán)檢測環(huán)節(jié)融合,提出激光 SLAM 在應(yīng)對結(jié)構(gòu)相似性及激光強(qiáng)干擾場景下的定位與建圖任務(wù)時的創(chuàng)新解決方法。同時,本研究將此技術(shù)應(yīng)用到無人駕駛的定位與建圖領(lǐng)域,實(shí)現(xiàn)了無人駕駛汽車全天候、全地域的精準(zhǔn)定位,提升了無人駕駛汽車定位算法的精準(zhǔn)性與穩(wěn)定性。

        2 相關(guān)研究進(jìn)展

        2.1 激光 SLAM 閉環(huán)檢測

        近年來一些國外學(xué)者為解決閉環(huán)檢測誤報現(xiàn)象對 SLAM 系統(tǒng)的影響,提出了閉環(huán)驗證算法。Bosse 與 Roberts[7]的工作提出,利用熵序列之間的最大相關(guān)性之和與投影直方圖的驗證度量來估計閉環(huán)檢測的正確性,并在此基礎(chǔ)上提升了閉環(huán)檢測的正確率[8]。Granstrom 等[9]提出了基于變換后掃描并在最后配準(zhǔn)的閉環(huán)檢測驗證標(biāo)準(zhǔn)。Corso[10]提出在室內(nèi)環(huán)境中嚴(yán)格處理閉環(huán)驗證時,由于閉環(huán)的現(xiàn)象可以從多種傳感器的數(shù)據(jù)源中被檢測到,因此應(yīng)將閉環(huán)驗證算法與閉環(huán)檢測算法分成兩個方向進(jìn)行研究。此外,Gao 與 Harle[11]在已有報道的基礎(chǔ)上,提出將地磁序列信號的匹配定位方法用于矯正基于 PDR(Pedestrian Dead Reckoning)的 SLAM 閉環(huán)檢測環(huán)節(jié),以此來提高行人步態(tài)檢測與定位的精度。

        2.2 閉環(huán)檢測模型

        閉環(huán)檢測是指無人車經(jīng)過一段較長行程并再次回到曾經(jīng)歷過的位置時,對地圖中曾觀測到的特征進(jìn)行二次觀測,同時通過兩次觀測的差異對全局地圖進(jìn)行調(diào)整,以減少定位與建圖過程中的誤差累計[12]。目前主要的閉環(huán)檢測方法包括:(1)幀與幀閉環(huán)檢測;(2)幀與子圖閉環(huán)檢測;(3)子圖與子圖閉環(huán)檢測[13]。以上閉環(huán)檢測算法都是采用相關(guān)性掃描匹配,通過旋轉(zhuǎn)矩陣R與平移向量T判斷兩幀激光點(diǎn)云的相似性。當(dāng)激光雷達(dá)獲得新的掃描幀時,在其附近一定范圍搜索最優(yōu)匹配幀,若該最優(yōu)匹配幀符合要求,則認(rèn)為是一個回環(huán)。該匹配問題可以描述為如下公式:

        其中,ξ為匹配解算的剛性變換,ω為搜索空間,k為搜索空間的位姿數(shù)量,Mnearest表示觀測激光點(diǎn)云hk和位置變換矩陣Tξ的乘積與地圖激光柵格點(diǎn)云最接近重合的置信度。對于每一幀激光點(diǎn)云插入子地圖上時的信度和來說,信度越高則認(rèn)為越相似。在ω空間中尋找出該信度和最大的匹配幀,需要在ω空間中尋找出匹配結(jié)果的最優(yōu)解。一種常見的方法是暴力匹配法,即在搜索空間范圍內(nèi),對每一幀與當(dāng)前幀進(jìn)行上式非線性最小二乘計算。匹配算法解算的剛性變換ξ與智能車初始的位姿相乘后便得出此時的位姿(xi,yi,θi)。當(dāng)匹配的兩幀之間存在對激光光束產(chǎn)生干擾的材質(zhì)(反射率過低的物體或?qū)馐型干渥饔玫牟AУ?時,場景中的這些干擾因素是激光點(diǎn)云匹配階段誤差累積的主要成分。其中,該累積誤差可以通過閉環(huán)檢測的方法進(jìn)行消除。以下場景容易引起激光 SLAM 的閉環(huán)檢測誤檢現(xiàn)象:(1)室內(nèi)的長廊、空曠的室內(nèi)大堂、結(jié)構(gòu)布局相似的房間,如圖 1(a)所示;(2)場景中反射率過低的物體,如黑色吸光墻面、家具等;(3)場景中存在玻璃或?qū)す夤馐a(chǎn)生透射現(xiàn)象的物體,如圖 1(b)所示;(4)場景中存在鏡子、不銹鋼等對激光光束產(chǎn)生鏡面反射的物體。

        隨著地圖擴(kuò)大,匹配搜索效率決定了閉環(huán)檢測的實(shí)時性。當(dāng) SLAM 在應(yīng)對較大場景和復(fù)雜干擾的環(huán)境時,實(shí)時定位與建圖對閉環(huán)檢測算法的效率提出了更高要求。此外,對于空間相似性較高的環(huán)境,由于低線束激光雷達(dá)對環(huán)境特征的表達(dá)能力不足,導(dǎo)致閉環(huán)檢測誤報現(xiàn)象十分常見。對激光光束存在干擾的場景(玻璃、鏡子、不銹鋼等),無人車運(yùn)行定位與建圖算法時,會出現(xiàn)一些未完全探明的區(qū)域,此處區(qū)域顯示為灰色,如圖 1(d)紅圈處所示。對于這些干擾,傳統(tǒng)激光雷達(dá)定位主要是在干擾激光掃描平面處貼上反射片,或是通過人工校驗的方法進(jìn)行解決。而傳統(tǒng)的人工后處理方法是通過使用機(jī)器人仿真軟件 RoboStudio 中的畫圖工具將建圖結(jié)果中的誤判區(qū)域進(jìn)行擦除,使其變?yōu)橐烟矫鲄^(qū)域[14],因此該方法既不智能也費(fèi)時耗力。而本文通過對地磁序列信號的研究,提出了地磁序列信號與激光雷達(dá)融合的閉環(huán)檢測方法,“一站式”地解決了上述干擾對整個定位與建圖系統(tǒng)的影響。

        圖1 常見閉環(huán)誤檢干擾及錯誤定位與建圖Fig. 1 Common closed-loop false detection interference and incorrect positioning and mapping

        3 地磁信號與激光 SLAM 融合算法設(shè)計

        本文基于地磁導(dǎo)航技術(shù)與激光 SLAM 算法,針對無人駕駛載體定位與建圖的閉環(huán)檢測環(huán)節(jié),設(shè)計了地磁序列搜索與激光點(diǎn)云匹配融合的閉環(huán)檢測算法。算法框架如圖 2 所示,其中紅色虛線框中是本文提出的閉環(huán)粗匹配與地磁特征篩選閉環(huán)檢測算法。

        3.1 基于地磁信號與激光雷達(dá)融合定位的算法設(shè)計

        地磁信號與激光雷達(dá)融合定位建圖算法是在激光 SLAM 算法框架基礎(chǔ)上設(shè)計的,因此和激光 SLAM 框架一樣擁有前端掃描匹配、后端優(yōu)化和閉環(huán)檢測等環(huán)節(jié)。本文提出的閉環(huán)粗匹配與地磁特征篩選閉環(huán)檢測算法是將地磁序列匹配技術(shù)引入激光 SLAM 閉環(huán)檢測環(huán)節(jié)。整個地磁信號與激光雷達(dá)融合定位建圖的算法流程如圖 3 所示。閉環(huán)粗匹配與地磁特征篩選閉環(huán)檢測算法位于整個系統(tǒng)框右側(cè)紅色虛線框中。算法總體框架參數(shù)設(shè)置分為傳感器參數(shù)設(shè)置與位姿地圖參數(shù)設(shè)置。其中傳感器參數(shù)設(shè)置分為來自激光雷達(dá)的輸入與來自 IMU 的輸入。激光雷達(dá)的參數(shù)設(shè)置包括:掃描角度的范圍、掃描角度間隔、掃描點(diǎn)數(shù)、掃描時間、一次掃描的線束數(shù)等。

        本文算法首先初始化上述參數(shù),以運(yùn)動載體的初始位置為原點(diǎn),將 IMU 估計的載體坐標(biāo)附近劃定為激光點(diǎn)云匹配的搜素區(qū)域。在該區(qū)域半徑內(nèi)調(diào)用激光 SLAM 前端點(diǎn)云匹配算法估計載體更精細(xì)的坐標(biāo),載體的姿態(tài)由當(dāng)前時刻的 IMU 提供,此時已完成前端位姿的估計。但是在激光點(diǎn)云的匹配過程中,由于受到環(huán)境的干擾,不可避免地出現(xiàn)累計誤差,這些誤差中一些由后端的優(yōu)化環(huán)節(jié)進(jìn)行消除,另一些則由閉環(huán)檢測環(huán)節(jié)進(jìn)行消除。本文提出的閉環(huán)粗匹配與地磁特征篩選閉環(huán)檢測算法利用地磁序列快速搜索與匹配的特點(diǎn),能為激光 SLAM 提供穩(wěn)定精準(zhǔn)的閉環(huán)候選集合。

        圖2 地磁信號與激光雷達(dá)融合定位建圖算法框架Fig. 2 Algorithm framework for geomagnetic signal and lidar fusion positioning mapping

        圖3 基于地磁信號與激光雷達(dá)融合定位與建圖算法流程Fig. 3 Algorithm flow of fusion positioning and mapping based on geomagnetic signal and lidar

        3.2 閉環(huán)粗匹配與地磁特征篩選閉環(huán)檢測算法

        接著按照激光點(diǎn)云的匹配算法,匹配新構(gòu)建的點(diǎn)云子地圖與歷史子地圖。本文將滿足子地圖匹配得分閾值的點(diǎn)云子地圖加入候選子圖集,對應(yīng)的地磁序列信號加入候選子序列集合。若不存在滿足條件的點(diǎn)云子地圖,則當(dāng)前位姿不存在閉環(huán),并跳出閉環(huán)檢測環(huán)節(jié)。然后,通過使用動態(tài)時間規(guī)劃(Dynamic Time Warping,DTW)算法計算候選地磁子序列與新加入的地磁子序列的距離。由于考慮到即使在閉環(huán)檢測的地方,運(yùn)動軌跡也不可能完全重合,因此閉環(huán)檢測附近區(qū)域的運(yùn)動必定是時而靠近上一次運(yùn)動的軌跡,時而遠(yuǎn)離上一次運(yùn)動的軌跡。針對這種無約束的運(yùn)動(無固定運(yùn)動軌跡的運(yùn)動),通過設(shè)置固定 DTW 距離來約束閾值是不適用的。故使用迭代最近鄰(Iterative Closest Point,ICP)算法計算候選集中的運(yùn)動軌跡,并與當(dāng)前軌跡進(jìn)行匹配,記錄算法迭代至收斂的步數(shù)。最后,對于滿足迭代步數(shù)約束,即運(yùn)動軌跡相似的候選集地磁子序列,放寬 DTW 閾值的約束。從而使即使偏離原來軌跡的運(yùn)動在閉環(huán)檢測的地方也能滿足 DTW 地磁匹配的閾值篩選條件。

        圖 4 為閉環(huán)粗匹配與地磁特征篩選閉環(huán)檢測算法流程圖。本文算法可在激光閉環(huán)檢測到的候選子圖中,用地磁匹配的 DTW 和軌跡匹配的 ICP 算法再次篩選出準(zhǔn)確的閉環(huán)檢測點(diǎn),從而解決了閉環(huán)檢測誤檢問題(室內(nèi)建筑結(jié)構(gòu)相似性引起)和定位建圖擾動問題(室內(nèi)玻璃、光滑鏡面材質(zhì)對激光光束透射、反射現(xiàn)象引起)。其中,ICP 迭代至收斂步數(shù)作為軌跡相似評價,并自適應(yīng)調(diào)節(jié)閉環(huán)檢測點(diǎn)處匹配的地磁序列閾值,從而保證閉環(huán)檢測的準(zhǔn)確性與穩(wěn)定性。

        圖4 閉環(huán)粗匹配與地磁特征篩選閉環(huán)檢測算法Fig. 4 Closed-loop coarse matching and geomagnetic feature screening closed-loop detection algorithm

        當(dāng)新的地磁序列Snew生成時,用 DTW 算法計算已生成的地磁序列Si與Snew的歐式距離。當(dāng) DTW(Snew,Si) 的距離小于閉環(huán)檢測的閾值DLC時,將此閉環(huán)檢測的可能位姿節(jié)點(diǎn)加入閉環(huán)檢測候選集。表 1 給出了地磁信號與激光雷達(dá)融合閉環(huán)檢測算法的偽代碼。圖 5 所示為地磁序列與激光 SLAM 融合原理圖。三軸地磁信號通過求平方和的形式形成序列Si,與相同時戳位姿對應(yīng)的示意圖形成新位姿節(jié)點(diǎn)Xi,體現(xiàn)地磁序列信號與激光解算位姿的融合原理。

        表1 地磁信號與激光雷達(dá)融合的閉環(huán)檢測的算法偽代碼Table 1 Pseudocode for closed-loop detection algorithm of geomagnetic signal and lidar fusion

        圖5 地磁序列與激光 SLAM 融合原理圖Fig. 5 Schematic diagram of fusion of geomagnetic sequence and lidar SLAM

        4 實(shí) 驗

        4.1 無人駕駛硬件測試平臺設(shè)計

        本研究主要采用為碼頭倉庫重載自動導(dǎo)引運(yùn)輸車(Automated Guided Vehicle,AGV)提供高精度定位與建圖作為研究背景,圖 6 所示為地磁與激光融合 SLAM 實(shí)驗平臺總框圖。該實(shí)驗平臺的定位與建圖主要使用的傳感設(shè)備包括,Hokuyo 單線激光雷達(dá)、禾賽 40 線激光雷達(dá)和 Xsens IMU。其中 Xsens IMU 作為地磁序列信號的感知設(shè)備,通過安裝了 ROS(Robot Operating System)系統(tǒng)的筆記本電腦采集空間三軸地磁信號。實(shí)驗平臺的工控機(jī)采用英偉達(dá)的 Jetson TX2,筆記本只作為與用戶交互的終端,通過 WIFI 向工控機(jī)收發(fā)指令。激光雷達(dá)與采集地磁信號的 IMU 一同接在 Jetson TX2 上,用以建圖與定位。本實(shí)驗平臺不僅能滿足空間地磁序列作為定位匹配信號的驗證性實(shí)驗要求,還是基于地磁信號的激光 SLAM 閉環(huán)檢測方法的主要實(shí)驗平臺。

        圖6 地磁與激光融合 SLAM 實(shí)驗平臺總框圖Fig. 6 General block diagram of geomagnetic and laser fusion SLAM experiment platform

        4.2 定位與建圖效果對照實(shí)驗

        為對比說明 Google 的 Cartographer 激光 SLAM 算法[5]與本文的地磁與激光融合 SLAM 算法在建圖與定位效果上的優(yōu)劣,選取對激光雷達(dá)產(chǎn)生大量干擾的場景,如圖 1(b)(中國科學(xué)院深圳先進(jìn)技術(shù)研究院 D 棟 2 樓)實(shí)驗場景中存在大片的玻璃落地窗,進(jìn)行對比實(shí)驗。圖 7 為實(shí)驗場景平面圖。

        圖7 實(shí)驗場景平面圖Fig. 7 Experimental scene plan

        定位與建圖算法對比實(shí)驗步驟:(1)對照實(shí)驗采用 AGV 實(shí)驗平臺,控制實(shí)驗無關(guān)變量進(jìn)行實(shí)驗(在相同場景、時間段、控制實(shí)驗車運(yùn)行大致相同的軌跡);(2)啟動實(shí)驗小車同時運(yùn)行 Cartographer SLAM 算法,實(shí)時觀察 SLAM 算法輸出的定位軌跡與建立的柵格地圖;(3)讓實(shí)驗小車完整地運(yùn)行一周,運(yùn)行結(jié)束后保存運(yùn)行軌跡與建立的柵格地圖;(4)運(yùn)行本文提出的地磁與激光融合 SLAM 算法,重復(fù)(2)、(3)步驟。

        4.3 實(shí)驗結(jié)果與分析

        4.3.1 定位與建圖效果對比實(shí)驗

        搭載了激光雷達(dá)的 AGV 在室內(nèi)場景運(yùn)行一周后構(gòu)建的柵格地圖與推算的運(yùn)動軌跡如圖 8(a)所示。結(jié)果顯示,與小車實(shí)際行駛軌跡的最大出入是剛開始的一段錯誤定位軌跡,這是由于場景中結(jié)構(gòu)相似性導(dǎo)致的。因為無論是從左到右還是從右到左行駛,激光雷達(dá)的觀測量都存在極大相似性。在經(jīng)過該結(jié)構(gòu)相識性較高的環(huán)境后,Cartographer 的定位才與實(shí)際情況相符合。而本文算法在相同干擾環(huán)境中定位的軌跡如圖 8(b)所示,符合無人車的實(shí)際運(yùn)動。

        在進(jìn)行定位與建圖效果對照實(shí)驗中,傳統(tǒng) SLAM 算法在應(yīng)對環(huán)境中的玻璃干擾時,常常錯誤建圖與定位,具體如圖 8(c)所示。原因是激光雷達(dá)對場景的描述能力不足,幀間匹配特征不夠明顯,閉環(huán)檢測環(huán)節(jié)在應(yīng)對上述干擾時不起作用。因為玻璃等光滑鏡面材質(zhì)對激光光束透射、反射,所以此算法容易構(gòu)建出實(shí)際中不存在的可行使區(qū)域(被玻璃材質(zhì)隔斷的區(qū)域),這對于使用該地圖進(jìn)行導(dǎo)航的任務(wù)來說將會產(chǎn)生碰撞后果。針對這些問題,基于地磁信號在空間分布的差異性與穩(wěn)定性,本文提出的地磁與激光融合的解決方案在應(yīng)對上述干擾時有更好的建圖與定位效果,如圖 8(c)、8(d)中的圓圈區(qū)域?qū)?yīng)圖 1(b)中的玻璃干擾區(qū)域。

        圖8 定位與建圖對比實(shí)驗Fig. 8 Comparison experiment of positioning and mapping

        4.3.2 算法運(yùn)行效率實(shí)驗與結(jié)果分析

        為體現(xiàn)地磁信號與激光雷達(dá)融合的閉環(huán)檢測算法對激光點(diǎn)云匹配速度的提升性,實(shí)驗選用 100 幀激光數(shù)據(jù)進(jìn)行匹配比較。同時將本文算法、暴力匹配的搜索算法[15]與 Cartographer 的分支定界加速閉環(huán)檢測算法[5]進(jìn)行比較。為確保實(shí)驗的公平性,在 AGV 運(yùn)行一周時采集的激光點(diǎn)云與地磁數(shù)據(jù)中,隨機(jī)選取 100 幀激光點(diǎn)云,測試 3 種閉環(huán)檢測算法完成 100 次匹配后的運(yùn)行時間。從圖 9 可看出,在同樣匹配次數(shù)下,暴力匹配算法消耗的時間大約為 13 s/次;Cartographer 算法大約為 6.7 s/次;而具有地磁匹配檢測算法僅為 0.9 s/次??梢姷卮牌ヅ浜Y選能減少產(chǎn)生的候選集,在 100 幀的匹配任務(wù)中本文算法匹配速度相比于 Cartographer 的分支定界加速匹配算法提升了 10%。

        圖9 三種閉環(huán)檢測算法耗時比較Fig. 9 Time-consuming comparison of three closed-loop detection algorithms

        4.3.3 算法穩(wěn)定性實(shí)驗與結(jié)果分析

        閉環(huán)檢測誤檢率和召回率分布情況如圖 10 所示。本文算法通過地磁匹配算法篩選出候選閉環(huán)檢測位姿節(jié)點(diǎn)方法后,由于地磁匹配算法能快速地過濾掉很多容易造成誤檢的結(jié)果,因此本文算法的誤檢率在 3 種算法中一直維持在較低水平。從圖 10 可看出,不論激光點(diǎn)云幀與子地圖匹配的得分閾值如何設(shè)置,在相同召回率的情況下,本文算法的閉環(huán)檢測誤檢率都低于分支定界加速匹配算法與暴力匹配算法;在 0.8 召回率的情況下閉環(huán)檢測的誤檢率降低了 23%,明顯提升了閉環(huán)檢測算法的穩(wěn)定性。

        圖10 三種閉環(huán)檢測算法誤檢率與召回率對比Fig. 10 Comparison of the false rate and recall rate of three algorithms for closed-loop detection calculation

        5 總結(jié)與展望

        本文以激光 SLAM 閉環(huán)檢測環(huán)節(jié)中的誤檢現(xiàn)象,及在定位與建圖環(huán)境中由干擾引起的閉環(huán)誤檢測與建圖失真現(xiàn)象為研究課題。首先,在對激光 SLAM 閉環(huán)檢測的相關(guān)研究進(jìn)行調(diào)研后,將地磁導(dǎo)航技術(shù)中的地磁匹配與激光 SLAM 中的閉環(huán)檢測環(huán)節(jié)相結(jié)合。通過從激光 SLAM 算法中必要的 IMU 傳感設(shè)備里提取地磁信號作為閉環(huán)的判斷依據(jù),有效地解決了建圖與定位技術(shù)中閉環(huán)檢測匹配速度緩慢及閉環(huán)誤檢的問題。然后基于本文提出的地磁序列搜索與激光點(diǎn)云匹配融合的閉環(huán)檢測算法以及地磁與激光融合 SLAM 實(shí)驗平臺設(shè)計,將傳統(tǒng) SLAM 算法與本文算法進(jìn)行對比。最后對傳統(tǒng) SLAM 算法定位與建圖失效的原因進(jìn)行詳細(xì)分析,并提出了在上述 SLAM 失效場景中的解決方案。

        實(shí)驗結(jié)果表明,與激光 SLAM 技術(shù)的行業(yè)標(biāo)桿 Cartographer 算法相比,本文算法降低了局部相似度較高引起的誤檢情況;同時在定位與建圖環(huán)境中,改善了激光光束反射與透射干擾引起的閉環(huán)誤檢與建圖失真現(xiàn)象。在穩(wěn)定性方面,本文算法與 Cartographer 算法相比,激光 SLAM 在匹配速度和閉環(huán)檢測穩(wěn)定性上都有明顯提升。

        傳統(tǒng)的基于濾波的激光 S L A M,如C o r e S L A M、G M a p p i n g 與基于優(yōu)化的HectorSLAM[16]、KartoSLAM、LagoSLAM[17]和 Cartographer,無法在激光干擾的場景中確保定位與建圖的準(zhǔn)確性。而本文算法由于使用了地磁匹配技術(shù)改進(jìn)激光閉環(huán)檢測環(huán)節(jié),在應(yīng)對上述干擾場景時均能穩(wěn)定輸出精確的定位與建圖結(jié)果。經(jīng)過多次實(shí)驗測試,證明本文算法在閉環(huán)檢測速度提升 31% 的前提下,定位精度在無激光干擾場景中仍可與 Cartographer 算法持平,從而提高了定位與建圖的效率。此外,在激光干擾的場景中,本文算法的定位精度與建圖效果優(yōu)于上述所有激光 SLAM 算法。

        室外的復(fù)雜環(huán)境為無人駕駛精準(zhǔn)定位與建圖帶來更多的挑戰(zhàn),同時室外對激光雷達(dá)感知與 IMU 地磁信號的測量存在更多干擾。如何在保證定位精度與建圖效果的前提下,將地磁與激光融合 SLAM 技術(shù)拓展到室外駕駛環(huán)境是我們未來探索的方向。

        猜你喜歡
        建圖激光雷達(dá)閉環(huán)
        手持激光雷達(dá)應(yīng)用解決方案
        北京測繪(2022年5期)2022-11-22 06:57:43
        視覺同步定位與建圖中特征點(diǎn)匹配算法優(yōu)化
        法雷奧第二代SCALA?激光雷達(dá)
        汽車觀察(2021年8期)2021-09-01 10:12:41
        基于三輪全向機(jī)器人的室內(nèi)建圖與導(dǎo)航
        電子制作(2019年10期)2019-06-17 11:45:06
        基于激光雷達(dá)通信的地面特征識別技術(shù)
        一種基于多傳感融合的室內(nèi)建圖和定位算法
        基于激光雷達(dá)的多旋翼無人機(jī)室內(nèi)定位與避障研究
        電子制作(2018年16期)2018-09-26 03:27:00
        機(jī)器人室內(nèi)語義建圖中的場所感知方法綜述
        單周期控制下雙輸入Buck變換器閉環(huán)系統(tǒng)設(shè)計
        黑龍江電力(2017年1期)2017-05-17 04:25:05
        雙閉環(huán)模糊控制在石化廢水處理中的研究
        亚洲人成人77777网站| 邻居美少妇张开腿让我爽了一夜| 人妻无码第一区二区三区| 又长又大又粗又硬3p免费视频| 色综合久久综合欧美综合图片 | 国语精品一区二区三区| 亚洲色大成网站www在线观看| 男女搞黄在线观看视频| 新中文字幕一区二区三区| a级毛片无码久久精品免费| 日本成人久久| 国产最新一区二区三区| av素人中文字幕在线观看| 亚洲熟妇无码八av在线播放| 无码午夜剧场| 一区二区三区成人av| 国产精品久久久福利| 国产亚洲精品久久久久婷婷瑜伽 | 黄片国产一区二区三区 | 国产精品亚洲一区二区三区在线| 无码人妻专区免费视频| 日本在线一区二区在线| 欧美精品欧美人与动人物牲交 | 成人片黄网站色大片免费观看cn| 国产精品原创av片国产日韩| 亚洲中文字幕乱码在线观看| 国产乱人无码伦av在线a| 国产在线精品一区二区三区不卡| 中文字幕大乳少妇| 男女做羞羞事的视频网站| 无码av一区二区大桥久未| 亚洲美女影院| 久久国产精品免费久久久| 又黄又爽又色视频| 精品香蕉久久久爽爽 | 色噜噜亚洲精品中文字幕| 后入到高潮免费观看| 岛国AV一区二区三区在线观看| 中文字幕av久久激情亚洲精品| 日本最新一区二区三区视频观看| 中国熟妇人妻xxxxx|