• <tr id="yyy80"></tr>
  • <sup id="yyy80"></sup>
  • <tfoot id="yyy80"><noscript id="yyy80"></noscript></tfoot>
  • 99热精品在线国产_美女午夜性视频免费_国产精品国产高清国产av_av欧美777_自拍偷自拍亚洲精品老妇_亚洲熟女精品中文字幕_www日本黄色视频网_国产精品野战在线观看 ?

    一種單目VIO/UWB室內(nèi)組合定位方法

    2023-01-07 08:00:34陳志鍵王思語(yǔ)張宏慶徐愛(ài)功
    導(dǎo)航定位學(xué)報(bào) 2022年6期
    關(guān)鍵詞:單目定位精度測(cè)距

    隋 心,張 杰,陳志鍵,王思語(yǔ),張宏慶,張 聰,徐愛(ài)功

    一種單目VIO/UWB室內(nèi)組合定位方法

    隋 心,張 杰,陳志鍵,王思語(yǔ),張宏慶,張 聰,徐愛(ài)功

    (遼寧工程技術(shù)大學(xué) 測(cè)繪與地理科學(xué)學(xué)院,遼寧 阜新 123000)

    針對(duì)單目視覺(jué)慣性里程計(jì)(VIO)在室內(nèi)環(huán)境下易漂移、定位誤差較大的問(wèn)題,提出了一種基于單目VIO/超寬帶(UWB)組合的室內(nèi)高精度定位方法。該方法結(jié)合單目VIO輸出的位置信息和UWB的測(cè)距信息,利用自適應(yīng)卡爾曼濾波進(jìn)行數(shù)據(jù)融合,考慮到UWB測(cè)距值易受非視距(NLOS)誤差的影響,通過(guò)新息向量構(gòu)建組合系統(tǒng)的抗差模型,以減小異常測(cè)距值對(duì)組合系統(tǒng)的影響,同時(shí)引入薩格-胡薩(Sage-Husa)濾波對(duì)系統(tǒng)噪聲進(jìn)行實(shí)時(shí)估計(jì)和修正。實(shí)驗(yàn)結(jié)果表明該定位方法能夠有效緩解單目VIO的累積漂移和UWB的非視距誤差,相較于基于擴(kuò)展卡爾曼濾波器(EKF)的單目VIO/UWB組合方法,其平面均方根誤差降低了52.3%,有效提高了組合系統(tǒng)的定位精度和魯棒性。

    單目視覺(jué)慣性里程計(jì);超寬帶;自適應(yīng)抗差卡爾曼濾波;非視距;室內(nèi)定位

    0 引言

    隨著時(shí)代的發(fā)展,人們對(duì)于定位精度的要求越來(lái)越高[1]。日常生產(chǎn)生活80%~90%的時(shí)間處于室內(nèi),因此更多的定位導(dǎo)航和位置服務(wù)需求來(lái)自室內(nèi)。室內(nèi)環(huán)境復(fù)雜,采用單一傳感器很難滿(mǎn)足當(dāng)下的定位需求,因此多傳感器組合方式已經(jīng)成為高精度定位領(lǐng)域的研究熱點(diǎn)[2]。由于相機(jī)和慣性測(cè)量單元(inertial measurement unit,IMU)傳感器之間的優(yōu)勢(shì)互補(bǔ)性,基于不同融合方式的視覺(jué)慣性里程計(jì)(visual inertial odometry,VIO)已經(jīng)成為解決此問(wèn)題的主流方法[2]。VIO的融合方式主要分基于濾波和基于優(yōu)化2種方式[3-4]:前者融合框架簡(jiǎn)單,但是線性化誤差較大;后者定位精度更加精確,但是對(duì)硬件計(jì)算力要求較高。盡管VIO在短時(shí)間內(nèi)能夠獲得較高的定位精度,但由于IMU本身定位易發(fā)散以及相機(jī)易受光照、紋理等因素的影響而導(dǎo)致跟蹤失敗,VIO自身誤差會(huì)隨著時(shí)間的推移而累積,進(jìn)而導(dǎo)致定位結(jié)果的累積誤差逐漸變大[5-6],因此需要進(jìn)一步引入其他輔助傳感器來(lái)降低VIO的定位誤差。

    目前常用的室內(nèi)無(wú)線定位技術(shù)有超寬帶(ultra-wide band, UWB)、無(wú)線保真(wireless fidelity, WiFi)、超聲波、藍(lán)牙等[7],其中UWB定位技術(shù)因具有功率譜密度低、脈沖寬度窄、時(shí)間分辨率高的特點(diǎn),能夠獲得較高的測(cè)距精度,從而被廣泛應(yīng)用于室內(nèi)高精度定位[8]。但UWB定位技術(shù)在脈沖信息傳播的過(guò)程中,障礙物的存在會(huì)遮擋UWB的脈沖信號(hào),使信號(hào)在傳播過(guò)程中發(fā)生反射、折射以及穿透的現(xiàn)象,構(gòu)成非視距(none line of sight,NLOS)環(huán)境,形成NLOS誤差,導(dǎo)致UWB定位系統(tǒng)的精度和穩(wěn)定性大幅度降低,嚴(yán)重時(shí)甚至無(wú)法測(cè)距定位[9]。文獻(xiàn)[10]提出了一種將穿墻模型與對(duì)數(shù)衰減模型相融合的UWB測(cè)距值處理方法,減少了信號(hào)在穿墻時(shí)的能量損失,提高了測(cè)距值的準(zhǔn)確性,并通過(guò)最小二乘法減少測(cè)距時(shí)的累計(jì)誤差,提高了UWB的定位精度。文獻(xiàn)[11]提出了一種UWB定位系統(tǒng)自主完好性監(jiān)測(cè)方法,根據(jù)最小二乘位置估計(jì)獲得距離殘差來(lái)構(gòu)建檢驗(yàn)因子,采用基于數(shù)理統(tǒng)計(jì)的卡方檢驗(yàn)進(jìn)行全局檢驗(yàn)以達(dá)到剔除異常測(cè)距值的目的。UWB的定位解算精度和可靠性提升效果明顯。

    綜上分析可知,在室內(nèi)環(huán)境下單獨(dú)依靠VIO或者UWB進(jìn)行定位很難獲得高時(shí)效和高精度的定位結(jié)果,因此,近幾年已有一些專(zhuān)家學(xué)者針對(duì)VIO和UWB的數(shù)據(jù)融合展開(kāi)研究。文獻(xiàn)[12]提出了一種VIO和UWB的緊耦合融合方案,將VIO的測(cè)量數(shù)據(jù)和UWB的量測(cè)數(shù)據(jù)進(jìn)行融合,從而獲得機(jī)器人的位姿。文獻(xiàn)[13]提出了一種利用UWB輔助單目VIO的方法,通過(guò)擴(kuò)展卡爾曼濾波(extend Kalman filter,EKF)進(jìn)行融合解算,以獲得改進(jìn)的無(wú)漂移全局位姿估計(jì)。文獻(xiàn)[14]提出了一種雙目VIO和UWB的松耦合方案,分別利用雙目VIO輸出的位置信息和UWB輸出的位置信息,通過(guò)EKF進(jìn)行數(shù)據(jù)融合得到機(jī)器人的最優(yōu)位置估計(jì),該方案采用的是松耦合的融合方式,組合系統(tǒng)的魯棒性偏低。雖然上述3種融合方案在良好環(huán)境下都能獲得較好的定位結(jié)果,但都并未充分考慮UWB NLOS誤差對(duì)組合系統(tǒng)的影響。因此針對(duì)組合系統(tǒng)存在UWB NLOS誤差影響的問(wèn)題,本文提出了一種基于自適應(yīng)抗差卡爾曼濾波(adaptive robust Kalman filter,ARKF)的單目VIO/UWB室內(nèi)組合定位方法,以期通過(guò)該方法,能夠有效抑制NLOS誤差對(duì)組合系統(tǒng)的影響,提高組合系統(tǒng)的定位精度。

    1 UWB測(cè)距模型及單目VIO定位算法原理

    1.1 TW-TOF測(cè)距模型

    在UWB的測(cè)距模型中,基于信號(hào)雙向傳播時(shí)間(two-way time-of-flight,TW-TOF)的測(cè)距模型既不需要UWB基準(zhǔn)站與流動(dòng)站之間保持時(shí)間同步[15],也不需要UWB基準(zhǔn)站互相之間保持時(shí)間同步,消除了因?yàn)闀r(shí)間不同步所導(dǎo)致的測(cè)距誤差,使得UWB的測(cè)距值更加精確。

    基于TW-TOF的測(cè)距模型是通過(guò)流動(dòng)站發(fā)送脈沖信號(hào)到基準(zhǔn)站產(chǎn)生響應(yīng)脈沖信號(hào)的時(shí)間差來(lái)計(jì)算二者之間的距離,測(cè)距原理如圖1所示。

    圖1 TW-TOF測(cè)距原理示意

    UWB流動(dòng)站與基準(zhǔn)站之間的TW-TOF測(cè)距模型為

    1.2 單目VIO定位算法原理

    單目VIO的代表性算法主要有2種:一種是基于濾波的多狀態(tài)約束擴(kuò)展卡爾曼濾波器(multi-state constraint Kalman filter,MSCKF);另一種是基于非線性?xún)?yōu)化的視覺(jué)慣性狀態(tài)估計(jì)器(visual-inertial state estimator system,VINS)。MSCKF算法在狀態(tài)向量中只能維護(hù)前幾幀相機(jī)位姿,無(wú)法做到利用全局的信息進(jìn)行全局位姿優(yōu)化,而VINS利用滑窗優(yōu)化算法融合預(yù)積分后的IMU測(cè)量值和相機(jī)的特征觀測(cè)值,能夠在短時(shí)間內(nèi)獲得較高精度的定位結(jié)果。因此本文選擇VINS實(shí)現(xiàn)單目VIO定位,VINS框架中單目VIO主要包括以下3個(gè)模塊:

    1)數(shù)據(jù)預(yù)處理。數(shù)據(jù)預(yù)處理主要分為2部分:第一部分是相機(jī)圖像處理,提取圖像哈里斯角點(diǎn),利用金字塔光流法跟蹤相鄰幀,基于隨機(jī)抽樣一致算法去除異常點(diǎn);第二部分是IMU數(shù)據(jù)預(yù)處理,計(jì)算當(dāng)前幀的位姿作為初始值,以及相鄰幀的預(yù)積分增量和預(yù)積分誤差的雅可比矩陣及協(xié)方差。

    2)初始化。初始化模塊分為相機(jī)初始化和相機(jī)慣導(dǎo)聯(lián)合初始化:相機(jī)初始化主要是計(jì)算滑動(dòng)窗口內(nèi)所有幀的位姿和路標(biāo)點(diǎn)的深度;相機(jī)慣導(dǎo)聯(lián)合初始化主要是利用旋轉(zhuǎn)約束估計(jì)陀螺儀的零偏,利用平移約束估計(jì)重力以及尺度初始值,求解世界坐標(biāo)系和初始相機(jī)坐標(biāo)系的外參矩陣。

    3)后端非線性?xún)?yōu)化。VINS后端優(yōu)化采用的是基于滑動(dòng)窗口的光束法平差(bundle adjustment,BA)優(yōu)化。優(yōu)化模型主要分為3個(gè)部分:第一部分是由于滑動(dòng)窗口刪除位姿和特征點(diǎn)約束所引起的先驗(yàn)殘差部分;第二部分是預(yù)積分所引起的IMU殘差部分;第三部分是視覺(jué)重投影誤差所引起的視覺(jué)殘差部分。優(yōu)化變量為

    2 單目VIO/UWB組合定位算法

    根據(jù)上述UWB測(cè)距模型和單目VIO定位算法原理,本文首先采用機(jī)器人操作系統(tǒng)(robot operating system, ROS)時(shí)間標(biāo)簽和四參數(shù)轉(zhuǎn)換模型對(duì)不同傳感器之間進(jìn)行時(shí)空同步,然后基于ARKF算法將UWB輸出的測(cè)距信息和單目VIO輸出的位置信息進(jìn)行融合,進(jìn)而獲得高精度和高穩(wěn)定性的定位結(jié)果。單目VIO/UWB組合系統(tǒng)定位算法流程如圖2所示。

    圖2 單目VIO/UWB組合定位系統(tǒng)流程

    2.1狀態(tài)模型構(gòu)建

    在室內(nèi)定位中,平面定位的需求多于高程定位[16],且對(duì)平面定位精度要求更高,所以本文單目VIO/UWB組合系統(tǒng)采用平面定位,利用ARKF算法進(jìn)行融合解算,獲得整個(gè)組合系統(tǒng)的位置更新。單目VIO/UWB組合系統(tǒng)的更新模型為

    單目VIO/UWB組合系統(tǒng)的狀態(tài)方程為

    2.2 量測(cè)模型構(gòu)建

    單目VIO/UWB組合系統(tǒng)的觀測(cè)模型為:

    對(duì)式(5)、式(6)進(jìn)行線性化可得:

    則單目VIO/UWB組合系統(tǒng)的量測(cè)方程為

    2.3 自適應(yīng)抗差卡爾曼濾波

    由式(4)和式(9)可知,本文的VIO/UWB組合系統(tǒng)是線性系統(tǒng),其標(biāo)準(zhǔn)卡爾曼濾波算法預(yù)測(cè)過(guò)程為

    更新過(guò)程為

    3 實(shí)驗(yàn)與結(jié)果分析

    3.1 實(shí)驗(yàn)平臺(tái)

    實(shí)驗(yàn)過(guò)程中首先將相機(jī)、IMU、UWB、棱鏡固定在組合定位實(shí)驗(yàn)平臺(tái)上,通過(guò)外參標(biāo)定完成空間坐標(biāo)系的統(tǒng)一。組合定位實(shí)驗(yàn)平臺(tái)如圖4所示。數(shù)據(jù)采集及處理所采用的電腦系統(tǒng)均為利努克斯(Linux)系統(tǒng)烏本圖(Ubuntu)18.04版本,單目相機(jī)、IMU、UWB所采集的數(shù)據(jù)均采用ROS時(shí)間標(biāo)簽進(jìn)行時(shí)間同步。

    圖4 單目VIO/UWB組合定位實(shí)驗(yàn)平臺(tái)

    本次實(shí)驗(yàn)共采用4個(gè)UWB模塊,3個(gè)作為基準(zhǔn)站使用,1個(gè)固定在組合定位實(shí)驗(yàn)平臺(tái)上作為流動(dòng)站使用。同時(shí)將全站儀架設(shè)在實(shí)驗(yàn)場(chǎng)地的空曠處,使其能夠全過(guò)程觀測(cè)到實(shí)驗(yàn)平臺(tái)的棱鏡,為實(shí)驗(yàn)提供真實(shí)可靠的參考軌跡。如圖5所示,點(diǎn)為實(shí)驗(yàn)平臺(tái)移動(dòng)的起始位置,點(diǎn)、點(diǎn)、點(diǎn)為UWB基準(zhǔn)站的架設(shè)位置,點(diǎn)為全站儀的架設(shè)位置。實(shí)驗(yàn)平臺(tái)以接近勻速的移動(dòng)速度采集數(shù)據(jù),順時(shí)針采集2圈數(shù)據(jù)。實(shí)驗(yàn)時(shí)長(zhǎng)共計(jì)10 min。

    圖5 實(shí)驗(yàn)設(shè)計(jì)示意

    3.2 結(jié)果與分析

    對(duì)實(shí)驗(yàn)過(guò)程中單目VIO采集到的數(shù)據(jù)進(jìn)行解算,將組合定位解算結(jié)果與全站儀的定位結(jié)果進(jìn)行對(duì)比,如圖6所示??梢钥闯觯?jiǎn)文縑IO在移動(dòng)的初期階段,定位精度較高;但隨著時(shí)間的推移,定位軌跡逐漸出現(xiàn)漂移,其中點(diǎn)處的漂移最為嚴(yán)重,最大定位誤差為0.384 m。

    圖6 單目VIO解算軌跡與參考軌跡對(duì)比

    利用單目VIO/UWB-EKF組合模型進(jìn)行參數(shù)解算,將組合定位解算結(jié)果與全站儀定位結(jié)果進(jìn)行對(duì)比,如圖7所示??梢钥闯觯趯?shí)驗(yàn)平臺(tái)移動(dòng)的初始階段,組合系統(tǒng)的定位精度較高,在、、、四點(diǎn)處的漂移明顯減小,整體的移動(dòng)軌跡更加貼近參考軌跡。但由于實(shí)驗(yàn)平臺(tái)在移動(dòng)過(guò)程中受到障礙物的遮擋,導(dǎo)致組合系統(tǒng)存在NLOS誤差的影響,隨著時(shí)間的推移,誤差累積仍然越來(lái)越大,其最大定位誤差為0.269 m。

    圖7 單目VIO/UWB-EKF組合系統(tǒng)軌跡與參考軌跡對(duì)比

    利用單目VIO/UWB-ARKF組合模型進(jìn)行參數(shù)解算,將組合定位解算結(jié)果與全站儀定位結(jié)果進(jìn)行對(duì)比,如圖8所示??梢钥闯?,利用ARKF解算的單目VIO和UWB組合系統(tǒng)的定位精度較好,不僅能夠解決單目VIO在、、、四點(diǎn)處容易出現(xiàn)漂移的問(wèn)題,同時(shí)有效消除了UWB的NLOS誤差對(duì)組合系統(tǒng)的影響,使得組合系統(tǒng)的定位軌跡更加貼近參考軌跡。組合系統(tǒng)的最大定位誤差為0.157 m。

    圖8 單目VIO/UWB-ARKF組合系統(tǒng)軌跡與參考軌跡對(duì)比

    圖9給出了單目VIO、單目VIO/UWB-EKF組合模型和單目VIO/UWB-ARKF組合模型定位誤差的統(tǒng)計(jì)結(jié)果??梢钥闯觯?jiǎn)文縑IO定位誤差隨著時(shí)間逐漸增大,在引入U(xiǎn)WB后,定位精度明顯提高;但由于UWB的NLOS誤差的存在,對(duì)組合系統(tǒng)的定位精度仍然存在較大影響。而ARKF算法的引入有效抑制了UWB的NLOS誤差的影響,提高了組合系統(tǒng)的定位精度和魯棒性。

    圖9 單目VIO、單目VIO/UWB-EKF、單目VIO/UWB-ARKF定位誤差

    表1 3種定位方法誤差統(tǒng)計(jì) m

    4 結(jié)束語(yǔ)

    針對(duì)單目VIO在室內(nèi)環(huán)境下易漂移、定位誤差較大,及UWB測(cè)距值易受NLOS誤差影響的問(wèn)題,本文采用ARKF算法對(duì)UWB原始測(cè)距值和單目VIO所解算的位置信息進(jìn)行融合,根據(jù)新息向量構(gòu)建抗差模型,同時(shí)引入Sage-Husa濾波實(shí)時(shí)估計(jì)并修正系統(tǒng)噪聲協(xié)方差矩陣,有效減小了UWB NLOS誤差對(duì)組合系統(tǒng)的影響,解決了單目VIO在室內(nèi)環(huán)境下定位誤差較大的問(wèn)題,提高了單目VIO/UWB組合系統(tǒng)的魯棒性和定位精度,平均定位精度可達(dá)到亞分米級(jí)。

    [1] XU H, WANG L, ZHANG Y, et al. Decentralized visual-inertial-UWB fusion for relative state estimation of Aerial Swarm[C]//The Institute of Electrical and Electronic Engineers (IEEE). Proceedings of 2020 IEEE International Conference on Robotics and Automation (ICRA). Paris, France: IEEE, 2020: 8776-8782[2022-03-21].

    [2] BENINI A, MANCINI A, LONGHI S. An IMU/UWB/Vision-based extended Kalman filter for mini-UAV localization in indoor environment using 802. 15. 4a wireless sensor network[J]. Journal of Intelligent & Robotic Systems, 2013, 70(1): 461-476.

    [3] NGUYEN T H, NGUYEN T-M, XIE L. Tightly-coupled single-anchor ultra-wideband-aided monocular visual odometry system[C]//The Institute of Electrical and Electronic Engineers (IEEE). Proceedings of 2020 IEEE International Conference on Robotics and Automation (ICRA). Paris, France: IEEE, 2020: 665-671[2022-03-21].

    [4] 楊觀賜, 王霄遠(yuǎn), 蔣亞汶, 等. 視覺(jué)與慣性傳感器融合的SLAM技術(shù)綜述[J]. 貴州大學(xué)學(xué)報(bào)(自然科學(xué)版), 2020, 37(6):1-12.

    [5] BRYSON M, SUKKARIEH S. Building a robust implementation of bearing-only inertial SLAM for a UAV[J]. Journal of Field Robotics, 2007, 24(1/2): 113-143.

    [6] LUTZ P, SCHUSTER M J, STEIDLE F. Visual-inertial SLAM aided estimation of anchor poses and sensor error model parameters of UWB radio modules[C]//The Institute of Electrical and Electronic Engineers (IEEE). Proceedings of 201919th International Conference on Advanced Robotics (ICAR). Montreal, Canada: IEEE, 2019: 739-746[2022-03-21].

    [7] XIA M, XIU C, YANG D, et al. A novel PDR aided UWB indoor positioning method[C]//The Institute of Electrical and Electronic Engineers (IEEE). Proceedings of 2018 Ubiquitous Positioning, Indoor Navigation and Location-Based Services (UPINLBS). Wuhan, China: IEEE, 2018: 1-7[2022-03-21].

    [8] SHI Q, CUI X, LI W, et al. Visual-UWB navigation system for unknown environments[C]//The Institute of Electrical and Electronic Engineers (IEEE). Proceedings of the 31st International Technical Meeting of the Satellite Division of the Institute of Navigation (ION GNSS+ 2018). Miami, American: ION GNSS, 2018: 3111-3121[2022-03-21].

    [9] 徐愛(ài)功, 閆可新, 高嵩, 等. 一種單目視覺(jué)里程計(jì)/UWB組合室內(nèi)定位方法[J]. 導(dǎo)航定位學(xué)報(bào), 2021, 9(5): 82-88.

    [10] 宰昶豐, 郭英, 葉瑾, 等. 基于UWB穿墻定位中NLOS誤差的優(yōu)化方法[J]. 電子測(cè)量技術(shù), 2021, 44(19): 128-133.

    [11] 徐愛(ài)功, 史政旭, 高嵩, 等. 一種UWB定位系統(tǒng)自主完好性監(jiān)測(cè)方法[J]. 導(dǎo)航定位學(xué)報(bào), 2021, 9(6): 9-15.

    [12] NGUYEN T H, NGUYEN T-M, XIE L. Range-focused fusion of camera-IMU-UWB for accurate and drift-reduced localization[J]. IEEE Robotics and Automation Letters, 2021, 6(2): 1678-1685.

    [13] NYQVIST H E, SKOGLUND M A, HENDEBY G, et al. Pose estimation using monocular vision and inertial sensors aided with ultra wide band[C]//The Institute of Electrical and Electronic Engineers (IEEE). Proceedings of 2015 International Conference on Indoor Positioning and Indoor Navigation (IPIN). Banff, Canada: IEEE, 2015: 1-10[2022-03-21].

    [14] 申炳琦, 張志明, 舒少龍. 移動(dòng)機(jī)器人UWB與VIO組合室內(nèi)定位算法[J]. 計(jì)算機(jī)應(yīng)用,2022(1): 1-8.

    [15] 隋心, 高嵩, 黃俊堯, 等. UWB輔助INS的室內(nèi)組合定位方法[J]. 無(wú)線電工程, 2020, 50(8): 624-630.

    [16] LIU H, DARABI H, BANERJEE P, et al. Survey of wireless indoor positioning techniques and systems[J]. IEEE Transactions on Systems, Man, and Cybernetics, Part C (Applications and Reviews), 2007, 37(6): 1067-1080.

    [17] 魏偉, 秦永元, 張曉冬, 等. 對(duì)Sage-Husa算法的改進(jìn)[J]. 中國(guó)慣性技術(shù)學(xué)報(bào), 2012, 20(6): 678-686.

    A monocular VIO/UWB indoor integrated positioning method

    SUI Xin, ZHANG Jie, CHEN Zhijian, WANG Siyu, ZHANG Hongqing, ZHANG Cong, XU Aigong

    (School of Geomatics, Liaoning Technical University, Fuxin, Liaoning 123000, China)

    Aiming at the problems of monocular visual inertial odometry (VIO) easy to drift and large positioning error in indoor environment, this paper proposes an indoor high-precision positioning method based on monocular VIO/ultra-wide band (UWB) integration. This method integrates position information output by VIO and the ranging information about (UWB), and uses adaptive kalian filter for data fusion. Considering that the UWB ranging value is susceptible to non line of sight (NLOS) error, the robust model of the integrated system is constructed by the new interest vector to reduce the influence of the abnormal ranging value on the integrated system, and Sage-Husa filter is introduced to estimate and correct the system noise in real time. The experimental results show that the positioning method can effectively alleviate the cumulative drift of monocular VIO and the non-line-of-sight error of UWB. Compared with the monocular VIO/UWB integrated method based on extend Kalman filter (EKF), the root mean square error is reduced by 52.3%, and the positioning accuracy and robustness of the integrated system are effectively improved.

    monocular visual inertial odometry; ultra-wide band; adaptive robust Kalman filtering; non line of sight; indoor positioning

    P228

    A

    2095-4999(2022)06-0001-08

    隋心,張杰,陳志鍵,等. 一種單目VIO/UWB室內(nèi)組合定位方法[J]. 導(dǎo)航定位學(xué)報(bào), 2022, 10(6): 1-8 .(SUI Xin, ZHANG Jie, CHEN Zhijian, et al. A monocular VIO/UWB indoor integrated positioning method[J]. Journal of Navigation and Positioning, 2022, 10(6): 1-8.)

    10.16547/j.cnki.10-1096.20220601.

    2022-04-11

    國(guó)家自然科學(xué)基金項(xiàng)目(42074012);遼寧省重點(diǎn)研發(fā)計(jì)劃項(xiàng)目(2020JH2/10100044);遼寧省“興遼英才計(jì)劃”項(xiàng)目(XLYC2002101,XLYC2008034);遼寧省教育廳基礎(chǔ)研究項(xiàng)目(LJ2020JCL016)。

    隋心(1981—),男,遼寧沈陽(yáng)人,博士,副教授,研究方向?yàn)榛诙鄠鞲衅鲾?shù)據(jù)融合的室內(nèi)外無(wú)縫定位。

    張杰(1995—),男,四川巴中人,碩士研究生,研究方向?yàn)槭覂?nèi)外導(dǎo)航定位。

    猜你喜歡
    單目定位精度測(cè)距
    北斗定位精度可達(dá)兩三米
    軍事文摘(2023年4期)2023-04-05 13:57:35
    類(lèi)星體的精準(zhǔn)測(cè)距
    科學(xué)(2020年3期)2020-01-06 04:02:51
    GPS定位精度研究
    一種單目相機(jī)/三軸陀螺儀/里程計(jì)緊組合導(dǎo)航算法
    組合導(dǎo)航的AGV定位精度的改善
    單目SLAM直線匹配增強(qiáng)平面發(fā)現(xiàn)方法
    淺談超聲波測(cè)距
    電子制作(2017年7期)2017-06-05 09:36:13
    基于CAD模型的單目六自由度位姿測(cè)量
    基于PSOC超聲測(cè)距系統(tǒng)設(shè)計(jì)
    基于單目立體視覺(jué)的三坐標(biāo)在線識(shí)別技術(shù)研究
    久久精品熟女亚洲av麻豆精品| 日韩av免费高清视频| 中文字幕av电影在线播放| 97人妻天天添夜夜摸| 97在线人人人人妻| 国产有黄有色有爽视频| 欧美人与性动交α欧美精品济南到| www.熟女人妻精品国产| 2021少妇久久久久久久久久久| 三上悠亚av全集在线观看| 男女床上黄色一级片免费看| 久久性视频一级片| 精品少妇久久久久久888优播| 国产精品一区二区精品视频观看| 亚洲国产毛片av蜜桃av| 国产成人精品久久久久久| 老司机午夜十八禁免费视频| 国产在视频线精品| 欧美精品高潮呻吟av久久| 国产男女超爽视频在线观看| 一级毛片 在线播放| 啦啦啦中文免费视频观看日本| 日韩中文字幕欧美一区二区 | 久久人人爽av亚洲精品天堂| 亚洲中文字幕日韩| 99re6热这里在线精品视频| 丝袜人妻中文字幕| 男女高潮啪啪啪动态图| 亚洲成人免费电影在线观看 | 啦啦啦中文免费视频观看日本| 久久久精品区二区三区| 国产一区二区激情短视频 | 精品少妇久久久久久888优播| 韩国高清视频一区二区三区| 亚洲精品美女久久av网站| 国产成人影院久久av| 男女边吃奶边做爰视频| 九色亚洲精品在线播放| 1024香蕉在线观看| 99精国产麻豆久久婷婷| 亚洲国产av新网站| 咕卡用的链子| 在线观看一区二区三区激情| av网站免费在线观看视频| 一级片'在线观看视频| 日本欧美国产在线视频| 国产精品久久久av美女十八| 国产伦人伦偷精品视频| 亚洲国产中文字幕在线视频| 国产精品国产三级国产专区5o| 久久久精品免费免费高清| 欧美在线一区亚洲| 青春草亚洲视频在线观看| 秋霞在线观看毛片| 亚洲精品美女久久av网站| 免费观看a级毛片全部| 午夜免费鲁丝| 日韩制服丝袜自拍偷拍| 老汉色av国产亚洲站长工具| 少妇人妻久久综合中文| 91九色精品人成在线观看| 日本五十路高清| 波野结衣二区三区在线| xxx大片免费视频| 免费日韩欧美在线观看| 赤兔流量卡办理| 男女边摸边吃奶| 精品一区在线观看国产| 婷婷成人精品国产| 亚洲av电影在线进入| 菩萨蛮人人尽说江南好唐韦庄| 黄色毛片三级朝国网站| 亚洲伊人色综图| 国产男女超爽视频在线观看| av片东京热男人的天堂| 国产黄色视频一区二区在线观看| 久久精品国产亚洲av涩爱| 男人操女人黄网站| 国精品久久久久久国模美| 狠狠精品人妻久久久久久综合| 亚洲精品美女久久av网站| 国产极品粉嫩免费观看在线| 免费在线观看视频国产中文字幕亚洲 | 每晚都被弄得嗷嗷叫到高潮| 啦啦啦 在线观看视频| 别揉我奶头~嗯~啊~动态视频 | 亚洲精品国产av蜜桃| 19禁男女啪啪无遮挡网站| 麻豆国产av国片精品| 亚洲精品av麻豆狂野| 日韩制服丝袜自拍偷拍| 美女脱内裤让男人舔精品视频| 国产成人欧美在线观看 | 欧美成狂野欧美在线观看| 精品少妇久久久久久888优播| 女人被躁到高潮嗷嗷叫费观| 中文字幕人妻丝袜制服| 国产人伦9x9x在线观看| av线在线观看网站| 国产精品久久久久久人妻精品电影 | 国产成人精品久久二区二区91| 亚洲国产中文字幕在线视频| 建设人人有责人人尽责人人享有的| 国产精品二区激情视频| 亚洲免费av在线视频| 又黄又粗又硬又大视频| 亚洲第一青青草原| 少妇人妻久久综合中文| 97精品久久久久久久久久精品| 亚洲男人天堂网一区| 日本色播在线视频| 精品高清国产在线一区| 男女无遮挡免费网站观看| 日韩一本色道免费dvd| 久久午夜综合久久蜜桃| 乱人伦中国视频| 人体艺术视频欧美日本| 免费av中文字幕在线| 国产日韩欧美视频二区| 一本一本久久a久久精品综合妖精| 亚洲一区二区三区欧美精品| 男男h啪啪无遮挡| 国产日韩欧美亚洲二区| 久久精品成人免费网站| 精品高清国产在线一区| 精品一品国产午夜福利视频| 99精品久久久久人妻精品| 大片免费播放器 马上看| 在线观看人妻少妇| 欧美日韩成人在线一区二区| 欧美日韩国产mv在线观看视频| 国产精品久久久av美女十八| 婷婷色麻豆天堂久久| 亚洲精品久久午夜乱码| 国产在线观看jvid| 男的添女的下面高潮视频| 欧美大码av| 少妇粗大呻吟视频| 国产成人精品久久二区二区91| 国产高清国产精品国产三级| 好男人电影高清在线观看| 免费观看av网站的网址| 久久综合国产亚洲精品| 波多野结衣av一区二区av| 亚洲国产欧美一区二区综合| 日日夜夜操网爽| 天天躁夜夜躁狠狠躁躁| 国产福利在线免费观看视频| 久久久久久久精品精品| 男女午夜视频在线观看| 高清黄色对白视频在线免费看| svipshipincom国产片| 亚洲精品成人av观看孕妇| 19禁男女啪啪无遮挡网站| 日韩大片免费观看网站| 亚洲精品中文字幕在线视频| 看十八女毛片水多多多| 黑人猛操日本美女一级片| 丝袜在线中文字幕| 亚洲九九香蕉| 黄片播放在线免费| 国产精品久久久av美女十八| 别揉我奶头~嗯~啊~动态视频 | 午夜福利视频在线观看免费| 十八禁人妻一区二区| 日日摸夜夜添夜夜爱| 少妇精品久久久久久久| 汤姆久久久久久久影院中文字幕| 一本大道久久a久久精品| 欧美变态另类bdsm刘玥| av片东京热男人的天堂| 亚洲av综合色区一区| 久久女婷五月综合色啪小说| 国产精品一区二区在线不卡| 亚洲国产毛片av蜜桃av| 欧美日韩一级在线毛片| 国产精品久久久久久精品电影小说| 深夜精品福利| 桃花免费在线播放| 免费看av在线观看网站| 亚洲国产精品一区二区三区在线| 国产av国产精品国产| 欧美av亚洲av综合av国产av| 免费观看a级毛片全部| 欧美性长视频在线观看| www.av在线官网国产| 婷婷丁香在线五月| 欧美日韩黄片免| 你懂的网址亚洲精品在线观看| 亚洲精品国产色婷婷电影| 国产爽快片一区二区三区| 亚洲欧美精品自产自拍| 亚洲精品av麻豆狂野| 国产xxxxx性猛交| 在线观看免费日韩欧美大片| 国产老妇伦熟女老妇高清| 国产成人一区二区在线| 成人国产av品久久久| 国产高清国产精品国产三级| 国产一区有黄有色的免费视频| 国产精品偷伦视频观看了| av国产久精品久网站免费入址| 午夜福利乱码中文字幕| 国产成人免费观看mmmm| 久久国产精品影院| 黄频高清免费视频| 欧美久久黑人一区二区| 精品亚洲成a人片在线观看| 亚洲av国产av综合av卡| 超碰成人久久| 高清视频免费观看一区二区| www.av在线官网国产| 啦啦啦啦在线视频资源| 欧美人与性动交α欧美软件| 一本一本久久a久久精品综合妖精| 成人国产av品久久久| 777米奇影视久久| 亚洲精品中文字幕在线视频| 麻豆av在线久日| 丝袜美足系列| 深夜精品福利| 欧美另类一区| 国产在线一区二区三区精| 母亲3免费完整高清在线观看| 我的亚洲天堂| 国产精品国产av在线观看| 午夜老司机福利片| 婷婷成人精品国产| 亚洲人成电影观看| 亚洲国产精品成人久久小说| 成人亚洲欧美一区二区av| 亚洲国产精品一区三区| 欧美av亚洲av综合av国产av| 菩萨蛮人人尽说江南好唐韦庄| 国产精品一二三区在线看| 性色av乱码一区二区三区2| 精品一区二区三区av网在线观看 | 五月天丁香电影| 欧美激情极品国产一区二区三区| 国产日韩一区二区三区精品不卡| 久热这里只有精品99| 久久这里只有精品19| 亚洲精品成人av观看孕妇| 你懂的网址亚洲精品在线观看| 精品少妇久久久久久888优播| 久久狼人影院| 一本—道久久a久久精品蜜桃钙片| 久久久久久免费高清国产稀缺| 久久人妻熟女aⅴ| 久久青草综合色| avwww免费| 国产成人av教育| 一边摸一边做爽爽视频免费| 天天操日日干夜夜撸| 国产成人a∨麻豆精品| 91麻豆精品激情在线观看国产 | 成年人午夜在线观看视频| 成人免费观看视频高清| av在线播放精品| 久久久欧美国产精品| 免费不卡黄色视频| 午夜精品国产一区二区电影| 日本av免费视频播放| 欧美日韩精品网址| 51午夜福利影视在线观看| 日日摸夜夜添夜夜爱| 亚洲视频免费观看视频| 又粗又硬又长又爽又黄的视频| 天天躁夜夜躁狠狠躁躁| 别揉我奶头~嗯~啊~动态视频 | 高清视频免费观看一区二区| 欧美大码av| 欧美在线黄色| 国产一区亚洲一区在线观看| 精品亚洲成a人片在线观看| 别揉我奶头~嗯~啊~动态视频 | 深夜精品福利| 久久久久精品国产欧美久久久 | www.999成人在线观看| 国产亚洲欧美精品永久| 午夜影院在线不卡| 一本色道久久久久久精品综合| 欧美 日韩 精品 国产| 亚洲一区二区三区欧美精品| 色婷婷久久久亚洲欧美| 中文字幕人妻丝袜制服| 亚洲欧美清纯卡通| 人体艺术视频欧美日本| 欧美乱码精品一区二区三区| 国产精品一区二区在线观看99| 黄片播放在线免费| 人人妻人人爽人人添夜夜欢视频| 欧美精品av麻豆av| 国产又色又爽无遮挡免| 国产片内射在线| 久久狼人影院| 国产亚洲欧美精品永久| 精品国产一区二区三区四区第35| 日韩中文字幕视频在线看片| 性色av乱码一区二区三区2| 中文字幕高清在线视频| 亚洲中文av在线| 两个人看的免费小视频| kizo精华| 国产精品一区二区在线不卡| 国产不卡av网站在线观看| 亚洲国产欧美在线一区| 欧美在线黄色| 久久久国产一区二区| 丁香六月天网| 亚洲精品乱久久久久久| 日本五十路高清| bbb黄色大片| 蜜桃国产av成人99| 两性夫妻黄色片| 国产日韩欧美视频二区| 欧美亚洲 丝袜 人妻 在线| 美女国产高潮福利片在线看| 最近最新中文字幕大全免费视频 | 亚洲激情五月婷婷啪啪| 国产黄色视频一区二区在线观看| 日韩av不卡免费在线播放| 男人爽女人下面视频在线观看| 你懂的网址亚洲精品在线观看| 亚洲av片天天在线观看| 黑丝袜美女国产一区| 亚洲,一卡二卡三卡| 人妻一区二区av| 久久久久精品国产欧美久久久 | 五月开心婷婷网| 国产成人av激情在线播放| 久久天堂一区二区三区四区| 中国国产av一级| 午夜免费男女啪啪视频观看| 伦理电影免费视频| kizo精华| 亚洲情色 制服丝袜| 亚洲精品一二三| 多毛熟女@视频| 国产精品香港三级国产av潘金莲 | 亚洲av美国av| 久久综合国产亚洲精品| 老汉色av国产亚洲站长工具| 久久青草综合色| 欧美人与善性xxx| 中国国产av一级| 涩涩av久久男人的天堂| 成年人黄色毛片网站| 亚洲欧美日韩另类电影网站| 一级片免费观看大全| 久久青草综合色| 国产精品久久久人人做人人爽| 多毛熟女@视频| 久久精品aⅴ一区二区三区四区| 一边亲一边摸免费视频| 国产午夜精品一二区理论片| 成人影院久久| 一本一本久久a久久精品综合妖精| 青春草亚洲视频在线观看| 亚洲视频免费观看视频| 久久久久久久久免费视频了| www.999成人在线观看| 我的亚洲天堂| 亚洲中文av在线| 少妇猛男粗大的猛烈进出视频| 国产亚洲欧美在线一区二区| 中文字幕高清在线视频| 国产有黄有色有爽视频| 亚洲一区中文字幕在线| 日韩一本色道免费dvd| 一二三四在线观看免费中文在| 美女大奶头黄色视频| 777久久人妻少妇嫩草av网站| 老鸭窝网址在线观看| 国产精品免费视频内射| 免费人妻精品一区二区三区视频| 亚洲精品中文字幕在线视频| 18禁黄网站禁片午夜丰满| 黑人巨大精品欧美一区二区蜜桃| 日本vs欧美在线观看视频| 国产日韩欧美亚洲二区| 婷婷丁香在线五月| 赤兔流量卡办理| 久久ye,这里只有精品| kizo精华| 国产99久久九九免费精品| 国产在线免费精品| 一区二区三区乱码不卡18| 国产av精品麻豆| 国产在视频线精品| 亚洲av欧美aⅴ国产| 九色亚洲精品在线播放| 久久九九热精品免费| 久久久久久免费高清国产稀缺| 午夜av观看不卡| 中文字幕亚洲精品专区| 国产一区二区在线观看av| 97在线人人人人妻| 18禁裸乳无遮挡动漫免费视频| 国产亚洲av片在线观看秒播厂| 久久久久视频综合| h视频一区二区三区| 久久久精品94久久精品| 亚洲av美国av| 午夜福利视频精品| 免费观看人在逋| 国产精品熟女久久久久浪| 亚洲av欧美aⅴ国产| 亚洲精品成人av观看孕妇| 在线观看免费日韩欧美大片| 午夜精品国产一区二区电影| 成人国产av品久久久| 久久久久久免费高清国产稀缺| 日本色播在线视频| 女人高潮潮喷娇喘18禁视频| 色综合欧美亚洲国产小说| 精品人妻在线不人妻| 国产视频首页在线观看| 亚洲国产日韩一区二区| 美国免费a级毛片| 亚洲av日韩在线播放| 日韩 亚洲 欧美在线| 丝袜人妻中文字幕| 国产欧美日韩一区二区三区在线| 成人国产av品久久久| 悠悠久久av| 国产国语露脸激情在线看| 极品少妇高潮喷水抽搐| 亚洲国产中文字幕在线视频| 欧美人与善性xxx| 91精品伊人久久大香线蕉| 欧美日韩亚洲综合一区二区三区_| 免费在线观看视频国产中文字幕亚洲 | 日韩av在线免费看完整版不卡| 秋霞在线观看毛片| 精品国产乱码久久久久久小说| 日韩制服丝袜自拍偷拍| 可以免费在线观看a视频的电影网站| e午夜精品久久久久久久| 嫩草影视91久久| 亚洲成国产人片在线观看| 精品国产一区二区三区四区第35| 青春草亚洲视频在线观看| 19禁男女啪啪无遮挡网站| 亚洲国产最新在线播放| 母亲3免费完整高清在线观看| 国产亚洲一区二区精品| 久久久精品国产亚洲av高清涩受| 精品国产一区二区三区四区第35| 两个人看的免费小视频| 亚洲av电影在线进入| 老司机亚洲免费影院| 亚洲av国产av综合av卡| 91字幕亚洲| 日韩中文字幕视频在线看片| 亚洲精品一二三| 啦啦啦视频在线资源免费观看| 最近中文字幕2019免费版| 久久久久网色| 国产一区二区三区av在线| 伊人久久大香线蕉亚洲五| 18禁裸乳无遮挡动漫免费视频| 精品人妻在线不人妻| 黄色怎么调成土黄色| 老司机影院毛片| 女性被躁到高潮视频| 亚洲av国产av综合av卡| 欧美+亚洲+日韩+国产| av又黄又爽大尺度在线免费看| 国产不卡av网站在线观看| 啦啦啦在线免费观看视频4| 丝袜美腿诱惑在线| 一二三四在线观看免费中文在| 日本午夜av视频| 日本91视频免费播放| 一级毛片电影观看| av有码第一页| 国产精品久久久久久精品电影小说| 国产精品成人在线| 亚洲精品一区蜜桃| 欧美另类一区| www.av在线官网国产| 人妻人人澡人人爽人人| 久久久亚洲精品成人影院| 一区二区三区激情视频| 久久这里只有精品19| 亚洲国产看品久久| 在线观看国产h片| 99re6热这里在线精品视频| 国产成人精品久久二区二区免费| 亚洲七黄色美女视频| 一级毛片黄色毛片免费观看视频| 日韩 亚洲 欧美在线| 99香蕉大伊视频| 亚洲少妇的诱惑av| 欧美中文综合在线视频| 91精品三级在线观看| av国产久精品久网站免费入址| 久久精品国产亚洲av高清一级| 99热全是精品| 极品人妻少妇av视频| 成年动漫av网址| 丰满迷人的少妇在线观看| 五月开心婷婷网| 亚洲自偷自拍图片 自拍| 日韩av不卡免费在线播放| 老司机靠b影院| 操美女的视频在线观看| 国产主播在线观看一区二区 | 国产精品.久久久| 99国产精品一区二区三区| 18在线观看网站| 丝瓜视频免费看黄片| 啦啦啦在线观看免费高清www| 久久天堂一区二区三区四区| 热re99久久国产66热| 国产成人精品无人区| 亚洲精品在线美女| 在线av久久热| 少妇被粗大的猛进出69影院| 午夜免费鲁丝| 中文字幕人妻丝袜制服| 日韩中文字幕欧美一区二区 | 精品亚洲乱码少妇综合久久| 亚洲精品国产一区二区精华液| 久久久欧美国产精品| 美女福利国产在线| 男女下面插进去视频免费观看| 妹子高潮喷水视频| 老司机午夜十八禁免费视频| 久久精品熟女亚洲av麻豆精品| 免费在线观看日本一区| 久久人妻福利社区极品人妻图片 | 一区在线观看完整版| tube8黄色片| 欧美少妇被猛烈插入视频| 国产一区二区三区综合在线观看| 女性被躁到高潮视频| 午夜av观看不卡| 一个人免费看片子| 9色porny在线观看| 精品国产乱码久久久久久男人| 久久久久国产精品人妻一区二区| 国产麻豆69| 美女中出高潮动态图| 啦啦啦视频在线资源免费观看| 男的添女的下面高潮视频| 男人舔女人的私密视频| 男女高潮啪啪啪动态图| 成在线人永久免费视频| 麻豆乱淫一区二区| 亚洲免费av在线视频| 亚洲男人天堂网一区| av不卡在线播放| 别揉我奶头~嗯~啊~动态视频 | 亚洲精品日韩在线中文字幕| 97在线人人人人妻| 人人澡人人妻人| 最近最新中文字幕大全免费视频 | 久久久国产一区二区| 国产亚洲欧美在线一区二区| 少妇 在线观看| 桃花免费在线播放| www.999成人在线观看| 免费日韩欧美在线观看| 欧美日韩视频精品一区| 成年动漫av网址| 99久久综合免费| 只有这里有精品99| 国产xxxxx性猛交| 99国产精品99久久久久| 久久天躁狠狠躁夜夜2o2o | 高清av免费在线| av有码第一页| 欧美精品亚洲一区二区| 两人在一起打扑克的视频| 欧美人与善性xxx| 曰老女人黄片| 性少妇av在线| 人妻一区二区av| 99国产精品一区二区三区| 精品国产乱码久久久久久小说| 久久毛片免费看一区二区三区| 亚洲欧美清纯卡通| 欧美日韩视频精品一区| h视频一区二区三区| netflix在线观看网站| 国产一区二区三区av在线| 欧美97在线视频| 亚洲国产欧美网| 国产一区二区三区av在线| 日韩 欧美 亚洲 中文字幕| 美女福利国产在线| 亚洲五月婷婷丁香| 久久狼人影院| 99久久综合免费| 欧美精品一区二区免费开放| avwww免费| 精品国产国语对白av| 后天国语完整版免费观看| 成年动漫av网址| 女人爽到高潮嗷嗷叫在线视频| 一区二区三区精品91| 美女午夜性视频免费| 丝袜美足系列| 久久性视频一级片| h视频一区二区三区| 午夜福利影视在线免费观看| av福利片在线| 国产精品久久久人人做人人爽| 高清欧美精品videossex| 国产欧美日韩综合在线一区二区| 国产精品国产av在线观看| 欧美国产精品va在线观看不卡| 国产国语露脸激情在线看|