采用相对位置量测的紧耦合式多无人机协同定位算法

刘淑青; 高永新; 韩德强

doi:10.7652/xjtuxb202410016

您当前的位置：

首页 >

文章列表页 >

采用相对位置量测的紧耦合式多无人机协同定位算法

—————————————————————— | 更新时间：2025-07-28

- 采用相对位置量测的紧耦合式多无人机协同定位算法
- Tightly Coupled Cooperative Localization Algorithm for Multiple Unmanned Aerial Vehicles Based on Relative Position Measurements
- 西安交通大学学报 2024年58卷第10期页码：178-187
- 作者机构：
  
  西安交通大学电子与信息学部,西安,710049
- 作者简介：
  
  : 2024-01-29。作者简介: 刘淑青(1999—),女,硕士生
  高永新(通信作者),男,副教授。基金项目: 国家自然科学基金资助项目(U22A2045)。
- 基金信息：
  
  : 2024-01-29。作者简介: 刘淑青(1999—),女,硕士生;高永新(通信作者),男,副教授。基金项目: 国家自然科学基金资助项目(U22A2045)。
- DOI：10.7652/xjtuxb202410016
  中图分类号： TP29;V249.3
- 网络首发：2024-10-10，
  
  纸质出版：2024
- 稿件说明：
移动端阅览
刘淑青, 高永新, 韩德强. 采用相对位置量测的紧耦合式多无人机协同定位算法[J]. 西安交通大学学报, 2024,58(10):178-187.

LIU Shuqing, GAO Yongxin, HAN Deqiang. Tightly Coupled Cooperative Localization Algorithm for Multiple Unmanned Aerial Vehicles Based on Relative Position Measurements[J]. 2024, 58(10): 178-187.
刘淑青, 高永新, 韩德强. 采用相对位置量测的紧耦合式多无人机协同定位算法[J]. 西安交通大学学报, 2024,58(10):178-187. DOI： 10.7652/xjtuxb202410016.

LIU Shuqing, GAO Yongxin, HAN Deqiang. Tightly Coupled Cooperative Localization Algorithm for Multiple Unmanned Aerial Vehicles Based on Relative Position Measurements[J]. 2024, 58(10): 178-187. DOI： 10.7652/xjtuxb202410016.

摘要

针对仅使用惯性测量单元(IMU)的自主定位导航存在严重误差累积的问题

将IMU解算和置信传播(BP)算法进行紧耦合

在扩展卡尔曼滤波器(EKF)的框架下

使用无人机(UAV)间的相对位置量测直接更新大地坐标系下各无人机的位置状态

提出了一种适用于大地坐标系多无人机定位与导航的紧耦合的分布式协同定位算法(EKF-BP)。首先

实现了基于IMU量测和无人机间相对位置量测的集中式协同定位算法; 接着

将BP算法扩展到大地坐标系

并与基于IMU的自主导航紧耦合

完成卫星拒止环境中多无人机系统的协同定位与导航; 最后

将所提出的方法与基于协方差交叉的协同定位进行比较。仿真结果表明

分布式协同定位算法具有明显的计算效率优势

与基于协方差交叉的分布式协同定位方法相比

所提EKF-BP算法提高了多无人机系统在卫星拒止环境中的定位导航精度

是协方差交叉方法提升量的10倍左右。所提的分布式EKF-BP算法能够显著地抑制仅依赖IMU数据所导致的定位导航精度随时间迅速变差的问题。

Abstract

To tackle the error-accumulation issue of autonomous localization and navigation utilizing inertial measurement unit(IMU)

a tightly coupled approach that integrates IMU estimation and belief propagation(BP)algorithm within the framework of the extended Kalman filter(EKF)is proposed. The proposed EKF-BP method directly updates the position states of multiple unmanned aerial vehicles(UAV)in the geodetic coordinate system based on relative position measurements. Firstly

a centralized cooperative localization algorithm is implemented based on IMU measurements and relative position measurements among UAVs. Then

the BP algorithm is extended to the geodetic coordinate system and tightly coupled with IMU-based autonomous navigation to achieve cooperative localization and navigation of multiple UAV systems in satellite-denied environments. Finally

the proposed method is compared with the cooperative localization based on covariance intersection. The simulation results show that the proposed distributed cooperative localization method has an obvious advantage in computing efficiency as the number of UAVs increases. In comparison to the distributed cooperative localization based on covariance intersection

EKF-BP achieves enhanced precision in localization and navigation in satellite-denied environments

which is about 10 times the improvement of the covariance intersection method. The proposed EKF-BP method effectively suppresses the rapid accuracy degradation of dead reckoning relying merely on IMU measurements.

关键词

Keywords

references

李清华, 高影, 王振桓, 等. 一种动态分组的多节点协同定位编队构型优化方法 [J]. 中国惯性技术学报, 2022, 30(6): 746-751.

LI Qinghua, GAO Ying, WANG Zhenhuan, et al. A dynamic grouping formation configuration optimization method for multi-node cooperative localization [J]. Journal of Chinese Inertial Technology, 2022, 30(6): 746-751.

HAN Ke, ZHANG Chongyu, XING Huashuai, et al. An area optimization based cooperative localization algorithm with node selection [J]. China Communications, 2021, 18(12): 178-195.

CHOI J, MYUNG H. BRM localization: UAV localization in GNSS-denied environments based on matching of numerical map and UAV images [C]//2020 IEEE/RSJ International Conference on Intelligent Robots and Systems. Piscataway, NJ, USA: IEEE, 2020: 4537-4544.

PAULL L, SAEEDI S, SETO M, et al. AUV navigation and localization: a review [J]. IEEE Journal of Oceanic Engineering, 2014, 39(1): 131-149.

PIRES A G, REZECK P A F, CHAVES R A, et al. Cooperative localization and mapping with robotic swarms [J]. Journal of Intelligent Robotic Systems, 2021, 102(2): 47.

YAN Zheping, LUAN Zhengkun, LIU Jianbo, et al. A cooperative localization method for multiple unmanned underwater vehicles based on improved factor graph [C]//2023 IEEE International Conference on Mechatronics and Automation. Piscataway, NJ, USA: IEEE, 2023: 894-899.

WAINWRIGHT M J, JAAKKOLA T S, WILLSKY A S. Tree-based reparameterization framework for analysis of sum-product and related algorithms [J]. IEEE Transactions on Information Theory, 2003, 49(5): 1120-1146.

SU Qinliang, WU Y C. Convergence analysis of the variance in gaussian belief propagation [J]. IEEE Transactions on Signal Processing, 2014, 62(19): 5119-5131.

MEYER F, HLINKA O, HLAWATSCH F. Sigma point belief propagation [J]. IEEE Signal Processing Letters, 2014, 21(2): 145-149.

WIELANDNER L, LEITINGER E, MEYER F, et al. Message passing-based 9-D cooperative localization and navigation with embedded particle flow [J]. IEEE Transactions on Signal and Information Processing Over Networks, 2023, 9: 95-109.

GARCÍA-FERNÁNDEZ Á F, SVENSSON L, SÄRKKÄ S. Cooperative localization using posterior linearization belief propagation [J]. IEEE Transactions on Vehicular Technology, 2018, 67(1): 832-836.

GARCÍA-FERNÁNDEZÁ F, SVENSSON L, MORELANDE M R, et al. Posterior linearization filter: principles and implementation using sigma points [J]. IEEE Transactions on Signal Processing, 2015, 63(20): 5561-5573.

ÇAKMAK B, URUP D N, MEYER F, et al. Cooperative localization for mobile networks: a distributed belief propagation-mean field message passing algorithm [J]. IEEE Signal Processing Letters, 2016, 23(6): 828-832.

WYMEERSCH H, LIEN J, WIN M Z. Cooperative localization in wireless networks [J]. Proceedings of the IEEE, 2009, 97(2): 427-450.

KIM H, CHOI S W, KIM S. Connectivity information-aided belief propagation for cooperative localization [J]. IEEE Wireless Communications Letters, 2018, 7(6): 1010-1013.

CORNELISSEN K, MANTHEY B. Belief propagation for the maximum-weight independent set and minimum spanning tree problems [J]. Theoretical Computer Science, 2018, 738: 53-64.

FANG Susu, LI Hao, YANG Ming. Adaptive cubature split covariance intersection filter for multi-vehicle cooperative localization [J]. IEEE Robotics and Automation Letters, 2022, 7(2): 1158-1165.

SUN Shuli. Multi-sensor optimal information fusion Kalman filters with applications [J]. Aerospace Science and Technology, 2004, 8(1): 57-62.

CHANG T K, CHEN K, MEHTA A. Resilient and consistent multirobot cooperative localization with covariance intersection [J]. IEEE Transactions on Robotics, 2022, 38(1): 197-208.

LIANG Mingchao, MEYER F. Neural enhanced belief propagation for cooperative localization [C]//2021 IEEE Statistical Signal Processing Workshop. Piscataway, NJ, USA: IEEE, 2021: 326-330.

杨秀建, 谢永焘. 基于启发式调谐EH∞F的多机器人协同定位 [J]. 中国惯性技术学报, 2023, 31(1): 24-32.

YANG Xiujian, XIE Yongtao. Multi-robot cooperative localization based on heuristically tuned extended H∞ filter [J]. Journal of Chinese Inertial Technology, 2023, 31(1): 24-32.

GOEL S, KEALYA, GIKAS V, et al. Cooperative localization of unmanned aerial vehicles using GNSS, MEMS inertial, and UWB sensors [J]. Journal of Surveying Engineering, 2017, 143(4): 04017007.

NOURELDIN A, KARAMAT T B, GEORGY J. Fundamentals of inertial navigation, satellite-based positioning and their integration [M]. Berlin, Germany: Heidelberg, 2013.

ZHANG Bolun, GAO Guangen, GAO Yongxin. Cooperative localization based on augmented state belief propagation for mobile agent networks [J]. Electronics, 2022, 11(13): 1959.

MA Xiaoshuang, LIU Xixiang, LI Chenlong, et al. Multi-source information fusion based on factor graph in autonomous underwater vehicles navigation systems [J]. Assembly Automation, 2021, 41(5): 536-545.

SU Qinliang, WU Y C. On convergence conditions of Gaussian belief propagation [J]. IEEE Transactions on Signal Processing, 2015, 63(5): 1144-1155.

浏览量

下载量

CSCD

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

提交

工具集

关联资源

电动车辆间接热系统快速除湿响应迟滞机理及优化控制策略

EBSILON软件在热电联产系统优化中的应用综述

超临界水异常区域热力学特性研究

融合物理信息与深度算子网络的变压器绕组热-流场快速计算方法

混合电解槽阵列协同的风光耦合制氢系统双层多目标优化