室內(nèi)行人航跡推算/超聲波組合定位融合算法
發(fā)布時(shí)間:2021-12-30 09:13
為提高室內(nèi)定位系統(tǒng)精度和跟蹤性能以及適應(yīng)復(fù)雜環(huán)境,將行人航跡推算與超聲波定位組合,提出基于平方根無跡卡曼濾波的噪聲權(quán)因子輔助協(xié)方差加權(quán)融合算法,并將全局最優(yōu)融合狀態(tài)作為反饋量引入算法。針對(duì)超聲波對(duì)行人航向角測(cè)量困難,采用一種簡單有效的幾何方法。仿真結(jié)果表明:在模擬的室內(nèi)動(dòng)態(tài)環(huán)境中,包括在多路徑效應(yīng)和慣性累積誤差的影響下,融合算法始終比單模型定位精度高,并有很好的收斂性、穩(wěn)定性與適應(yīng)性,對(duì)室內(nèi)定位技術(shù)研究與應(yīng)用具有重要意義。
【文章來源】:中南大學(xué)學(xué)報(bào)(自然科學(xué)版). 2016,47(05)北大核心EICSCD
【文章頁數(shù)】:11 頁
【部分圖文】:
行人航跡推算模型圖
穿戴式設(shè)備超聲波定位模型圖
浦?k,jx(j=1,2)以及航跡誤差協(xié)方差k,jS(j=1,2)基礎(chǔ)上,由2組定位模型的系統(tǒng)噪聲Q1和Q2的相關(guān)性估計(jì)噪聲權(quán)因子和μ,滿足以下關(guān)系:12FF22FF00;;1iiiiQQQQ(24)F為Frobenius范數(shù),對(duì)于任意矩陣N,F(xiàn)NTdiag(NN)。針對(duì)室內(nèi)動(dòng)態(tài)環(huán)境,通過噪聲權(quán)因子和μ輔助協(xié)方差加權(quán),以滿足系統(tǒng)的實(shí)時(shí)融合效果。同時(shí),為提高系統(tǒng)的跟蹤性與穩(wěn)定性,將上一時(shí)刻的全局最優(yōu)估計(jì)融合狀態(tài)作為反饋量引入算法;谝陨戏治,本文提出了基于SRUKF的噪聲權(quán)因子輔助協(xié)方差加權(quán)融合算法,原理如圖3所示。圖3基于SRUKF的噪聲權(quán)因子輔助協(xié)方差加權(quán)融合算法框圖Fig.3DiagramofnoisepowerfactorsassistingcovarianceweightedbasedonSRUKF下面介紹噪聲權(quán)因子輔助協(xié)方差加權(quán)融合算法具體步驟與策略:2組定位模型k時(shí)刻最優(yōu)航跡狀態(tài)估計(jì)值之差為,12,1,2kkkdxx(25)則k,12d的協(xié)方差矩陣為TT,12,12,1,2,1,2{}{()()}kkkkkkEddExxxxk,1k,2k,12k,21SSSS(26)式中:T,12,210kkSS為2個(gè)估計(jì)的互協(xié)方差。當(dāng)采用SRUKF濾波器對(duì)定位模型進(jìn)行狀態(tài)估計(jì)時(shí),互協(xié)方差k,12S可由下式求出:,1,2,12122kkkIKKSHHT121,121212()()()k+S+Q+QT,1,2122kkIKKHH(27)其中:k,jK(j=1,2)為SRUKF濾波器增益;為狀態(tài)轉(zhuǎn)移矩陣;Q為系統(tǒng)過程噪聲方差矩陣;H為觀測(cè)矩
【參考文獻(xiàn)】:
期刊論文
[1]室內(nèi)定位技術(shù)及應(yīng)用綜述[J]. 趙銳,鐘榜,朱祖禮,馬樂,姚金飛. 電子科技. 2014(03)
[2]基于多模型航跡質(zhì)量的融合算法[J]. 張偉,王澤陽,張可. 計(jì)算機(jī)科學(xué). 2013(02)
[3]室內(nèi)定位技術(shù)及系統(tǒng)比較研究[J]. 張凡,陳典鋮,楊杰. 廣東通信技術(shù). 2012(11)
[4]基于平方根UKF的多傳感器融合再入段目標(biāo)跟蹤研究[J]. 司學(xué)慧,李小兵,張彥,喬朋朋. 系統(tǒng)工程與電子技術(shù). 2012(02)
[5]航跡融合算法在多傳感器融合中的應(yīng)用[J]. 田雪怡,李一兵,李志剛. 計(jì)算機(jī)仿真. 2012(01)
[6]基于推算定位和超聲波定位融合的機(jī)器人自主定位技術(shù)[J]. 原新,王東陽,嚴(yán)勇杰. 海軍工程大學(xué)學(xué)報(bào). 2009(05)
[7]迭代平方根UKF[J]. 成蘭,謝愷. 信息與控制. 2008(04)
[8]組合濾波器在組合導(dǎo)航中的應(yīng)用設(shè)計(jì)[J]. 張志鑫,張峰. 中國慣性技術(shù)學(xué)報(bào). 2008(02)
[9]基于UKF的低成本SINS/GPS組合導(dǎo)航系統(tǒng)濾波算法[J]. 沈忠,俞文伯,房建成. 系統(tǒng)工程與電子技術(shù). 2007(03)
[10]基于無味卡爾曼濾波的多雷達(dá)方位配準(zhǔn)算法[J]. 金宏斌,戴凌燕,徐毓,彭焱. 數(shù)據(jù)采集與處理. 2006(01)
博士論文
[1]多傳感器目標(biāo)跟蹤數(shù)據(jù)融合關(guān)鍵技術(shù)研究[D]. 崔波.西南交通大學(xué) 2012
[2]基于GPS和自包含傳感器的行人室內(nèi)外無縫定位算法研究[D]. 陳偉.中國科學(xué)技術(shù)大學(xué) 2010
碩士論文
[1]UKF算法及其改進(jìn)算法的研究[D]. 劉錚.中南大學(xué) 2009
本文編號(hào):3557899
【文章來源】:中南大學(xué)學(xué)報(bào)(自然科學(xué)版). 2016,47(05)北大核心EICSCD
【文章頁數(shù)】:11 頁
【部分圖文】:
行人航跡推算模型圖
穿戴式設(shè)備超聲波定位模型圖
浦?k,jx(j=1,2)以及航跡誤差協(xié)方差k,jS(j=1,2)基礎(chǔ)上,由2組定位模型的系統(tǒng)噪聲Q1和Q2的相關(guān)性估計(jì)噪聲權(quán)因子和μ,滿足以下關(guān)系:12FF22FF00;;1iiiiQQQQ(24)F為Frobenius范數(shù),對(duì)于任意矩陣N,F(xiàn)NTdiag(NN)。針對(duì)室內(nèi)動(dòng)態(tài)環(huán)境,通過噪聲權(quán)因子和μ輔助協(xié)方差加權(quán),以滿足系統(tǒng)的實(shí)時(shí)融合效果。同時(shí),為提高系統(tǒng)的跟蹤性與穩(wěn)定性,將上一時(shí)刻的全局最優(yōu)估計(jì)融合狀態(tài)作為反饋量引入算法;谝陨戏治,本文提出了基于SRUKF的噪聲權(quán)因子輔助協(xié)方差加權(quán)融合算法,原理如圖3所示。圖3基于SRUKF的噪聲權(quán)因子輔助協(xié)方差加權(quán)融合算法框圖Fig.3DiagramofnoisepowerfactorsassistingcovarianceweightedbasedonSRUKF下面介紹噪聲權(quán)因子輔助協(xié)方差加權(quán)融合算法具體步驟與策略:2組定位模型k時(shí)刻最優(yōu)航跡狀態(tài)估計(jì)值之差為,12,1,2kkkdxx(25)則k,12d的協(xié)方差矩陣為TT,12,12,1,2,1,2{}{()()}kkkkkkEddExxxxk,1k,2k,12k,21SSSS(26)式中:T,12,210kkSS為2個(gè)估計(jì)的互協(xié)方差。當(dāng)采用SRUKF濾波器對(duì)定位模型進(jìn)行狀態(tài)估計(jì)時(shí),互協(xié)方差k,12S可由下式求出:,1,2,12122kkkIKKSHHT121,121212()()()k+S+Q+QT,1,2122kkIKKHH(27)其中:k,jK(j=1,2)為SRUKF濾波器增益;為狀態(tài)轉(zhuǎn)移矩陣;Q為系統(tǒng)過程噪聲方差矩陣;H為觀測(cè)矩
【參考文獻(xiàn)】:
期刊論文
[1]室內(nèi)定位技術(shù)及應(yīng)用綜述[J]. 趙銳,鐘榜,朱祖禮,馬樂,姚金飛. 電子科技. 2014(03)
[2]基于多模型航跡質(zhì)量的融合算法[J]. 張偉,王澤陽,張可. 計(jì)算機(jī)科學(xué). 2013(02)
[3]室內(nèi)定位技術(shù)及系統(tǒng)比較研究[J]. 張凡,陳典鋮,楊杰. 廣東通信技術(shù). 2012(11)
[4]基于平方根UKF的多傳感器融合再入段目標(biāo)跟蹤研究[J]. 司學(xué)慧,李小兵,張彥,喬朋朋. 系統(tǒng)工程與電子技術(shù). 2012(02)
[5]航跡融合算法在多傳感器融合中的應(yīng)用[J]. 田雪怡,李一兵,李志剛. 計(jì)算機(jī)仿真. 2012(01)
[6]基于推算定位和超聲波定位融合的機(jī)器人自主定位技術(shù)[J]. 原新,王東陽,嚴(yán)勇杰. 海軍工程大學(xué)學(xué)報(bào). 2009(05)
[7]迭代平方根UKF[J]. 成蘭,謝愷. 信息與控制. 2008(04)
[8]組合濾波器在組合導(dǎo)航中的應(yīng)用設(shè)計(jì)[J]. 張志鑫,張峰. 中國慣性技術(shù)學(xué)報(bào). 2008(02)
[9]基于UKF的低成本SINS/GPS組合導(dǎo)航系統(tǒng)濾波算法[J]. 沈忠,俞文伯,房建成. 系統(tǒng)工程與電子技術(shù). 2007(03)
[10]基于無味卡爾曼濾波的多雷達(dá)方位配準(zhǔn)算法[J]. 金宏斌,戴凌燕,徐毓,彭焱. 數(shù)據(jù)采集與處理. 2006(01)
博士論文
[1]多傳感器目標(biāo)跟蹤數(shù)據(jù)融合關(guān)鍵技術(shù)研究[D]. 崔波.西南交通大學(xué) 2012
[2]基于GPS和自包含傳感器的行人室內(nèi)外無縫定位算法研究[D]. 陳偉.中國科學(xué)技術(shù)大學(xué) 2010
碩士論文
[1]UKF算法及其改進(jìn)算法的研究[D]. 劉錚.中南大學(xué) 2009
本文編號(hào):3557899
本文鏈接:http://sikaile.net/kejilunwen/dianzigongchenglunwen/3557899.html
最近更新
教材專著