基于修iE Rodrigues参数和UKF的姿态估计算法

以修正Rodrigues参数作为姿态参数,利用无味Kalman滤波(uKF)设计了一种全姿态估计算法.修正Rodrigues参数在姿态估计中具有简洁高效的优点,然而,因其奇异性不能用于全姿态运动情况.利用修正Rodrigues参数与其影子参数相互切换的方法可以避免奇异现象的发生.UKF直接利用非线性模型而不需要线性化,适用于高精度的姿态估计.本文针对"陀螺 矢量观测"这种典型的姿态确定模式,以修正Rodrigues参数与其影子参数相互切换的方法描述姿态,利用UKF设计了姿态估计器.状态协方差阵在姿态参数切换时发生突变,引起姿态估计器的滤波波动.为此,提出了在姿态参数切换时对姿态估计器进行修正的方法.最后通过仿真验证了算法的有效性.     

基于修正Rodrigues参数和UKF的姿态估计算法

以修正Rodrigues参数作为姿态参数,利用无味Kalman滤波（UKF）设计了一种全姿 态估 计算法。修正Rodrigues参数在姿态估计中具有简洁高效的优点,然而,因其奇异性不能用 于全姿态运动情况。利用修正Rodrigues参数与其影子参数相互切换的方法可以避免奇异现 象的发生。UKF直接利用非线性模型而不需要线性化,适用于高精度的姿态估计。本文针对 “陀螺+矢量观测”这种典型的姿态确定模式,以修正Rodrigues参数与其影子参数相互切换 的方法描述姿态,利用UKF设计了姿态估计器。状态协方差阵在姿态参数切换时发生突变, 引起姿态估计器的滤波波动。为此,提出了在姿态参数切换时对姿态估计器进行修正的方法 。最后通过仿真验证了算法的有效性     

刚体姿态估计的类Rodrigues参数算法研究

针对Rodrigues参数描述刚体姿态运动时的缺陷,提出了一种类Rodrigues参数的姿态估计算法,从定义上避免了Rodrigues参数和修正Rodrigues参数在π-,-π,2π,-2π时的奇异。推导了类Rodrigues参数描述的姿态运动学微分方程,给出了坐标变换的类Rodrigues参数描述,讨论了类Rodr...     

姿态运动的Rodrigues参数描述

详细介绍了刚体姿态运动的Rodrigues参数描述，指出了Rodrigues参数的许多新特性，定义了Rodrigues参数的乘法及相关的代数运算，给出了坐标变换的Rodrigues参数乘法描述，推导了Rodrigues参数描述的姿态运动学微分方程及逆运动方程，并给出了Rodrigues参数与其他常用姿态描述之间的转换公式。文中指出用Rodrigues参数描述姿态转动具有简洁、直观的优点，而且Rodrigues参数描述的微分方程结构简洁、无多余的约束，其计算效率优于当前广泛应用的四元数方法。文末介绍了Rodrigues参数在弹道导弹捷联姿态实时解算中的应用，基于Rodrigues参数的捷联姿态算法在计算精度、内存消耗上均优于目前弹上计算机使用的四元数递推算法，且计算量仅相当于后者的一半。     

基于双目视觉的相对状态自主确定

基于双目视觉系统提出了一种适于交会对接最后阶段的近距离绕飞的相对状态自主确定方法。用修正罗德里格参数(MRP)描述姿态,给出了追踪器与目标器间的相对姿态运动学与动力学方程,以及相对运动方程,根据双目视觉系统的小孔成像原理建立了双目系统的测量数学模型,由扩展卡尔曼滤波(EKF)获得两航天器的相对位姿及其变化率。仿真结果表明该法可行。     

基于对偶四元数的航天器交会对接位姿双目视觉测量算法

针对航天器交会对接中位姿参数的测量问题,突破传统的位姿计算态分而治之的模式,采用双目视觉技术和对偶四元数这一数学工具,建立了追踪航天器与目标航天器间相对位姿参数的统一描述模型.该模型与传统的欧拉角和四元数的描述方法完全不同,具有非常简洁统一的形式.同时,针对该对偶四元数模型,给出其两步解析算法,解算出两航天器间的相对位置和姿态参数.仿真结果表明该算法能够满足航天器位姿参数的测量要求,并且具有较强的稳定性,对航天器的在轨实时应用具有重要参考价值.     

对空间碎片的相对位姿估计

针对几何、质量特性参数均未知的空间碎片,提出一种基于扩展卡尔曼滤波（EKF）的相对位姿估计算法。该算法以单目相机获得的目标图像特征视线信息作为测量输入,以目标姿态、姿态角速度、惯量比、相对位置、相对速度和特征位置作为滤波状态。对算法进行可观性分析,给出两个可以保证算法可观性的条件。分别针对不同条件进行数值仿真,仿真结果表明新算法能够对几何和质量参数未知的空间碎片进行有效的相对位姿 估计。     

面向在轨服务的相对位姿单目视觉确定的凸松弛优化方法

针对非合作目标之间基于特征点的相对位姿单目视觉确定问题,考虑利用自然特征导致误差增大等因素,提出一种基于凸松弛理论和LMI算法的相对位姿求解迭代方法。该方法在基于逆投影线构建的优化模型基础上,首先利用松弛理论将姿态矩阵的单位正交非凸等式约束松弛为不等式凸约束,并证明了松弛后的优化问题与原问题等价,即松弛后的凸问题取得最值时,姿态矩阵满足原等式约束。进一步将松弛后的姿态矩阵不等式凸约束表示成线性矩阵不等式形式,进而利用内点法进行求解,并利用全局收敛性定理证明了该算法的全局收敛性。以在轨服务为背景,仿真试验表明,利用该算法相对位姿可在7次迭代达到收敛,与传统SVD算法相比,在噪声较大的情况下,该算法计算精度提高近一倍,能够快速收敛并具有较强的鲁棒性。     

双Rodrigues参数方法及其在姿态确定中的应用

提出了一种利用Rodrigues参数序对描述刚体姿态运动的方法。首先证明了刚体的任一     

逼近段惯性/视觉组合相对导航算法

针对交会对接最终逼近段相对位姿测量,提出了惯性/视觉组合相对导航算法.基于对接航天器相对运动模型,利用追踪航天器上惯性测量单(IMU)获取两航天器间的相对运动信息作为短期参考,以电荷耦合器件(CCD)视觉测量作为长期参考,综合姿态四元数运动学方程,分别建立了姿态滤波器和位置滤波器.仿真结果表明算法可行且有效,并仿真分析...     

基于预测滤波的卫星交会对接相对位姿确定方法

基于视频制导系统提供的视线测量,引入一种高精度、高鲁棒性的、实时的预测滤波算法,建立系统的误差模型,对角速度和位移速度进行一步预测,从而精确地估计卫星的相对位置和相对姿态。此外提出修正方案,通过卡尔曼增益对相对姿态和相对位移进行修正和更新,估计性能得到改进优化。通过卫星交会对接仿真实验验证算法的有效性,结果表明,预测滤波算法高精确估计相对姿态和相对位置,修正后算法得到了更高的精度结果,满足卫星交会对接要求,对在轨实验有重要参考价值。     

基于MRPs/NPUPF的地磁/加速度计测量的姿态估计新方法

针对现有基于地磁/加速度计的姿态估计算法存在状态误差协方差阵的奇异值和需要准确已知当地地磁矢量的问题,提出了一种新的姿态估计基本方法。该方法采用修正罗德里格参数(MRPs)表示系统动态,消除了采用四元数法导致的状态误差协方差阵的奇异值问题;根据地磁场缓变的特性,将地磁矢量作为平稳过程加入到状态变量中,使得姿态估计不再需要准确已知当地地磁矢量。针对大初始误差和有色噪声对基本方法的影响,通过引入模型误差预测(NPF)和无迹粒子滤波(UPF)方法对其进行改进,提出了基于模型预测无迹粒子滤波(NPUPF)的地磁/加速度计的姿态估计新方法。仿真结果表明,NPUPF方法可在大初始误差和非高斯条件下实现高精度的姿态估计,提高了基于地磁/加速度计的姿态估计方法的可靠性和实用性。
     

基于样条模型的高精度星间相对定位与定姿

针对分布式小卫星编队的星间相对定位与定姿的高精度要求，提出了基于样条模型的星间相对定位与定姿的新方法。新方法将一段连续时间内的卫星状态参数用样条参数模型表示，将直接估计状态参数转化为样条参数，减少了待估参数的个数，实现了多时刻状态联解，提高了姿态参数对距离变化的敏感性，结构更加稳定。仿真结果表明，相对定位精度由5mm提高到2mm，相对定姿精度由0．0004弧度提高到0．00003弧度，并解决了估计不稳定现象。     

Distributed attitude synchronization of formation flying via consensus-based virtual structure

This paper presents a general framework for synchronized multiple spacecraft rotations via consensus-based virtual structure. In this framework, attitude control systems for formation spacecrafts and virtual structure are designed separately. Both parametric uncertainty and external disturbance are taken into account. A time-varying sliding mode control (TVSMC) algorithm is designed to improve the robustness of the actual attitude control system. As for the virtual attitude control system, a behavioral consensus algorithm is presented to accomplish the attitude maneuver of the entire formation and guarantee a consistent attitude among the local virtual structure counterparts during the attitude maneuver. A multiple virtual sub-structures (MVSSs) system is introduced to enhance current virtual structure scheme when large amounts of spacecrafts are involved in the formation. The attitude of spacecraft is represented by modified Rodrigues parameter (MRP) for its non-redundancy. Finally, a numerical simulation with three synchronization situations is employed to illustrate the effectiveness of the proposed strategy.     

空间交会相对状态测定与控制

阐述航天器交会对接最终逼近段相对状态测定与控制算法。测定算法适用于计算机视觉系统,根据标志点构型几何特征,建立非线性测距方程组并构造加权目标函数。对非共面标志点构型（如3点T型与5点锥型）和共面标志点构型（如正方形、矩形、菱形）,目标函数均含标志点间距比率关系项;对共面构型,目标函数还包含共面条件项。按最小二乘法,采用Gauaa-Newton数值迭代法求解测距最佳值;对共面标志点四边形构型,利用对角线交点的虚影像坐标确定测距求解迭代初值。获得测距后即可应用四元数估算法确定相对姿态与相对位置。对相对姿态控制算法,给出相对姿态运动学与动力学方程,讨论相平面法与四元数反馈法的控制设计方法。相平面控制法应用常值推力,针对小姿态角机动的特点,将相对姿态通道解耦为三个独立的二阶子系统,设计相平面推力方向切换函数;四元数反馈法应用本征轴旋转的线性二阶系统瞬态响应特性,选择相对四元数与相对角速率反馈增益系数,确定控制力矩。对相对位置控制算法,将实际位移对标称位移之差作为控制变量,阐述所需速度增量最小的双冲量机动。大量模拟计算结果表明相对状态测定与控制算法是有效的。     

卫星正常模式姿态确定算法研究

针对太阳同步极轨卫星进行了正常模式姿态确定算法研究 ,采用四元数法建立了较完整和准确的姿态估计器模型 ,并进行了可观测性及观测度的分析。通过数学仿真证明此姿态确定算法能够对星体姿态进行较精确的估计或校正 ,满足卫星控制精度要求     

GEO非合作目标超近距相对位姿视觉测量

提出一种基于几何特征综合匹配的双目超近距相对位姿视觉测量方法。首先,将失效卫星的矩形太阳帆板作为几何特征,采用综合匹配方法实现了双目图像的高精度匹配,随后基于几何特征指标参数判别和ROI检测方法,实现了卫星太阳帆板特征点组的识别与提取,在此基础上,进一步建立了目标坐标系,通过三维重建完成了超近距阶段失效卫星的相对位姿高精度解算。最后建立了高精度双目视觉超近距相对测量实验系统,结合所提出的综合匹配算法和相对位姿解算方法,完成了动态非合作目标的相对位姿测量实验,实验结果说明所提出的方法具有较好的实时性和较高的精度。