多传感器行人航位推算方法和UKF融合算法

doi:10.13474/j.cnki.11-2246.2018.0074

测绘通报 ›› 2018, Vol. 0 ›› Issue (3): 49-54.doi: 10.13474/j.cnki.11-2246.2018.0074

多传感器行人航位推算方法和UKF融合算法

漆钰晖, 郭杭, 邓林坤

南昌大学信息工程学院, 江西南昌 330031

收稿日期:2017-07-13 修回日期:2017-09-06 出版日期:2018-03-25 发布日期:2018-04-03
作者简介:漆钰晖(1994-),女,硕士生,主要从事室内定位方面的研究。E-mail:975850349@qq.com
基金资助:
国家重点研发计划项目（2016YFB0502002）；国家自然科学基金（41374039）

Research of Multi-sensor Pedestrian Dead Reckoning Method and UKF Fusion Algorithm

QI Yuhui, GUO Hang, DENG Linkun

School of Information Engineering, Nanchang University, Nanchang 330031, China

Received:2017-07-13 Revised:2017-09-06 Online:2018-03-25 Published:2018-04-03

摘要/Abstract

摘要：

针对利用惯性测量单元进行行人航位推算（PDR）时，其定位误差会随时间累积的问题，提出了一种基于多传感器融合的室内行人航位推算方法；对于智能移动设备的低成本多传感器，设计了基于无迹卡尔曼滤波（UKF）的初始对准，设定4种阈值条件进行步伐状态检测；在行走过程中，针对步长和航向角误差累积的问题，利用基于UKF的零速度更新（ZUPT）对速度误差进行修正，零角速率更新（ZARU）和磁力计融合对航向角误差进行修正，从而有效提高了行人最终的位置精度。试验结果表明：使用该方法可以有效提高PDR位置精度，平均位置偏差占总路程的1.5%左右。

关键词: 无迹卡尔曼滤波, ZUPT, ZARU, 磁力计, 行人航位推算

Abstract:

Aiming at the problem of pedestrian dead reckoning (PDR) with inertial measurement unit and the positioning error will accumulate over time.A method of estimating indoor pedestrian space based on multi-sensor fusion is proposed.For low-cost multi-sensor of smart mobile device,the initial alignment based on the unscented Kalman filter (UKF) is designed and the four threshold conditions are set to carry out the step state detection.In the process of walking,the problem of the accumulation of the step and the heading angle error is based on the zero speed update (ZUPT) of the UKF to correct the speed error,zero angle rate update (ZARU) and magnetometer fusion of the heading angle error correction,which effectively improve the pedestrian final position accuracy.The experimental results show that the method can effectively improve the average positional deviation of PDR position by about 1.5% of the total distance.

Key words: unscented Kalman filter, ZUPT, ZARU, magnetometer, pedestrian dead reckoning

中图分类号:

漆钰晖, 郭杭, 邓林坤. 多传感器行人航位推算方法和UKF融合算法[J]. 测绘通报, 2018, 0(3): 49-54.

QI Yuhui, GUO Hang, DENG Linkun. Research of Multi-sensor Pedestrian Dead Reckoning Method and UKF Fusion Algorithm[J]. 测绘通报, 2018, 0(3): 49-54.

参考文献

[1] 田国会,张庆宾,丁娜娜.基于WT-UKF的PDR/GPS组合定位算法[J].控制与决策,2015,30(1):86-90.
[2] 李金凤,王庆辉,刘晓梅,等.基于MEMS惯性传感器的行人航位推算系统[J].传感器与微系统,2014,33(12):85-90.
[3] 马宏阳,程鹏飞,王潜心.一种改进的UKF算法在捷联惯导初始对准中的应用[J].测绘通报,2015(7):18-22.
[4] 门爱东,姜竹青,王宇鹏,等.双重自适应UKF在SINS初始对准中的应用[J].北京邮电大学学报,2014,37(1):11-15.
[5] 苏宛新.自适应UKF滤波在SINS初始对准中的应用[J].中国惯性技术学报,2011,19(5):533-536.
[6] JIMENEZ A R,SECO F,PRIETO C,et al.A Comparison of Pedestrian Dead-Reckoning Algorithms Using a Low-cost MEMS IMU[C]//The 6th IEEE International Symposium on Intelligent Signal Processing.Budapest:IEEE,2009:37-42.
[7] RAUL F,EDUARDO Z,JAIME G.Pedestrian Tracking Using Inertial Sensors[J].Journal of Physical Agents,2009,3(1):35-42.
[8] ZHENG X,YANG H,TANG W,et al.Indoor Pedestrian Navigation with Shoe-mounted Inertial Sensors[C]//Multimedia and Ubiquitous Engineering.Berlin:Springer,2014:67-73.
[9] FRANCISCO Z,MOHAMMED K,PATRICK R,et al.Unscented Kalman Filter and Magnetic Angular Rate Update (MARU) for an Improved Pedestrian Dead-reckoning[C]//Position Location and Navigation Symposium.[S.l.]:IEEE,2012:129-139.
[10] 赵鹤,王喆垚.基于UKF的MEMS传感器姿态测量系统[J].传感技术学报,2011,24(5):642-646.
[11] 陈国良,张言哲,汪云甲,等.WiFi-PDR室内组合定位的无迹卡尔曼滤波算法[J].测绘学报,2015,44(12):1314-1321.
[12] BORENSTEIN J,OJEDA L,KWANMUANG S.Heuristic Reduction of Gyro Drift in IMU-based Personnel Tracking Systems[J].Journal of Navigation,2009,62(1):41-58.
[13] JIMENEZ A R,SECO F,PRIETO J C,et al.Indoor Pedestrian Navigation Using an INS/EKF Framework for Yaw Drift Reduction and a Foot-mounted IMU[C]//Proc.of 7th Workshop on Positioning,Navigation and Communication (WPNC'10).Dresden:[s.n.],2010:1-9.
[14] WEINBERG H.Using the ADXL202 in Pedometer and Personal Navigation Applications[EB/OL].[2017-01-02].www.BDTIC.com/ADI.
[15] JIMENEZ A R,SECO F,PRIETO C,et al.A Comparison of Pedestrian Dead-reckoning Algorithms Using a Low-cost MEMS IMU[C]//The 6th IEEE International Symposium on Intelligent Signal Processing.Budapest:IEEE,2009:37-42.

多传感器行人航位推算方法和UKF融合算法

Research of Multi-sensor Pedestrian Dead Reckoning Method and UKF Fusion Algorithm

PDF

可视化

摘要/Abstract

引用本文

使用本文

参考文献

相关文章 5

编辑推荐

Metrics

本文评价

[1]	王安义, 欧雪. 基于粒子滤波的PDR/地磁指纹室内定位[J]. 测绘通报, 2021, 0(1): 24-28.
[2]	朱家松, 程凯, 周宝定, 林伟东. 基于互补滤波融合WiFi和PDR的行人室内定位[J]. 测绘通报, 2019, 0(5): 12-15,34.
[3]	任晓斌, 聂桂根, 李连艳, 陈祖岸, 雷浩川. 修正扩维无迹卡尔曼滤波算法研究[J]. 测绘通报, 2019, 0(5): 83-87,101.
[4]	牛欢, 廉保旺. 一种基于改进UKF滤波的GPS+PDR组合定位方法[J]. 测绘通报, 2017, 0(7): 5-9.
[5]	王仁, 赵长胜, 夏志浩, 谭兴龙, 孙鹏. 无迹卡尔曼滤波衰减记忆算法研究[J]. 测绘通报, 2015, 0(12): 20-22.