室内惯性导航系统/相机拓扑测量的因子图合作定位算法

张琳; 廉保旺

doi:10.7652/xjtuxb202003009

您当前的位置：

首页 >

文章列表页 >

室内惯性导航系统/相机拓扑测量的因子图合作定位算法

更新时间：2025-07-09

- 室内惯性导航系统/相机拓扑测量的因子图合作定位算法
- Inertial Navigation System/Topology Measurement Integrated Algorithm with Factor Graph for Indoor Cooperative Locali-ation
- 西安交通大学学报 2020年54卷第3期页码：70-79
- 作者机构：
  
  西北工业大学电子信息学院,西安,710129
- 作者简介：
- 基金信息：
  
  : 2019-07-01。作者简介: 张琳(1988—),女,博士生;廉保旺(通信作者),男,教授。基金项目: 国家自然科学基金资助项目(61771393);国家自然科学基金青年科学基金资助项目(61803310)
- DOI：10.7652/xjtuxb202003009
  中图分类号： TP29;V249.3
- 网络首发：2020-03-10，
  
  纸质出版：2020
- 稿件说明：
移动端阅览
张琳, 廉保旺. 室内惯性导航系统/相机拓扑测量的因子图合作定位算法[J]. 西安交通大学学报, 2020,54(3):70-79.

Inertial Navigation System/Topology Measurement Integrated Algorithm with Factor Graph for Indoor Cooperative Locali-ation[J]. 2020, 54(3): 70-79.
张琳, 廉保旺. 室内惯性导航系统/相机拓扑测量的因子图合作定位算法[J]. 西安交通大学学报, 2020,54(3):70-79. DOI： 10.7652/xjtuxb202003009.

Inertial Navigation System/Topology Measurement Integrated Algorithm with Factor Graph for Indoor Cooperative Locali-ation[J]. 2020, 54(3): 70-79. DOI： 10.7652/xjtuxb202003009.

摘要

为解决合作定位算法中滤波结构不易扩展、鲁棒性差的问题

提出了一种适应于室内多用户的惯性导航系统/相机拓扑测量的因子图合作定位算法。利用目标检测识别算法

提出相机拓扑测量合作定位算法。通过构建拓扑测量、惯性导航系统因子函数

推导出基于因子图的可扩展参数优化模型。为进一步提高鲁棒性

引入综合考虑残差和检测分数的权值判断法

提出适应于相机拓扑测量的改进型开关约束算法。仿真和实测实验表明:拓扑测量观测精度的提升对位置和速度估计、算法收敛次数均有不同程度的改善; 合作+改进型开关约束算法的定位精度较非合作+非鲁棒算法的提高了79.8%; 改进型开关约束算法相比原开关约束算法具有较高的预测成功率

当测量遮挡时长比为0.4时

改进型开关约束算法将原开关约束算法对野值点的预测成功率由89.35%提高到了97.4%; 与原开关约束算法相比

引入权值判断法的改进型开关约束算法剔除了同用户多边框的异常拓扑测量值

减小了计算开销

提高了合作定位精度和鲁棒性。

Abstract

To address the deficiencies of standard filters and low robustness in cooperative locali-ation system

a novel factor graph algorithm is proposed

which can be applied to indoor multiple users by fusing topology measurement provided by cameras with inertial navigation system. A topology measuring cooperative locali-ation method is further presented utili-ing the objects detection algorithm from the images. To derive a flexible optimi-ation model of the navigation solution with incorporating asynchronous sensors capabilities

the topology measuring factors and inertial navigation system factors are created in solving nonlinear optimi-ation problems. To further enhance the robustness

an improved switch constraint algorithm is developed by introducing weights decision approach considering both residuals and detection scores

and it better suits to the topology measurements. Simulations and experiments show that the rising accuracy of topology measurements improves position and velocity e

关键词

Keywords

references

张佳龙, 闫建国, 张普, 等. 基于一致性算法的无人机协同编队避障研究 [J]. 西安交通大学学报, 2018, 52(9): 168-174.

ZHANG Jialong, YAN Jianguo, ZHANG Pu, et al. Collision avoidance of unmanned aerial vehicle formation based on consensus control algorithm [J]. Journal of Xi’an Jiaotong University, 2018, 52(9): 168-174.

KONG S H, JUN S Y. Cooperative positioning technique with decentralized malicious vehicle detection [J]. IEEE Transactions on Intelligent Transportation Systems, 2018, 19(3): 826-838.

魏全瑞, 刘俊, 韩九强. 改进的无线传感器网络无偏距离估计与节点定位算法 [J]. 西安交通大学学报, 2014, 48(6): 1-6.

WEI Quanrui, LIU Jun, HAN Jiuqiang. An improved DV-hop node localization algorithm based on unbiased estimation for wireless sensor networks [J]. Journal of Xi’an Jiaotong University, 2014, 48(6): 1-6.

SOTTILE F, CACERES M A, SPIRITO M A. A simulation tool for hybrid-cooperative positioning [C]∥Proceedings of International Conference on Localization and GNSS. Piscataway, NJ, USA: IEEE, 2011: 64-70.

PIASCO N, MARZAT J, SANFOURCHE M. Collaborative localization and formation flying using distributed stereo-vision [C]∥Proceedings of IEEE International Conference on Robotics and Automation. Piscataway, NJ, USA: IEEE, 2016: 1202-1207.

NASERI H, KOIVUNEN V. Cooperative simultaneous localization and mapping by exploiting multipath propagation [J]. IEEE Transactions on Signal Processing, 2017, 65(1): 200-211.

邸凯昌, 万文辉, 赵红颖, 等. 视觉SLAM技术的进展与应用 [J]. 测绘学报, 2018, 47(6): 770-779.

DI Kaichang, WAN Wenhui, ZHAO Hongying, et al. Progress and applications of visual SLAM [J]. Acta Geodaetica et Cartographica Sinica, 2018, 47(6): 770-779.

MINETTO A, CRISTODARO C, DOVIS F. A collaborative method for positioning based on GNSS inter agent range estimation [C]∥Proceedings of 25th European Signal Processing Conference. Piscataway, NJ, USA: IEEE, 2017: 2714-2718.

STANCOVICI A, MICEA M V, CRETU V. Cooperative positioning system for indoor surveillance applications [C]∥Proceedings of International Conference on Indoor Positioning and Indoor Navigation. Piscataway, NJ, USA: IEEE, 2016: 1-7.

ZENG Q H, CHEN W N, LIU J Y, et al. An improved multi-sensor fusion navigation algorithm based on the factor graph [J]. Sensors, 2017, 17(3): 641.

SUNDERHAUF N, OBST M, LANGE S, et al. Switchable constraints and incremental smoothing for online mitigation of non-line-of-sight and multipath effects [C]∥Proceedings of IEEE Intelligent Vehicles Symposium. Piscataway, NJ, USA: IEEE, 2013: 262-268.

PFEIFER T, WEISSIG P, LANGE S, et al. Robust factor graph optimization: a comparison for sensor fusion applications [C]∥Proceedings of IEEE 21st International Conference on Emerging Technologies and Factory Automation. Piscataway, NJ, USA: IEEE, 2016: 1-4.

OZOG P, EUSTICE R M. Large-scale model-assisted bundle adjustment using Gaussian max-mixtures [C]∥Proceedings of IEEE International Conference on Robotics and Automation. Piscataway,NJ,USA: IEEE, 2016: 5576-5581.

崔云博, 杜友田, 王航. 面向图像的有效目标区域提取方法 [J]. 西安交通大学学报, 2019, 53(5): 52-57.

CUI Yunbo, DU Youtian, WANG Hang. Extraction method for key object region in images [J]. Journal of Xi’an Jiaotong University, 2019, 53(5): 52-57.

BELLAVIA S, GRATTON S, RICCIETTI E. A Levenberg-Marquardt method for large nonlinear least-squares problems with dynamic accuracy in functions and gradients [J]. Numerische Mathematik, 2018, 140(3): 791-825.

GIRSHICK R, DONAHUE J, DARRELL T, et al. Rich feature hierarchies for accurate object detection and semantic segmentation [C]∥Proceedings of IEEE Conference on Computer Vision and Pattern Recognition. Piscataway, NJ, USA: IEEE, 2014: 580-587.

GIRSHICK R. Fast R-CNN [C]∥Proceedings of IEEE International Conference on Computer Vision. Piscataway, NJ, USA: IEEE, 2015: 1440-1448.

REN S Q, HE K M, GIRSHICK R, et al. Faster R-CNN: towards real-time object detection with region proposal networks [J]. IEEE Transactions on Pattern Analysis and Machine Intelligence, 2017, 39(6): 1137-1149.

浏览量

下载量

CSCD

文章被引用时，请邮件提醒。

提交

工具集

关联资源

联合串行干扰抵消与因子图的单通道混合信号盲分离算法

扇贝仿生密封腔室内超临界二氧化碳泄漏流湍动能耗散机理研究

结构-语义-残差协同的图像压缩框架：面向隐私保护与高保真重建

语义区分和子图整合驱动的知识图谱表示学习方法

电子级超纯氮深冷空分流程节能优化研究