CN109141418B - 过载环境下捷联惯导数据处理装置及其多源误差建模方法 - Google Patents

过载环境下捷联惯导数据处理装置及其多源误差建模方法 Download PDF

Info

Publication number
CN109141418B
CN109141418B CN201811128089.4A CN201811128089A CN109141418B CN 109141418 B CN109141418 B CN 109141418B CN 201811128089 A CN201811128089 A CN 201811128089A CN 109141418 B CN109141418 B CN 109141418B
Authority
CN
China
Prior art keywords
error
aircraft
inertial navigation
data processing
strapdown inertial
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201811128089.4A
Other languages
English (en)
Other versions
CN109141418A (zh
Inventor
陈熙源
石春凤
马振
邵鑫
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Southeast University
Original Assignee
Southeast University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Southeast University filed Critical Southeast University
Priority to CN201811128089.4A priority Critical patent/CN109141418B/zh
Publication of CN109141418A publication Critical patent/CN109141418A/zh
Application granted granted Critical
Publication of CN109141418B publication Critical patent/CN109141418B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • G01C21/18Stabilised platforms, e.g. by gyroscope
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20Instruments for performing navigational calculations
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C25/00Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
    • G01C25/005Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Manufacturing & Machinery (AREA)
  • Navigation (AREA)

Abstract

本发明公开了一种过载环境下捷联惯导数据处理装置及其多源误差建模方法,捷联惯导数据处理装置包括捷联惯导组件模块和导航数据处理模块;多源误差建模方法包括建立飞行器的发动机推力模型,分析多种误差的来源,采用高阶高次误差分析,考虑外在发动机推力导致的弹性形变,及过载导致的加速度计及陀螺仪高阶误差,从而建立的多源非线性误差模型,提高了误差模型的准确性,从而有针对性地进行高精度的误差修正,提高导航定位精度,尤其适用于多种误差源影响下的捷联惯导系统,具有极强的普适性,为捷联惯导在飞行器工程化实现和应用方面提供有力支撑。

Description

过载环境下捷联惯导数据处理装置及其多源误差建模方法
所属领域
本发明属于飞行器惯性导航技术领域,具体涉及一种过载环境下捷联惯导数据处理装置及其多源误差建模方法。
背景技术
高空飞行器是一种用于高空探索的重要工具,随着高新材料、导航定位等技术的发展,高空飞行器在军事、民用方面的应用更加重要。在高空飞行器运行主动段,发动机对其实施一定的推力,使其过载并上升,达到预定高度与速度后关闭发动机,要完成这一过程的导航定位功能,捷联惯导起到主导作用。
捷联惯导系统可以将惯性器件直接固连在飞行器上,直接敏感其线速度和角速度,具有高精度、高隐蔽性的优点,在高空飞行器的应用十分广泛。但是在高速高动态的过载环境下,飞行器会产生弹性形变,加速度计与陀螺仪误差将会更加复杂,无法用单一的线性模型进行模拟,因导航算法的数字积分特性,这些误差会不断迭代积累,而最终影响导航定位精度。因此,对其在不同状态下尤其是过载状态下的研究,分析其运动状态变化而引起的多源误差,建立一种具有普适性的飞行器捷联惯导数据处理装置及多源误差建模方法,以此保证在高动态变化下仍能高性能工作,对进一步提高捷联惯导导航定位的精度具有重要的工程和军事意义。
发明内容
本发明正是为了克服现有技术中模型单一,不符合实际情况的问题,提供了一种过载环境下捷联惯导数据处理装置及其多源误差建模方法,通过分析飞行器所受推力模型及影响,分别分析不同误差源,进而提出一种具有普适性的捷联惯导多源误差建模方法,为进一步进行导航误差补偿提供有利支撑。
为了实现上述目的,本发明采用的技术方案是:过载环境下捷联惯导数据处理装置,包括捷联惯导组件模块和导航数据处理模块,
所述捷联惯导组件模块至少包括三轴加速度计与三轴陀螺仪,用于输出飞行器的三轴加速度和角速率信息,并将信息输出至导航数据处理模块;
所述导航数据处理模块包括接口模块、核心处理器及电源模块,接口模块接收捷联惯导组件模块输出的信息后,将其传送至核心处理器,通过惯性导航算法计算得到飞行器的姿态、速度和位置信息,然后导航定位输出;
还包括发动机模块,所述发动机模块用于为捷联惯导数据处理装置提供外在推力,并对捷联惯导组件模块产生误差影响。
作为本发明的一种改进,所述捷联惯导组件模块安装于飞行器弹性振动1阶振型的波腹处。
为了实现上述目的,本发明还采用的技术方案是:基于过载环境下的捷联惯导数据处理装置的多源误差建模方法,包括如下步骤:
S1,建立发动机推力模型;在发动机作用下,所述飞行器受外力主要综合体现在视加速度上,故,飞行器视加速度模型为:
Figure BDA0001812938810000021
其中,m*为t时刻飞行器质量;F*为t时刻飞行器发动机高空推力;N*为t时刻飞行器所受气动力;
Figure BDA0001812938810000022
为t时刻飞行器所受燃气舵阻力;
S2,对捷联惯导数据处理装置的误差源进行分析,所述惯性器件的误差源主要包括零偏、标度因数与交叉耦合误差、随机噪声、杆臂效应误差la、深层次误差源Gg及高阶误差项lgb
所述零偏包括加速度计零偏ba和陀螺仪零偏bg
所述标度因数与交叉耦合误差包括加速度计标度因数误差Ka、陀螺仪的标度因数误差Kg及交叉耦合误差
Figure BDA0001812938810000023
所述随机噪声包括加速度计随机噪声wa及陀螺仪随机噪声wg
S3,建立基于过载环境下的捷联惯导数据处理装置的多源误差模型:
Figure BDA0001812938810000024
Figure BDA0001812938810000025
其中,
Figure BDA0001812938810000031
为惯性器件输出的比力与角速率;
Figure BDA0001812938810000032
为比力与角速率的真值;I3为单位阵;其中,
Figure BDA0001812938810000033
Figure BDA0001812938810000034
ψ、γ分别为发射惯性系下飞行器的航向角、俯仰角和横滚角。
作为本发明的一种改进,所述步骤S1中,t时刻飞行器发动机高空推力F*为:
F*=F+CF0AtΔPc
其中,CF0为地面实际推力系数;At为喷管喉部面积;ΔPc表征发动燃烧室相对压强的测量误差;
所述t时刻飞行器所受气动力N*为:
Figure BDA0001812938810000035
其中,
Figure BDA0001812938810000036
表征轴向气动阻力系数;ρ*表征大气密度;v*表征飞行器相对大气运动速度;Smax表征最大横截面积;
所述t时刻飞行器所受燃气舵阻力
Figure BDA0001812938810000037
是i个舵偏角的函数,
Figure BDA0001812938810000038
所述
Figure BDA0001812938810000039
其中,m为利用相对压强遥测值所计算的t时刻飞行器质量;CD为流量损失系数;C*表征特征速度。
根据S1中所述视加速度模型,及上述力的分析,所述视加速度为所述飞行器在载体坐标系b系相对于发射惯性坐标系i的加速度在i系中的投影,通过坐标转换矩阵
Figure BDA00018129388100000310
将其转换至在载体坐标系中的投影,即最终的比力真值为
Figure BDA00018129388100000311
作为本发明的另一种改进,所述步骤S2中零偏为静态零偏与动态零偏之和,
ba=bas+bad,bg=bgs+bgd
式中,ba、bg分别为加速度计零偏与陀螺仪零偏;bas、bgs分别为加速度计、陀螺仪静态零偏;bad、bgd分别为加速度计、陀螺仪动态零偏;
动态零偏为对加速度敏感的零偏与对加速度不敏感的零偏:
bgd=κf+τ[fTf-diag2(fx,fy,fz)]
式中,κ=diag(bax,bay,baz),bax,bay,baz为对加速度敏感的零偏系数;f=(fx,fy,fz)为飞行器视加速度;
Figure BDA0001812938810000041
bazx,baxy,bayz为高阶误差项的不等弹性零偏系数;
所述加速度计与陀螺仪的标度因数误差Ka、Kg为非线性误差,随时间与弹性变形变化引起的比力与角速率变化而变化:
Ka=τa(Ka,x,Ka,y,Ka,z),Kg=τg(Kg,x,Kg,y,Kg,z)
其中,τ=f(t,l,ζ)为变化系数,l,ζ分别为弹性变形下的线位移与角位移;
所述交叉耦合误差
Figure BDA0001812938810000042
为惯性器件敏感轴s系同载体坐标系b系的正交不对准造成的偏差值:
Figure BDA0001812938810000043
式中θ为安装误差角。
作为本发明的另一种改进,所述步骤S2中加速度计在飞行器震荡情况下的动态零偏系数bad通过遥测数据进行数据拟合确定;
所述加速度计和陀螺仪的随机噪声矢量形式分别为:
wa=(wa,x,wa,y,wa,z),wg=(wg,x,wg,y,wg,z)。
作为本发明的有一种改进,所述步骤S2中杆臂效应误差la为:
Figure BDA0001812938810000044
式中,μ为弹性形变系数;
Figure BDA0001812938810000051
为敏感点N在载体坐标系中的坐标;wb为载体角速度。
作为本发明的更进一步改进,所述步骤S2中高阶误差项取不等惯量误差lgb,正比于两个正交轴上角速率乘积:
Figure BDA0001812938810000052
式中,lgzx,lgxy,lgyz表征不等惯量系数,ω表征三轴的角速率。
作为本发明的更进一步改进,所述步骤S2中深层次误差源Gg系在飞行器加速推进过程中,飞行器超重而引发的陀螺所表现出的与比力相关的误差,即g相关零偏,三轴向的加速度均可影响同一个陀螺测量,因此g相关零偏取3×3矩阵。
为了实现上述目的,本发明还采用的技术方案是:基于过载环境下捷联惯导数据处理装置的多源误差建模的导航方法,包括如下步骤:
S1’:对于步骤S1中飞行器所受发动机外在推力建模分析,分析飞行器在发射惯性系下的视加速度a,求得比力真值
Figure BDA0001812938810000053
S2’:在所述比力真值基础上添加所建加速度计误差:
Figure BDA0001812938810000054
得到带有所述多源误差的加速度计输出比力
Figure BDA0001812938810000055
在陀螺仪输出角速率真值基础上添加所述陀螺仪误差:
Figure BDA0001812938810000056
得到带有所述多源误差的传感器输出角速率
Figure BDA0001812938810000057
S3’:通过加速度计相关比力数据进行坐标转换,求解发射惯性系下飞行器的速度,
vi(k+1)=vi(k)+aiΔt
其中,
Figure BDA0001812938810000058
gi为飞行器所受万有引力;Δt为采样时间;
S4’:通过泰勒展开求解发射惯性系下飞行器的位置,
Si(k+1)=Si(k)+viΔt
Figure BDA0001812938810000061
S5’:将地球看作一均质圆球,求解得其经纬度信息
Figure BDA0001812938810000062
与现有技术相比,本发明提出了一种过载环境下捷联惯导数据处理装置及其多源误差建模方法,具有的技术效果和优势为:
(1)本发明给出了一种基于过载环境的捷联惯导数据处理装置,能够直接获取高空高速飞行器在发射惯性系下的传感器数据,可以模拟惯性器件误差并添加至所输出数据,进而通过导航数据处理模块进行惯导解算,获取导航定位结果。
(2)高空飞行器由于发动机推力产生过载,对飞行器自身形状及惯性器件都有一定的影响,进而对加速度计及陀螺仪产生干扰,本发明从推力模型出发,分析影响惯性器件精度的多种源头,分别建立对于误差模型,最终建立过载环境下飞行器捷联惯导系统的多源误差模型。
(3)与传统的误差模型相比,本发明考虑了发动机推力及过载导致的弹性形变,舍弃线性误差模型,在高空高速及弹性形变时考虑非线性误差模型,并更加全面的添加了过载引发的对加速度计及陀螺仪造成的高阶误差,提高了误差模型的准确性,为进一步误差补偿、提高精度提供了基础。
附图说明
图1为本发明的飞行器捷联惯导数据处理装置结构示意图;
图2为本发明飞行器的捷联惯导数据解算及误差模型原理图。
图3为本发明所涉及杆臂误差分析示意图。
具体实施方式
以下将结合附图和实施例,对本发明进行较为详细的说明,为了便于描述,附图中仅示出了与本发明相关的部分而非全部结构。
实施例1
过载环境下捷联惯导数据处理装置,如图1所示,包括捷联惯导组件模块和导航数据处理模块,
捷联惯导组件模块包括三轴加速度计与三轴陀螺仪,输出飞行器的包含多源误差的三轴加速度和角速率信息,并将其输出至导航数据处理模块。导航数据处理模块,通过接口模块接收来自传感器的信息,将其传送至核心处理器进行计算,通过惯性导航算法计算得到飞行器的姿态、速度和位置信息,并最终输出。发动机模块用于为飞行器提供所需推力,使其产生过载并为飞行器运动提供动力,同时因发动机作用,影响捷联惯导组件模块在多个源头产生不同的非线性误差,进而影响传感器输出结果。
其中,捷联惯导组件模块安装于飞行器弹性振动1阶振型的波腹处,此安装处震荡中心线位移最大而角速率小:考虑飞行器为变质量的弹性体,其存在结构弹性变形问题,进而将改变推力方向及气动力分布,从而改变力的平衡状态,使其姿态发生变化。
实施例2
一种过载环境下捷联惯导数据处理装置的多源误差建模方法,包括如下步骤:
S1,建立发动机推力模型;在发动机作用下,分析飞行器受力模型,其所受外力将综合体现在视加速度上,所述飞行器视加速度模型为:
Figure BDA0001812938810000071
式中,a表征t时刻飞行器的视加速度,m*表征t时刻飞行器质量,F*表征t时刻发动机高空推力:
F*=F+CF0AtΔPc
式中,F表征利用发动机燃烧室相对压强遥测值计算的高空推力,CF0表征地面实际推力系数,由发动机结构参数与推进剂性能决定,At表征喷管喉部面积,ΔPc表征发动燃烧室相对压强的测量误差。
N*表征t时刻飞行器所受气动力:
Figure BDA0001812938810000081
式中,
Figure BDA0001812938810000082
表征轴向气动阻力系数,ρ*表征大气密度,v*表征飞行器相对大气运动速度,Smax表征最大横截面积。
Figure BDA0001812938810000083
表征t时刻飞行器所受燃气舵阻力,是i个舵偏角的函数,
Figure BDA0001812938810000084
所述飞行器视加速度模型中,
Figure BDA0001812938810000085
式中,m表征利用相对压强遥测值所计算的t时刻飞行器质量,CD表征流量损失系数,C*表征特征速度。
根据所述视加速度模型,及上述力的分析,所述视加速度为所述飞行器在载体坐标系b系相对于发射惯性坐标系i的加速度在i系中的投影,在实际应用中,需通过坐标转换矩阵
Figure BDA0001812938810000086
将其转换至在载体坐标系中的投影,即最终的比力真值为
Figure BDA0001812938810000087
S2,对捷联惯导数据处理装置的误差源进行分析,如图2所示,惯性器件的误差源主要由以下六部分组成:
a.零偏
将零偏分为静态零偏和动态零偏两部分,
ba=bas+bad,bg=bgs+bgd
式中,所述ba、bg分别为加速度计零偏与陀螺仪零偏,所述bas、bgs分别为加速度计、陀螺仪静态零偏,所述bad、bgd分别为加速度计、陀螺仪动态零偏。
动态零偏为对加速度敏感的零偏与对加速度不敏感的零偏:
bgd=κf+τ[fTf-diag2(fx,fy,fz)]
式中,κ=diag(bax,bay,baz),bax,bay,baz表征对加速度敏感的零偏系数;f=(fx,fy,fz)表征飞行器视加速度;
Figure BDA0001812938810000091
bazx,baxy,bayz为高阶误差项的不等弹性零偏系数。bad为加速度计在飞行器震荡情况下的动态零偏系数,通过遥测数据进行数据拟合以确定。
b.标度因数与交叉耦合误差
惯性器件输入输出斜率与标称值之间的偏差为标度因数误差,因发动机推力影响,所述加速度计与陀螺仪的标度因数误差Ka、Kg为非线性误差,误差随时间与弹性变形变化引起的比力与角速率变化而变化:
Ka=τa(Ka,x,Ka,y,Ka,z),Kg=τg(Kg,x,Kg,y,Kg,z)
其中,τ=f(t,l,ζ)为变化系数,l,ζ分别为弹性变形下的线位移与角位移。
交叉耦合误差
Figure BDA0001812938810000092
为惯性器件敏感轴s系同载体坐标系b系的正交不对准造成的偏差值:
Figure BDA0001812938810000093
式中θ为安装误差角。
c.随机噪声
在惯性器件采样中,加速度计和陀螺仪的矢量形式分别为:
wa=(wa,x,wa,y,wa,z),wg=(wg,x,wg,y,wg,z)
d.杆臂效应
因安装位置偏差所造成的外杆臂效应与由三轴加速度计坐标轴敏感点不重合引起的误差,即为杆臂效应,当飞行器在过载阶段时,因发动机推力造成的弹性形变,使得杆臂效应随其发生变化。
如图3所示为内杆臂原理图,将杆臂参数通过加速度计敏感点N在参考坐标系中的位置矢量进行表示,其中,
Figure BDA0001812938810000101
为敏感点N在载体坐标系中的坐标,载体角速度为wb,记其杆臂效应误差为:
Figure BDA0001812938810000102
式中,μ表征弹性形变系数,随过载阶段弹性形变发生变化。因此杆臂误差也是一个非线性误差。
e.深层次误差源
深层次误差源,系在飞行器加速推进过程中,飞行器超重而引发的陀螺所表现出的与比力相关的误差,即g相关零偏,三轴向的加速度均可影响同一个陀螺测量,因此g相关零偏取3×3矩阵,记为Gg
f.高阶误差项
本发明中所述高阶误差项取不等惯量误差lgb,正比于两个正交轴上角速率乘积:
Figure BDA0001812938810000103
式中,lgzx,lgxy,lgyz表征不等惯量系数,ω表征三轴的角速率。
S3,建立基于过载环境下的捷联惯导数据处理装置的多源误差模型:
Figure BDA0001812938810000104
Figure BDA0001812938810000105
其中,
Figure BDA0001812938810000106
为惯性器件输出的比力与角速率;
Figure BDA0001812938810000107
为比力与角速率的真值;I3为单位阵;其中,
Figure BDA0001812938810000108
Figure BDA0001812938810000109
ψ、γ分别为发射惯性系下飞行器的航向角、俯仰角和横滚角。
实施例3
一种过载环境下捷联惯导数据处理装置的多源误差建模的导航方法,如图2所示,包括如下步骤:
S1’:对于步骤S1中飞行器所受发动机外在推力建模分析,分析飞行器在发射惯性系下的视加速度a,求得比力真值
Figure BDA0001812938810000111
S2’:在所述比力真值基础上添加所建加速度计误差:
Figure BDA0001812938810000112
得到带有所述多源误差的加速度计输出比力
Figure BDA0001812938810000113
其中,所述标度因数误差为非线性误差,与弹性变形下的线位移与角位移相关;所述杆臂效应,与发动机推力造成的弹性形变系数有关;
在陀螺仪输出角速率真值基础上添加所述陀螺仪误差:
Figure BDA0001812938810000114
得到带有所述多源误差的传感器输出角速率
Figure BDA0001812938810000115
其中,所述高阶误差项的不等弹性零偏系数及动态零偏系数的选取,所述标度因数误差为非线性误差,与弹性变形下的线位移与角位移相关;
S3’:通过加速度计相关比力数据进行坐标转换,求解发射惯性系下飞行器的速度,
vi(k+1)=vi(k)+aiΔt
其中,
Figure BDA0001812938810000116
gi为飞行器所受万有引力;Δt为采样时间;
S4’:通过泰勒展开求解发射惯性系下飞行器的位置,
Si(k+1)=Si(k)+viΔt
Figure BDA0001812938810000118
S5’:将地球看作一均质圆球,求解得其经纬度信息
Figure BDA0001812938810000117
通过陀螺仪相关角速率数据求解姿态矩阵,最终求得飞行器姿态角信息。
以上显示和描述了本发明的基本原理、主要特征和本发明的优点。本行业的技术人员应该了解,本发明不受上述实例的限制,上述实例和说明书中描述的只是说明本发明的原理,在不脱离本发明精神和范围的前提下本发明还会有各种变化和改进,这些变化和改进都落入要求保护的本发明范围内。本发明要求保护范围由所附的权利要求书及其等同物界定。

Claims (9)

1.过载环境下捷联惯导数据处理的多源误差建模方法,其特征在于,包括如下步骤:
S1,建立发动机推力模型;在发动机作用下,飞行器受外力主要综合体现在视加速度上,故,飞行器视加速度模型为:
Figure FDA0003534496620000011
其中,a为飞行器视加速度,m*为t时刻飞行器质量;F*为t时刻飞行器发动机高空推力;N*为t时刻飞行器所受气动力;
Figure FDA0003534496620000012
为t时刻飞行器所受燃气舵阻力;
t时刻飞行器发动机高空推力F*为:
F*=F+CF0AtΔPc
其中,CF0为地面实际推力系数;At为喷管喉部面积;ΔPc表征发动燃烧室相对压强的测量误差;
所述t时刻飞行器所受气动力N*为:
Figure FDA0003534496620000013
其中,
Figure FDA0003534496620000014
表征轴向气动阻力系数;ρ*表征大气密度;v*表征飞行器相对大气运动速度;Smax表征最大横截面积;
所述t时刻飞行器所受燃气舵阻力
Figure FDA0003534496620000015
是i个舵偏角δ1,δ2,…δi的函数,因此
Figure FDA0003534496620000016
即为
Figure FDA0003534496620000017
所述
Figure FDA0003534496620000018
其中,m为利用相对压强遥测值所计算的t时刻飞行器质量;CD为流量损失系数;C*表征特征速度;
所述视加速度为所述飞行器在载体坐标系b系相对于发射惯性坐标系i的加速度在i系中的投影,通过坐标转换矩阵
Figure FDA0003534496620000019
将其转换至在载体坐标系中的投影,即比力真值
Figure FDA00035344966200000110
S2,对捷联惯导数据处理装置的误差源进行分析,惯性器件的误差源主要包括零偏、标度因数与交叉耦合误差、随机噪声、杆臂效应误差la、深层次误差源Gg及高阶误差项lgb
所述零偏包括加速度计零偏ba和陀螺仪零偏bg
所述标度因数与交叉耦合误差包括加速度计标度因数误差Ka、陀螺仪的标度因数误差Kg及交叉耦合误差
Figure FDA0003534496620000021
所述随机噪声包括加速度计随机噪声wa及陀螺仪随机噪声wg
S3,建立基于过载环境下的捷联惯导数据处理装置的多源误差模型:
Figure FDA0003534496620000022
Figure FDA0003534496620000023
其中,
Figure FDA0003534496620000024
为惯性器件输出的比力与角速率;
Figure FDA0003534496620000025
为比力与角速率的真值;I3为单位阵;其中,
Figure FDA0003534496620000026
Figure FDA0003534496620000027
ψ、γ分别为发射惯性系下飞行器的航向角、俯仰角和横滚角。
2.如权利要求1所述的过载环境下捷联惯导数据处理的多源误差建模方法,其特征在于所述步骤S2中零偏为静态零偏与动态零偏之和,
ba=bas+bad,bg=bgs+bgd
式中,ba、bg分别为加速度计零偏与陀螺仪零偏;bas、bgs分别为加速度计、陀螺仪静态零偏;bad、bgd分别为加速度计、陀螺仪动态零偏;
动态零偏为对加速度敏感的零偏与对加速度不敏感的零偏:
bgd=κa+τ[aTa-diag2(ax,ay,az)]
式中,κ=diag(bax,bay,baz),bax,bay,baz为对加速度敏感的零偏系数;a=(ax,ay,az)为飞行器视加速度,ax,ay,az为在该向量在发射惯性系x,y,z三轴的分量;
Figure FDA0003534496620000028
bazx,baxy,bayz为高阶误差项的不等弹性零偏系数;
所述加速度计与陀螺仪的标度因数误差Ka、Kg为非线性误差,随时间与弹性变形变化引起的比力与角速率变化而变化:
Ka=τa(Ka,x,Ka,y,Ka,z),Kg=τg(Kg,x,Kg,y,Kg,z)
其中,τa=f(t,l,ζ),τg=f(t,l,ζ)分别为加速度计和陀螺仪的变化系数,l,ζ分别为弹性变形下的线位移与角位移;
所述交叉耦合误差
Figure FDA0003534496620000031
为惯性器件敏感轴s系同载体坐标系b系的正交不对准造成的偏差值:
Figure FDA0003534496620000032
式中θ为安装误差角。
3.如权利要求2所述的过载环境下捷联惯导数据处理的多源误差建模方法,其特征在于:所述步骤S2中加速度计在飞行器震荡情况下的动态零偏系数bad通过遥测数据进行数据拟合确定;
所述加速度计和陀螺仪的随机噪声矢量形式分别为:
wa=(wa,x,wa,y,wa,z),wg=(wg,x,wg,y,wg,z)。
4.如权利要求3所述的过载环境下捷联惯导数据处理的多源误差建模方法,其特征在于:所述步骤S2中杆臂效应误差la为:
Figure FDA0003534496620000033
式中,μ为弹性形变系数;
Figure FDA0003534496620000034
为敏感点N在载体坐标系中的坐标;wb为载体角速度。
5.如权利要求4所述的过载环境下捷联惯导数据处理的多源误差建模方法,其特征在于:所述步骤S2中高阶误差项取不等惯量误差lgb,正比于两个正交轴上角速率乘积:
Figure FDA0003534496620000041
式中,lgzx,lgxy,lgyz表征不等惯量系数,ω表征三轴的角速率。
6.如权利要求1所述的过载环境下捷联惯导数据处理的多源误差建模方法,其特征在于:所述步骤S2中深层次误差源Gg系在飞行器加速推进过程中,飞行器超重而引发的陀螺所表现出的与比力相关的误差,即g相关零偏,三轴向的加速度均可影响同一个陀螺测量,因此g相关零偏取3×3矩阵。
7.如权利要求1所述的过载环境下捷联惯导数据处理的多源误差建模方法,其特征在于,还包括如下的导航方法步骤:
S1’:对于步骤S1中飞行器所受发动机外在推力建模分析,分析飞行器在发射惯性系下的视加速度a,求得比力真值
Figure FDA0003534496620000042
S2’:在所述比力真值基础上添加加速度计误差:
Figure FDA0003534496620000043
得到带有所述多源误差的加速度计输出比力
Figure FDA0003534496620000044
在陀螺仪输出角速率真值基础上添加陀螺仪误差:
Figure FDA0003534496620000045
得到带有所述多源误差的传感器输出角速率
Figure FDA0003534496620000046
S3’:通过加速度计相关比力数据进行坐标转换,求解发射惯性系下飞行器的速度,
vi(k+1)=vi(k)+aiΔt
其中,
Figure FDA0003534496620000047
gi为飞行器所受万有引力;Δt为采样时间;
S4’:通过泰勒展开求解发射惯性系下飞行器的位置,
Si(k+1)=Si(k)+viΔt
Figure FDA0003534496620000048
S5’:将地球看作一均质圆球,求解得其经纬度信息
Figure FDA0003534496620000051
8.使用如权利要求1所述的过载环境下捷联惯导数据处理的多源误差建模方法的数据处理装置,其特征在于:包括捷联惯导组件模块和导航数据处理模块,
所述捷联惯导组件模块至少包括三轴加速度计与三轴陀螺仪,用于输出飞行器的三轴加速度和角速率信息,并将信息输出至导航数据处理模块;
所述导航数据处理模块包括接口模块、核心处理器及电源模块,接口模块接收捷联惯导组件模块输出的信息后,将其传送至核心处理器,通过惯性导航算法计算得到飞行器的姿态、速度和位置信息,然后导航定位输出;
还包括发动机模块,所述发动机模块用于为捷联惯导数据处理装置提供外在推力,并对捷联惯导组件模块产生误差影响。
9.根据权利要求8所述的数据处理装置,其特征在于:所述捷联惯导组件模块安装于飞行器弹性振动1阶振型的波腹处。
CN201811128089.4A 2018-09-27 2018-09-27 过载环境下捷联惯导数据处理装置及其多源误差建模方法 Active CN109141418B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201811128089.4A CN109141418B (zh) 2018-09-27 2018-09-27 过载环境下捷联惯导数据处理装置及其多源误差建模方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201811128089.4A CN109141418B (zh) 2018-09-27 2018-09-27 过载环境下捷联惯导数据处理装置及其多源误差建模方法

Publications (2)

Publication Number Publication Date
CN109141418A CN109141418A (zh) 2019-01-04
CN109141418B true CN109141418B (zh) 2022-05-13

Family

ID=64812651

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201811128089.4A Active CN109141418B (zh) 2018-09-27 2018-09-27 过载环境下捷联惯导数据处理装置及其多源误差建模方法

Country Status (1)

Country Link
CN (1) CN109141418B (zh)

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110040245B (zh) * 2019-04-30 2022-04-22 中北大学 一种设有过载传感器及安装误差标定系统的飞行器
US11667392B2 (en) 2019-06-20 2023-06-06 Pratt & Whitney Canada Corp. Method and system for operating a rotorcraft engine
CN110765669B (zh) * 2019-12-04 2023-10-13 北京电子工程总体研究所 一种轴对称无翼无舵导弹主动段零升阻力系数辨识方法
CN110940336B (zh) * 2019-12-30 2022-01-07 河北科技大学 捷联惯导仿真定位解算方法、装置及终端设备
CN112710470B (zh) * 2020-12-10 2022-12-27 沈阳航空航天大学 一种基于机动识别的自适应小波阈值mems陀螺仪降噪方法

Family Cites Families (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US7509216B2 (en) * 2004-03-29 2009-03-24 Northrop Grumman Corporation Inertial navigation system error correction
US20050240347A1 (en) * 2004-04-23 2005-10-27 Yun-Chun Yang Method and apparatus for adaptive filter based attitude updating
RU2256880C1 (ru) * 2004-10-12 2005-07-20 Мезенцев Александр Павлович Способ комплексных испытаний бесплатформенных инерциальных измерительных блоков на основе микромеханических гироскопов и акселерометров и устройство для его осуществления
FR2949258A1 (fr) * 2007-12-21 2011-02-25 Thales Sa Procede d'alignement autonome d'unite de mesure inertielle pour instrument de bord d'aeronef
CN101694389B (zh) * 2009-10-20 2011-11-16 哈尔滨工程大学 无陀螺捷联惯导系统的初始姿态快速测量方法
CN102607596B (zh) * 2012-03-07 2014-04-30 北京航空航天大学 基于差分gps观测的捷联挠性陀螺动态随机漂移误差测试方法
CN102759364B (zh) * 2012-04-26 2015-01-07 北京航空航天大学 一种应用gps/sins组合的挠性陀螺比力敏感误差飞行校准方法
CN106248078B (zh) * 2016-07-12 2018-12-28 中国人民解放军国防科学技术大学 机抖激光陀螺敏感轴动态偏移误差参数估计与补偿方法
CN107389099B (zh) * 2017-09-13 2019-11-12 哈尔滨工业大学 捷联惯导系统空中快速对准装置及方法
CN107966162B (zh) * 2017-11-14 2019-12-20 北京临近空间飞行器系统工程研究所 飞行器过载传感器系统级安装误差标定系统及方法
CN108562288B (zh) * 2018-05-08 2020-07-14 北京航天时代激光导航技术有限责任公司 一种激光捷联惯组系统级在线自标定系统及方法

Also Published As

Publication number Publication date
CN109141418A (zh) 2019-01-04

Similar Documents

Publication Publication Date Title
CN109141418B (zh) 过载环境下捷联惯导数据处理装置及其多源误差建模方法
CN111323050B (zh) 一种捷联惯导和多普勒组合系统标定方法
CN101788296B (zh) 一种sins/cns深组合导航系统及其实现方法
CN106289246B (zh) 一种基于位置和姿态测量系统的柔性杆臂测量方法
CN108548542B (zh) 一种基于大气阻力加速度测量的近地轨道确定方法
US20050230557A1 (en) Zero-G emulating testbed for spacecraft control system
CN106767797B (zh) 一种基于对偶四元数的惯性/gps组合导航方法
CN109708663B (zh) 基于空天飞机sins辅助的星敏感器在线标定方法
CN104764467B (zh) 空天飞行器惯性传感器误差在线自适应标定方法
CN107764261B (zh) 一种分布式pos传递对准用模拟数据生成方法和系统
CN111623770B (zh) 一种基于速度误差开环修正的提高惯性制导精度的方法
Chan et al. Aerodynamic Characterization and Improved Testing Methods for the Space Launch System Liftoff and Transition Environment
JPH095104A (ja) 移動物体の三次元姿勢角測定法および三次元姿勢角計測装置
CN114861320B (zh) 一种航天器姿控推力建模及定轨解算方法
CN116429095A (zh) 一种基于主子惯导结合的行进间炮口振动测量方法
CN117053782A (zh) 一种水陆两栖机器人组合导航方法
CN112327883A (zh) 基于扩张状态观测器的欠驱动水面船路径跟踪控制方法
CN111780753A (zh) 一种姿态误差反馈修正的提高惯性制导精度的方法
CN111637883B (zh) 基于速度和位置误差闭环反馈的提高惯性制导精度的方法
CN113029197B (zh) 一种针对柔性杆臂的传递对准方法
CN111982126B (zh) 一种全源BeiDou/SINS弹性状态观测器模型设计方法
CN111220182B (zh) 一种火箭传递对准方法及系统
CN112947522A (zh) 一种基于有限时间观测器的硬式空中加油姿态控制方法
CN112729297A (zh) 一种基于多mems传感器的微型航姿定位装置
CN106679612A (zh) 一种基于惯性测量匹配的非线性挠曲变形估计方法

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant