首页 > 论文 > 激光与光电子学进展 > 55卷 > 10期(pp:101201--1)

基于工作空间测量定位系统和激光雷达的室内组合导航算法研究

Indoor Integrated Navigation Algorithm Based on Workshop Measurement Positioning System and Lidar

  • 摘要
  • 论文信息
  • 参考文献
  • 被引情况
  • PDF全文
分享:

摘要

针对复杂场景下大空间室内高精度导航应用, 提出一种基于工作空间测量定位系统(wMPS)和激光雷达的组合建图、定位算法。采用wMPS对激光雷达位姿进行精确估计, 融合激光雷达点云数据完成栅格地图的绘制, 使得机器人在导航时能够识别周围环境信息; 考虑到导航时容易缺失wMPS测量信息的情况, 根据雷达获得的实时数据与栅格地图通过粒子滤波算法反算雷达的位姿; 最后将粒子滤波的结果进行线性卡尔曼滤波处理, 并进行算法仿真与实验。仿真与实验结果表明:组合导航系统保证了地图的可靠性和动态导航精度, 大大提升了系统的整体性能。

Abstract

Aiming at the large space indoor high-precision navigation application in complex environment, we propose an algorithm for integrated mapping and positioning based on workshop Measurement Positioning System (wMPS) and lidar. The wMPS carries out precise estimation on the position and orientation of the lidar, and integrates the point cloud data of the lidar to complete the mapping of the grid map. Therefore, the robot can recognize the information of the surrounding environment when navigating. Then considering that the wMPS measurement information is easy to be missing during navigating, we use particle filter algorithm to inversely calculate the position and orientation of the lidar according to the real-time point cloud data from lidar and the gird map. Finally, the results of particle filter are processed with the linear Kalman filter, and the algorithm simulation and experiment are conducted. The simulation and experimental results show that the integrated navigation system ensures the reliability of the map and the accuracy of the dynamic navigation, which greatly improves the overall performance of the navigation system.

Newport宣传-MKS新实验室计划
补充资料

中图分类号:V241.6

DOI:10.3788/lop55.101201

所属栏目:仪器,测量与计量

基金项目:国家重点研发计划(2017YFF0204802)、天津市自然科学基金(16JCZDJC38100)

收稿日期:2018-03-26

修改稿日期:2018-04-26

网络出版日期:2018-05-05

作者单位    点击查看

王金旺:天津大学精密测试技术及仪器国家重点实验室, 天津 300072
杨凌辉:天津大学精密测试技术及仪器国家重点实验室, 天津 300072
史慎东:天津大学精密测试技术及仪器国家重点实验室, 天津 300072
赵显:天津大学精密测试技术及仪器国家重点实验室, 天津 300072
张正吉:天津大学精密测试技术及仪器国家重点实验室, 天津 300072
徐秋宇:天津大学精密测试技术及仪器国家重点实验室, 天津 300072

联系人作者:杨凌辉(icelinker@tju.edu.cn); 王金旺(jinwang@tju.edu.cn);

【1】Jiang Q, Zhang Y Z, Zhang S Q, et al. Path planning method of the AGV navigated by IGPS in aircraft digital assembly[J]. Aeronautical Manufacturing Technology, 2016(22): 72-77, 83.
蒋倩, 张云志, 张少擎, 等. 飞机数字化装配中IGPS导航的AGV路径规划方法[J]. 航空制造技术, 2016(22): 72-77, 83.

【2】Liu B, Zhang J, Lu M, et al. Research progress of laser radar applications[J]. Laser & Infrared, 2015, 45(2): 117-122.
刘斌, 张军, 鲁敏, 等. 激光雷达应用技术研究进展[J]. 激光与红外, 2015, 45(2): 117-122.

【3】Guan Y, Sun D D, Yin S G, et al. High precision visible light indoor positioning based on image communication[J]. Chinese Journal of Lasers, 2016, 43(12): 1206001.
管扬, 孙德栋, 殷树刚, 等. 基于成像通信的高精度可见光室内定位方法[J]. 中国激光, 2016, 43(12): 1206001.

【4】Xie Z X, Chen W Z, Chi S K, et al. Industrial robot positioning system based on the guidance of the structured-light vision[J]. Acta Optica Sinica, 2016, 36(10): 1015001.
解则晓, 陈文柱, 迟书凯, 等. 基于结构光视觉引导的工业机器人定位系统[J]. 光学学报, 2016, 36(10): 1015001.

【5】Li C X, Zhang J, Jin X Y, et al. Review of LIDAR SLAM technology and its application in autonomous vehicles[J]. Journal of Beijing Union University (Natural Science), 2017, 31(4): 61-69.
李晨曦, 张军, 靳欣宇, 等. 激光雷达SLAM技术及其在无人车中的应用研究进展[J]. 北京联合大学学报(自然科学版), 2017, 31(4): 61-69.

【6】Huang Z, Yang L H, Zhao Z Y, et al. Research on optoelectronic scanning dynamic coordinate measurement algorithm based on extended Kalman filter[J]. Laser & Optoelectronics Progress, 2016, 53(5): 051201.
黄喆, 杨凌辉, 赵子越, 等. 基于扩展卡尔曼滤波的光电扫描动态坐标测量算法研究[J]. 激光与光电子学进展, 2016, 53(5): 051201.

【7】Xue C H, Nie G G, Wang J. Comparison of performance between extended Kalman filter and particle filter[J]. Bulletin of Surveying and Mapping, 2016(4): 10-14.
薛长虎, 聂桂根, 汪晶. 扩展卡尔曼滤波与粒子滤波性能对比[J]. 测绘通报, 2016(4): 10-14.

【8】Wang D, Zhao X, Zou Y G, et al. Research on filtering algorithm based on laser ranging system[J]. Laser & Optoelectronics Progress, 2016, 53(10): 101402.
王丹, 赵鑫, 邹永刚, 等. 基于激光测距系统的滤波算法研究[J]. 激光与光电子学进展, 2016, 53(10): 101402.

【9】Yang L H, Yang X Y, Lao D B, et al. Large-scale coordinates measurement method based on intersection of optical planes[J]. Infrared and Laser Engineering, 2010, 39(6): 1105-1109.
杨凌辉, 杨学友, 劳达宝, 等. 采用光平面交汇的大尺寸坐标测量方法[J]. 红外与激光工程, 2010, 39(6): 1105-1109.

【10】Shi S D, Yang L H, Lin J R, et al. Omnidirectional angle constraint based dynamic six-degree-of-freedom measurement for spacecraft rendezvous and docking simulation[J]. Measurement Science and Technology, 2018, 29(4): 045005.

【11】Lei B B, Zeng W B, Li C X. A method of mapping based on ROS[J]. Industrial Control Computer, 2017, 30(9): 42-43, 45.
雷碧波, 曾文彬, 李晨曦. 基于ROS二维地图构建的方法[J]. 工业控制计算机, 2017, 30(9): 42-43, 45.

【12】Sheng Z, Xie S Q, Pan C Y. Probability theory and mathematics statistics[M]. Beijing: Higher Education Press, 2003: 115-126.
盛骤, 谢式千, 潘承毅. 概率论与数理统计[M]. 北京: 高等教育出版社, 2003: 115-126.

【13】Zhao X Y. Research on simultaneous localization and indoor mapping algorithm based on lidar[D]. Harbin: Harbin Institute of Technology, 2017: 20-43.
赵新洋. 基于激光雷达的同时定位与室内地图构建算法研究[D]. 哈尔滨: 哈尔滨工业大学, 2017: 20-43.

【14】Hol J D, Schon T B, Gustafsson F. On resampling algorithms for particle filters[C]. 2006 IEEE Nonlinear Statistical Signal Processing Workshop. 2006: 4378824.

【15】Jin N G. Study on audio-visual speaker localization and tracking[D]. Dalian: Dalian University of Technology, 2008: 15-34.
金乃高. 音视频联合说话人定位与跟踪方法研究[D]. 大连: 大连理工大学, 2008: 15-34.

【16】Duanmu Q, Yang X Y, Zhu J G. Study on tracking algorithm for wMPS based on least square-Kalman filter[J]. Chinese Journal of Sensors and Actuators, 2012, 25(2): 236-239.
端木琼, 杨学友, 邾继贵. 基于小二乘-卡尔曼滤波的wMPS系统跟踪定位算法研究[J]. 传感技术学报, 2012, 25(2): 236-239.

【17】Dong W H. Research of Kalman filter on initial alignment of inertial navigation system[D]. Harbin: Harbin Institute of Technology, 2010: 29-30.
董卫华. 最优卡尔曼滤波在惯导系统初始对准中的应用研究[D]. 哈尔滨: 哈尔滨工业大学, 2010: 29-30.

【18】Wang J, Yang L H, Huang Z, et al. Indoor integrated navigation algorithm based on photoelectric scanning and strapdown inertial navigation system[J]. Laser & Optoelectronics Progress, 2016, 53(10): 101201.
王姣, 杨凌辉, 黄喆, 等. 基于光电扫描/捷联惯导系统的室内组合导航算法研究[J]. 激光与光电子学进展, 2016, 53(10): 101201.

引用该论文

Wang Jinwang,Yang Linghui,Shi Shendong,Zhao Xian,Zhang Zhengji,Xu Qiuyu. Indoor Integrated Navigation Algorithm Based on Workshop Measurement Positioning System and Lidar[J]. Laser & Optoelectronics Progress, 2018, 55(10): 101201

王金旺,杨凌辉,史慎东,赵显,张正吉,徐秋宇. 基于工作空间测量定位系统和激光雷达的室内组合导航算法研究[J]. 激光与光电子学进展, 2018, 55(10): 101201

您的浏览器不支持PDF插件,请使用最新的(Chrome/Fire Fox等)浏览器.或者您还可以点击此处下载该论文PDF