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

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

UKF在基于修正罗德里格参数的飞行器姿态确定中的应用

UKF是一种新的非线性滤波方法,在状态的时间更新阶段直接使用非线性模型,不引入线性化误差,而且不必计算Jacobi矩阵,相对于扩展卡尔曼滤波(EKF)不仅能提高滤波精度,而且更容易实现。修正的罗德里格参数(MRPs)是一种飞行器姿态参数,相对于四元数姿态参数,用MRPs表示飞行器的姿态时,状态误差方差不会产生奇异性,并且能在一定程度上减小估计的计算量。本文针对MRPs表示的无陀螺飞行器姿态系统,利用UKF设计了姿态估计器,并通过仿真验证了算法的有效性。     

UKF位姿估计的超静平台耦合模型参数辨识

针对载荷无陀螺时辨识超静平台耦合动力学参数存在位姿确定问题,设计了一种基于Schur分解以及无迹卡尔曼滤波(UKF)的位姿确定及参数辨识方法。首先,建立加速度计和姿态敏感器组成的测量系统状态模型和观测模型,并给出测量系统的可观性分析。然后,给出基于UKF的载荷位姿确定方法;在UKF中引入姿态修正信息,从而提高载荷角速度估计精度,实现载荷广义位移、广义速度、广义加速度的准确估计。通过Schur分解实现超静平台动力学模型解耦及辨识模型中动力学参数显式表达。以滤波器估计载荷位姿信息为依据,采用最小二乘法辨识动力学参数。仿真结果表明UKF能够准确估计载荷角速度以及超静平台支杆刚度系数,辨识误差优于百分之一。     

基于UKF的航天器最小参数姿态矩阵估计方法

钊对航天器的惯性-星光姿态确定系统，选取基于矢量观测的最小参数姿态矩阵估计方法为定姿算法。但是由于系统模型是非线性的，针对系统模型的非线性，将UKF（Unscented Kalman Filter）与最小参数姿态矩阵估计方法结合，设计了一种针对MEMS陀螺和CMOS APS星敏感器的UKF姿念估计器。仿真结果表明：在敏感器精度较差的情况下，该UKF、姿态估计器能够满足大多数航天器对姿态确定精度的要求。此外，UKF和EKF（Extended Kalman Filter）的仿真对比结果表明：UKF滤波器的收敛速度高于EKF滤波器，状态估计的精度也优于EKF滤波器，且数值稳定性好。     

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

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

基于实时相对测量的航天器指向跟踪控制问题研究

针对大型挠性航天器指向跟踪控制问题,提出一种期望姿态估计方法和基于反步法的姿态跟踪控制方法。首先采用平方根容积卡尔曼滤波进行相对轨道估计,利用相对位置估计信息解算出追踪航天器观测轴指向目标航天器的期望姿态。然后基于修正Rodrigues参数描述的误差姿态动力学方程设计了姿态控制器,考虑系统惯量的不确定性设计了自适应控制律。最后将该方法应用到某空间观测任务中,仿真结果表明了方法的有效性。     

基于低成本MEMS传感器的皮卫星融合定姿算法研究

基于低成本低精度的MEMS陀螺、太阳敏感器、磁强计组合,设计了Unscented Kalman融合滤波算法.同时考虑到可能的故障模式,提出了仅依赖磁强计的备份滤波算法.在姿态参数选取上,采用修正罗德师里德参数来描述卫星姿态,降低了滤波器的维数,避免了采用四元数时解算状态误差协方差参数的奇异.利用MEMS陀螺采集的随机噪声数据进行半物理仿真,仿真结果表明:该融合算法能有效对卫星姿态进行实时估计,在个别敏感器失效的情况下,同样能实现较高的精度,满足普通任务的要求.该算法具有工程实现意义,是对低精度MEMS敏感器在低成本皮卫星上应用的有益探索.     

基于Rodrigues参数的视觉相对位姿确定算法

以Rodrigues参数作为姿态描述参数提出了一种视觉相对位姿确定算法。Rodrigues参 数作为一种简洁、高效的姿态描述法,适用于实时性要求高的视觉相对位姿确定,但它本身 的奇异性使其不能用于大角度的位姿确定。将视觉导航方法和无奇异姿态描述的Rodrig ues参数切换理论结合起来,推导了基于Rodrigues参数的视觉相对位姿解算模型,并给出了 这种相对位姿确定算法的流程。仿真结果表明该算法能很好地解决奇异问题,实现全姿态运 动情形下的相对位姿确定。
     

一种基于光学成像敏感器多目标视线角测量的相对导航方法

针对基于光学成像敏感器测量的相对导航问题,提出一种直接采用光学敏感器多目标视线角测量信息,利用UKF滤波方法设计滤波器,对相对位置、相对速度和相对姿态等相对状态进行估计的相对导航方法.将所提出的方法应用于月球交会对接平移靠拢段的相对导航,通过数学仿真验证了所提出方法的有效性,对实际工程应用具有理论参考价值.     

一种基于光学成像敏感器多目标视线角测量的相对导航方法

针对基于光学成像敏感器测量的相对导航问题,提出一种直接采用光学敏感器多目标视线角测量信息,利用UKF滤波方法设计滤波器,对相对位置、相对速度和相对姿态等相对状态进行估计的相对导航方法.将所提出的相对导航方法应用于月球交会对接平移靠拢段相对导航,通过数学仿真验证了所提出方法的有效性.所提出的方法对实际工程应用具有理论参考价值.