CN106441301A - 一种飞行器发射初始参数获取方法及系统 - Google Patents
一种飞行器发射初始参数获取方法及系统 Download PDFInfo
- Publication number
- CN106441301A CN106441301A CN201610833844.3A CN201610833844A CN106441301A CN 106441301 A CN106441301 A CN 106441301A CN 201610833844 A CN201610833844 A CN 201610833844A CN 106441301 A CN106441301 A CN 106441301A
- Authority
- CN
- China
- Prior art keywords
- aircraft
- formula
- sin
- information
- micro
- 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.)
- Pending
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/04—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means
- G01C21/08—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means involving use of the magnetic field of the earth
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; 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/16—Navigation; 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/165—Navigation; 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 combined with non-inertial navigation instruments
Abstract
本发明涉及一种飞行器初始参数获取方法及系统,包括:通过微惯性传感器和磁阻电子罗盘采集飞行器的测量数据并进行处理;根据所述测量数据的变化情况,将其分解为静态数据与动态数据;对静态数据进行飞行器姿态角的初始对准计算;对动态数据与之前获得的飞行器初始姿态角,计算出飞行器初始参数信,包括:飞行器姿态角信息飞行器速度信息以及飞行器位置信息;输出飞行器初始参数信息。本发明解决了无线测量常因信号失真、规律异常、离散性过大,有线测量精度不高的问题。
Description
技术领域
本发明涉及电学技术领域,尤其涉及一种飞行器发射初始参数获取方法及系统。
背景技术
目前,飞行器发射时初始参数的获取通常采用无线测量与有线测量作为遥测的辅助手段。由于飞行器发射时,力学环境复杂,飞行器动态变化激烈,无线测量常因信号失真、规律异常、离散性过大,造成初始参数获取困难,不能得到满意的结果;而有线测量需要在飞行器上选择线缆合适的剥离点、分离点和线缆敷设位置,造成了飞行器发射环境的复杂,且受线缆敷设的限制,测量精度不高。因此,现有的飞行器初始参数获取方法由于诸多原因的限制,越来越难以满足日益提高的飞行器初始参数采集精度的要求。
发明内容
鉴于上述的分析,本发明旨在提供一种飞行器发射初始参数获取方法及系统,解决无线测量常因信号失真、规律异常、离散性过大,有线测量精度不高的问题。
本发明的目的主要是通过以下技术方案实现的:
本发明提供了一种飞行器初始参数获取方法,包括:
通过微惯性传感器和磁阻电子罗盘采集飞行器的测量数据并进行处理;
根据所述测量数据的变化情况,将其分解为静态数据与动态数据;
对静态数据进行飞行器姿态角的初始对准计算;对动态数据与之前获得的飞行器初始姿态角,计算出飞行器初始参数信,包括:飞行器姿态角信息飞行器速度信息以及飞行器位置信息;
输出飞行器初始参数信息。
进一步地,所述微惯性传感器包括:三轴微惯性传感器和三轴微陀螺仪,则所述方法还包括:
分别建立三轴微惯性加速度计的误差模型、三轴微陀螺仪的误差模型以及磁阻电子罗盘的误差模型;
根据上述误差模型对测量数据进行误差补偿。
进一步地,建立三轴微惯性加速度计的误差模型为:
A=A0+KA·Fij·a+δ
式中,A为三轴微惯性加速度计输出值;A0为三轴微惯性加速度计零偏;KA为三轴微惯性加速度计标度系数;Fij(i,j=x,y,z)为三轴微惯性加速度计i轴对j轴的正交误差系数;a为飞行器运动输入加速度;δ为三轴微惯性加速度计随机误差;
建立三轴微陀螺仪的误差模型为:
G=G0+KG(Eij·ω)+Dij·a+ε
式中,G为三轴微陀螺仪输出值;G0为三轴微陀螺仪的零偏;KG为三轴微陀螺仪的标度系数;ω为飞行器运动输入角速度;ε为三轴微陀螺仪随机误差;Eij(i,j=x,y,z)为三轴微陀螺仪i轴对j轴的安装误差系数;Dij(i,j=x,y,z)为与加速度有关的一次项误差系数;
建立磁阻电子罗盘的误差模型为:
ψ=ψc+σ1+σ2sinψ+σ3cosψ+σ4sin(2ψ)+σ5cos(2ψ)
式中,ψ为磁阻电子罗盘的输出值;ψc为预先输入的飞行器航向角;σ1、σ2、σ3、σ4、σ5为磁阻电子罗盘的补偿系数。
进一步地,对静态数据进行飞行器姿态角的初始对准计算的过程具体包括:
由三轴微惯性加速度计输出的加速度静态信息确定初始时刻飞行器的俯仰角θ0和横滚角γ0,公式为:
γ0=arctan(-ax/az) (8)
由磁阻电子罗盘确定初始时刻飞行器的航向角ψ0:
ψ0=ψc (9)
通过式(7)、式(8)、式(9)得到飞行器初始静止状态下的初始姿态角:俯仰角θ0、横滚角γ0、航向角ψ0。
飞行器的航向角ψ=ψc,ψc为预先输入磁阻电子罗盘的飞行器航向角。
进一步地,对动态数据与之前获得的飞行器初始姿态角,采用捷联惯性导航算法对结果进行连续积分处理,并转换到导航坐标系中,先计算出飞行器的姿态角信息:俯仰角θ、航向角ψ和横滚角γ;再计算出飞行器的速度信息:横向速度vx、前向速度vy和纵向速度vz;最后计算出飞行器的位置信息横向位移x、前向位移y和纵向位移z。
进一步地,飞行器的姿态角信息计算:
飞行器坐标系b至导航坐标系n的姿态矩阵T为:
姿态矩阵T与四元数q=[q0 q1 q2 q3]T的关系如下:
由初始姿态角通过公式(10)得到初始状态矩阵T0,为飞行器的姿态更新提供了初值。根据式(11),由初始状态矩阵T0即可求出四元数q=[q0 q1 q2 q3]T的初始值q0;
此外,
用经过误差补偿的三轴微惯性陀螺仪测量的角速度对式(16)进行四阶龙格—库塔法计算,并依据式(17)做归一化处理,即可实现四元数的实时更新;
经过式(16)式和(17)实时计算出四元数后,由式(11)完成姿态矩阵的更新,并可根据式(10)和式(11)的转换关系即可反算获得飞行器的姿态角信息:俯仰角θ、航向角ψ、横滚角γ;
飞行器的速度信息计算:
经过补偿的三轴微惯性加速度计测量的加速度信息ax、ay、az,通过姿态矩阵T与发射坐标系的关系转化到导航坐标系,通过一次积分进行导航坐标系内飞行器的速度更新。
式中,g为地球重力加速度;
结合前面计算出的飞行器的姿态角信息,对式(18)进行二阶龙格-库塔法计算,得到飞行器的速度信息:
飞行器的位置信息计算:
对式(19)再进行一次积分计算,即得到飞行器的位置信息:x、y、z。
本发明还提供了一种飞行器初始参数获取系统,包括:微惯性传感器和磁阻电子罗盘、信息采集处理装置、初始参数解散处理器以及显控装置;微惯性传感器与磁阻电子罗盘封装于一体,并通过通信总线与信息采集处理装置连接;信息采集处理装置通过通信总线与初始参数解算处理器连接;初始参数解算处理器通过通信总线与显控装置连接;
所述微惯性传感器、磁阻电子罗盘,用于采集飞行器的测量数据并通过通信总线发送给所述信息采集处理装置;
所述信息采集处理装置,用于将接收到的测量数据进行信号转换后发送给所述初始参数解散处理器;
所述初始参数解散处理器,用于根据所述测量数据的变化情况,将其分解为静态数据与动态数据;对静态数据进行飞行器姿态角的初始对准计算;对动态数据与之前获得的飞行器初始姿态角,计算出飞行器初始参数信,包括:飞行器姿态角信息、飞行器速度信息以及飞行器位置信息;
所述显控装置,用于显示飞行器初始参数信息。
进一步地,所述初始参数解散处理器具体包括:
误差补偿模块,用于分别建立三轴微惯性加速度计的误差模型、三轴微陀螺仪的误差模型以及磁阻电子罗盘的误差模型,并根据上述误差模型对测量数据进行误差补偿;
静动态测量数据辨识模块,用于根据所述测量数据的变化情况,将其分解为静态数据与动态数据;
初始对准模块,用于对静态数据进行飞行器姿态角的初始对准计算,并将计算得到的初始姿态角发送给参数计算模块;
捷联惯性解算模块,用于对动态数据与获得的飞行器初始姿态角,采用捷联惯性导航算法对结果进行连续积分处理,并转换到导航坐标系中,先计算出飞行器的姿态角信息,进而计算出飞行器速度信息以及飞行器位置信息,并输出给所述显控装置。
进一步地,所述误差补偿模块建立的三轴微惯性加速度计的误差模型为:
A=A0+KA·Fij·a+δ
式中,A为三轴微惯性加速度计输出值;A0为三轴微惯性加速度计零偏;KA为三轴微惯性加速度计标度系数;Fij(i,j=x,y,z)为三轴微惯性加速度计i轴对j轴的正交误差系数;a为飞行器运动输入加速度;δ为三轴微惯性加速度计随机误差;
建立的三轴微陀螺仪的误差模型为:
G=G0+KG(Eij·ω)+Dij·a+ε
式中,G为三轴微陀螺仪输出值;G0为三轴微陀螺仪(10)的零偏;KG为三轴微陀螺仪(10)的标度系数;ω为飞行器运动输入角速度;ε为三轴微陀螺仪随机误差;Eij(i,j=x,y,z)为三轴微陀螺仪i轴对j轴的安装误差系数;Dij(i,j=x,y,z)为与加速度有关的一次项误差系数。
建立的磁阻电子罗盘的误差模型为:
ψ=ψc+σ1+σ2sinψ+σ3cosψ+σ4sin(2ψ)+σ5cos(2ψ)
式中,ψ为磁阻电子罗盘的输出值;ψc为预先输入的飞行器航向角;σ1、σ2、σ3、σ4、σ5为磁阻电子罗盘的补偿系数。
进一步地,所述捷联惯性解算模块具体用于,
飞行器的姿态角信息计算:
飞行器坐标系b至导航坐标系n的姿态矩阵T为:
姿态矩阵T与四元数q=[q0 q1 q2 q3]T的关系如下:
由初始姿态角通过公式(10)得到初始状态矩阵T0,为飞行器的姿态更新提供了初值。根据式(11),由初始状态矩阵T0即可求出四元数q=[q0 q1 q2 q3]T的初始值q0;
此外,
用经过误差补偿的三轴微惯性陀螺仪测量的角速度对式(16)进行四阶龙格—库塔法计算,并依据式(17)做归一化处理,即可实现四元数的实时更新;
经过式(16)式和(17)实时计算出四元数后,由式(11)完成姿态矩阵的更新,并可根据式(10)和式(11)的转换关系即可反算获得飞行器的姿态角信息:俯仰角θ、航向角ψ、横滚角γ;
飞行器的速度信息计算:
经过补偿的三轴微惯性加速度计测量的加速度信息ax、ay、az,通过姿态矩阵T与发射坐标系的关系转化到导航坐标系,通过一次积分进行导航坐标系内飞行器的速度更新。
式中,g为地球重力加速度;
结合前面计算出的飞行器的姿态角信息,对式(18)进行二阶龙格-库塔法计算,得到飞行器的速度信息:
飞行器的位置信息计算:
对式(19)再进行一次积分计算,即得到飞行器的位置信息:x、y、z。
本发明有益效果如下:
本发明解决了无线测量常因信号失真、规律异常、离散性过大,有线测量精度不高的问题。
本发明的其他特征和优点将在随后的说明书中阐述,并且,部分的从说明书中变得显而易见,或者通过实施本发明而了解。本发明的目的和其他优点可通过在所写的说明书、权利要求书、以及附图中所特别指出的结构来实现和获得。
附图说明
附图仅用于示出具体实施例的目的,而并不认为是对本发明的限制,在整个附图中,相同的参考符号表示相同的部件。
图1为本发明实施例所述系统的结构示意图;
图2为本发明实施例所述方法的流程示意图。
具体实施方式
下面结合附图来具体描述本发明的优选实施例,其中,附图构成本申请一部分,并与本发明的实施例一起用于阐释本发明的原理。
如图1所示,图1为本发明实施例所述系统的结构示意图,主要可以包括:微惯性传感器、磁阻电子罗盘、信息采集处理装置、初始参数解算处理器、显控装置、通信总线。其中微惯性传感器包括:三轴微惯性加速度计和三轴微惯性陀螺仪;初始参数解算处理器包括:误差补偿模块、静动态数据辨识模块、初始对准模块和捷联惯性解算模块。微惯性传感器与磁阻电子罗盘封装于一体,并通过通信总线与信息采集处理装置连接;信息采集处理装置通过通信总线与初始参数解算处理器连接;初始参数解算处理器通过通信总线与显控装置连接;显控装置用于人机交互。
需要说明的是,由于该系统各个部分的具体实现过程将在以下方法的描述中进行详细说明,故此处不再赘述。
如图2所示,图2为本发明实施例所述方法的流程示意图,具体可以包括如下步骤:
步骤201:测量数据采集
在待获取参数的飞行器上安装好初始参数获取系统后,微惯性传感器与磁阻电子罗盘开始采集飞行器数据并经数据采集处理装置处理(将电压信号转换成物理信号)后传输给初始参数解算处理器。
步骤202:误差补偿模块补偿测量数据误差
初始参数解算处理器接收到微惯性传感器和磁阻电子罗盘的测量数据后,由误差补偿模块进行误差补偿,其中,误差补偿的过程主要包括:分别建立三轴微惯性加速度计的误差模型、三轴微陀螺仪的误差模型以及磁阻电子罗盘的误差模型;根据上述误差模型对测量数据进行误差补偿。
上述各个误差补偿模型分别描述如下:
考虑三轴微惯性加速度计的零偏、安装误差、随机漂移误差项,忽略二阶以上动态小量误差,建立三轴微惯性加速度计的误差模型为:
A=A0+KA·Fij·a+δ (1)
式中,A为三轴微惯性加速度计输出值;A0为三轴微惯性加速度计零偏;KA为三轴微惯性加速度计标度系数;Fij(i,j=x,y,z)为三轴微惯性加速度计i轴对j轴的正交误差系数;a为飞行器运动输入加速度;δ为三轴微惯性加速度计随机误差。
各个矩阵的表达式为:
A=[Ax Ay Az]T;A0=[Ax0 Ay0 Az0]T;
δ=[δx δy δz]T;a=[ax ay az]T。
式中,Ax、Ay、Az为微惯性加速度计x、y、z三轴的输出;Ax0、Ay0、Az0为微惯性加速度计x、y、z三轴的零偏;KAx、KAy、KAz为微惯性加速度计x、y、z三轴的标度系数;Fxy、Fxz、Fyx、Fyz、Fzx、Fzy为微惯性加速度计相应的i轴对j轴的正交误差系数(i,j=x,y,z);δx、δy、δz微惯性加速度计x、y、z三轴的随机误差;ax、ay、az为飞行器x、y、z三轴运动输入加速度,即飞行器运动的真实加速度。
同样地,考虑三轴微陀螺仪的零偏、安装误差、正交误差和随机漂移误差,忽略二阶以上动态小量误差,建立三轴微陀螺仪的误差模型为:
G=G0+KG(Eij·ω)+Dij·a+ε (2)
式中,G为三轴微陀螺仪输出值;G0为三轴微陀螺仪的零偏;KG为三轴微惯性陀螺仪的标度系数;ω为飞行器运动输入角速度;ε为三轴微惯性陀螺仪随机误差;Eij(i,j=x,y,z)为三轴微惯性陀螺仪i轴对j轴的安装误差系数;Dij(i,j=x,y,z)为三轴微陀螺仪与加速度有关的一次项误差系数。
各个矩阵的表达式为:
G=[Gx Gy Gz]T;G0=[Gx0 Gy0 Gz0]T;
ω=[ωx ωy ωz]T;ε=[εx εy εz]T。
式中,Gx、Gy、Gz为三轴微惯性陀螺仪x、y、z三轴的输出;Gx0、Gy0、Gz0为微惯性陀螺仪x、y、z三轴的零偏;Exy、Exz、Eyx、Eyz、Ezx、Ezy为微惯性陀螺仪相应的i轴对j轴的安装误差系数(i,j=x,y,z);Dxx、Dxy、Dxz、Dyx、Dyy、Dyz、Dzx、Dzy、Dzz为微惯性陀螺仪相应的i轴对j轴的(i,j=x,y,z)与加速度有关的一次项误差系数;KGx、KGy、KGz为微惯性陀螺仪x、y、z三轴的标度系数;ωx、ωy、ωz为飞行器x、y、z三轴运动输入的角速度;εx、εy、εz为三轴微惯性陀螺仪x、y、z三轴的随机误差。
鉴于弹射试验时在常温下进行,三轴微惯性加速度计与三轴微惯性陀螺仪的标定试验在常温条件下进行,忽略温度对传感器输出的影响。采用“六位置测试法”确定微惯性加速度计的零偏、标度系数、正交轴安装误差系数、微惯性陀螺仪对加速度敏感项;采用“速率转位测试法”确定微惯性陀螺仪的零偏、标度系数、正交轴安装误差系数。
对式(1)、式(2)进行变换得
式中,a=[ax ay az]T,为补偿后的微惯性加速度计三轴的输出,即飞行器运动实际输入的加速度;ω=[ωx ωy ωz]T,为补偿后的微惯性陀螺仪三轴的输出,即为飞行器运动实际输入的角速度。
建立磁阻电子罗盘的误差模型为:
ψ=ψc+σ1+σ2sinψ+σ3cosψ+σ4sin(2ψ)+σ5cos(2ψ) (5)
式中,ψ为磁阻电子罗盘的输出值;ψc为预先输入的飞行器航向角,即误差补偿后的实际航向角;σ1、σ2、σ3、σ4、σ5为磁阻电子罗盘的补偿系数。
采用最小二乘法,即基于“误差平方和最小”,在0°~360°之间,每个15°共24个实验点进行误差测试,得到24组数据,记误差方程:
U·Ω=H (6)
式中,
经计算即可获取磁阻电子罗盘的补偿系数σ1、σ2、σ3、σ4、σ5。
误差补偿模块对测量数据进行误差补偿后传输给静动态测量数据辨识模块。
步骤203:静动态测量数据辨识模块辨识飞行器静态与动态数据
静动态测量数据辨识模块接收到经误差补偿的测量数据后,根据微惯性传感器测量数据的变化情况辨识出飞行器的静态与动态,并将测量数据分解为静态数据与动态数据。其中,静态数据用于飞行器姿态角的初始对准,动态数据用于飞行器的姿态更新、速度更新与位置更新。
步骤204:初始对准模块计算飞行器初始姿态角
初始对准模块根据静动态测量数据辨识模块的静态数据进行飞行器姿态角的初始对准计算。
由三轴微惯性加速度计输出的加速度静态信息确定初始时刻飞行器的俯仰角θ0和横滚角γ0,公式为:
γ0=arctan(-ax/az) (8)
由磁阻电子罗盘(2)确定初始时刻飞行器的航向角ψ0:
ψ0=ψc (9)
通过式(7)、式(8)、式(9)得到飞行器初始静止状态下的初始姿态角:俯仰角θ0、横滚角γ0、航向角ψ0。
初始对准模块将飞行器的初始姿态角信息传送给初始参数解算处理器内的捷联惯性解算模块。
步骤205:捷联惯性解算模块计算飞行器初始参数信息,并由总线传输给显控装置;
捷联惯性解算模块根据静动态辨识模块辨识出的动态数据与初始对准模块(获得的飞行器初始姿态角,采用捷联惯性导航算法对结果进行连续积分处理,并转换到导航坐标系中,先计算出飞行器的姿态角信息:俯仰角θ、航向角ψ和横滚角γ;再计算出飞行器的速度信息:横向速度vx、前向速度vy和纵向速度vz;最后计算出飞行器的位置信息横向位移x、前向位移y和纵向位移z。
飞行器的姿态角信息计算:
飞行器坐标系b至导航坐标系n的姿态矩阵T为:
姿态矩阵T与四元数q=[q0 q1 q2 q3]T的关系如下:
由初始对准模块得到的初始姿态角通过公式(10)得到初始状态矩阵T0,为飞行器的姿态更新提供了初值。根据式(11),由初始状态矩阵T0即可求出四元数q=[q0 q1 q2 q3]T的初始值q0。
由于微惯性陀螺仪角速率是飞行器坐标系内测量的,需要将其转换到导航坐标系内,有:
式中,为导航坐标系内飞行器的角速率,为飞行器坐标系内飞行器的角速率。
鉴于试验时,飞行器绝对距离变化不大,因此,
式中,为微惯性陀螺仪测量飞行器相对惯性空间转动的角速率在飞行器系中的投影,即误差补偿后的微惯性陀螺仪的输出
由于
根据四元数的乘法结合律,可以由式(12)得到:
将式(15)写成矩阵的形式有:
此外,
用经过误差补偿的三轴微惯性陀螺仪测量的角速度对式(16)进行四阶龙格—库塔法计算,并依据式(17)做归一化处理,即可实现四元数的实时更新。
经过式(16)式和(17)实时计算出四元数后,由式(11)完成姿态矩阵的更新,并可根据式(10)和式(11)的转换关系即可反算获得飞行器的姿态角信息:俯仰角θ、航向角ψ、横滚角γ。
飞行器的速度信息计算:
经过补偿的三轴微惯性加速度计测量的加速度信息ax、ay、az,通过姿态矩阵T与发射坐标系的关系转化到导航坐标系,通过一次积分进行导航坐标系内飞行器的速度更新。
式中,g为地球重力加速度。
结合前面计算出的飞行器的姿态角信息,对式(18)进行二阶龙格-库塔法计算,得到飞行器的速度信息:
飞行器的位置信息计算:
对式(19)再进行一次积分计算,即得到飞行器的位置信息:x、y、z。
初始参数解算处理器输出飞行器的姿态角信息,包括:俯仰角θ、航向角ψ和横滚角γ,速度信息,包括:横向速度vx、前向速度vy和纵向速度vz,位置信息,包括:横向位移x、前向位移y和纵向位移z。将解算得到的飞行器初始参数信息由通信总线传输给显控装置。
步骤206:显控装置将接收到的飞行器的姿态角信息、速度信息、位置信息等初始参数信息输出显示。
至此,完成了发射时飞行器初始参数信息的获取综上所述,本发明实施例提供了一种飞行器发射初始参数获取方法及系统,
综上所述,本发明提供了一种基于低成本微惯性传感器的发射初始参数获取方法及系统,解决了无线测量常因信号失真、规律异常、离散性过大,有线测量精度不高的问题。本发明可以获取飞行器发射时的初始参数主要包括:飞行器的姿态角信息,包括:俯仰角θ、航向角ψ和横滚角γ,速度信息,包括:横向速度vx、前向速度vy和纵向速度vz,位置信息,包括:横向位移x、前向位移y和纵向位移z。
本领域技术人员可以理解,实现上述实施例方法的全部或部分流程,可以通过计算机程序来指令相关的硬件来完成,所述的程序可存储于计算机可读存储介质中。其中,所述计算机可读存储介质为磁盘、光盘、只读存储记忆体或随机存储记忆体等。
虽然已经详细说明了本发明及其优点,但是应当理解在不超出由所附的权利要求所限定的本发明的精神和范围的情况下可以进行各种改变、替代和变换。而且,本申请的范围不仅限于说明书所描述的过程、设备、手段、方法和步骤的具体实施例。本领域内的普通技术人员从本发明的公开内容将容易理解,根据本发明可以使用执行与在此所述的相应实施例基本相同的功能或者获得与其基本相同的结果的、现有和将来要被开发的过程、设备、手段、方法或者步骤。因此,所附的权利要求旨在它们的范围内包括这样的过程、设备、手段、方法或者步骤。
以上所述,仅为本发明较佳的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到的变化或替换,都应涵盖在本发明的保护范围之内。
Claims (10)
1.一种飞行器初始参数获取方法,其特征在于,包括:
通过微惯性传感器和磁阻电子罗盘采集飞行器的测量数据并进行处理;
根据所述测量数据的变化情况,将其分解为静态数据与动态数据;
对静态数据进行飞行器姿态角的初始对准计算;对动态数据与之前获得的飞行器初始姿态角,计算出飞行器初始参数信,包括:飞行器姿态角信息飞行器速度信息以及飞行器位置信息;
输出飞行器初始参数信息。
2.根据权利要求1所述的方法,其特征在于,所述微惯性传感器包括:三轴微惯性传感器和三轴微陀螺仪,则所述方法还包括:
分别建立三轴微惯性加速度计的误差模型、三轴微陀螺仪的误差模型以及磁阻电子罗盘的误差模型;
根据上述误差模型对测量数据进行误差补偿。
3.根据权利要求2所述的方法,其特征在于,
建立三轴微惯性加速度计的误差模型为:
A=A0+KA·Fij·a+δ
式中,A为三轴微惯性加速度计输出值;A0为三轴微惯性加速度计零偏;KA为三轴微惯性加速度计标度系数;Fij(i,j=x,y,z)为三轴微惯性加速度计i轴对j轴的正交误差系数;a为飞行器运动输入加速度;δ为三轴微惯性加速度计随机误差;
建立三轴微陀螺仪的误差模型为:
G=G0+KG(Eij·ω)+Dij·a+ε
式中,G为三轴微陀螺仪输出值;G0为三轴微陀螺仪的零偏;KG为三轴微陀螺仪的标度系数;ω为飞行器运动输入角速度;ε为三轴微陀螺仪随机误差;Eij(i,j=x,y,z)为三轴微陀螺仪i轴对j轴的安装误差系数;Dij(i,j=x,y,z)为与加速度有关的一次项误差系数;
建立磁阻电子罗盘的误差模型为:
ψ=ψc+σ1+σ2sinψ+σ3cosψ+σ4sin(2ψ)+σ5cos(2ψ)
式中,ψ为磁阻电子罗盘的输出值;ψc为预先输入的飞行器航向角;σ1、σ2、σ3、σ4、σ5为磁阻电子罗盘的补偿系数。
4.根据权利要求1或2所述的方法,其特征在于,对静态数据进行飞行器姿态角的初始对准计算的过程具体包括:
由三轴微惯性加速度计输出的加速度静态信息确定初始时刻飞行器的俯仰角θ0和横滚角γ0,公式为:
γ0=arctan(-ax/az) (8)
由磁阻电子罗盘确定初始时刻飞行器的航向角ψ0:
ψ0=ψc (9)
通过式(7)、式(8)、式(9)得到飞行器初始静止状态下的初始姿态角:俯仰角θ0、横滚角γ0、航向角ψ0。
飞行器的航向角ψ=ψc,ψc为预先输入磁阻电子罗盘的飞行器航向角。
5.根据权利要求1所述的方法,其特征在于,对动态数据与之前获得的飞行器初始姿态角,采用捷联惯性导航算法对结果进行连续积分处理,并转换到导航坐标系中,先计算出飞行器的姿态角信息:俯仰角θ、航向角ψ和横滚角γ;再计算出飞行器的速度信息:横向速度vx、前向速度vy和纵向速度vz;最后计算出飞行器的位置信息横向位移x、前向位移y和纵向位移z。
6.根据权利要求5所述的方法,其特征在于,
飞行器的姿态角信息计算:
飞行器坐标系b至导航坐标系n的姿态矩阵T为:
姿态矩阵T与四元数q=[q0 q1 q2 q3]T的关系如下:
由初始姿态角通过公式(10)得到初始状态矩阵T0,为飞行器的姿态更新提供了初值。根据式(11),由初始状态矩阵T0即可求出四元数q=[q0 q1 q2 q3]T的初始值q0;
此外,
用经过误差补偿的三轴微惯性陀螺仪测量的角速度对式(16)进行四阶龙格—库塔法计算,并依据式(17)做归一化处理,即可实现四元数的实时更新;
经过式(16)式和(17)实时计算出四元数后,由式(11)完成姿态矩阵的更新,并可根据式(10)和式(11)的转换关系即可反算获得飞行器的姿态角信息:俯仰角θ、航向角ψ、横滚角γ;
飞行器的速度信息计算:
经过补偿的三轴微惯性加速度计测量的加速度信息ax、ay、az,通过姿态矩阵T与发射坐标系的关系转化到导航坐标系,通过一次积分进行导航坐标系内飞行器的速度更新。
式中,g为地球重力加速度;
结合前面计算出的飞行器的姿态角信息,对式(18)进行二阶龙格-库塔法计算,得到飞行器的速度信息:
飞行器的位置信息计算:
对式(19)再进行一次积分计算,即得到飞行器的位置信息:x、y、z。
7.一种飞行器初始参数获取系统,其特征在于,包括:微惯性传感器和磁阻电子罗盘、信息采集处理装置、初始参数解散处理器以及显控装置;微惯性传感器与磁阻电子罗盘封装于一体,并通过通信总线与信息采集处理装置连接;信息采集处理装置通过通信总线与初始参数解算处理器连接;初始参数解算处理器通过通信总线与显控装置连接;
所述微惯性传感器、磁阻电子罗盘,用于采集飞行器的测量数据并通过通信总线发送给所述信息采集处理装置;
所述信息采集处理装置,用于将接收到的测量数据进行信号转换后发送给所述初始参数解散处理器;
所述初始参数解散处理器,用于根据所述测量数据的变化情况,将其分解为静态数据与动态数据;对静态数据进行飞行器姿态角的初始对准计算;对动态数据与之前获得的飞行器初始姿态角,计算出飞行器初始参数信,包括:飞行器姿态角信息、飞行器速度信息以及飞行器位置信息;
所述显控装置,用于显示飞行器初始参数信息。
8.根据权利要求7所述的系统,其特征在于,所述初始参数解散处理器具体包括:
误差补偿模块,用于分别建立三轴微惯性加速度计的误差模型、三轴微陀螺仪的误差模型以及磁阻电子罗盘的误差模型,并根据上述误差模型对测量数据进行误差补偿;
静动态测量数据辨识模块,用于根据所述测量数据的变化情况,将其分解为静态数据与动态数据;
初始对准模块,用于对静态数据进行飞行器姿态角的初始对准计算,并将计算得到的初始姿态角发送给参数计算模块;
捷联惯性解算模块,用于对动态数据与获得的飞行器初始姿态角,采用捷联惯性导航算法对结果进行连续积分处理,并转换到导航坐标系中,先计算出飞行器的姿态角信息,进而计算出飞行器速度信息以及飞行器位置信息,并输出给所述显控装置。
9.根据权利要求8所述的系统,其特征在于,
所述误差补偿模块建立的三轴微惯性加速度计的误差模型为:
A=A0+KA·Fij·a+δ
式中,A为三轴微惯性加速度计输出值;A0为三轴微惯性加速度计零偏;KA为三轴微惯性加速度计标度系数;Fij(i,j=x,y,z)为三轴微惯性加速度计i轴对j轴的正交误差系数;a为飞行器运动输入加速度;δ为三轴微惯性加速度计随机误差;
建立的三轴微陀螺仪的误差模型为:
G=G0+KG(Eij·ω)+Dij·a+ε
式中,G为三轴微陀螺仪输出值;G0为三轴微陀螺仪(10)的零偏;KG为三轴微陀螺仪(10)的标度系数;ω为飞行器运动输入角速度;ε为三轴微陀螺仪随机误差;Eij(i,j=x,y,z)为三轴微陀螺仪i轴对j轴的安装误差系数;Dij(i,j=x,y,z)为与加速度有关的一次项误差系数。
建立的磁阻电子罗盘的误差模型为:
ψ=ψc+σ1+σ2sinψ+σ3cosψ+σ4sin(2ψ)+σ5cos(2ψ)
式中,ψ为磁阻电子罗盘的输出值;ψc为预先输入的飞行器航向角;σ1、σ2、σ3、σ4、σ5为磁阻电子罗盘的补偿系数。
10.根据权利要求8所述的系统,其特征在于,所述捷联惯性解算模块具体用于,飞行器的姿态角信息计算:
飞行器坐标系b至导航坐标系n的姿态矩阵T为:
姿态矩阵T与四元数q=[q0 q1 q2 q3]T的关系如下:
由初始姿态角通过公式(10)得到初始状态矩阵T0,为飞行器的姿态更新提供了初值。根据式(11),由初始状态矩阵T0即可求出四元数q=[q0 q1 q2 q3]T的初始值q0;
此外,
用经过误差补偿的三轴微惯性陀螺仪测量的角速度对式(16)进行四阶龙格—库塔法计算,并依据式(17)做归一化处理,即可实现四元数的实时更新;
经过式(16)式和(17)实时计算出四元数后,由式(11)完成姿态矩阵的更新,并可根据式(10)和式(11)的转换关系即可反算获得飞行器的姿态角信息:俯仰角θ、航向角ψ、横滚角γ;
飞行器的速度信息计算:
经过补偿的三轴微惯性加速度计测量的加速度信息ax、ay、az,通过姿态矩阵T与发射坐标系的关系转化到导航坐标系,通过一次积分进行导航坐标系内飞行器的速度更新。
式中,g为地球重力加速度;
结合前面计算出的飞行器的姿态角信息,对式(18)进行二阶龙格-库塔法计算,得到飞行器的速度信息:
飞行器的位置信息计算:
对式(19)再进行一次积分计算,即得到飞行器的位置信息:x、y、z。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610833844.3A CN106441301A (zh) | 2016-09-19 | 2016-09-19 | 一种飞行器发射初始参数获取方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610833844.3A CN106441301A (zh) | 2016-09-19 | 2016-09-19 | 一种飞行器发射初始参数获取方法及系统 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN106441301A true CN106441301A (zh) | 2017-02-22 |
Family
ID=58165889
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610833844.3A Pending CN106441301A (zh) | 2016-09-19 | 2016-09-19 | 一种飞行器发射初始参数获取方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106441301A (zh) |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107976296A (zh) * | 2017-11-13 | 2018-05-01 | 北京临近空间飞行器系统工程研究所 | 一种基于回溯自适应算法的飞行器气动特性在线辨识方法 |
CN110132268A (zh) * | 2019-06-10 | 2019-08-16 | 西北工业大学 | 一种车载飞行器初始姿态获取方法 |
CN110304270A (zh) * | 2019-06-03 | 2019-10-08 | 宁波天擎航天科技有限公司 | 用于运载火箭的全方位发射控制方法、装置、计算机设备 |
CN110785722A (zh) * | 2018-11-30 | 2020-02-11 | 深圳市大疆创新科技有限公司 | 对移动平台的参数优化方法、装置及控制设备、飞行器 |
CN111324172A (zh) * | 2018-12-13 | 2020-06-23 | 北京松果电子有限公司 | 遥杆的校准方法、装置、电子设备和存储介质 |
CN111712688A (zh) * | 2019-06-28 | 2020-09-25 | 深圳市大疆创新科技有限公司 | 标定方法、标定设备、稳定器及计算机可读存储介质 |
CN113359793A (zh) * | 2021-06-01 | 2021-09-07 | 北京电子工程总体研究所 | 一种低速飞行器提高空速控制品质的补偿方法与装置 |
CN113701574A (zh) * | 2020-05-21 | 2021-11-26 | 北京机械设备研究所 | 火箭喷管摆动角度测量方法和装置 |
CN114911252A (zh) * | 2022-07-15 | 2022-08-16 | 北京航天驭星科技有限公司 | 基于遥测数据确定火箭姿态的方法、装置、设备、介质 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20020049519A1 (en) * | 2000-06-05 | 2002-04-25 | Rafael-Armament Development Authority Ltd. | Method for transfer alignment of an inertial measurement unit in the presence of unknown aircraft measurements delays |
CN102901977A (zh) * | 2012-10-24 | 2013-01-30 | 北京航天自动控制研究所 | 一种飞行器的初始姿态角的确定方法 |
CN104034329A (zh) * | 2014-06-04 | 2014-09-10 | 南京航空航天大学 | 发射惯性系下的多组合导航处理装置及其导航方法 |
CN105136142A (zh) * | 2015-10-16 | 2015-12-09 | 北京机械设备研究所 | 一种基于微惯性传感器的室内定位方法 |
CN105352502A (zh) * | 2015-11-26 | 2016-02-24 | 湖北三江航天红峰控制有限公司 | 一种微惯性航姿参考系统的姿态获取方法 |
-
2016
- 2016-09-19 CN CN201610833844.3A patent/CN106441301A/zh active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20020049519A1 (en) * | 2000-06-05 | 2002-04-25 | Rafael-Armament Development Authority Ltd. | Method for transfer alignment of an inertial measurement unit in the presence of unknown aircraft measurements delays |
CN102901977A (zh) * | 2012-10-24 | 2013-01-30 | 北京航天自动控制研究所 | 一种飞行器的初始姿态角的确定方法 |
CN104034329A (zh) * | 2014-06-04 | 2014-09-10 | 南京航空航天大学 | 发射惯性系下的多组合导航处理装置及其导航方法 |
CN105136142A (zh) * | 2015-10-16 | 2015-12-09 | 北京机械设备研究所 | 一种基于微惯性传感器的室内定位方法 |
CN105352502A (zh) * | 2015-11-26 | 2016-02-24 | 湖北三江航天红峰控制有限公司 | 一种微惯性航姿参考系统的姿态获取方法 |
Non-Patent Citations (1)
Title |
---|
罗世杰: "高超声速巡航飞行器导航系统方案研究", 《西北工业大学》 * |
Cited By (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107976296B (zh) * | 2017-11-13 | 2019-10-22 | 北京临近空间飞行器系统工程研究所 | 一种基于回溯自适应算法的飞行器气动特性在线辨识方法 |
CN107976296A (zh) * | 2017-11-13 | 2018-05-01 | 北京临近空间飞行器系统工程研究所 | 一种基于回溯自适应算法的飞行器气动特性在线辨识方法 |
CN110785722A (zh) * | 2018-11-30 | 2020-02-11 | 深圳市大疆创新科技有限公司 | 对移动平台的参数优化方法、装置及控制设备、飞行器 |
CN111324172B (zh) * | 2018-12-13 | 2021-11-23 | 北京小米松果电子有限公司 | 遥杆的校准方法、装置、电子设备和存储介质 |
CN111324172A (zh) * | 2018-12-13 | 2020-06-23 | 北京松果电子有限公司 | 遥杆的校准方法、装置、电子设备和存储介质 |
CN110304270A (zh) * | 2019-06-03 | 2019-10-08 | 宁波天擎航天科技有限公司 | 用于运载火箭的全方位发射控制方法、装置、计算机设备 |
CN110304270B (zh) * | 2019-06-03 | 2021-01-05 | 宁波天擎航天科技有限公司 | 用于运载火箭的全方位发射控制方法、装置、计算机设备 |
CN110132268A (zh) * | 2019-06-10 | 2019-08-16 | 西北工业大学 | 一种车载飞行器初始姿态获取方法 |
CN111712688A (zh) * | 2019-06-28 | 2020-09-25 | 深圳市大疆创新科技有限公司 | 标定方法、标定设备、稳定器及计算机可读存储介质 |
CN113701574A (zh) * | 2020-05-21 | 2021-11-26 | 北京机械设备研究所 | 火箭喷管摆动角度测量方法和装置 |
CN113701574B (zh) * | 2020-05-21 | 2023-04-11 | 北京机械设备研究所 | 火箭喷管摆动角度测量方法和装置 |
CN113359793A (zh) * | 2021-06-01 | 2021-09-07 | 北京电子工程总体研究所 | 一种低速飞行器提高空速控制品质的补偿方法与装置 |
CN114911252A (zh) * | 2022-07-15 | 2022-08-16 | 北京航天驭星科技有限公司 | 基于遥测数据确定火箭姿态的方法、装置、设备、介质 |
CN114911252B (zh) * | 2022-07-15 | 2022-09-30 | 北京航天驭星科技有限公司 | 基于遥测数据确定火箭姿态的方法、装置、设备、介质 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106441301A (zh) | 一种飞行器发射初始参数获取方法及系统 | |
CN100585602C (zh) | 惯性测量系统误差模型验证试验方法 | |
CN104792340B (zh) | 一种星敏感器安装误差矩阵与导航系统星地联合标定与校正的方法 | |
CN106643737A (zh) | 风力干扰环境下四旋翼飞行器姿态解算方法 | |
CN108413887B (zh) | 光纤光栅辅助分布式pos的机翼形变测量方法、装置和平台 | |
CN106342284B (zh) | 一种飞行载体姿态确定方法 | |
CN103727941B (zh) | 基于载体系速度匹配的容积卡尔曼非线性组合导航方法 | |
CN101979277B (zh) | 卫星磁测磁控系统的全实物验证平台与工作方法 | |
CN104374388B (zh) | 一种基于偏振光传感器的航姿测定方法 | |
CN103363992B (zh) | 基于梯度下降的四旋翼无人机姿态航向参考系统解算方法 | |
CN106153073B (zh) | 一种全姿态捷联惯导系统的非线性初始对准方法 | |
CN103852081B (zh) | 用于大气数据/捷联惯导组合导航系统的真空速解算方法 | |
CN104697526A (zh) | 用于农业机械的捷联惯导系统以及控制方法 | |
CN104215244B (zh) | 基于发射惯性坐标系的空天飞行器组合导航鲁棒滤波方法 | |
CN107588771A (zh) | 基于李群描述的捷联惯性导航解算方法 | |
CN106052716A (zh) | 惯性系下基于星光信息辅助的陀螺误差在线标定方法 | |
CN103759729B (zh) | 采用捷联惯导的月球软着陆地面试验用初始姿态获取方法 | |
CN106767797A (zh) | 一种基于对偶四元数的惯性/gps组合导航方法 | |
CN103471613A (zh) | 一种飞行器惯性导航系统参数仿真方法 | |
CN113008227B (zh) | 一种基于三轴加速度计测姿的地磁二分量测量方法 | |
CN106767925A (zh) | 带双轴转位机构的惯导系统三位置参数辨识对准方法 | |
CN111189474A (zh) | 基于mems的marg传感器的自主校准方法 | |
Barczyk | Nonlinear state estimation and modeling of a helicopter UAV | |
CN106525055A (zh) | 一种基于模型摄动的火星大气进入自适应估计方法 | |
CN103983274A (zh) | 一种适用于低精度无方位基准双轴转位设备的惯性测量单元标定方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20170222 |