[发明专利]一种利用陀螺修正星敏感器轨道周期系统误差的方法有效
申请号: | 201610950838.6 | 申请日: | 2016-10-26 |
公开(公告)号: | CN106568436B | 公开(公告)日: | 2019-04-26 |
发明(设计)人: | 尹海宁;叶立军;袁彦红;冉玉萍;朱文山;王世耀;邵志杰;孙锦花;李利亮;李圣文 | 申请(专利权)人: | 上海航天控制技术研究所 |
主分类号: | G01C21/02 | 分类号: | G01C21/02;G01C21/20 |
代理公司: | 中国航天科技专利中心 11009 | 代理人: | 陈鹏 |
地址: | 201109 *** | 国省代码: | 上海;31 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 星敏感器 系统误差 差值表 陀螺 轨道周期 三轴姿态 修正 系统误差修正 漂移 插值补偿 实时辨识 实时性 航天器 辨识 更新 构建 工作量 存储 扣除 查找 轨道 | ||
1.一种利用陀螺修正星敏感器轨道周期系统误差的方法,其特征在于包括如下步骤:
(1)构建补偿差值表;所述的补偿差值表用于存储星敏感器三轴姿态系统误差和航天器所处轨道相位的关系,所述的轨道相位采用轨道钟描述,轨道钟是控制系统星载软件步长ts的整数倍,轨道钟以轨道上的某个点为起点,以ts为单位进行累加积分,待积分到刚好一个轨道周期时轨道钟清零,重新开始累加;
(2)利用星敏感器的姿态对陀螺的常值漂移进行修正;
(3)采用陀螺积分值来辨识星敏感器轨道周期系统误差,并对补偿差值表进行更新;
(4)查找更新后的补偿差值表,将星敏感器三轴姿态直接扣除补偿差值表中对应的值,得到不含系统误差的星敏感器三轴姿态。
2.根据权利要求1所述的一种利用陀螺修正星敏感器轨道周期系统误差的方法,其特征在于:所述的轨道钟的计时方法为:
(11)轨道钟累加,torbit(k)=torbit(k-1)+ts,其中torbit(k)为当前节拍轨道钟,torbit(k-1)为上节拍轨道钟;
(12)记录当前时刻航天器轨道幅角与180°之差Δu(k)=u-180°,其中u为当前时刻航天器轨道幅角,航天器轨道幅角为航天器轨道六要素中的近地点幅角与真近点角之和;
(13)判断Δu(k)·ΔU<0是否成立,其中ΔU是记录的上一节拍航天器轨道幅角与180°之差,初始值为0;如果成立则轨道钟清零并进入下一步,如果不成立,则直接转至下一步;
(14)将当前时刻航天器轨道幅角与180°之差Δu(k)赋值给ΔU。
3.根据权利要求2所述的一种利用陀螺修正星敏感器轨道周期系统误差的方法,其特征在于:所述步骤(2)中的修正方法为:
(21)根据积分时间t(k)判断当前是否是陀螺积分第一节拍,如果是则跳至步骤(22),如果否则跳至步骤(23);
(22)记录当前星敏感器的姿态,记为θstr0并结束;
(23)判断积分时间t(k)是否到达轨道周期T,如果是则跳至步骤(25),如果否则跳至步骤(24);
(24)当前节拍陀螺积分姿态θgyro(k)=θgyro(k-1)+ω,其中θgyro(k-1)是上一节拍陀螺积分姿态,ω是当前节拍陀螺测量角速度;当前节拍陀螺积分时长t(k)=t(k-1)+ts,t(k-1)是上一节拍陀螺积分时长,然后跳至步骤(26);
(25)记录当前星敏感器的姿态,记为θstrf;计算陀螺的常漂残量
计算结束跳至步骤(27);
(26)判断陀螺积分是否超出阈值,如果是则跳至步骤(28),如果否则结束;
(27)判断陀螺常漂残量Bremain是否小于阈值BC,如果是则跳至步骤(29),如果否则跳至步骤(28);
(28)清除陀螺修星敏标志flag=0,然后跳至步骤(30);flag是表示是否可以采用陀螺积分值来辨识星敏感器轨道周期系统误差的标志;
(29)建立陀螺修星敏标志flag=1,然后跳至步骤(30);
(30)计算陀螺常值漂移为本轨道周期计算得到的陀螺常值漂移,其中ktl∈[0,1]为陀螺常值漂移更新权系数,为上次计算得到的陀螺常值漂移;同时
积分时间清零t(k)=0;
陀螺积分清零θgyro(k)=0;
记录当前轨道钟T0=torbit(k);
记录陀螺积分残差θ0=θgyro(k)-θstrf+θstr0。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于上海航天控制技术研究所,未经上海航天控制技术研究所许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201610950838.6/1.html,转载请声明来源钻瓜专利网。