一种自适应非接触式失效卫星的形态参数测算方法与流程
本发明涉及航天领域的空间在轨服务技术，属于涉及翻滚卫星的位姿、转动惯量与目标质心位置的测量领域，特别涉及一种自适应非接触式失效卫星的形态参数测算方法。
背景技术：
随着航天科技的发展与各类航天任务的开展，越来越多的卫星被应用于各种任务中。由于使用年限，未知故障以及空间环境影响等各种内外因素影响，有一定数量的卫星已经或正在结束其服务。然而，由于这类太空资产价值昂贵且占据宝贵的太空轨道资源，仅仅由于一些故障而使其不得不终止服务或任由其占据空间位置将会对后续空间任务产生重大影响并且造成资源大幅浪费。因此，对这类失效的卫星进行在轨服务是当前急需完成的任务，对其进行抓捕前的非接触式形态参数测算是亟待解决的问题之一。
对失效卫星的形态参数进行自适应非接触式测算有着重要意义：其一，测算出的形态参数能够对失效卫星的状态进行评估；其二，利用已经获得的形态参数能够对下一步的抓捕提供重要参考。
对失效卫星而言，现有的参数测算技术大多是接触式的参数辨识技术，这类技术虽然具有一定的精度，然而由于需要服务航天器与目标接触而限制了其使用范围。同时，对失效卫星进行参数测算的应用中，极少有对失效卫星的形态参数一并测算的技术。大多数只是对其姿态或者位置进行分开测算，而忽略其质量特性参数的测算。这样会造成参数测算不完全，并且参数测算效率较低。
技术实现要素：
本发明要解决的技术问题是在非接触的情况对翻滚状态的失效卫星的形态参数进行一体化的测算，提供一种基于对偶矢量四元数的自适应非接触式失效卫星的形态参数测算方法，从而获得对失效卫星准确的形态参数测算。
本发明是通过以下技术方案来实现：
一种自适应非接触式失效卫星的形态参数测算方法，包括以下步骤：
1)基于矢量对偶四元数，建立失效卫星相对于服务航天器的运动学与动力学模型；
2)对失效卫星的姿态与相对距离做出带噪声的测量；
3)在建立基于对偶矢量四元数相对运动学与动力学模型的基础上，以测得的含有噪声的卫星姿态四元数以及相对距离数据作为观测量，构建自适应卡尔曼滤波算法，实时地估计出系统的形态参数信息。
所述的形态参数信息包括：相对位置参数、相对姿态参数、失效卫星的转动惯量比值参数及失效卫星的质心参数。
所述的自适应卡尔曼滤波算法是基于扩展卡尔曼滤波器，并且采用新息信息作为自适应输入，针对不确定的空间环境以及测量误差对失效卫星的形态参数做出测算。
所述的自适应扩展卡尔曼滤波算法具体步骤为：
a、初始化；
b、对偶矢量四元数扩展卡尔曼滤波；
c、新息计算；
d、故障检测；
e、若有故障，自适应对偶矢量四元数扩展卡尔曼滤波；
若无故障，卡尔曼增益计算；
f、对偶矢量卡尔曼滤波更新
h、返回步骤b。
采用激光成像系统对失效卫星的姿态与相对距离做出带噪声的测量。
基于对偶矢量四元数运动学方程为：
其中为
对偶矢量四元数的动力学方程为：
定义运算：
以及：
其中，
形态参数状态为：
其中，
测量相对距离的观测方程为：
其中，qm，rm为测量的失效卫星相对姿态四元数与相对距离v为观测噪声。
与现有技术相比，本发明具有以下有益的技术效果：
本发明的方法针对空间中的失效卫星采用对偶矢量四元数建立其运动学与动力学的模型，因此能够一体化获得有关失效卫星的形态参数；针对空间环境的复杂性以及测量的不确定性设计了自适应形态参数测算滤波算法，能够更利于实际应用。本发明所建立的基于对偶矢量四元数的相对运动学与动力学模型的基础上，根据测量输入设计自适应卡尔曼形态参数测算算法对所需要测算的失效卫星形态参数进行测算。所采用的自适应卡尔曼滤波器的观测量是用现有的观测技术获得的带有噪声的失效卫星姿态四元数以及相对距离的测量值。采用基于新息的自适应滤波测算算法能够处理在形态参数测算过程中出现的不确定性环境以及测量误差所带来的形态参数错误估计等问题，构建新型自适应卡尔曼滤波算法，实时地估计出系统的位姿参数，质量参数等形态参数信息，从而获得对失效卫星准确的形态参数测算。
附图说明
图1为服务航天器与失效卫星的相对模型；
图2为设计的自适应对偶矢量四元数形态参数滤波算法流程图；
图3为位姿参数估计值的误差收敛实例图；
图4为质量特性参数(转动惯量比值)估计值的误差收敛过程的实例图；
图5为质量特性参数(失效卫星的质心位置)估计值的误差收敛过程的实例图。
图中，1为航天服务器，2为视觉敏感器，3为识别位置，4为空间非合作目标。
具体实施方式
本发明首先采用新型的对偶矢量四元数对失效卫星进行运动学与动力学的建模；其次，采用激光成像系统对失效卫星的姿态与相对距离做出带噪声的测量。随即，在上述模型和测量的基础上，设计基于对偶矢量四元数自适应形态参数滤波算法，在外界干扰下对失效卫星的位置参数，姿态参数，转动惯量比值与失效卫星的质心位置进行一体化的自适应参数测算。具体包括以下步骤：
步骤一：建立基于对偶矢量四元数运动学方程：
其中为
步骤二：建立对偶矢量四元数的动力学方程：
定义运算：
以及：
其中，
步骤三：建立形态参数状态：
其中，
步骤四：考虑到失效卫星的翻滚，其姿态四元数以及相对服务航天器的距离可以借助现有的技术直接观测到，建立观测方程：
其中，qm，rm为测量的失效卫星相对姿态四元数与相对距离v为观测噪声。
步骤五：结合基于对偶矢量四元数的运动学与动力学方程以及观测方程，设计针对失效卫星基于对偶矢量四元数的形态参数测算滤波算法。
步骤六：在上一步得到的滤波算法基础上，针对失效卫星所处的空间环境干扰以及测量误差进行分析，设计基于对偶矢量四元数的自适应参数测算滤波算法。翻滚卫星的形态参数中，位姿参数与质量参数同时测算，并且形态参数包括：相对位置参数，相对姿态参数，失效卫星的转动惯量比值参数，失效卫星的质心参数。
为了更好地说明本发明的目的和优点，下面结合附图和实例对本发明内容做进一步说明。
图1展示了服务航天器与失效卫星的相对模型。其中{i}为惯性坐标系，{b}为失效卫星本体坐标系，失效卫星的姿态四元数所反映的就是从惯性坐标系到本体坐标系的旋转。服务航天器使用立体视觉设备或激光测距仪可以测得姿态四元数四个变量随时间变化的函数。由于干扰力矩和观测误差的影响，测量结果是受噪声污染的。应用本方法，可以利用这些观测噪声实时地估计出该失效卫星的形态参数(转动惯量比值以及失效卫星的质心位置)，具体包括以下步骤：
步骤一：基于矢量对偶四元数，建立失效卫星相对于服务航天器的运动学与动力学模型。详见方程(0.1)～(0.9)。
步骤二：令x表示失效卫星将被估计的形态参数，以姿态四元数q以及相对距离rim的实时观测量为输入，构建基于对偶矢量四元数的扩展卡尔曼滤波算法。
步骤三：利用步骤二所设计的基于对偶矢量四元数的扩展卡尔曼滤波算法时所获得的新息信息，针对不确定空间环境以及观测误差，设计基于对偶矢量四元数的自适应扩展卡尔曼滤波算法，算法流程图如图2所示。
a、初始化；
b、对偶矢量四元数扩展卡尔曼滤波；
c、新息计算；
d、故障检测；
e、若有故障，自适应对偶矢量四元数扩展卡尔曼滤波；
若无故障，卡尔曼增益计算；
f、对偶矢量卡尔曼滤波更新
h、返回步骤b。
步骤四：利用步骤三所设计的算法得到有关x的测算结果如图3、图4、图5所示，可见估计值与真实值的相对误差随着观测量的增加而趋近于零。
本实例中采用的系统真实初始参数值如表1所示。
表1
本实例中采用的系统仿真初始参数的值如表2所示。
表2
本发明保护范围不仅局限于实施例，实施例用于解释本发明，凡与本发明在相同原理和构思下的变更或修改均在本发明公开的保护范围之内。
- 还没有人留言评论。精彩留言会获得点赞！