胡文超，孫新柱，陳孟元

（安徽工程大學 安徽省電氣傳動與控制重點實驗室，安徽 蕪湖 241000）

同步定位與地圖構(gòu)建(simultaneous location and mapping，SLAM)就是運動載體利用自身攜帶的傳感器獲得周圍環(huán)境的地圖，同時確定自己在地圖中的位置[1]。機器人SLAM可以實現(xiàn)二維空間的經(jīng)歷圖構(gòu)建，但是對于空中某一高度的經(jīng)歷圖構(gòu)建，例如利用SLAM技術(shù)用經(jīng)歷圖來描述建筑物特定高度的外圍輪廓，機器人SLAM已經(jīng)不再適用。無人機可以在特定高度下飛行，利用無人機SLAM技術(shù)可以實現(xiàn)特定高度下二維經(jīng)歷圖的構(gòu)建。無人機SLAM問題應用最成功的是概率的方法，如卡爾曼濾波算法[2]、擴展卡爾曼濾波算法[3]、粒子濾波算法[4]等，文獻[5]將小型無人機的SLAM問題分解成路徑估計與環(huán)境地標估計兩部分，分別采用粒子濾波器和擴展卡爾曼濾波器進行估計，提出了一種小型無人機的FAST SLAM算法，運算的復雜度大幅度降低，且能更好地表示非線性、非高斯運動模型，這些概率算法的優(yōu)勢是能夠處理傳感器與環(huán)境的模糊性，有很好的SLAM性能，但由于概率方法存在計算量大、搜索時間長、易陷于局部最優(yōu)解等問題，故不能夠完全解決全局地圖構(gòu)建和導航問題。慣性導航設備是無人機最常用的導航與地圖構(gòu)建方案，其主要使用慣性/衛(wèi)星/磁傳感器/氣壓高度計組合導航，但是無人機在樓群之間、大型建筑物內(nèi)部或者山區(qū)等GPS信號較弱的地區(qū)飛行時，由于缺乏衛(wèi)星導航系統(tǒng)，慣性導航系統(tǒng)的誤差會不斷發(fā)散，很難實現(xiàn)準確的導航與地圖構(gòu)建[6]。而視覺SLAM方法僅使用機載攝像頭作為外部傳感器，目前常用的是單目視覺SLAM[7]、雙目視覺SLAM[8]、RGB_D SLAM[9]、文獻[10]使用四旋翼飛行器搭載RGB_D傳感器并進行SLAM系統(tǒng)研究，使用稀疏的RGB_D SLAM方法，提高無人機SLAM系統(tǒng)的實時性的同時也達到了高精度的效果。然而視覺SLAM算法對于光照依賴性較強，必須在適宜的光照強度下，在黑暗或較暗的光強下，很難實現(xiàn)準確的同步定位與地圖構(gòu)建；為了解決此類問題，出現(xiàn)了聲吶SLAM算法，聲吶SLAM與視覺SLAM相比，聲吶具有處理速度快、不受光線條件限制等優(yōu)點，文獻[11]利用AUV上的聲吶傳感器持續(xù)探測非合作目標并估計目標航跡的同時，利用探測到的AUV與目標間的相對信息修正其自身航位推算帶來的累積估計誤差，從而提高AUV的自定位精度。但是聲吶SLAM的缺點在于獲取的信息量較少，空間分布分散，其感知信息存在較大的不確定性，因此生物聲吶逐漸作為研究的熱點。生物聲吶，能夠?qū)崿F(xiàn)在復雜的環(huán)境下進行導航，因為它從回聲中提取更多的信息。文獻[12]提出可以模仿蝙蝠聲吶的發(fā)射與接收過程，利用仿生聲吶系統(tǒng)實現(xiàn)復雜環(huán)境下的定位與導航。

概率方法廣泛應用于SLAM的同時，澳大利亞昆士蘭大學Michael等[13]提出了一種基于復合位姿表征的嚙齒動物海馬區(qū)擴展模型(RatSLAM)。RatSLAM模型提出了一種位姿細胞網(wǎng)絡，即連續(xù)吸引子網(wǎng)絡，作為一種手段來進行路徑積分。RatSLAM的路徑積分是通過里程計獲取速度與角度信息，同時使用視覺傳感器對里程計得到的信息進行修正與更新，繪制精確的經(jīng)歷圖。文獻[14]已經(jīng)證明在RatSLAM基礎上，可以使用仿生聲吶模板來代替RatSLAM系統(tǒng)中的視覺模板，用雙耳平滑耳蝸圖來代替視覺圖像，可以實現(xiàn)在暗光或黑暗的條件下，使用BatSLAM模型來構(gòu)建二維經(jīng)歷圖。

BatSLAM模型通過雙耳平滑耳蝸圖作為仿生聲吶模板構(gòu)建二維經(jīng)歷圖，使用絕對差值和(SAD)模塊進行處理產(chǎn)生局部場景，即通過計算所有模板中的耳蝸圖的像素亮度與當前耳蝸圖的像素亮度之差并求和后與閾值相比較來進行仿生聲吶模板的更新，但是此方法是基于外觀的低分辨率、并且只需判斷圖像外觀前后是否一致，不存在幾何處理和特征提取。耳蝸圖在獲取和傳輸過程中會產(chǎn)生各類噪音，相同位置獲得的回波信號構(gòu)建的耳蝸圖具有一定的差異，單獨使用SAD模塊處理會由于識別出錯而導致二維經(jīng)歷圖的失真。

文獻[15]提出對視覺圖像進行閉環(huán)檢測，通常利用當前幀和歷史幀的特征點匹配對數(shù)，通過設定的閾值來判斷是否達到閉環(huán)狀態(tài)。對于音頻圖像，出現(xiàn)了可以進行聲音識別的音頻感知哈希技術(shù)。音頻感知哈希是指可以代表一段音頻重要聲學特征的基于內(nèi)容的緊致數(shù)字簽名，其主要目的是建立一種有效機制來比較兩個音頻文件的感知聽覺質(zhì)量[16]。本文以音頻感知哈希檢索時的誤碼率作為標準，將當前耳蝸圖構(gòu)建的音頻感知哈希與模板庫中耳蝸圖構(gòu)建的音頻感知哈希相比較，當最小誤碼率小于某一閾值時，識別成功，完成閉環(huán)檢測，從而實現(xiàn)經(jīng)歷圖的優(yōu)化。

1 算法原理與設計

采用一種可以在特定高度下進行繪制二維經(jīng)歷圖的BatSLAM模型，使用仿生聲吶模板來代替RatSLAM系統(tǒng)中的視覺模板，用雙耳平滑耳蝸圖代替視覺圖像來構(gòu)建二維經(jīng)歷圖。使用仿生聲吶系統(tǒng)采集回波信號，經(jīng)過一系列處理后將二次采樣的雙耳平滑耳蝸圖作為仿生聲吶模板，同時生成局部場景細胞。用位姿感知細胞來表示無人機在特定高度下的位置與方向。使用陀螺儀與加速度計信息來更新位姿感知細胞，使用仿生聲吶模板對應的局部場景細胞來實現(xiàn)位姿感知細胞的修正，當使用仿生聲吶模板識別失敗時，則使用音頻感知哈希模板進行位姿細胞的修正?？紤]到單獨使用音頻感知哈希進行修正會降低算法的實時性，所以選擇優(yōu)先使用仿生聲吶模板修正，輔助使用音頻感知哈希修正，在提高閉環(huán)檢測準確率的同時，實時性也不會有很大的影響。最后由位姿感知細胞、局部場景細胞與音頻感知哈希的相互聯(lián)系來實現(xiàn)二維經(jīng)歷圖的構(gòu)建與校正。改進后的BatSLAM算法的結(jié)構(gòu)框圖如圖1。

圖1 改進后的BatSLAM算法的結(jié)構(gòu)框圖Fig.1 Structure block diagram of the improved BatSLAM algorithm

1.1 仿生聲吶模型

蝙蝠發(fā)出高頻信號，并對反射的回波信號進行分析并進行導航。在頭部相關傳遞函數(shù)(head function related transfer，HRTF)的基礎上，加入發(fā)射器與接收器的位置信息，采用echolation related transfer function(ERTF)進行聲源定位。左耳與右耳ERTF濾波器如式(1)、式(2)所示。

式中： He(f,θ)表 示發(fā)射器方位，(f,θ)、(f,θ)分別表示左右接收器方位。頻率為 f， 角度 θ表示仿生聲吶系統(tǒng)中處于特定高度的反射器的方位角。

文獻[11]指出雙耳ERTF差是綜合了回聲譜、雙耳強度差(IID)和雙耳時間差(ITD)的聲源定位模型，包含了從目標物到反射器位置的詳細方位信息，可以實現(xiàn)蝙蝠的回聲定位。

在多個反射器的作用下，左右耳蝸接收到的信號如式(3)、式(4)所示。

為了分析這些雙耳回波信號的生理學時頻特性，使用Gammatone聽覺濾波器組來模擬蝙蝠耳廓聽覺頻率響應，其時域表達式為式中： fc(n)為中心頻率；b為帶寬。對于接收到的回波信號經(jīng)過Gammatone濾波器組處理后，使用得到的Gammatone耳蝸能量譜來表示回波信號的時頻特性，接下來進行一階低通濾波，分別得到左耳與右耳耳蝸圖，計算公式如式(6)、式(7)所示。式 中 ： XL(t) 、 XR(t)分 別 為 左 耳 與 右 耳 耳 蝸 圖 ，ulp(t)為 一階低通濾波， xL(t)、 xR(t)為左耳與右耳接收的信號。

在BatSLAM模型中，將構(gòu)建的耳蝸圖模型作為仿生聲吶模板，在使用耳蝸圖作為仿生聲吶模板時，必須注意對無人機位置細微的變化進行處理，及時進行二次采樣的單聲道耳蝸圖使系統(tǒng)更加具有魯棒性。這里使用高斯濾波器進行平滑處理，進一步排除細小位置改變帶來的影響。二個平滑和二次采樣的單聲道耳蝸圖連接起來，形成一個雙耳平滑耳蝸圖如式(8)所示。

使用標準化雙耳平滑耳蝸圖，計算公式為

將標準化雙耳平滑耳蝸圖作為當前仿生聲吶模板，計算公式為

1.2 位姿感知細胞

定高飛行的無人機在特定的位姿狀態(tài)時，處于空間位姿感知細胞網(wǎng)絡(X，Y，θ)中，通過連續(xù)吸引子網(wǎng)絡(CAN)控制無人機位姿感知網(wǎng)絡內(nèi)部的活動。路徑積分是通過轉(zhuǎn)換每個位姿感知細胞基于無人機加速度計速度、陀螺儀角速度和(X，Y，θ)坐標的活動來更新姿態(tài)細胞的活動，同時使用仿生聲吶模板的比較來保持和修正位姿信息，從而實現(xiàn)位姿感知細胞的重定位。

1) CAN模型

位姿細胞內(nèi)部動態(tài)過程主要包括興奮度更新，對所有細胞的全局抑制。使用一個三維離散高斯分布來創(chuàng)建興奮度權(quán)重矩陣 ε，如式(11)所示：

式中： km、 kn分別表示位置與方向的常數(shù)；a、b、c為x′、 y′、 θ′的分布系數(shù)。

由于興奮性造成的位姿感知細胞的活動變化如式(12)所示：

式中： Nx′,Ny′,Nθ′為 (x′,y′,θ′)空間中的位姿感知細胞三維矩陣元素。 Pabc為位姿感知細胞的活動系數(shù)，對于位姿感知細胞的活動變化的全局抑制如式(13)所示：

式中：抑制常數(shù) φ控制全局抑制水平且興奮度水平被限制在非負數(shù)范圍。

2)直觀的路徑積分

該模型的路徑積分方法是轉(zhuǎn)換現(xiàn)有位姿感知細胞的活性而不是立即將當前活性復制傳遞。該過程使其性能獨立于感知變化更新速率和加速度計速度與陀螺儀角速度，不僅能生成更加準確的無人機飛行軌跡，并且不需要參數(shù)調(diào)整。經(jīng)過路徑積分后，被更新的位姿感知細胞活性為如式(14)所示：

式中： kx′、 ky′、 kθ′是路徑積分常數(shù)；v表示加速度計速度；w表示陀螺儀得到的角速度。

3)仿生聲吶模板修正位姿感知細胞

采用雙耳平滑耳蝸圖作為仿生聲吶模板，局部場景細胞由一個一維細胞陣列組成，每個細胞單元對應一個特定的仿生聲吶模板。在路徑積分時，由于位置和方向上的累計誤差，使用仿生聲吶模板來進行修正。對于每個新的場景，算法會建立新的仿生聲吶模板，同時建立局部場景細胞與位姿感知細胞間的聯(lián)系。進行更新的連接強度如式(16)所示：

式中： Gi為局部場景細胞的活動水平； Px′y′θ′為位姿感知細胞的活動水平；λ表示加權(quán)值。

對于每一個雙耳平滑耳蝸圖使用絕對差值和SAD模塊進行處理產(chǎn)生局部場景。SAD模塊將當前耳蝸圖與模板庫中的耳蝸圖進行比較，通過計算所有模板中耳蝸圖的像素亮度與當前耳蝸圖的像素亮度之差，如式(17)所示：

式中： Ucur表示當前耳蝸圖的像素亮度； Ui表示數(shù)據(jù)庫中的第i個仿生聲吶模板的像素亮度。如果像素亮度之差低于某一閾值 τ，當前耳蝸圖被識別出來，對位姿感知細胞進行校正：

如果像素亮度之差高于某一閾值 τ，當前耳蝸圖成為新的仿生聲吶模板并加入到模板庫中。閾值τ為

式中： nG為數(shù)據(jù)庫中的仿生聲吶模板的數(shù)量； αt為調(diào)整系統(tǒng)的比例因子， αt設置為0.5。

1.3 音頻感知哈希算法修正位姿細胞

1)音頻感知哈希

音頻感知哈希是音頻數(shù)據(jù)集到音頻感知摘要集的單向映射,將具有相同感知內(nèi)容的音頻數(shù)字表示唯一地映射為一段數(shù)字摘要。映射關系為PH，如式(20)所示, ph感知哈希(perceptual hash)：

生成的數(shù)字摘要稱為感知哈希(perceptual hash)。在感知哈希映射作用下，音頻信息間主觀測度下的感知距離轉(zhuǎn)化為感知哈希間的客觀可計算的數(shù)學距離 n ∈N。

2)音頻感知哈希的生成

仿生聲吶系統(tǒng)將收集到的音頻信號B作為感知哈希函數(shù)的輸入，使用一組具有8通道的Gammatone濾波器進行濾波，將濾波后的的數(shù)據(jù)根據(jù)頻帶高低進行排序，由低到高分別為 S1,S2,···,S8。使用Gammatone耳蝸能量譜來對回波信號的時頻特性進行表示。將每一個頻帶的數(shù)據(jù){,,···,}實行90%重疊后進行分幀，每幀20 ms(即

80個采樣點)，矩陣W作為能量譜矩陣，對于能量譜矩陣里每一個元素 W(n,L),如式(21)所示：

式中： Δ2Qk是 對 Qk做 二階差分， Rk長度為6。最后對得到的結(jié)果實行二值化處理，音頻感知哈希Y如式(23)所示。

式中：音頻感知哈希生成過程如圖2所示。

圖2 音頻感知哈希生成Fig.2 Audio perception Hashi generation

3)音頻感知哈希模板修正

對于每個新的場景，算法會建立新的音頻感知哈希模板。同時建立音頻感知哈希與位姿感知細胞間的聯(lián)系。進行更新的連接強度如式(24)所示：

式中： Yi指的是第i個音頻感知哈希模板。這里采用誤碼率P=Vi/V來衡量任意二個音頻感知哈希之間的相似水平，V表示待識別音頻感知哈希碼元個數(shù)，Vi表示模板庫中的音頻感知哈希進行對比時出現(xiàn)錯誤的個數(shù)。將當前音頻感知哈希和數(shù)據(jù)庫中音頻感知哈希進行對比，若低于閾值 γ則

對位姿感知細胞進行修正：

如果高于閾值 γ，當前音頻感知哈希成為新的音頻感知哈希模板并加入到音頻感知哈希模板庫中。

1.4 經(jīng)歷圖的構(gòu)建與校正

每個經(jīng)驗 exi,yi,θi= 〈Ei,Pxi,yi,θi,Yi,Gi〉關聯(lián)經(jīng)驗能級Ei， 位姿細胞 Pxi,yi,θi和局部場景細胞 Gi，與音頻感知哈希模板 Yi，第i個經(jīng)驗如式(26)所示：

當前位姿感知細胞的活性或當前的音頻感知哈希決定經(jīng)驗能級 Ei的各組成要素，如式(27)所示。

使用當前位姿信息、音頻感知哈希和仿生聲吶模板與經(jīng)歷圖進行匹配時，當?shù)竭_經(jīng)驗過的地方時，進行一次閉環(huán)檢測，并對經(jīng)歷圖進行校正，經(jīng)驗位姿改變?nèi)缡?28)所示：

式中：α為校正常數(shù)， Nf為經(jīng)驗i到其他經(jīng)驗的連接數(shù)， Nt為從其他經(jīng)驗到經(jīng)驗i的連接數(shù)。

2 實驗與分析

2.1 硬件平臺數(shù)據(jù)處理

本文是通過I2C協(xié)議來讀取MPU6050數(shù)據(jù)，獲取的傳感器數(shù)據(jù)經(jīng)過預處理后，經(jīng)過互補濾波算法進行數(shù)據(jù)融合，通過姿態(tài)解算獲取四旋翼飛行器的姿態(tài)角與位置，由SPI總線將數(shù)據(jù)發(fā)送到定高飛行的無人機控制器。使用氣壓計MES5611來獲取氣壓數(shù)據(jù)。因為氣壓值與海拔高度成固定的比例，通過氣壓計數(shù)據(jù)轉(zhuǎn)換為海拔高度：

式中：Alt是海拔高度，m； P0為1 013.25 hPa.

通過3個超聲波換能器作為蝙蝠的耳朵和嘴，3個超聲波換能器按照“一字型”進行排列?！岸狈謩e將采集的信息通過信號接收電路，經(jīng)過AD芯片轉(zhuǎn)換為數(shù)字信號傳遞給四旋翼飛行器的STM32主控芯片；STM32主控芯片發(fā)出信號，經(jīng)過信號處理電路后使用“嘴”發(fā)出聲波，仿生聲吶系統(tǒng)采集音頻信號并傳輸給上位機獲得左右耳蝸圖。

2.2 音頻感知哈希構(gòu)建基礎

圖3表示為2組不同回波信號的Gammatone耳蝸能量譜。分別含有了3段回波信號的最初版本、帶噪聲版本、高斯平滑處理版本。耳蝸能量譜的縱軸表示不同的頻帶，橫軸表示不同時間，能量值越高對應的顏色也相應較深。由圖3可以發(fā)現(xiàn)，兩組音頻信號獲得的能量譜具有很大的不同，而相同音頻雖然經(jīng)過不同的處理，但是相鄰頻帶間能量差異依然沒有較大改變。所以可以通過耳蝸能量譜進行特征提取構(gòu)建音頻感知哈希。

圖3 最初音頻和處理后的音頻耳蝸能量譜比較Fig.3 Comparison of the energy spectrum between the initial and the processed audio cochlea.

2.3 不同噪音條件下改進算法與原算法的準確率-召回率對比試驗

為了分析不同噪音條件下改進算法與原算法的閉環(huán)檢測的準確率，這里選取典型的兩種噪音，即高斯噪音與椒鹽噪音。設計了外加高斯噪音、椒鹽噪音和未添加噪音下的準確率-召回率對比試驗。選取其中一個耳蝸圖模板，得到不同噪音版本與原始版本的耳蝸圖對比如圖4所示。

圖4 不同噪音版本與原始版本耳蝸圖對比Fig.4 Comparison of different noise versions and original versions of cochlea

為了分析不同噪音對于閉環(huán)檢測準確性的影響，本文使用準確率P、召回率R來分析不同條件下2種算法的性能。其表達式如式(30)、式(31)所示。

式中：TP表示正確識別的閉環(huán)經(jīng)驗單元，F(xiàn)P表示錯誤識別的閉環(huán)經(jīng)驗單元，F(xiàn)N表示未識別的實際閉環(huán)經(jīng)驗單元。BatSLAM算法和基于音頻感知哈希閉環(huán)檢測的BatSLAM算法在不同條件下的準確率、召回率如表1、2所示。

表1 BatSLAM在不同條件下的準確率、召回率Table1 The accuracy and recall rate of BatSLAM under different conditions

表2 基于音頻感知哈希的BatSLAM在不同條件下的準確率、召回率Table2 The accuracy and recall rate of BatSLAM based on audio perception Hashi under different conditions

通過表1、2可得，在無噪音條件下，兩種算法的準確率大體相同分別為99.06%和100%，但是對于召回率，改進后的算法具有明顯提高，未識別的實際閉環(huán)經(jīng)驗單元數(shù)量明顯減少。當噪聲干擾較小時，即高斯噪音，準確率提高程度不太明顯，當噪音干擾較大時，即椒鹽噪音，其準確率具有顯著提高，因為改進后的算法不僅考慮到外觀，而且考慮到相鄰頻帶間的能量差異，從而提高了正確識別的閉環(huán)經(jīng)驗單元數(shù)量。當存在多種噪音時，基于音頻感知哈希的BatSLAM算法具有明顯優(yōu)勢，提高了閉環(huán)檢測的準確率。

2.4 改進算法與原算法經(jīng)歷圖對比實驗

本文首先設計了硬件平臺數(shù)據(jù)處理方案，實現(xiàn)了對MPU6050姿態(tài)數(shù)據(jù)、氣壓計MES5611的數(shù)據(jù)以及音頻數(shù)據(jù)的采集與處理；然后將無人機定高飛行過程中獲取的姿態(tài)數(shù)據(jù)與仿生聲吶系統(tǒng)獲取的音頻數(shù)據(jù)上傳到上位機進行了MATLAB仿真實驗分析，來驗證改進算法的可行性。

選取室外高度為1 m的橢圓形方桌構(gòu)建的環(huán)形空間作為實驗場地，使用GPS獲取位置信息作為基準。無人機分別使用BatSLAM算法和基于音頻感知哈希的BatSLAM算法在暗光條件下以1 m的特定高度進行繞圈實驗，起始點為A，終點為B，圖5和圖6中A與B點代表相同的實際位置。如圖5所示，BatSLAM算法構(gòu)建的經(jīng)歷圖在第一圈時，由于聲吶模板修正，當?shù)竭_終點B時，自動定位到起點A，繼續(xù)導航，當?shù)竭_C點時，由于耳蝸圖在獲取和傳輸過程中會產(chǎn)生各類噪音，僅僅使用SAD處理方法會導致識別出錯，同時因為加速度計與陀螺儀漂移出現(xiàn)了C-D間的誤差偏移，當?shù)竭_D點時，再次識別成功，自動定位到E點，繼續(xù)導航。如圖6所示，將音頻感知哈希算法融合進入的BatSLAM算法，經(jīng)歷圖在第一圈時，由于聲吶模板-音頻感知哈希修正，當?shù)竭_終點B時，自動定位到起點A，繼續(xù)導航，雖然在導航過程會存在各種噪音干擾，但是當使用仿生聲吶模板識別失敗時，自動調(diào)用音頻感知哈希進行修正，因此第二圈軌跡與第一圈基本重合。因為聲吶模板-音頻感知哈希修正不僅考慮到外觀，而且考慮到相鄰頻帶間的能量差異，提高了閉環(huán)檢測的準確性?；谝纛l感知哈希閉環(huán)檢測的BatSLAM算法不僅完成了無人機特定高度和暗光條件下的二維經(jīng)歷圖繪制，而且提高了閉環(huán)檢測準確率，減小了軌跡偏差，改善了經(jīng)歷圖的失真，實現(xiàn)了經(jīng)歷圖優(yōu)化。

圖5 BatSLAM經(jīng)歷圖Fig.5 BatSLAM experience diagram

圖6 基于音頻感知哈希閉環(huán)檢測的BatSLAM經(jīng)歷圖Fig.6 BatSLAM experience graph based on audio perception Hashi closed loop detection

3 結(jié)束語

本文提出的基于音頻感知哈希閉環(huán)檢測的BatSLAM模型不僅實現(xiàn)了無人機特定高度和暗光條件下的二維經(jīng)歷圖繪制，同時改善單獨使用SAD模塊處理所導致二維經(jīng)歷圖失真問題，而且提高了閉環(huán)檢測的準確率，減小了軌跡偏差，從而實現(xiàn)經(jīng)歷圖的優(yōu)化?；诒舅惴ǖ臒o人機SLAM技術(shù)具有適應性強的優(yōu)勢，可以擺脫對于GPS的依賴，不受光照強度的限制等，可以適用于各種復雜的外界環(huán)境下，如礦洞、樓群間、山區(qū)等。同時具有廣泛的實際應用前景，可以實現(xiàn)無人機自主導航的同時并在固定高度下對農(nóng)作物進行灌溉；模仿蝙蝠在洞穴中躲避空中鐘乳石的原理，實現(xiàn)在室內(nèi)或室外復雜環(huán)境下躲避空中障礙物；實現(xiàn)建筑物特定高度外圍輪廓的的二維經(jīng)歷圖構(gòu)建等。本文僅僅進行了簡單地形環(huán)境下的SLAM二維經(jīng)歷圖的構(gòu)建并證明了算法的合理性與可行性，復雜環(huán)境下的SLAM二維經(jīng)歷圖的構(gòu)建將是接下來的工作重點，正在深入研究中。