Inertial Navigation System/Topology Measurement Integrated Algorithm with Factor Graph for Indoor Cooperative Locali-ation

doi:10.7652/xjtuxb202003009

您当前的位置：

首页 >

文章列表页 >

Inertial Navigation System/Topology Measurement Integrated Algorithm with Factor Graph for Indoor Cooperative Locali-ation

更新时间：2025-07-09

- Inertial Navigation System/Topology Measurement Integrated Algorithm with Factor Graph for Indoor Cooperative Locali-ation
- Vol. 54, Issue 3, Pages: 70-79(2020)
- 作者机构：
  
  西北工业大学电子信息学院,西安,710129
- 作者简介：
- 基金信息：
- DOI：10.7652/xjtuxb202003009
  CLC： TP29;V249.3
- Online First：10 March 2020，
  
  Published：2020
- 稿件说明：
移动端阅览
Inertial Navigation System/Topology Measurement Integrated Algorithm with Factor Graph for Indoor Cooperative Locali-ation[J]. 2020, 54(3): 70-79.
DOI：

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.

Views

下载量

CSCD

Alert me when the article has been cited

提交

Tools

Publicity Resources

A Blind Separation Algorithm of Single-Channel Signals Based on Serial Interference Cancellation and Factor Graphs

Influence of Structural Parameters on the Summer Operational Characteristics of a Three-Tower-in-One Indirect Air-Cooling System

A Structure-Semantics-Residual Collaborative Image Compression Framework：Towards Privacy Protection and High-Fidelity Reconstruction

Numerical Simulation of the Energy Conversion Process in Thermoacoustic Engines with Different Stack Materials

Review of the Application of EBSILON Software in Combined Heat and Power System Optimization

Related Author

郭一鸣

彭华

张冬玲

杨勇

Related Institution

Institute of Information System Engineering, Information Engineering University of PLA

⁰