基于序列机动的星敏安装误差在轨标定方法技术

本发明专利技术涉及基于序列机动的星敏安装误差在轨标定方法，包括以下步骤：S1、滤波模型：利用星敏感器数据处理单元，将四元数信息直接转换为欧拉角信息；S2、滤波算法：采用扩展卡尔曼滤波算法对星敏的安装误差进行估计；S3、高精度陀螺标定星敏。本发明专利技术的优点在于：采用多次机动策略的星敏感器安装误差在轨标定算法，适用于短周期的星敏感器安装误差在轨标定；面向配置高精度陀螺和低精度星敏的卫星设计需要，可满足后续星敏/陀螺姿态确定的GNC任务。

On orbit calibration method of star sensor installation error based on sequence maneuver

【技术实现步骤摘要】
基于序列机动的星敏安装误差在轨标定方法
本专利技术涉及基于序列机动的星敏安装误差在轨标定方法。
技术介绍
在卫星总装完成后，通过地面精测手段获得星敏感器的安装矩阵，卫星入轨后，由于应力释放、在轨的结构热变形等因素，导致星敏的安装矩阵发生变化，当前的星敏安装矩阵标定方法大多借助更高精度的惯性指向数据，如卫星光学载荷的数据，或者更高精度的星敏感器数据，来完成星敏感器安装误差何低频误差的标定工作，以上手段在卫星配置受限的情况下难以实现。
技术实现思路
本专利技术的目的在于克服现有技术的缺点，提供一种基于序列机动的星敏安装误差在轨标定方法，提出一种采用多次机动策略的星敏感器安装误差在轨标定算法，适用于短周期的星敏感器安装误差在轨标定，面向配置高精度陀螺和低精度星敏的卫星设计需要，可满足后续星敏/陀螺姿态确定的的GNC任务。本专利技术的目的通过以下技术方案来实现：基于序列机动的星敏安装误差在轨标定方法，包括以下步骤：S1、滤波模型：利用星敏感器数据处理单元，将四元数信息直接转换为欧拉角信息；S2、滤波算法：采用扩展卡尔曼滤波算法对星敏的安装误差进行估计；S3、高精度陀螺标定星敏。进一步地，步骤S1的具体操作步骤是：将三个姿态角作为敏感器的测量输出，则星敏感器测量残差为星敏测量输出与估计输出的差值，假设星敏感器坐标系与本体坐标系重合，那么，考虑星敏感器的系统常值误差和星敏感器测量噪声之后的星敏模型为：式(1)中δθ，δψ表示星敏的测量残差项，Δθ，Δψ表示星敏标定过程的姿态角估计误差，待标定项表示星敏的安装偏差，υθ，υψ表示星敏的测量噪声项，姿态角的估计误差是小角度，由欧拉角与四元数的转换关系可得：式(2)中，δq1，δq2，δq3为姿态角估计误差对应的四元数矢量部分，可表示δqυ＝[δq1δq2δq3]T，由此得到星敏感器的测量残差方程为：与星敏感器标定陀螺相似的过程，给出误差四元数的状态方程表达式为：式(4)中表示对卫星角速度的估计值，δb表示陀螺安装偏差的测量残差项，ηω表示陀螺的测量噪声，δq4表示姿态角估计误差对应的四元数标量部分。采用高精度陀螺对星敏感器进行标定时，由于陀螺精度高，陀螺的常值漂移小，因此，不对陀螺的常值漂移进行估计，将星敏感器的常值误差作为估计量，取为状态变量进行卡尔曼滤波，则状态矢量X的微分方程表达式为：取星敏感器的测量残差为：观测方程离散化为：Zk＝HkXk+Vk(7)其中，E(Vk)＝0,E(VkVjT)＝Rδk,jR为星敏感器的测量噪声方差阵，Hk为输出矩阵，Hk＝[2I3I3]。进一步地，步骤S2的具体步骤是：定义滤波周期为T，那么滤波所需的离散方程的状态转移矩阵等表示为：根据扩展卡尔曼滤波算法：一步状态预估：Xk+1,k＝Fx*Xk误差协方差矩阵一步预估：Pk+1，k＝Fx*Pk*FxT+G*Q*GT滤波增益矩阵计算：状态更新Xk+1＝Xk+1,k+Kk+1*(Zk+1-Hk*Xk+1,k)误差协方差矩阵更新其中，P表示误差协方差矩阵，Q表示过程噪声矩阵，R表示测量噪声矩阵，那么星敏安装误差的估计值计算为：表示估计的初始值，一段时间后，即可标定出星敏的安装误差值。进一步地，步骤S3的具体步骤是：S31：整星角速度为0，给定整星绕本体X轴的小角速度，星敏有可信数据输出，根据星敏感器和陀螺输出数据，给出标定结果，取三轴标定结果的Y轴和Z轴数据，并阻尼整星角速度至0；S32：给定整星绕本体Y轴的小角速度，星敏有可信数据输出，根据星敏感器和陀螺输出数据，给出标定结果，取三轴标定结果的X轴和Z轴数据，并阻尼整星角速度至0；S33：给定整星绕本体Z轴的小角速度，星敏有可信数据输出，根据星敏感器和陀螺输出数据，给出标定结果，取三轴标定结果的X轴和Y轴数据，并阻尼整星角速度至0；S34：综合前三个步骤中标定得到的结果，按照一定的权值完成最终的星敏感器安装误差标定。本专利技术具有以下优点：1、该专利技术提出一种采用多次机动策略的星敏感器安装误差在轨标定算法，适用于短周期的星敏感器安装误差在轨标定。2、该专利技术面向配置高精度陀螺和低精度星敏的卫星设计需要，可满足后续星敏/陀螺姿态确定的GNC任务。附图说明图1是基于序列机动的星敏安装误差在轨标定方法的流程图；图2是第一次绕X机动标出的Y轴安装偏差曲线图；图3是第一次绕X机动标出的Z轴安装偏差曲线图；图4是第一次绕Y机动标出的X轴安装偏差曲线图；图5是第一次绕Y机动标出的Z轴安装偏差曲线图；图6是第一次绕Z机动标出的X轴安装偏差曲线图；图7是第一次绕Z机动标出的Y轴安装偏差曲线图；图8是基于序列姿态机动的星敏安装误差标定结果-X轴标定结果曲线图；图9是基于序列姿态机动的星敏安装误差标定结果-Y轴标定结果曲线图；图10是基于序列姿态机动的星敏安装误差标定结果-Z轴标定结果曲线图；图11是基于序列姿态机动的星敏安装误差标定结果-X轴标定误差曲线图；图12是基于序列姿态机动的星敏安装误差标定结果-Y轴标定误差曲线图；图13是基于序列姿态机动的星敏安装误差标定结果-Z轴标定误差曲线图。具体实施方式下面结合附图和实施例对本专利技术做进一步的描述，但本专利技术的保护范围不局限于以下所述。如图1所示，基于序列机动的星敏安装误差在轨标定方法，包括以下步骤：S1、滤波模型：利用星敏感器数据处理单元，将四元数信息直接转换为欧拉角信息；S2、滤波算法：采用扩展卡尔曼滤波算法对星敏的安装误差进行估计；S3、高精度陀螺标定星敏。进一步地，步骤S1的具体操作步骤是：将三个姿态角作为敏感器的测量输出，则星敏感器测量残差为星敏测量输出与估计输出的差值，假设星敏感器坐标系与本体坐标系重合，那么，考虑星敏感器的系统常值误差和星敏感器测量噪声之后的星敏模型为：式(1)中δθ，δψ表示星敏的测量残差项，Δθ，Δψ表示星敏标定过程的姿态角估计误差，待标定项表示星敏的安装偏差，υθ，υψ表示星敏的测量噪声项，姿态角的估计误差是小角度，由欧拉角与四元数的转换关系可得：式(2)中，δq1，δq2，δq3为姿态角估计误差对应的四元数矢量部分，可表示δqυ＝[δq1δq2δq3]T，由此得到星敏感器的测量残差方程为：与星敏感器标定陀螺相似的过程，给出误差四元数的状态方程表达式为：式(4)中表示对卫星角速度的估计值，δb表示陀螺安装偏差的测量残差项，ηω表示陀螺的测量噪声，δq4表示姿态角估计误差对应的四元数标量部分。采用高精度陀螺对星敏感器进行标定时，由于陀螺精度高，陀螺的常值漂移小，因此，不对陀螺的常值漂移进行估计，将星敏感器的常值误差作为估计量，取为状态变量进行卡尔曼滤波，则状态矢量X的微分方程表达式为：其中，I3为单位矩阵。取星敏感器的测量残差为：观测方程离散化为：Zk＝HkXk+Vk(7)其中，E(Vk)＝0,E(VkVjT)＝Rδk,jR为星敏感器的测量噪声方差阵，Hk为输出矩阵，Hk＝[2I3I3]。进一步地，步骤S2的具体步骤是：定义滤波周期为T，那么滤波所需的离散方程的状态转移矩阵等表示为：式(8)中，矩阵A，B的表达式见式(5)所示。根据扩展卡尔曼滤波算法：一步状态预估：Xk+1,k＝Fx*Xk误差协方差矩阵一步预估：Pk+1，k＝Fx*Pk*FxT+G*Q*GT滤波增益矩阵计算：状态更新Xk+1本文档来自技高网...

【技术保护点】
1.基于序列机动的星敏安装误差在轨标定方法，其特征在于：包括以下步骤：S1、滤波模型：利用星敏感器数据处理单元，将四元数信息直接转换为欧拉角信息；S2、滤波算法：采用扩展卡尔曼滤波算法对星敏的安装误差进行估计；S3、高精度陀螺标定星敏。

【技术特征摘要】
1.基于序列机动的星敏安装误差在轨标定方法，其特征在于：包括以下步骤：S1、滤波模型：利用星敏感器数据处理单元，将四元数信息直接转换为欧拉角信息；S2、滤波算法：采用扩展卡尔曼滤波算法对星敏的安装误差进行估计；S3、高精度陀螺标定星敏。2.根据权利要求1所述基于序列机动的星敏安装误差在轨标定方法，其特征在于：步骤S1的具体操作步骤是：将三个姿态角作为敏感器的测量输出，则星敏感器测量残差为星敏测量输出与估计输出的差值，假设星敏感器坐标系与本体坐标系重合，那么，考虑星敏感器的系统常值误差和星敏感器测量噪声之后的星敏模型为：式(1)中δθ，δψ表示星敏的测量残差项，Δθ，Δψ表示星敏标定过程的姿态角估计误差，待标定项表示星敏的安装偏差，υθ，υψ表示星敏的测量噪声项，姿态角的估计误差是小角度，由欧拉角与四元数的转换关系可得：式(2)中，δq1，δq2，δq3为姿态角估计误差对应的四元数矢量部分，可表示δqυ＝[δq1δq2δq3]T，由此得到星敏感器的测量残差方程为：给出误差四元数的状态方程表达式为：式(4)中表示对卫星角速度的估计值，δb表示陀螺安装偏差的测量残差项，ηω表示陀螺的测量噪声，δq4表示姿态角估计误差对应的四元数标量部分，采用高精度陀螺对星敏感器进行标定时，由于陀螺精度高，陀螺的常值漂移小，因此，不对陀螺的常值漂移进行估计，将星敏感器的常值误差作为估计量，取为状态变量进行卡尔曼滤波，则状态矢量X的微分方程表达式为：其中，I3为单位矩阵，取星敏感器的测量残差为：观测方程离散化为：Zk＝HkXk+Vk(7)其...

【专利技术属性】
技术研发人员：宗伟，陈实，
申请(专利权)人：广州泾渭信息科技有限公司，
类型：发明
国别省市：广东,44