基于uwb优化配置的室内行人导航方法-曾庆化.pdf

《基于uwb优化配置的室内行人导航方法-曾庆化.pdf》由会员分享，可在线阅读，更多相关《基于uwb优化配置的室内行人导航方法-曾庆化.pdf（6页珍藏版）》请在淘文阁 - 分享文档赚钱的网站上搜索。

1、第25卷第2期2017年04月中国惯性技术学报Journal of Chinese Inertial TechnologyV0125 No2Apr2017文章编号：1 0056734(20 1 7)020 1 86-06 doi：10136958cnki12122203201702009基于UWB优化配置的室内行人导航方法曾庆化1，一，王敬贤1，一，孟骞1，一，熊智1，一，钱伟行3(1南京航空航天大学导航研究中心，南京210016；2卫星通信与导航协同创新中心，南京210016；3南京师范大学电气与自动化工程学院，南京210094)摘要：在卫星信号无法覆盖的室内条件下，行人的精确导航问题是当前

2、研究的热点。为解决基于MEMS的微质性导航系统误差随时间发散、航向角发散快的问题，提出了一种利用UWB辅助修正I质性导航系统，实现室内较高精度定位的方法。该方法采用基于零速修正的微惯导系统进行导航，以抑制惯导误差随时间发散，并在建筑内拐角、楼梯口等关键节点处优化配置UWB设备，采用UWB信息与微惯导数据进行卡尔曼滤波，实现对微惯导航向及位置的修正。与大规模使用UWB系统进行室内定位相比，该方法降低了系统布设成本，避免了UWB出现问题时对整体导航结果的影响，有效地保证了系统的定位精度。行走实验表明：直线行走时，微惯导最终定位误差为18；转弯行走时，在UWB辅助定位下，微惯导最终定位误差小于10。

3、关键词：室内定位；惯性导航系统；超宽带无线技术；组合导航中图分类号：U6661 文献标志码：AIndoor pedestrian navigation method based on optimal allocation of UWBZENG Qinghual，一，WANG Jingxianl，MENG Qianl。，XIONG Zhil。，QIAN Weixin93(1Navigation Research Center,Nanjiing University ofAeronautics and Astronautics，Nanjing 210016，China；2Satellite Com

4、munication and Navigation Collaborative Innovation Center,Nanjing 210016，China；3School ofElectrical and Automation Engineering，Nanjing Normal University,Nanjing 210094，China)Abstract：In view that the heading and positioning errors of the MEMS microinertial navigation system isdivergent with time，a m

5、ethod for realizing the indoor high precision pedestrian positioning system is putforward based on an ultra-wideband-aided microinertial navigation systemA microinertial navigation systembased on zero velocity update is adopted to suppress the divergence of inertial navigation error with timeTheUWB(

6、Ultrawideband)equipment is optimally installed in key areas ofthe building，and a Kalman filter is usedto modify the direction and the position of the micro-inertial navigation system With the help of the I肿signaland the inertial navigation dataCompared with the method based on a large number of UWB

7、devices，theproposed method has such advantages as high positioning accuracy，low cost，high autonomy,etcMeanwhile，this method Can avoid the poor I MB informationS influences on the overall navigation resultsThe walkingexperiments indicate that the final positioning error of the micro-inertial navigati

8、on system iS 18in the 1inearwalkingand the final positioning error is less than 10when assisted with the I，WB in the turning walkingKey words：indoor positioning；inertial navigation；ultrawideband radio technology；integrated navigation基于卫星定位的行人导航系统已广泛应用于定位领域1，由于卫星信号容易被建筑物阻隔，产生多路径、非视距、时变性等问题，因此卫星导航接收机很

9、难实现室内的高精度定位应用。美国Draper实验室于收稿日期：基金项目：作者简介：20世纪末提出将惯性测量器件安装在人体的足部实现人体定位功能，其中应用零速修正技术较好地解决了低成本惯导系统误差发散快的问题。国内外学者对该算法进行了大量的改进研究2卅。20170104：修回日期：20170328国家自然科学基金(61533008，613741 15，61328301，61304227)；江苏省自然科学基金(BK20141453)；中央高校基本科研业务费专项资金(NS201 5037)曾庆化(1 979一)，男，副教授，从事惯性导航及组合导航技术研究。E-mail：zengqhnuaaeducn

10、万方数据第2期 曾庆化等：基于UWB优化配置的室内行人导航方法 -187-由于室内航向角很难精确获得，因此行人惯性导航系统中的航向角误差已成为惯性导航系统误差的主要来源之-E5。61。当前解决航向角发散问题的方法主要有磁航向辅助算法【_71、陀螺旋转修正算法8】等。磁航向辅助算法主要运用于室外，室内磁场环境复杂，很难应用该算法；陀螺旋转修正算法多用于机器，行人无法满足算法所需的陀螺匀速旋转的条件。对室内行人惯性导航系统航向进行修正的重要性日益突出。UWB(超宽带无线技术)是当前国内外定位领域研究热点之一【9。01。在室内定位过程中，UWB具有厘米级的定位精度，良好的抗多路径性能，较低的发射功率

11、及一定的穿透能力，与WiFi、ZigBee、RFID等室内定位技术相比优势显著。目前，国内外研究者对惯导UWB组合的研究主要集中在UWB与IMU组合实现无人机的室内定位【111，UWB与PDRSLU(Pedestrian dead reckoningStep length update)组合实现行人导航【1”】。PDRSLU对行人的步长、步数精度要求较高，而基于足部微惯性系统的零速修正算法则不需获知行人的精确步长，因此本文选择UBrB与使用零速修正的惯导系统组合，以UWB修正惯导系统的航向与位置，同时在UWB受干扰定位出现偏差时，利用惯导保证定位的准确性实现低成本高精度的室内导航。1 惯性导航

12、系统定位方法本文选用低成本的微惯性传感器是消费级别的，因此传统捷联惯性导航算法无法使之满足行人惯导系统的需要。在足部运动时，足部的惯性传感器数据使用捷联惯导算法递推得到导航结果；在足部静止时，采用零速修正算法将速度置零，并重新计算姿态角以修正导航结果、抑制误差发散。具体流程如图1所示。 n甄丽获取陀螺、加表信息刮冀惯导解算二工二输出位置7一 =|达目的自(墨堕笙室)图1 基于零速修正算法的行人惯性导航算法原理图Fig1 Pedestrian navigation algorithm principle based onzero-velocity update algorithm准确判断足部的零

13、速时刻是零速修正算法最重要的条件。由图2可以看出，足部处于零速时刻时，惯性器件有一段较为明显的平稳输出区间。本文采取了以陀螺仪输出为主，加速度计输出为辅的滑动窗口判断方法，对足部的零速时刻进行判定。基于不同的行走状态将滑动窗口宽度设置为变量，该值的大小与行走状态有关，相关变量定义如式(1)所示：q=ICO，mL矿l旷J矿哼J (1)哆=l秽“一矽n| 一么=害(厄瓦万了)式中，q、q、哆分别为窗口范围内单轴陀螺输出量的极差，彳为窗口范围内三轴加速度计输出矢量的最大幅值。时问墙(a)陀螺仪三轴输出数据(b)加速度计二轴输出数据图2行人行走时惯性器件输出数据Fig2 The output data

14、 of inertial device for pedestrian为了避免零速判定的条件过于严格导致惯导误差的积累，本文适度放宽零速判定的条件，当上述4个变量有一个满足所给定的限定门限值时，就认为处于万方数据188 中国惯性技术学报 第25卷零速时刻，并对惯性器件进行零速修正。当惯性器件处于零速修正时刻，利用式(2)可以使用加速度计输出信息求出该器件的横滚角与俯仰角。曰：arcsin笪g，。 (2)一删an篆 一式中：目、y分别为俯仰、横滚角度，盛、盛、兑分别为三轴加速度计输出，g为当地的重力加速度值。低成本惯性器件稳定性、重复性都比较差，每次使用前均需要对其进行标定，以扣除陀螺仪和加速度计

15、的零偏误差，提高传感器的精度。陀螺仪取静止时刻的输出作为零偏，但加速度计无法仅由某一位置的输出求出零偏，因此本文使用一种三位置加速度计标定法，通过传感器在三个不同位置的静态数据，求出加速度计的零偏值。该方法简单实用，是一种适用于安装完成后的现场标定方法，其算法如式(3)所示：一 一 i- 1一l一 一bx l，l 4，4，4：l z。lbe l=专l 4，4，4：I z：l (3)【吃j 4， 4， 4：【z3j式中：b、 一 分别为三轴加速度计的零偏值；xb bz4，、44，分别为第i个位置的三轴加速度计输出均值；Zi=m；一92，表示第i个位置三轴加速度计输出的平方和与g平方的差值。惯性导

16、航系统通过惯性器件获得加速度计与陀螺仪的测量信息，去除零偏后解算出自身的位置与姿态，同时在足部静止时刻引入零速修正以抑制误差的发散，从而保证一定时间内的精确导航。2 UWB定位方法常用的无线定位算法有以下四种：测量信号的到达时间(TOA，Time ofArrival)；信号的到达时间差(TDOA，Difference of Time Arrival)；信号的到达角度(AOA，Angel ofArrival)；接收信号的强度(RSSI，Received Signal Strength)。由于UWB技术支持使用纳秒级的同步时钟，因此能够确保时间的准确性，故本文中选用TOA方法：精确测量定位芯片发出

17、的无线脉冲信号到达各基站所经过的时间，乘以光速即获得芯片与各基站之间的精确距离，从而解算出较高精度的芯片位置【1 41。如图3所示，各基站BSi的坐标是(xi，Y，z，)，定位芯片MS的坐标是(z，Y，z)。定位芯片MS与各基站BSi之间的距离n都可以确定一个以基站BS，为球心，n为半径的球体，这三个球的交点就是定位芯片MS的位置。图3 TOA定位方法的几何模型Fig3 Geometric model ofTOA location method然而在大部分情况下，由于，i、吃、吃的测量值存在误差，三球并不会正好相交于一点，因此需要个(3个以上)基站才能完成定位，如式(4)所示：瓜i再石j万百虿

18、=_厄而F而再一(4)瓜万了而万万丽；矛=式(4)通过平方和求差可得式(5)：2(xlt)x+(Yl一”)，+(Zlzi)z=Iz一_：+奸+并+z?一(#+茸+彳) (5)个定位基站可得，-1个类似式(5)的方程，写成如式(6)所示的矩阵形式：MI=b (6)其中，b=M=2，=z，Y，z】1五一也 J，l一乃 z1一z2五一屯 MY3 z1一Z3xLxN yIyN zlzN疗一吒2+彳+y；+彳一(+y；+乏)茸一，i2+砰+订+彳一瞎+剪+豸)瑶一吒2+x；+并+z；一(x；+盛+z；)根据基站的数据，获得M和6的值，带入式(6)，利用最小二乘法，即可求出定位芯片MS的坐标J。3惯导咖B

19、组合定位方法31 惯导UWB组合定位原理基于零速修正的惯性导航技术通过自身加速度计与陀螺仪测得的信息计算出行人的位置和航向，同时万方数据第2期 曾庆化等：基于UWB优化配置的室内行人导航方法 一189-在足部静止时刻引入零速修正算法，以修正导航结果。虽然零速修正算法在一定程度上能抑制误差的发散，保证一定时间的独立工作能力，但是误差随着行人走动仍会不断累积，最后无法满足导航的需求。同时在行人行进时航向角计算会出现偏差，若不对其进行及时修正，会对后续定位造成很大的影响。基于TOA方法的UWB技术采用测量无线脉冲信号准确的飞行时间，从而解得厘米级的精确位置，可以为行人提供准确的位置与航向。但是UW-

20、B信号易被人体所吸收，尤其在对快速行走的人体进行定位时，这种影响所带来的误差将达到分米级【15。另外UWB基站成本相对微惯性器件来说较高，很多室内导航系统的预算无法支持UWB的全面覆盖。惯导，I TwB组合定位相辅相成，可以实现定位精度与成本之间的平衡。在直线行走时，采用惯性传感器自主导航，在楼道关键节点处(如拐角)布设UWB基站予以辅助定位，既修正了惯性传感器的航向，同时又消除了惯导之前行走过程所积累的位置误差，还避免了建筑内大规模布设UWB基站的高昂成本，在满足定位需求的同时降低了成本的投入。本文采用的是惯性UWB的松组合导航系统，具体原理如图4所示，组合过程分为以下三步：1)实时由惯性导

21、航系统进行导航解算，同时依靠零速修正算法对其误差进行修正。2)UWB模块尝试接收UWB信号，当能获取到正甄丽否获取陀螺、加表信息二二基于零速修正的惯导解算黾否获警获取UWB定位信息二二卡尔曼滤波修正惯导数据输出位置达目的否(量堕笙壅)图4惯导UWB组合定位原理图Fig4 INSUWB integrated positioning principle可用的UWB定位信息时，转到步骤3)。3)使用UWB定位信息与惯导解算结果进行卡尔曼滤波，对惯导解算数据进行修正，返回步骤1)继续进行惯导解算。32卡尔曼滤波原理基于对数据融合的有效性与算法的总体计算量的考虑，本文选择仅在零速修正时刻进行基本线性卡尔

22、曼滤波，其状态方程与观测方程为Xt 2嚷扣-鼍一，+疋一，一， (10)【毛=Hk鼍+K式中：噻卢。=F(气)丁”n!疋一。：n喜=O去。F。气，丁，。一，)G。气，丁(11)其中：K为状态量，嚷“，为状态转移矩阵，玩为量测矩阵，哌一。和K分别表示系统噪声和量测噪声，L一。为系统噪声矩阵，丁为离散周期。卡尔曼滤波的状态量如下所示：X=，con，6，8VN，6，乩，6名，6五，8K，8Kgy，强；，蚤K。，黾K。，8K。l V-式中：纯、仇为惯导数学平台误差角，6协8VN、为惯导东北天坐标系三向速度误差，乩、6旯、6而为惯导东北天坐标系三向位置误差，6、6b、6、6k、6k、涨。，分别为三轴陀螺

23、和三轴加表的标定因数误差。卡尔曼滤波的量测量为乙=8y，80，8V，8vE，8vN，6屹，8L，6Z】1 (131式中：87、80、8沙为当前时刻惯导解算的姿态角与零速时刻加速度计计算的姿态角差值，6v。、8VN、6u，为当前时刻惯导解算的速度与零速差值，乩、6五为当前时刻惯导解算位置与UWB位置的误差。式(13)中的姿态角误差可通过式(14)转换为惯导数学平台误差：COSt矿-sinVcos8coslsin臼由于惯导传感器采样周期为200 Hz，UWB采样周期为20 Hz，因此本文所选量测量并非时刻存在，故仅在可以获得有效量测量的零速时刻进行系统状态更新和量测更新，其余时刻滤波器仅作状态更新

24、。经过滤波器量测更新得到的导航误差估计量被返回至惯导解算环节，惯导系统输出修正后的导航结果。lJ，引。，。LJpSO0OC一嘶翥础门州一旧一万方数据190 中国惯性技术学报 第25卷4实验验证与数据分析为了对本文提出的UWB辅助惯导定位方法进行验证，项目组在南京航空航天大学自动化学院楼群进行了室内行走实验。本次实验将低成本微惯性器件MPU6050置于足部，器件输出频率设为200 Hz，以测量行人行走过程中的足部运动信息，实现零速修正下的惯性导航，同时将UWB标签置于上半身(本次实验选择肩部)，避免下半身行走时抖动过大对UWB测量精度的影响。具体设备如图5所示。网 磐艄图5惯性传感器与UWB标签

25、、基站示意图Fig5 Schematic of inertial sensor,UWB tag andUWB base station本次实验分为两部分进行：第一部分实验验证惯导在长距离直线行走中的准确性；第二部分实验验证UWB辅助修正惯导的效果。41 纯惯导长距离直线行走实验本部分实验在4号楼内一条贯穿全楼的直线过道中行走，由激光测距仪测得行走距离长52081 m，行走效果如图6所示。1i走路缄图5三i 一一 三专叶一、7 “1二一5：苗吉_言寺i噶、_J：_Jf忖置m图6长距离直线行走实验结果Fig6 Experiment result of long distance walking s

26、traight图6中直线前后的红点所示理论起始点为(0，0)，理论终点为(52081，0)。实际行走结果由蓝色曲线表示，起始点为(0，0)，终点为(52912，-0437)。由数据可知，起点一终点位置差为0939 in，位置误差占行走距离的18。可见，本文所采用的基于零速修正的惯性导航算法，在直线行走时可以基本满足室内行人定位的需求。42 UWB辅助惯导实验本UWB实验室构型如图7所示，室内安装4个UWB基站实时向计算机传输标签定位数据。实验区为边长5 m的正方形，各点坐标由激光测距仪测得，将惯导与UWB的坐标原点均设于其左下角D点，苁y轴如图7所示。实验路线设置为从D点起沿】，轴正向顺时针绕

27、行一圈回到D点，共20m。实验过程中：前15m实验者正常行走；后5In设置一名人员位于实验者与某一基站之间，起到对信号的阻挡作用。图7设备位置及实验路线示意图Fig7 Sketch map of equipment position and experimental route实验结果如图8所示，其中：黑色点划线为规划行走路线9红色虚线为UWB测量路线，由于遮挡的存在，在(0，0)附近时候存在较大的误差9浅蓝色点线为惯导测量路线，存在一定的误差累积情况；深蓝色粗实线为惯导UWB组合导航路线，与规划行走路线贴合最好。行=路蛙囡图8惯导、UWB导航与组合导航实验结果对比Fig8 Compariso

28、n on experimental results of inertialnavigation，UWB navigation and integrated navigation由图8可得：1)前15 In中，由于实验者实际行走时肩部存在轻微晃动，不能保证时刻与规划路线一致，UWB数据与规划路线之间存在20 cm以内的误差，具有较高的可靠性。后5in中，由于部分信号被阻挡，UWB信号产生漂移。2)惯导数据由于误差累积，随着时间推移，后期偏差逐步扩大，最终位置为(06918，01279)，与原点r(訾訾万方数据第2期 曾庆化等：基于UWB优化配置的室内行人导航方法 一191一位置差为07035 m

29、，位置误差占行走距离的352， 5 曾庆化，万骏炜，刘建业，等基于蜂窝网格粒子滤波全程平均位置误差为06437 1TI。3)惯导UWB组合导航数据最终位置为(一00738，一01588)，与原点位置差为01751 nq，位置误差占行走距离的088，全程平均位置误差为00968 m。由于本文设置仅在零速修正时刻进行卡尔曼滤波，因此每次刚进入零速修正时刻开始滤波时，输出结果存在小幅度的跳变。综上，惯导UWB组合导航相对于惯性导航单独使用在绕圈行走的最终结果以及整个导航过程的平均误差方面都有明显的精度提升，同时与UWB单独导航相比，基本接近UWB的正常导航精度，且在UWB定位出现问题时，系统依然能靠

30、惯导保证定位的精度，能够满足较长时间导航的需要。5结论在一般室内区域，本文采用基于零速修正的惯导系统进行导航，以抑制惯导误差随时间发散。同时，在关键节点(拐弯)处布设UWB设备，通过松组合的形式，将UWBI贯导组合在一起，则可以实现在零速修正时刻对UWB与惯导进行卡尔曼滤波，实现对惯导信息的修正。从实验结果可以看出，本文提出的算法能够将文中室内导航的定位精度从352提升到088。本方法修正了惯性传感器之前行走过程所积累的误差，解决了低精度消费级惯导无法较长时间准确导航定位的问题；与完全使用UWB进行室内定位相比，系统既实现了定位精度与成本的平衡，又能够避免UWB出现问题时对整体定位性能的影响。

31、参考文献(References)：1Hsu L T，Gu Y，Kamijo S3D building modelbased pedestrian positioning method using GPSGLONASSQZSSand its reliability calculationJGPS Solutions，2015：1-162 Zhang Xinxi，Zhang Rong，Guo Meifeng，et a1Yawerror self-observation algorithm for pedestrian navigationvia foot-mounted inertial navi

32、gation systemJJournal ofChinese Inertial Technology,2015，23(4)：457-4663】 万骏炜多信息融合室内外无缝个人定位导航系统实现研究D南京航空航天大学，2015Wan Jun-weiResearch on multiinformation fusion basedseamless outdoorindoor personal navigation systemDNanjing University ofAeronautics andAstronautics，20154 Girisha R，Prateek G V Had K V S

33、，et a1Fusing thenavigation information of dual foot-mounted zerovelo-city-update-aided inertial navigation systemsC2014IEEE International Conference on Signal Processing andCommunications20】4：】6的行人导航航向估计方法J】l中国惯性技术学报，20 14，22(5)：576579Zeng Qinghua，Wan Junwei，Liu Jianye，et a1Headingcompensation algor

34、ithm based on cellular structure par-ticle filter for pedestrian navigationJJournal of ChineseInertial Technology,2014，22(5)：576-5796】 王云舒，刘建业，曾庆化，等结构光辅助的惯性视觉室内导航三维环境重构方法J中国惯性技术学报，2016，24(1)：5158Wang Yunshu，Liu Jian-ye，Zeng Qinghua,et a13Denvironment restructure method with structured light forindoo

35、r visioninertial navigationJJournal of ChineseInertial Technology,2016，24(1)：51-587】 Zhang R，Hoflinger F，Reindl LInertial sensor basedindoor localization and monitoring system for emergencyrespondersJIEEE Sensors Journal，201 3，1 3(2)：838-8488】 吴哲明，孙振国，张文增，等基于惯性测量单元旋转的陀螺漂移估计和补偿方法J清华大学学报(自然科学版)，2014(9

36、)：1 1431 147Wu Zheruing，Sun Zhen-guo，Zhang Wen-zeng，et a1Gyroscope bias estimation and compensation by rotationof the inertial measurement unitJJournal of TsinghuaUniversity(Science and Technology)，2014(9)：1 1431 1479 Suski W，Banerjee S，Hoover AUsing a map of measurement noise to improve UWB indoor

37、position trackingJIEEE Transactions on Instrumentation&Measurement2013，62(8)：2228223610】Tiemann J，Schweikowski F，Wietfeld CDesign of anUWB indoo卜positioning system for UAV navigation inGNSSdenied environmentsCInternational Conferenceon Indoor Positioning and Indoor NavigationIEEE，20151 1Benini A，Man

38、cini A，Longhi SAn IMUUWBVisionbased extended Kalman filter for miniUAV localizationin indoor environment using 8021 54a wireless sensornetworkJJoumal of Intelligent&Robotic Systems2013，70(14)：461-47612Ascher C，Zwirello L，Zwick T，et a1Integrity monitoringfor UWBINS tightly coupled pedestrian indoor s

39、cenariosCInternational Conference on Indoor Positioning andIndoor NavigationIEEE，201 1：1-61 3】Zampella F，De Angelis A，Skog I，et a1A constraintapproach for UWB and PDR fusionCIntemationalConference on Indoor Positioning and Indoor Navigation2012：1914】Irahhauten Z，Nikookar H，Klepper M2D UWB localizati

40、on in indoor multipath environment using a joint ToADoA techniqueCIEEE Wireless Communications&Networking Conference2012：2253225715Kilic Y Ali A J，Meijerink A，et a1The effect ofhumanbody shadowing on indoor UWB TOA-based rangingsystemsCThe Workshop on Positioning Navigation&CommunicationIEEE2012：126130万方数据