|
|
论文:2020,Vol:38,Issue(2):427-433 |
|
|
引用本文： |
|
|
郭宇扬, 徐向波, 姬淼鑫. 一种自适应粒子滤波的零速修正方法[J]. 西北工业大学学报 |
|
|
GUO Yuyang, XU Xiangbo, JI Miaoxin. A Zero-Velocity Update Method for Adaptive Particle Filtering[J]. Northwestern polytechnical university |
|
|
|
|
|
|
|
| 一种自适应粒子滤波的零速修正方法 |
|
| 郭宇扬, 徐向波, 姬淼鑫 |
|
| 北京林业大学 工学院, 北京 100083 |
| 摘要: |
| 针对卡尔曼滤波方法处理非线性非高斯模型滤波精度低，以及标准粒子滤波中粒子退化严重的问题，提出一种自适应粒子滤波的零速修正方法。将自适应阈值与粒子滤波结合，从而提高重采样的效率；重采样过程中引入退化系数判断粒子退化程度，对粒子进行二次采样，保证了粒子的多样性。为了验证所提算法的有效性和可行性，搭建了以惯性测量单元IMU（inertial measurement unit）为核心的硬件平台，利用IMU采集的数据建立系统的状态空间模型，并进行实验。结果表明，与卡尔曼滤波方法和经典粒子滤波方法相比，自适应粒子滤波方法在零速区间的定位精度分别提高了40.6%和19.4%。自适应粒子滤波APF（adaptive particle filter）能更好地修正导航误差，提高行人轨迹精度。 |
| 关键词:
卡尔曼滤波
自适应阈值
二次采样
粒子滤波
实验
零速修正
算法
|
|
| A Zero-Velocity Update Method for Adaptive Particle Filtering |
|
| GUO Yuyang, XU Xiangbo, JI Miaoxin |
|
| School of Engineering, Beijing Forestry University, Beijing 100083, China |
| Abstract: |
| Aiming at the low precision of Kalman filter in dealing with non-linear and non-Gaussian models and the serious particle degradation in standard particle filter, a zero-velocity correction algorithm of adaptive particle filter is proposed in this paper. In order to improve the efficiency of resampling, the adaptive threshold is combined with particle filter. In the process of resampling, the degradation co-efficient is introduced to judge the degree of particle degradation, and the particles are re-sampled to ensure the diversity of particles. In order to verify the effectiveness and feasibility of the proposed algorithm, a hardware platform based on the inertial measurement unit (IMU) is built, and the state space model of the system is established by using the data collected by IMU, and experiments are carried out. The experimental results show that, compared with Kalman filter and classical particle filter, the positioning accuracy of adaptive particle filter in zero-velocity range is improved by 40.6% and 19.4% respectively. The adaptive particle filter (APF) can correct navigation errors better and improve pedestrian trajectory accuracy. |
| Key words:
Kalman filter
adaptive threshold
secondary sampling
particle filter
experiment
zero-velocity correction
algorithm
|
|
| 收稿日期: 2019-06-21
修回日期:
|
| DOI: 10.1051/jnwpu/20203820427 |
| 基金项目: 中央高校基本科研业务费专项资金（2017ZY38）、国家自然科学基金（51605031）与中国博士后科学基金（2018T110055）资助 |
| 通讯作者: 徐向波(1982-),北京林业大学副教授,主要从事MEMS组合导航技术与伺服控制技术研究。E-mail:xuxiangbo@bjfu.edu.cn
Email：xuxiangbo@bjfu.edu.cn |
| 作者简介: 郭宇扬(1995-),北京林业大学硕士研究生,主要从事GPS/INS组合导航技术研究。
|
|
|
|
|
|
|
|
参考文献: |
|
|
[1] 朱新宇,陶庭叶,姜冬致. 基于GPS/MEMS惯性传感器的消防员室内定位研究[J]. 合肥工业大学学报,2018,41(7):949-955 ZHU Xinyu, TAO Tingye, JIANG Dongzhi. Research on Indoor Positioning of Firefighters Based on GPS/MEMS Inertial Sensors[J]. Journal of Hefei University of Technology, 2018,41(7):949-955(in Chinese)
[2] ZHANG W, LI X, WEI D, et al. A Foot-Mounted PDR System Based on IMU/EKF+HMM+ZUPT+ZARU+HDR+Compass Algorithm[C]//2017 International Conference on Indoor Positioning and Indoor Navigation(IPIN), 2017
[3] ZHANG R, YANG H, HOFLINGER F, et al. Adaptive Zero Velocity Update Based on Velocity Classification for Pedestrian Tracking[J]. IEEE Sensors Journal, 2017, 17(7):2137-2145
[4] 张健敏,修春娣,杨威,等. 一种多运动模式下自适应阈值零速修正算法[J]. 北京航空航天大学学报,2018,44(3):636-644 ZHANG Jianmin, XIU Chundi, YANG Wei, et al. An Adaptive Threshold Zero-Velocitycorrection Algorithm in Multi-Motion Mode[J]. Journal of Beijing University of Aeronautics and Astronautics, 2018, 44(3):636-644(in Chinese)
[5] 刘恒志,李擎. 一种12维零速状态更新的智能行人航位推算[J]. 系统仿真学报,2018,30(11):4387-4394 LIU Hengzhi, Li Qing. An Intelligent Pedestrian Dead Reckoning with 12-Dimensional Zero-Velocity Status Update[J]. Journal of Systems Simulation, 2018, 30(11):4387-4394(in Chinese)
[6] WANG Q, CHENG M, NOURELDIN A, et al. Research on the Improved Method for Du-Al Foot-Mounted Inertial/Magnetometer Pedestrian Positioning Based on Adaptive in-Equality Constraints Kalman Filter Algorith-M[J]. Measurement, 2019, 135:189-198
[7] 黄欣,熊智,许建新,等. 基于零速/航向自观测/地磁匹配的行人导航算法研究[J]. 兵工学报,2017,38(10):2031-2040 HUANG Xin, XIONG Zhi, XU Jianxin, et al. Pedestrian Navigation Algorithm Based on Zero-Speed/Course Self-Observation/Geomagnetic Matching[J]. Journal of Military Engineering, 2017,38(10):2031-2040(in Chinese)
[8] 杨智,严华. 基于SVR和粒子滤波的室内导航方法[J]. 计算机测量与控制,2016,24(9):231-233,250 YANG Zhi, YAN Hua. Indoor Navigation Method Based on SVR and Particle Filter[J]. Computer Measurement and Control, 2016, 24(9):231-233,250(in Chinese)
[9] 王林,林雪原,孙炜玮,等. 改进粒子滤波算法及其在GPS/SINS组合导航中的应用[J]. 海军航空工程学院学报,2016,31(1):51-57 WANG Lin, LIN Xueyuan, SUN Weiwei, et al. Improved Particle Filter Algorithm Andits Application in GPS/SINS Integrated Navigation[J]. Journal of Naval Aviation Engineering College, 2016, 31(1):51-57(in Chinese)
[10] PEI L, LIU D, ZOU D, et al. Optimal Heading Estimation Based Multi-Dimensional Particle Filter for Pedestrian Indoor Positioning[J]. IEEE Access, 2018, 6:49705-49720
[11] 方群,徐青. 基于改进粒子群算法的无人机三维航迹规划[J]. 西北工业大学学报,2017,35(1):66-73 FANG Qun, XU Qing. 3D Route Planning for UAV Based on Improved PSO Algorithm[J]. Journal of Northwestern Polytechnical University, 2017,35(1):66-73(in Chinese)
[12] JIMÉNEZ 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]//2010 7th Workshop on Positioning, Navigation and Communication, 2010
[13] 陈增增,马晓民,陶伟. 基于粒子滤波的多枚声呐浮标联合跟踪定位算法[J]. 声学与电子工程,2015(1):6-10 CHEN Zengzeng, MA Xiaomin, TAO Wei. Joint Tracking and Positioning Algorithm of Multiple Sonar Buoys Based on Particle Filter[J]. Acoustics and Electronic Engineering, 2005(1):6-10(in Chinese)
[14] 王录,刘明雍,王梦凡,等. 基于地磁场自适应修正的航姿系统姿态解算研究[J]. 西北工业大学学报,2019,37(2):225-231 WANG Lu, LIU Mingyong, WANG Mengfan, et al. Attitude Calculation of AHRS Based on Geomagnetic Field Adaptive Correction[J]. Journal of Northwestern Polytechnical University, 2019,37(2):225-231(in Chinese) |
|
|
|
相关文献: |
|
|
1．刘明雍, 郭娇娇, 王梦凡, 牛云, 王录.基于重力场与地磁场序贯修正的姿态解算研究[J]. 西北工业大学学报, 2020,38(1): 1-5 |
|
|
2．刘俊豪, 郑华, 段世强, 裴承鸣.一种基于EM-KS算法的连续变速颤振边界预测方法[J]. 西北工业大学学报, 2019,37(6): 1231-1237 |
|
|
3．王录, 刘明雍, 王梦凡, 郭娇娇, 雷罡, 张小件.基于地磁场自适应修正的航姿系统姿态解算研究[J]. 西北工业大学学报, 2019,37(2): 225-231 |
|
|
4．周渭博, 钟勇, 王阳.MapReduce模型中基于直方图的数据均衡算法[J]. 西北工业大学学报, 2018,36(3): 480-486 |
|
|
5．刘悄然, 杨训.基于改进的交互式多模型粒子滤波算法[J]. 西北工业大学学报, 2018,36(1): 169-175 |
|
|
6．李建良, 杜承烈, 赵晔, 禹科.一种视觉机器人演示学习的轨迹生成方法[J]. 西北工业大学学报, 2016,34(6): 1082-1087 |
|
|
7．曾向阳, 马慧颖, 王海涛.一种用于舱室声源定位的双传声器方法及其性能研究[J]. 西北工业大学学报, 2016,34(2): 189-193 |
|
|
8．苟艳妮, 王英民, 王奇.实测新型水下小尺寸扩展式基阵声探测系统定向性能研究[J]. 西北工业大学学报, 2015,33(3): 426-431 |
|
|
9．范旭慧, 张捷, 马化斌.一类新型的光滑支持向量分类机[J]. 西北工业大学学报, 2015,33(3): 467-471 |
|
|
10．黄伟, 陈光.一种改善动脉自旋标记磁共振图像中部分容积效应的新算法[J]. 西北工业大学学报, 2015,33(3): 516-523 |
|
|
11．韩青, 孙树栋, 智睿瑞.基于纯角度观测信息的leader-followers机器人编队控制方法[J]. 西北工业大学学报, 2015,33(2): 244-250 |
|
|
12．张维, 李文涛, 王力.基于接收信号强度的不同移动终端定位方法研究[J]. 西北工业大学学报, 2014,32(3): 481-485 |
|
|
13．朱良谊, 王庆.一种基于粒子滤波的优化目标跟踪算法研究[J]. 西北工业大学学报, 2013,31(6): 967-973 |
|
|
14．周勇, 张玉峰, 张超, 张举中.基于Sage-Husa的线性自适应平方根卡尔曼滤波算法[J]. 西北工业大学学报, 2013,31(1): 89-93 |
|
|
15．王静, 黄建国, 张群飞, 韩晶.噪声空间谱预白化小孔径阵列被动目标检测方法[J]. 西北工业大学学报, 2012,30(3): 422-427 |
|
|
16．周文佳, 陈旿, 肖迪, 张鹏飞, 慕德俊.MANET网络中一种基于灰色区域的移动预测路由协议及多径备份路由扩展[J]. 西北工业大学学报, 2012,30(5): 739-745 |
|
|
|
|
|
|
