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