[发明专利]一种姿态误差可观测的提高惯性制导精度方法有效
申请号: | 202010524370.0 | 申请日: | 2020-06-10 |
公开(公告)号: | CN111780752B | 公开(公告)日: | 2022-01-04 |
发明(设计)人: | 魏宗康 | 申请(专利权)人: | 北京航天控制仪器研究所 |
主分类号: | G01C21/16 | 分类号: | G01C21/16;G01C21/02;G06F17/16 |
代理公司: | 中国航天科技专利中心 11009 | 代理人: | 张晓飞 |
地址: | 100854 北京*** | 国省代码: | 北京;11 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 姿态 误差 观测 提高 惯性 制导 精度 方法 | ||
1.一种姿态误差可观测的提高惯性制导精度方法,其特征在于:步骤如下:
(1)获取导弹相对发射点地球坐标系的遥外测速度误差的序列值遥外测位置误差的序列值其中,δvx、δvy、δvz为导弹在发射点地球坐标系OXeYeZe三个轴上的速度误差分量;i=1,2,…,N,i表示导航解算的时间序列,N表示参与导航解算的最大个数;设采样间隔周期为ΔT,序列i对应的时刻为ti=i×ΔT;
(2)获取惯性导航ti时刻的姿态角误差
(3)根据姿态角误差相对陀螺仪漂移系数的环境函数矩阵,求解陀螺仪各误差系数;
(4)对遥外测速度误差进行修正;
(5)根据速度环境函数,采用最小二乘法求解制导工具误差系数;
(6)将制导工具误差系数经补偿后提高惯性制导精度;
所述步骤(2)中的姿态角误差获取方法为:
(21)在惯性系统安装两个敏感轴近似正交的星敏器S1和S2,分别观测星体P1和P2;星体P1相对于惯性系统的高低角的理论值为μp1、方位角的理论值为ψp1;星体P2相对于惯性系统的高低角的理论值为μp2、方位角的理论值为ψp2;
(22)星敏器S1测量出星体P1相对于惯性系统的高低角的实际值为μc1、方位角的实际值为ψc1;星敏器S2测量出星体P2相对于惯性系统的高低角的实际值为μc2、方位角的实际值为ψc2;
(23)计算出星敏器S1的视差角Δμ1=μc1-μp1、Δψ1=ψc1-ψp1,星敏器S2的视差角Δμ2=μc2-μp2、Δψ2=ψc2-ψp2;
(24)给出视差角和姿态角误差之间的关系
(25)采用最小二乘法求解出姿态角误差Δφx、Δφy、Δφz。
2.根据权利要求1所述的一种姿态误差可观测的提高惯性制导精度方法,其特征在于:所述步骤(21)中的星敏器与惯性系统之间的安装方式采用捷联方式,即星敏器直接安装在平台台体上,视差角通过数据解算得到;或者采用星光锁定方式,通过双轴平台使星敏器的输入轴始终对准星体,再通过双轴平台的框架角解算出视差角。
3.根据权利要求1所述的一种姿态误差可观测的提高惯性制导精度方法,其特征在于:所述步骤(6)中的补偿为直接对遥外测观测量进行修正,陀螺仪误差系数修正公式为ΔYφ=Yφ-CattXatt,加速度计误差系数修正公式为ΔδVacc=δVacc-AaccXacc。
4.根据权利要求1所述的一种姿态误差可观测的提高惯性制导精度方法,其特征在于:所述步骤(6)中的补偿为利用确定的工具误差系数对工具误差的装订值进行修正,进而实现对惯性制导遥外测观测量的补偿。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于北京航天控制仪器研究所,未经北京航天控制仪器研究所许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202010524370.0/1.html,转载请声明来源钻瓜专利网。