公开/公告号CN106997053A
专利类型发明专利
公开/公告日2017-08-01
原文格式PDF
申请/专利权人 北京航天自动控制研究所;中国运载火箭技术研究院;
申请/专利号CN201710103365.0
申请日2017-02-24
分类号
代理机构中国航天科技专利中心;
代理人徐辉
地址 100854 北京市海淀区北京142信箱402分箱
入库时间 2023-06-19 02:53:54
法律状态公告日
法律状态信息
法律状态
2019-11-12
授权
授权
2017-08-25
实质审查的生效 IPC(主分类):G01S19/23 申请日:20170224
实质审查的生效
2017-08-01
公开
公开
技术领域
本发明涉及一种共支架基座三捷联惯组导航一致性试验方法,属于航天试验领域。
背景技术
运载器飞行中采用多套捷联惯性组件冗余模式提高飞行可靠性,现有运载器采用三捷联惯性测量组合。为考核捷联惯性组件性能,需要进行导航精度试验,在试验过程中,将三套捷联惯性组件安装在支架基座上,通过振动台控制施加规定振动激励来模拟飞行过程,通过总线录取捷联惯性组件脉冲数进行导航计算,由于安装支架基座平面较大,在振动过程中存在挠曲变形,使得三套惯组输出不一致。因此需要对三套捷联惯性组件导航一致性和精度进行评定,用于考核捷联惯性组件对振动过程的适应能力。
发明内容
本发明的目的在于克服现有技术的不足,提供一种共支架基座三捷联惯组导航一致性试验方法,实现在振动过程终对捷联惯性组件的考核。
本发明目的通过如下技术方案予以实现:
提供一种共支架基座三捷联惯组导航一致性试验方法,包括如下步骤:
(1)将三套捷联惯性组件,捷联惯组A、捷联惯组B、捷联惯组C分别安装在支架基座上,通过支架基座固定在振动台上;测得三套捷联惯性组件的方位角A0A、A0B、A0C,得到滚动角
(2)利用初始俯仰不水平度
(3)开始振动试验,记录三套捷联惯性组件中的陀螺和加速度计输出数据;
(4)通过惯性导航算法进行导航计算,获得三套捷联惯性组件输出计算出的位置、速度和姿态;计算三套捷联惯性组件两两之间的位置差值,并与阈值比较,判断是否超差;计算三套捷联惯性组件两两之间的速度差值,并与阈值比较,判断是否超差;计算三套捷联惯性组件两两之间的位置差值,并与阈值比较,判断是否超差;计算三套捷联惯性组件两两之间的姿态差值,并与阈值比较,判断是否超差;如果两套捷联惯性组件之间的差值存在超差则认为两个捷联惯性组件不一致。
优选的,步骤(2)中利用初始俯仰不水平度
捷联惯组B的俯仰角
捷联惯组C的俯仰角
优选的,三套捷联惯性组件的方位角A0A、A0B、A0C即为每套捷联惯性组件与北向的夹角,通过瞄准测得。
优选的,如果两个捷联惯组一致,两个捷联惯组均与另外一个捷联惯组不一致,则认为另外一个惯组一致性差,器件偏差大。
优选的,如果存在捷联惯性组件不一致的情况,则通过后续分析区分捷联惯性组件和支架基座对导航一致性产生的影响,如果由于支架基座产生的不一致,则对飞行过程中一致性判断阈值进行补偿。
本发明与现有技术相比具有如下优点:
(1)本发明在振动环境中,通过共基座三捷联惯性组件导航一致性仿真试验,评估三套捷联惯性组件导航一致性和精度。
(2)本发明可以对飞行过程中三套捷联惯性组件一致性判断提供依据,避免在飞行中出现由于支架基座影响而导致的误判。
(3)本发明的方法利用实际飞行使用的支架和惯组,采用实际惯组输出数据,试验准确,可对飞行中的数据处理提供有效指导。
附图说明
图1为本发明的三套捷联惯性组件安装示意图。
具体实施方式
下面将结合附图对本发明进一步详细说明。
试验方法主要包括如下步骤:
(1)捷联惯性组件方位角、不水平度计算
如图1所示,将三套捷联惯性组件(主惯组A、备份惯组B、备份惯组C)安装在支架基座上,通过支架基座固定在振动台上,试验开始前测得三套捷联惯性组件的方位角A0A、A0B、A0C,得到滚动角
捷联惯性组件加电30分钟,根据捷联惯性组件输出的测量数据计算三套捷联惯性组件初始俯仰不水平度
(2)四元数初始值计算
采用步骤(1)中获得的初始不水平度和滚动角进行四元数初始值计算:
主惯组A的俯仰角
备份惯组B的俯仰角
备份惯组C的俯仰角
(3)开始振动试验,记录三套捷联惯性组件中的陀螺和加速度计输出数据。
(4)导航一致性计算
振动结束后,通过惯性导航算法进行导航计算,获得3套惯组对应的位置、速度和姿态导航信息,进行两两做差,判断差值是否满足阈值要求,如果差值均满足要求,则认为3个惯组一致;如果两个惯组之间的差值满足要求,与另外一个惯组不一致,则认为两个惯组一致,另外一个惯组存在故障;否则认为3个惯组不一致。
录取捷联惯性组件器件数据,采用惯组中的陀螺和加速度计数据,得到三套捷联惯性组件的速度、位置和姿态导航数据,三套捷联惯性组件导航数据间的差为一致性误差。
通过惯性导航算法进行导航计算的具体方法如下:
速度初值(V0=0)和试验地点位置(α0)作为位置初值进行惯性导航计算,速度计算公式:
Vi=Vi-1+ΔWi+g·τ
Vi为惯性导航计算速度数据,ΔWi为加速度计输出数据,g为重力加速度,τ惯组输出间隔时间。
位置计算公式:
αi=αi-1+Vi·τ
αi为惯性导航计算位置数据。
姿态计算公式:
对于惯组A,qA计算公式如下:
其中:δθAx1[i]、δθAy1[i]、δθAz1[i]为惯组陀螺输出数据。
δθA[i]2=δθAx1[i]2+δθAy1[i]2+δθAz1[i]2;
(q0A[i],q1A[i],q2A[i],q3A[i])惯性导航计算四元数数据。
主惯组A的四元数初始值为q0A、q1A、q2A、q3A。
对于惯组B和惯组C分别采用各自的四元数初始值和惯组陀螺输出数据,利用上述公式计算姿态四元素qB和qC。
计算3套惯组惯性导航计算速度数据VAi,VBi,VCi两两之间的差值,并与阈值比较,判断是否超差;
计算3套惯组惯性导航计算位置数据αAi,αBi,αCi两两之间的差值,并与阈值比较,判断是否超差;
计算3套惯组惯性导航计算姿态四元素数据qA,qB,qC两两之间的差值,并与阈值比较,判断是否超差;
如果以上任意数据存在超差则认为两个惯组不一致。
如果差值均满足要求,则认为3个惯组一致;如果两个惯组之间的差值满足要求,与另外一个惯组不一致,则认为两个惯组一致,另外一个惯组一致性差,器件偏差大;如果3个惯组均不一致,则认为3个惯组一致性差器件偏差大。如果存在捷联惯性组件不一致的情况,则通过后续定量分析区分捷联惯性组件和支架基座对导航一致性产生的影响,如果由于支架基座产生的不一致,则对飞行过程中一致性判断阈值进行补偿。
以上所述,仅为本发明最佳的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到的变化或替换,都应涵盖在本发明的保护范围之内。
本发明说明书中未作详细描述的内容属于本领域专业技术人员的公知技术。
机译: 数字处理器null包括用于以方式使用的存储器以及设备和捷联惯性导航系统以补偿捷联惯性导航中的sukaringu
机译: 根据捷联惯性导航系统的信息对卫星无线电导航系统的导航数据进行完整性控制的自动导航系统
机译: 一种具有一个通用辐射源的基于三轴光纤陀螺仪的捷联惯性定向系统的精度提高方法