控制与系统

无人机空中加油相对位姿解耦迭代确定算法

展开
  • 1. 空军工程大学工程学院,西安710038
    2. 中国人民解放军93942 部队,陕西咸阳712000
王龙,博士生,研究方向:自主空中加油视觉相对导航、组合导航、数据融合等,E-mail: afeu78@126.com;董新民,教授,博导,研究方向:飞行器控制理论与应用、智能控制等,E-mail: dongxinmin@163.com

收稿日期: 2011-08-15

  修回日期: 2012-03-06

  网络出版日期: 2012-07-30

基金资助

航空科学基金(No.2008ZC01006, No.20110896009)资助

Relative Pose Decoupled Iterative Determination Algorithm for UAV Aerial Refueling

Expand
  • 1. Engineering College, Air Force Engineering University, Xi’an 710038, China
    2. Unit 93942, People’s Liberation Army, Xianyang 712000, Shaanxi Province, China

Received date: 2011-08-15

  Revised date: 2012-03-06

  Online published: 2012-07-30

摘要

 针对视线方程中位置和姿态信息存在严重耦合及强非线性的问题,研究了一种相对位姿解耦迭代确定算法,并用于无人机空中加油. 根据卫星导航中的伪距概念,利用视线矢量构建观测矩阵,通过最小二乘法求解相对位置更新,进而更新伪距确定相对姿态. 引入单步迭代误差证明了算法的收敛性,通过分析误差协方差阵的迹讨论
特征点几何构型对相对位置确定精度的影响. 仿真结果表明,与高斯最小二乘微分修正算法相比,提出的算法运行速度和抗噪声性能分别提高了23%和40%,相对位置稳态误差优于0.1 m,相对姿态误差优于0.5±,满足无人机空中加油对接阶段相对位姿测量精度要求.

本文引用格式

王龙1, 董新民1, 贾海燕2 . 无人机空中加油相对位姿解耦迭代确定算法[J]. 应用科学学报, 2012 , 30(4) : 427 -432 . DOI: 10.3969/j.issn.0255-8297.2012.04.016

Abstract

 Considering the coupled and nonlinear relationship between the relative pose in the line of sight
equations, an iterative decoupling algorithm is proposed to determine relative pose. Application of the method
to aerial refueling is discussed. Based on the pseudo-range of satellite navigation, an observation matrix is
constructed by using line of sight vectors. The relative position are updated by the least square method, and
then the relative attitude is updated. By introducing an iterative error, convergence of the iterative algorithm
is proved. The trace of error variance matrix is used to analyze the effect of feature geometry configuration
on the precision. Simulation results show that the proposed algorithm can improve performance by 23% and
40% in speed and robustness than Gaussian least square differential correction (GLSDC), respectively. Steady
state errors of relative pose are 0.1 m and 0.2± lower respectively. The precisio can satisfy the relative pose
requirements of UAV aerial refueling during docking.

文章导航

/