<menuitem id="v539z"></menuitem>
    <menuitem id="v539z"></menuitem>
    <ins id="v539z"><track id="v539z"><mark id="v539z"></mark></track></ins>

    <font id="v539z"><dl id="v539z"><nobr id="v539z"></nobr></dl></font>

        <thead id="v539z"><rp id="v539z"></rp></thead>

          <del id="v539z"><track id="v539z"></track></del>

          <var id="v539z"><pre id="v539z"><listing id="v539z"></listing></pre></var>

            新聞中心

            EEPW首頁 > 手機與無線通信 > 設計應用 > 基于Wi-Fi指紋定位的智能車仿生聲納SLAM算法研究

            基于Wi-Fi指紋定位的智能車仿生聲納SLAM算法研究

            作者:胡文超,閆肖梅,陳信強,閆偉,崔坤利(奇瑞新能源汽車股份有限公司,安徽 蕪湖 241000)時間:2021-04-08來源:電子產品世界收藏
            編者按:針對基于SLAM技術智能車在室內構建二維經驗圖優化問題,在RatSLAM的基礎上,采用仿生聲納系統代替視覺傳感器的BatSLAM模型和Wi-Fi指紋定位,實現室內的二維經驗圖優化。本文在BatSLAM的基礎上,使用Wi-Fi指紋定位技術,離線階段構建指紋數據庫,在線階段使用K加權近鄰算法實現在線指紋匹配,提高定位的準確性和精度,從而改善經驗圖的失真問題。


            本文引用地址:http://www.kfyj19.com/article/202104/424273.htm

            摘要

            仿真實驗表明,采用基于的BatSLAM模型,不僅實現了室內二維經驗圖的構建,而且提高了定位的準確性和精度,改善經驗圖的失真問題,實現經驗圖的優化效果。

            引言

            (Simultaneous Location and Mapping,SLAM) 就是運動載體利用自身攜帶的傳感器獲得周圍環境的地圖,同時確定自己在地圖中的位置[1]在很多領域得到了大量應用,例如室內進行快遞的運送,餐廳內食物的傳送等,均使用了SLAM技術。

            SLAM問題應用最成功的是概率的方法,如卡爾曼濾波算法,擴展卡爾曼濾波算法,粒子濾波算法[2]等。雖然有些傳統的SLAM算法使用聲納傳感器采集信息,但是更多被視覺傳感器[3]、激光測距傳感器[4]所替代。使用聲納傳感器采集信息,常常得到的是周圍環境的粗略信息。生物聲納,能夠實現在復雜的環境下的定位和導航,因為它從回聲中提取更多的信息,可以模仿蝙蝠聲納的發射與接收過程,利用實現復雜環境下的定位與導航。

            概率方法廣泛應用于SLAM的同時,澳大利亞昆士蘭大學Michael等提出了一種基于復合位姿表征的嚙齒動物海馬區擴展模型(RatSLAM)[5]。RatSLAM的路徑積分是通過里程計獲取速度與角度信息,同時使用視覺傳感器對里程計得到的信息進行修正與更新,繪制精確的經驗圖。文獻[6]已經證明在RatSLAM基礎上,可以使用仿生聲納模板來代替RatSLAM系統中的視覺模板,用雙耳平滑耳蝸圖來代替視覺圖像,使用BatSLAM模型來構建二維經驗圖。

            科學技術在不斷發展,目前提高定位精度的方法越來越多,當前主流定位技術主要是無線局域網(Wi-Fi)、藍牙、慣性定位等。文獻[7]提出了基于RSSI的室內定位技術來解決當前定位系統中成本高、定位精度低、不能適應室內環境多樣性等問題。文獻[8]提出了在RSSI技術的基礎上引入TOA(Time of Arrive,到達時間)技術,從而實現基于TOA的指紋定位系統,利用無線信號的連續性改進定位精度。

            本文將BatSLAM與相結合,通過提高定位的準確性和精度,改善經驗圖的失真問題,實現經驗圖的優化效果。

            1   算法原理與設計

            本文設計了1種可以提高室內定位精度的改進仿生聲納SLAM的算法,在原有的BatSLAM的基礎上,使用Wi-Fi指紋模板對位姿細胞進行輔助修正,從而提高定位精度。首先使用所設計的仿生聲納硬件系統來采集智能車接收到的回波信息,對采集到的回波信息進行處理后,將耳蝸能量譜作為仿生聲納模板,構建的仿生聲納模板生成局部場景細胞。智能車的位姿狀態用位姿感知細胞進行表示。利用智能車的里程計和轉角傳感器來不斷更新位姿感知細胞,利用局部場景細胞來實現對位姿細胞的修正,當仿生聲納模板識別失敗時,此時使用Wi-Fi指紋模板來實現位姿細胞的修正。本文首先使用仿生聲納模板進行修正,輔助使用Wi-Fi指紋模板修正,不但可以提高定位精度,而且可以實現經驗圖的優化。

            改進后的仿生聲納SLAM定位算法的結構框圖如圖1所示。

            1617862681586606.png

            圖1 改進后的仿生聲納SLAM算法的結構框圖

            1.1 采集回波信號

            蝙蝠在進化過程中形成了完善的聲納系統。該系統中必不可少的是發聲系統和聽覺系統。連續發射頻率可調(CTFM)聲納是1種寬帶主動式聲學探測方式,在機器人導航,以及導盲等領域得到廣泛應用。從仿生學的角度模仿蝙蝠的嘴巴和耳朵,利用CTFM模型構建來進行聲納信號的發射和數據采集。仿生聲納系統主要由信號發生模塊,回波采集模塊組成。

            1.1.1 信號發生模塊

            仿生聲納系統的關鍵是模仿蝙蝠聲納脈沖來設計適應于該系統的探測波源。基于STM32可以快捷地構造所需波形。信號發生器使用直接數字式(DDS),首先對波形進行采樣,將采樣后得到的數據點進行量化并存入存儲器,將存儲其中地址對應的波形數據點,通過DAC轉換成模擬量進行輸出[8]。

            蝙蝠發出的聲音信號,脈沖主要分為3種類型:恒頻(CF)、調頻(FM)和復頻(CF-FM)。在對生物聲納探測的研究過程中,CF脈沖和FM脈沖的使用最為普遍。CF脈沖持續時間長,具有能量值大的優點,適合對目標的遠距離探測。FM脈沖屬于寬頻帶脈沖,頻率一般由高到低,適合對近距離物體的識別和定位。為獲得偵測、識別和定位的能力,蝙蝠很多時候發出的脈沖是由CF和FM的混合而成。CF脈沖的頻率為c,具有長度和發送速度可調的特性。FM脈沖頻率為(c-d)-(c+d)(c>d),頻率隨時間線性變換。為更加符合蝙蝠啁啾脈沖的特征,將FM脈沖的幅值進行半波調制。FM脈沖的函數表達式如式(1)所示。

            image.png(1)

            其中, 為(c+d),a為頻率相對于時間的變換率,T為脈沖時間長度。這2種波形通過STM32的DA芯片轉換成模擬量,經過電壓放大與驅動電路后使用超聲波換能器進行輸出。

            1.1.2 回波采集模塊

            信號發生器發出仿生聲納信號來對前方的障礙物進行檢測,通過超聲波換能器來接收反射波并將反射波信號轉化為電信號,電信號經過信號調理電路進行電壓放大以及濾波處理,通過數模轉換器轉換為數字信號送至STM32,STM32接收到的回波信號分別為 1617863196913635.png1617863249277896.png

            1.2 仿生聲納模板的構建

            STM32接收到的信號分別為 1617863155192002.png1617863234267516.png 。耳蝸圖作為局部視圖模板,其構建過程如下:對于接收到的信號使用1組Gammachirp濾波器處理,利用Gammachirp聽覺濾波器組來模擬人類耳蝸基底膜,分別得到左耳與右耳的耳蝸能量譜,計算公式如式(2)式(3)所示。

            image.png (2)

            image.png (3)

            其中 ,image.png ,1617863333220651.png 分別為左耳與右耳耳蝸能量譜,image.png 為一階低通濾波,。

            在使用耳蝸譜作為仿生聲納模板時,這里使用高斯濾波器進行平滑處理,進一步排除細小位置改變帶來的影響。2個平滑和二次采樣的單聲道耳蝸圖連接起來,形成1個雙耳耳蝸圖如式(4)所示。

            image.png   (4)

            其中, 為左側二次采樣耳蝸圖, 為右側二次采樣耳蝸圖, 高斯平滑濾波器。

            使用標準化雙耳平滑耳蝸圖,計算公式如式(5)所示。

            image.png   (5)

            將標準化雙耳平滑耳蝸圖作為當前仿生聲納模版,計算公式如式(6)所示。

            image.png   (6)

            1.3 位姿感知細胞

            智能車到達室內具體位置時,其處于空間中的位姿感知細胞網絡(X,Y和Θ)中。此時會利用連續吸引子網絡(CAN)來實時控制智能車在(X,Y和Θ)空間中的活動情況。路徑積分是指通過不斷地獲取智能車的里程計、轉角傳感器的數據以及智能車在(X,Y和Θ)空間中的位姿變化情況來的實現位姿感知細胞的更新,并且利用生成的仿生聲納模板來實現位姿感知細胞的位姿修正。

            1.3.1 CAN模型

            位姿細胞內部動態過程主要包括興奮度更新,對所有細胞的全局抑制。使用1個三維離散高斯分布來創建興奮度權重矩陣,如式(7)所示。

            image.png    (7)

            其中,km,kn  分別表示位置與方向的常數。a 、b 、c 為 x`、y` 、Θ` 的分布系數;

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

            image.png    (8)

            其中Nx`,Ny` , Nθ`, 為 空間中的位姿感知細胞三維矩陣元素。對于位姿感知細胞的活動變化的全局抑制如式(9)所示。

            image.png    (9)

            其中km,kn抑制常數φ控制全局抑制水平,且興奮度水平被限制在非負數范圍。

            1.3.2 路徑積分

            路徑積分主要對位姿感知細胞活性進行更新。路徑積分令位姿感知細胞的性能可以獨立于感知變化速率和里程計速度與角速傳感器獲取的角速度,不但可以獲取較為準確的智能車運行軌跡,而且不需要改變具體的參數。通過路徑積分,位姿感知細胞活性得到更新如式(10)所示。

             image.png   (10)

                   其中image.png為在x` ,y` ,θ` 方向被四舍五入后的整數偏差image.png由式(11)計算得到。

            image.png    (11)

            其中image.png 是路徑積分常數,v表示加速度計速度,w表示陀螺儀得到的角速度。

            1.3.3 仿生聲納模板修正位姿感知細胞

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

            image.png   (12)

            其中,Gi為局部場景細胞的活動水平,image.png為位姿感知細胞的活動水平。

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

            image.png   (13)

            其中, 表示當前耳蝸圖的像素亮度, 表示數據庫中的第i個仿生聲納模板的像素亮度。如果像素亮度之差低于某一閾值,當前耳蝸圖被識別出來,對位姿感知細胞進行校正,如式(14)所示。

            image.png   (14)

            如果像素亮度之差高于某一閾值 ,當前耳蝸圖成為新的仿生聲納模板并加入到模板庫中。閾值 如式(15)所示。

            image.png   (15)

            其中,nG為數據庫中的仿生聲納模板的數量,αt為調整系統的比例因子,αt設置為0.5。

            1.4 Wi-Fi指紋模版修正位姿感知細胞

            本文所設計算法與傳統的位置指紋定位算法相類似,是將實際環境中的具體位置和Wi-Fi指紋相聯系,具體的位置與特定的Wi-Fi指紋相對應。本文選取的Wi-Fi指紋特征是具體位置檢測得到的基站信號的RSS(信號接收強度)。基于RSS(信號接收強度)的Wi-Fi指紋定位算法主要包括離線采集階段和在線定位階段。

            1.4.1離線訓練階段

            離線訓練階段的主要工作是完成離線指紋數據庫的構建,主要包括3個部分:選取參考點、采集指紋、構建指紋數據庫。首先繪制出室內環境的地圖,接下來合理的選取進行測試的參考點,同時對各個參考點接收到的不同AP(無線接入點)的RSSI(信號接收強度的平均值)進行統計,不同AP的RSSI作為參考點的特征,并將其記錄在Wi-Fi指紋數據庫中。

            離線指紋數據庫的具體構建過程:在Wi-Fi裝置調試完成后首先設置N個AP,接下來在室內環境中保持相同的距離設置參考點,共設置w個參考點,參考點的坐標為 ,最后在每個參考點上采集不同AP的RSSI,并且將每個AP的均值存儲于Wi-Fi指紋模板數據庫中,Wi-Fi指紋數據庫如式(16)所示:

            image.png   (16)

            其中, 表示所選取參考點的集合, , 為參考點的位置,參考點的數目為w; 為所設置的無線接入點,即觀測點的集合;N為觀測點的數目, 是Wi-Fi指紋全部均值的集合,如式(17)所示。

            image.png   (17)

            其中,1617868718990057.png為第j個AP在位置Vi處的均值。

            離線階段的原理圖如圖2所示。

            image.png

            圖2 離線訓練階段原理圖

            1.4.2在線定位階段

            在線定位階段主要是利用智能車自身攜帶的通訊設備在室內空間中的具體位置對各個AP的RSSI進行采集,采集完成后使用一定的匹配算法,將采集到的實時數據與離線的Wi-Fi指紋數據庫中的數據進行對比,通過對比可以在離線的Wi-Fi指紋數據庫中得到與實時數據相似的Wi-Fi指紋,從而完成智能車的實時定位,本文采用的在線指紋匹配算法是

            是將采集到的實時數據與離線的Wi-Fi指紋數據庫中的數據進行對比,通過求解采集的實時數據(不同AP的RSSI)與Wi-Fi指紋數據庫中相應AP的RSSI間的歐式距離,然后將匹配獲取的K個與實時定位點相似的Wi-Fi指紋,得到這K個Wi-Fi指紋的位置坐標,并且將這些位置坐標根據相似度屬性給予不同的權重值,最后根據這些權重值對位置坐標進行加權求和,從而獲取最終的定位。如圖所示。

            首先采集到實時的第i個Wi-Fi位置指紋,其與指紋數據庫中的離線Wi-Fi指紋間的歐式距離為Di,如式(18)所示。

            image.png   (18)

            其中,1617868809484700.png是第j個AP在第i個參考點的信號接收強度的平均值, 是實時采集的參考點在第j個AP的信號接收強度的平均值。

            接下來將獲取的 進行排序,得到K個歐式距離最小的參考點,再根據這些參考點的相似度屬性賦予不同的加權系數ui,如式(19)所示。

            image.png    (19)

            最后對這K個參考點進行加權求和,定位坐標如式(20)所示。

            image.png   (20)

            (Xi,Yi)是K個Wi-Fi指紋對應的坐標。在線階段原理圖如圖3所示。

            image.png

            圖3 在線定位階段原理圖

            1.4.3 Wi-Fi指紋模板修正

                   對于每個新的場景,算法會建立新的Wi-Fi指紋模板。同時建立Wi-Fi指紋與位姿感知細胞間的聯系。進行更新的連接強度如式(21)所示。

            image.png   (21)

                   其中,Yi指的是第i個Wi-Fi指紋模板。將當前Wi-Fi指紋和數據庫中Wi-Fi指紋模板進行對比,若低于閾值則對位姿感知細胞進行修正,如式(22)所示。

            image.png   (22)

                   如果高于閾值y,當前Wi-Fi指紋成為新的Wi-Fi指紋模板并加入到Wi-Fi指紋模板庫中。

            1.5 經驗圖的構建與校正

            每個經驗 image.png關聯經驗能級Ei,位姿細胞 Pxi,yi,θi和局部場景細胞 Gi,與Wi-Fi指紋模板 Yi,第i個經驗如式(23)所示。

            image.png   (23)

            當前位姿感知細胞的活性或當前的Wi-Fi 指紋決定經驗能級 Ei的各組成要素,如式(24)所示。

            image.png   (24)

            其中,X`pc ,Y`pc , θ`pc為最大活性姿態細胞坐標;image.png,為與該經驗相關的位姿感知細胞坐標;Ra為(X`,Y`)平面的區域常數;θaθ`維上區域常數:image.png為當前局部場景細胞; Gi為與經驗i相關的局部場景細胞, 為當前的音頻感知哈希, 與經驗i相關的音頻感知哈希。

            使用當前位姿信息、Wi-Fi指紋模板和仿生聲納模板與經驗圖進行匹配時,當到達經驗過的地方時,進行1次閉環檢測,并對經驗圖進行校正,經驗位姿改變如式(25)所示。

            image.png    (25)

            其中, 為校正常數, 為經驗i到其他經驗的連接數; 為從其他經驗到經驗i的連接數。



            上一頁 1 2 下一頁

            評論


            相關推薦

            技術專區

            關閉
            成年片黄网站色大全清风阁 网站地图