视觉辅助下的室内惯导位姿修正

doi:10.13474/j.cnki.11-2246.2019.0141

测绘通报 ›› 2019, Vol. 0 ›› Issue (5): 16-20.doi: 10.13474/j.cnki.11-2246.2019.0141

视觉辅助下的室内惯导位姿修正

邹汉达^1,2, 袁洪²

1. 中国科学院大学, 北京 100094;
2. 中国科学院空天信息研究院, 北京 100094

收稿日期:2019-01-19 修回日期:2019-02-11 出版日期:2019-05-25 发布日期:2019-06-04
作者简介:邹汉达(1993-),男,硕士生,主要研究方向为多源融合导航定位。E-mail:zouhanda@sina.com

Pose correction of INS for indoor location based on a vision navigation method

ZOU Handa^1,2, YUAN Hong²

1. University of Chinese Academy of Sciences, Beijing 100094, China;
2. Aerospace Information Research Institute, Chinese Academy of Sciences, Beijing 100094, China

Received:2019-01-19 Revised:2019-02-11 Online:2019-05-25 Published:2019-06-04

摘要/Abstract

摘要： 惯性导航系统可以短期内提供连续的高精度信息，但是误差会随时间增大，不能长期独立工作。而在大型仓库、地下停车场等室内卫星信号薄弱的场景中，传统的惯导+卫星组合方法也不再适用。针对该问题，本文提出了一种视觉与惯导组合定位的方法。本文研究的惯导+视觉组合的定位方法中，采用基于合作目标的单目视觉定位方法对惯导误差进行修正。对于惯导误差的修正方法，本文利用视觉定位的位姿信息建立量测方程，进行卡尔曼滤波，并选取合适的试验设备，通过实际试验对比验证了该算法对惯导系统误差的修正具有良好的效果。

关键词: 多源融合导航, 合作目标, 位姿修正, 卡尔曼滤波

Abstract: The inertial navigation system can provide continuous navigation information, of which short-term positioning accuracy and stability is good. But positioning error increases with time which cannot work independently for a long time. The traditional way is to use the INS+GNSS integrated navigation method to correct the INS cumulative error. However, this method is no longer applicable in the situation where satellite signals such as indoors and underground are weak. In this paper, vision navigation method adopts a monocular vision positioning method based on cooperative target to correct the error of inertial navigation system. For the method of correcting the error of inertial navigation system, this paper uses the position and attitude information of vision navigation system to establish the observation equation, realize the Kalman filter algorithm based on vision correction, and show that the algorithm has good effect on the correction of the error of inertial navigation system through experiment.

Key words: multi-source fusion navigation, cooperative target, pose correction, Kalman filtering

中图分类号:

P228

邹汉达, 袁洪. 视觉辅助下的室内惯导位姿修正[J]. 测绘通报, 2019, 0(5): 16-20.

ZOU Handa, YUAN Hong. Pose correction of INS for indoor location based on a vision navigation method[J]. 测绘通报, 2019, 0(5): 16-20.

参考文献

[1] HE X F. Application of interval Kalman filter to an integrated GPS/SINS system[J]. Transactions of Nanjing University of Aeronautics and Astronautics, 1999, 16(1):39-45.
[2] ZHANG J, XU X, WANG B. A system-level compensation method for inertial navigation system[J]. Lecture Notes in Electrical Engineering, 2012, 176(4):229-233.
[3] 郝雨时, 徐爱功, 隋心, 等. 噪声协方差自适应控制下的双天线GNSS/INS初始对准方法[J]. 测绘学报, 2018, 47(4):473-479.
[4] 王勇, 陈国良, 李晓园, 等. 一种相机标定辅助的单目视觉室内定位方法[J]. 测绘通报, 2018(2):35-40.
[5] 徐勇志, 宁晓琳. 一种巡视器惯性/视觉组合导航新方法[J]. 空间科学学报, 2015, 35(6):721-729.
[6] 倪立学, 徐贵力, 胡建华. 一种地面合作目标的研究与设计[J]. 光电工程, 2007, 34(7):8-13.
[7] BASS R W. Kalman filtering:theory and practice[J]. Proceedings of the IEEE, 1996, 84:321-321.
[8] LI L Z, WANG X H, CAI S J. New recursion formula used in the matrix of the direction cosine in the strapdown inertial navigation and guidance system[J]. Journal of Astronautics, 2006, 27(3):349-353.
[9] HENDY H, RUI X T, KHALIL M. An integrated GPS/INS navigation system for land vehicle[J]. Applied Mechanics and Materials, 2013, 336-338(1):221-226.
[10] MUSOFF H, MURPHY J H. Study of strapdown navigation attitude algorithms[J]. Journal of Guidance Control Dynamics, 2012, 18(2):287-290.
[11] SAVAGE P G. Strapdown inertial navigation integration algorithm design part 1:attitude algorithms[J]. Journal of Guidance Control & Dynamics, 1998, 21(1):19-28.
[12] SAVAGE P G. Strapdown inertial navigation integration algorithm design part 2:velocity and position algorithms[J]. Journal of Guidance Control & Dynamics, 1998, 22(2):384-384.
[13] ROGERS R M, ROGERS R, ROGERS C R. Applied mathematics in integrated navigation systems[J]. Reston American Institute of Aeronautics & Astronautics Inc., 2007(2):78-88.
[14] TITTERTON D, WESTON J. Strapdown inertial navigation technology (2nd edition)[J]. IEEE Aerospace & Electronic Systems Magazine, 2005, 20(7):33-34.
[15] YU J C, CHEN J B, XU X Q. Multi-position observability analysis of strapdown inertial navigation system[J]. Journal of Beijing Institute of Technology, 2004, 24(2):150-153.
[16] BORTZ J E. A new mathematical formulation for strapdown inertial navigation[J]. IEEE Transactions on Aerospace and Electronic Systems, 1971, AES-7(1):61-66.

视觉辅助下的室内惯导位姿修正

Pose correction of INS for indoor location based on a vision navigation method

PDF

可视化

摘要/Abstract

引用本文

使用本文

参考文献

相关文章 15

编辑推荐

Metrics

本文评价

[1]	章诗芳, 张锦. 卡尔曼滤波在山西省西山煤田地面沉降GNSS监测中的应用[J]. 测绘通报, 2021, 0(9): 103-107.
[2]	宋宝, 柯福阳, 赵兴旺. 面向LiDAR/Radar松组合的迭代加权IEKF-BP组合算法精度分析[J]. 测绘通报, 2021, 0(2): 44-48.
[3]	王式太, 杨诗妮, 李雪珍. 单双频智能手机GNSS定位精度分析[J]. 测绘通报, 2021, 0(1): 18-23.
[4]	常明, 尹海权, 苏广利, 田晓, 徐玉健. 利用水准数据的天津市地面沉降时空特征分析[J]. 测绘通报, 2020, 0(7): 88-92.
[5]	冯木榉, 高迪, 何文涛. 面向低成本车载IMU的安装姿态估计[J]. 测绘通报, 2020, 0(6): 67-70.
[6]	刘星, 郭杭. 手机视觉与惯性融合的松耦合滤波算法[J]. 测绘通报, 2020, 0(2): 61-65.
[7]	陈文涛, 程鹏飞, 徐彦田. GPS/BDS/GLONASS双频RTK定位算法研究[J]. 测绘通报, 2020, 0(1): 55-60,70.
[8]	王亚荣, 黄声享, 匡翠林. 融合GNSS和加速度计监测数据的超高建筑动态特性分析[J]. 测绘通报, 2019, 0(8): 14-19.
[9]	张园, 谭兴龙, 赵长胜, 李晓明. 顾及有色噪声的自适应粒子滤波UWB定位算法[J]. 测绘通报, 2019, 0(8): 30-33.
[10]	闫伟, 牛小骥, 旷俭. 光源编码+PDR组合的室内行人定位方法[J]. 测绘通报, 2019, 0(5): 7-11,54.
[11]	程风, 李海霞, 常乐, 王力, 牛小骥. CNS+GNSS+INS船载高精度实时定位定姿算法改进研究[J]. 测绘通报, 2019, 0(5): 30-34.
[12]	任晓斌, 聂桂根, 李连艳, 陈祖岸, 雷浩川. 修正扩维无迹卡尔曼滤波算法研究[J]. 测绘通报, 2019, 0(5): 83-87,101.
[13]	严小意, 郭杭. 激光SLAM移动机器人室内定位研究[J]. 测绘通报, 2019, 0(12): 8-11.
[14]	杨帆, 赵增鹏, 张磊, 张子文. D-InSAR和水准数据融合方法研究[J]. 测绘通报, 2018, 0(6): 82-85.
[15]	王艺希, 秘金钟, 徐彦田, 王铎. BDS/GPS/GLONASS RTK定位算法研究[J]. 测绘通报, 2018, 0(3): 9-13.