一种星敏感器光行差修正地面验证方法
【专利摘要】本发明公开了一种星敏感器光行差修正地面验证方法，包含以下步骤：计算星敏感器相对太阳的线速度在星敏坐标系的投影分量Vss；设定星敏感器的轨道参数和儒略日，使星敏感器相对太阳的线速度达到第一预设线速度值V′；若Vss与V′的差值小于等于计算线速度时的最小允许的容差值；向星敏感器注入预设四元数Q0，设置星敏感器不修正光行差，并记录此时的星敏感器输出的四元数Q，设置星敏感器以Vss修正光行差，并记录此时的星敏感器输出的修正四元数Q′及Vss引起光行差的偏差四元数ΔQ′；计算四元数Q与修正四元数Q′的误差四元数ΔQ；比较ΔQ′与ΔQ，以判断进行光行差修正时提供的线速度是否满足姿态精度要求，完成对星敏感器光行差修正的地面验证。本发明能有效检验星敏感器光行差修正是否正确。
【专利说明】
一种星敏感器光行差修正地面验证方法
技术领域
[0001] 本发明涉及航天器姿态控制技术领域，具体涉及一种星敏感器光行差修正地面验 证方法。
【背景技术】
[0002] 星敏感器作为一种姿态测量敏感器，普遍用于各航天器中。目前星敏感器测量误 差有三类:系统偏差(Bias)、慢变误差(LFE)、噪声等效角(NEA)。其中，光行差是慢变误差中 主要的误差源。因此，如何在地面验证星敏感器光行差修正的正确性则尤为重要。
【发明内容】
[0003] 本发明的目的在于提供一种星敏感器光行差修正地面验证方法，能有效检验星敏 感器光行差修正是否正确。
[0004] 为了达到上述目的，本发明通过以下技术方案实现：一种星敏感器光行差修正地 面验证方法，其特点是，包含以下步骤：
[0005] S1、计算星敏感器相对太阳的线速度在星敏坐标系的投影分量Vss;
[0006] S2、设定星敏感器的轨道参数和儒略日，使星敏感器相对太阳的线速度达到第一 预设线速度值V'；
[0007] S3、判断Vss与V'的差值是否小于等于计算线速度时的最小允许的容差值；
[0008] 若否，则返回步骤S2,重新设定星敏感器的轨道参数和儒略日；
[0009] 若是，则执行步骤S4;
[0010] S4、向星敏感器注入预设四元数Q〇,设置星敏感器不修正光行差，并记录此时的星 敏感器输出的四元数Q;
[0011] S5、向星敏感器注入预设四元数Q〇,设置星敏感器以Vss修正光行差，并记录此时的 星敏感器输出的修正四元数Q '及Vss引起光行差的偏差四元数A Q ' ；
[0012] S6、计算四元数Q与修正四元数Q'的误差四元数A Q;
[0013] S7、比较A Q'与A Q，以判断进行光行差修正时提供的线速度是否满足姿态精度要 求，完成对星敏感器光行差修正的地面验证。
[0014] 所述的步骤S1包含：
[0015] S1.1、根据太阳视运动轨道平近点角和太阳视运动轨道偏心率，计算得到t时刻的 真近点角fs;
[0016] S1.2、根据t时刻的真近点角:^及太阳视运动轨道近地点幅角，计算得到t时刻地 球相对太阳的线速度Ve;
[0017] S1.3、根据太阳视运动轨道倾角及上注轨道参数，计算得到星敏感器相对太阳的 线速度在2000.0惯性坐标系的投影分量Vj2000 ;
[0018] S1.4、采集t时刻星敏感器的四元数Q，并结合Vj2_，得到星敏感器相对太阳的线速 度在星敏坐标系的投影分量vss。
[0019] 所述的步骤SI. 1中t时刻的真近点角fs的计算公式为：
[0020] fs=Ms+2essin(Ms)+1.25es2sin(2Ms)
[0021] 式中，Ms为太阳视运动轨道平近点角，es为太阳视运动轨道偏心率。
[0022 ]所述的步骤S1.2中t时刻地球相对太阳的线速度Ve的计算公式为：
[0024] 式中，fs为真近点角，cos为太阳视运动轨道近地点幅角。
[0025]所述的步骤S1.3中星敏感器相对太阳的线速度在2000.0惯性坐标系的投影分量 VJ20QQ的计算公式为：
[0027]式中，e为太阳视运动轨道倾角，￥=(^，^，1)为星敏感器相对地球线速度在 J2000.0坐标系的投影分量，由上注轨道参数计算得到，单位m/s。
[0028]所述的步骤S1.4中计算星敏感器相对太阳的线速度在2000.0惯性坐标系的投影 分量VJ2QQQ在星敏感器测量坐标系中的分量Vss的计算公式为：
[0030] 式中，Q(Vss) = [0 Vss(x) Vss(y) Vss(z)]T，Q*=[q0-qi-q2-q3]T，?为四元数相乘，Q (Vj2〇oo) = [0 Vj20oo(x) Vj20oo(y) Vj20oo(z)]T，Q=[q。qi q2 q3]T〇
[0031] 所述的步骤S5中计算Vss引起光行差的偏差四元数A Q'的步骤包含：
[0032] A、计算光行差引起的偏角值a;
[0033] B、根据光行差引起的偏角值a计算得到星敏感器在轨光行差引起的偏差四元数A Q〇
[0034] 所述的步骤A中光行差引起的偏角值a的计算公式为：
[0036]式中，a为光行差引起的偏角值，V为线速度，C为光速。
[0037]所述的步骤A中包含：
[0038] 计算星敏感器X轴线速度Vss(x)所引起的偏差角ax，
[0039] 计算星敏感器Y轴线速度Vss(y)所引起的偏差角ay
[0040] 所述的步骤B中星敏感器在轨光行差引起的偏差四元数A Q的计算公式为：
[0042]式中，ax为星敏感器X轴线速度Vss(x)所引起的偏差角，ay为星敏感器Y轴线速度Vss (y)所引起的偏差角。
[0043]本发明一种星敏感器光行差修正地面验证方法与现有技术相比具有以下优点：本 发明主要通过比较地面计算出的星敏感器相对太阳的线速度与星敏感器自身计算出的星 敏感器相对太阳的线速度，确定地面提供给星敏感器进行光行差修正时使用的线速度是否 正确;进而比较星敏进行光行差修正前后的误差四元数与地面通过线速度计算出的光行差 修正偏差四元数，确定光行差修正算法是否正确，从而有效便捷的验证地面光行差修正是 否正确。
【附图说明】
[0044]图1为本发明一种星敏感器光行差修正地面验证方法的流程图。
【具体实施方式】
[0045]以下结合附图，通过详细说明一个较佳的具体实施例，对本发明做进一步阐述。 [0046] 如图1所示，一种星敏感器光行差修正地面验证方法，包含以下步骤：
[0047] S1、计算星敏感器相对太阳的线速度在星敏坐标系的投影分量Vss。
[0048] S1.1、根据太阳视运动轨道平近点角和太阳视运动轨道偏心率，计算得到t时刻的 真近点角fs。
[0049] t时刻的真近点角fs的计算公式为：
[0050] fs=Ms+2essin(Ms)+1.25es2sin(2Ms)
[0051] 式中，Ms为太阳视运动轨道平近点角，es为太阳视运动轨道偏心率。
[0052] S1.2、根据t时刻的真近点角fs及太阳视运动轨道近地点幅角，计算得到t时刻地 球相对太阳的线速度Ve。
[0053] t时刻地球相对太阳的线速度Ve的计算公式为：
[0055] 式中，fs为真近点角，为太阳视运动轨道近地点幅角。
[0056] S1.3、根据太阳视运动轨道倾角及上注轨道参数，计算得到星敏感器相对太阳的 线速度在2000.0惯性坐标系的投影分量V〗 2000。
[0057]星敏感器相对太阳的线速度在2000.0惯性坐标系的投影分量Vj2Qm的计算公式为：
[0059] 式中，e为太阳视运动轨道倾角，￥=(^，^，^)为星敏感器相对地球线速度在 J2000.0坐标系的投影分量，由上注轨道参数计算得到，单位m/s。
[0060] S1.4、采集t时刻星敏感器的四元数Q，并结合Vj2_，得到星敏感器相对太阳的线速 度在星敏坐标系的投影分量V ss。
[0061 ]计算星敏感器相对太阳的线速度在2000.0惯性坐标系的投影分量Vj2QQ()在星敏感 器测量坐标系中的分量Vss的计算公式为：
[0063] 式中，Q(Vss) = [0 Vss(x) Vss(y) Vss(z)]T，Q*=[q0-qi-q2-q3]T，每为四元数相乘，Q (Vj2〇oo) = [0 Vj20oo(x) Vj20oo(y) Vj20oo(z)]T，Q=[q。qi q2 q3]T〇
[0064] S2、设定星敏感器的轨道参数和儒略日，使星敏感器相对太阳的线速度达到第一 预设线速度值V'。
[0065] S3、判断Vss与V'的差值是否小于等于计算线速度时的最小允许的容差值；
[0066] 若否，则返回步骤S2,重新设定星敏感器的轨道参数和儒略日；
[0067]若是，则执行步骤S4;
[0068] Vss-V'^Vmin
[0069] 其中，Vmin为计算线速度时最小允许的容差值，可视具体定姿精度要求确定。
[0070] S4、向星敏感器注入预设四元数Qo,设置星敏感器不修正光行差，并记录此时的星 敏感器输出的四元数Q。
[0071] S5、向星敏感器注入预设四元数Qo,设置星敏感器以Vss修正光行差，并记录此时的 星敏感器输出的修正四元数Q '及Vss引起光行差的偏差四元数A Q '。
[0072] 计算Vss引起光行差的偏差四元数A Q'的步骤包含：
[0073] A、计算光行差引起的偏角值a。
[0074]光行差引起的偏角值a的计算公式为：
[0076] 式中，a为光行差引起的偏角值，V为线速度，C为光速。
[0077] 计算星敏感器X轴线速度Vss(x)所引起的偏差角ax，
[0078] 计算星敏感器Y轴线速度Vss(y)所引起的偏差角ay，
[0079] B、根据光行差引起的偏角值a计算得到星敏感器在轨光行差引起的偏差四元数A Q〇
[0080] 星敏感器在轨光行差引起的偏差四元数A Q的计算公式为：
[0082]式中，ax为星敏感器X轴线速度Vss(x)所引起的偏差角，ay为星敏感器Y轴线速度Vss (y)所引起的偏差角。
[0083] S6、计算四元数Q与修正四元数Q'的误差四元数A Q。
[0084]误差四元数A Q的计算公式为
[0086]式中，Q* = [q『qi-q2_q3]T，?'为四元数相乘，Q=[qo qi q2 q3]T。
[0087] S7、比较A Q'与A Q，以判断进行光行差修正时提供的线速度是否满足姿态精度要 求，完成对星敏感器光行差修正的地面验证。
[0089]式中，为光行差修正时最小允许的容差值，可视具体定姿精度要求确定。
[0090] 尽管本发明的内容已经通过上述优选实施例作了详细介绍，但应当认识到上述的 描述不应被认为是对本发明的限制。在本领域技术人员阅读了上述内容后，对于本发明的 多种修改和替代都将是显而易见的。因此，本发明的保护范围应由所附的权利要求来限定。
【主权项】
1. 一种星敏感器光行差修正地面验证方法，其特征在于，包含以下步骤： 51、 计算星敏感器相对太阳的线速度在星敏坐标系的投影分量Vss; 52、 设定星敏感器的轨道参数和儒略日，使星敏感器相对太阳的线速度达到第一预设 线速度值疒； 53、 判断Vss与，的差值是否小于等于计算线速度时的最小允许的容差值； 若否，则返回步骤S2，重新设定星敏感器的轨道参数和儒略日； 若是，则执行步骤S4; 54、 向星敏感器注入预设四元数Q〇,设置星敏感器不修正光行差，并记录此时的星敏感 器输出的四元数Q; 55、 向星敏感器注入预设四元数Q〇,设置星敏感器以Vss修正光行差，并记录此时的星敏 感器输出的修正四元数V及V ss引起光行差的偏差四元数A Q'; 56、 计算四元数Q与修正四元数吖的误差四元数A Q; 57、 比较A Q'与A Q，以判断进行光行差修正时提供的线速度是否满足姿态精度要求， 完成对星敏感器光行差修正的地面验证。2. 如权利要求1所述的星敏感器光行差修正地面验证方法，其特征在于，所述的步骤S1 包含： S1. 1、根据太阳视运动轨道平近点角和太阳视运动轨道偏心率，计算得到t时刻的真近 点角fs; 51.2、 根据t时刻的真近点角fs及太阳视运动轨道近地点幅角，计算得到t时刻地球相对 太阳的线速度Ve; 51.3、 根据太阳视运动轨道倾角及上注轨道参数，计算得到星敏感器相对太阳的线速 度在2000 ? 0惯性坐标系的投影分量Vj2〇oo; 51.4、 采集t时刻星敏感器的四元数Q，并结合Vj2_，得到星敏感器相对太阳的线速度在 星敏坐标系的投影分量V ss。3. 如权利要求1所述的星敏感器光行差修正地面验证方法，其特征在于，所述的步骤 S1.1中t时刻的真近点角fs的计算公式为： fs=Ms+2essin(Ms)+1.25es2sin(2Ms) 式中，Ms为太阳视运动轨道平近点角，es为太阳视运动轨道偏心率。4. 如权利要求1所述的星敏感器光行差修正地面验证方法，其特征在于，所述的步骤 S1.2中t时刻地球相对太阳的线速度Ve的计算公式为：式中，fs为真近点角，w s为太阳视运动轨道近地点幅角。5. 如权利要求1所述的星敏感器光行差修正地面验证方法，其特征在于，所述的步骤 S1.3中星敏感器相对太阳的线速度在2000.0惯性坐标系的投影分量Vj 2Qm的计算公式为：式中，e为太阳视运动轨道倾角，￥=卜\^，〇为星敏感器相对地球线速度在12000.0 坐标系的投影分量，由上注轨道参数计算得到，单位m/s。6. 如权利要求1所述的星敏感器光行差修正地面验证方法，其特征在于，所述的步骤 S1.4中计算星敏感器相对太阳的线速度在2000.0惯性坐标系的投影分量Vjsooo在星敏感器 测量坐标系中的分量V ss的计算公式为：式中，Q(Vss) = [〇 Vss(x) Vss(y) Vss(z)]T，Q*=[q〇-qi-q2-q3]T，逸为四元数相乘，Q (Vj2〇oo) = [0 Vj2〇oo(x) Vj2〇oo(y) Vj2〇oo(z)]T，Q=[q。qi q2 q3]T〇7. 如权利要求1所述的星敏感器光行差修正地面验证方法，其特征在于，所述的步骤S5 中计算Vss引起光行差的偏差四元数A Q'的步骤包含： A、 计算光行差引起的偏角值a; B、 根据光行差引起的偏角值a计算得到星敏感器在轨光行差引起的偏差四元数A Q。8. 如权利要求7所述的星敏感器光行差修正地面验证方法，其特征在于，所述的步骤A 中光行差引起的偏角值a的计算公式为：式中，a为光行差引起的偏角值，V为线速度，C为光速。9. 如权利要求8所述的星敏感器光行差修正地面验证方法，其特征在于，所述的步骤A 中包含： 计算星敏感器X轴线速度Vss(x)所引起的偏差角ax，计算星敏感器Y轴线速度Vss(y)所引起的偏差角ay，10. 如权利要求9所述的星敏感器光行差修正地面验证方法，其特征在于，所述的步骤B 中星敏感器在轨光行差引起的偏差四元数A Q的计算公式为：式中，ax为星敏感器X轴线速度Vss(x)所引起的偏差角，ay为星敏感器Y轴线速度Vss(y) 所引起的偏差角。
【文档编号】G01C25/00GK106052713SQ201610341768
【公开日】2016年10月26日
【申请日】2016年5月20日
【发明人】李苗, 马雪阳, 余维, 谢任远, 何益康, 沈怡颹, 周连文, 朱晏庆, 周静静, 张涛, 杨波, 赵永德
【申请人】上海航天控制技术研究所