CN113281824B - 一种考虑飞机非刚性以及极化电流因素的航空磁补偿方法 - Google Patents
一种考虑飞机非刚性以及极化电流因素的航空磁补偿方法 Download PDFInfo
- Publication number
- CN113281824B CN113281824B CN202110544510.5A CN202110544510A CN113281824B CN 113281824 B CN113281824 B CN 113281824B CN 202110544510 A CN202110544510 A CN 202110544510A CN 113281824 B CN113281824 B CN 113281824B
- Authority
- CN
- China
- Prior art keywords
- magnetic field
- compensation
- aircraft
- magnetic
- interference
- 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
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01V—GEOPHYSICS; GRAVITATIONAL MEASUREMENTS; DETECTING MASSES OR OBJECTS; TAGS
- G01V13/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices covered by groups G01V1/00 – G01V11/00
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01V—GEOPHYSICS; GRAVITATIONAL MEASUREMENTS; DETECTING MASSES OR OBJECTS; TAGS
- G01V3/00—Electric or magnetic prospecting or detecting; Measuring magnetic field characteristics of the earth, e.g. declination, deviation
- G01V3/15—Electric or magnetic prospecting or detecting; Measuring magnetic field characteristics of the earth, e.g. declination, deviation specially adapted for use during transport, e.g. by a person, vehicle or boat
- G01V3/16—Electric or magnetic prospecting or detecting; Measuring magnetic field characteristics of the earth, e.g. declination, deviation specially adapted for use during transport, e.g. by a person, vehicle or boat specially adapted for use from aircraft
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01V—GEOPHYSICS; GRAVITATIONAL MEASUREMENTS; DETECTING MASSES OR OBJECTS; TAGS
- G01V3/00—Electric or magnetic prospecting or detecting; Measuring magnetic field characteristics of the earth, e.g. declination, deviation
- G01V3/15—Electric or magnetic prospecting or detecting; Measuring magnetic field characteristics of the earth, e.g. declination, deviation specially adapted for use during transport, e.g. by a person, vehicle or boat
- G01V3/165—Electric or magnetic prospecting or detecting; Measuring magnetic field characteristics of the earth, e.g. declination, deviation specially adapted for use during transport, e.g. by a person, vehicle or boat operating with magnetic or electric fields produced or modified by the object or by the detecting device
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01V—GEOPHYSICS; GRAVITATIONAL MEASUREMENTS; DETECTING MASSES OR OBJECTS; TAGS
- G01V3/00—Electric or magnetic prospecting or detecting; Measuring magnetic field characteristics of the earth, e.g. declination, deviation
- G01V3/38—Processing data, e.g. for analysis, for interpretation, for correction
Landscapes
- Life Sciences & Earth Sciences (AREA)
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Geophysics (AREA)
- General Life Sciences & Earth Sciences (AREA)
- General Physics & Mathematics (AREA)
- Environmental & Geological Engineering (AREA)
- Geology (AREA)
- Remote Sensing (AREA)
- Manufacturing & Machinery (AREA)
- Electromagnetism (AREA)
- Aviation & Aerospace Engineering (AREA)
- Measuring Magnetic Variables (AREA)
Abstract
本发明公开了一种考虑飞机非刚性以及极化电流因素的航空磁补偿方法。本发明的方法包括:建立经典的磁补偿T‑L模型,建立飞机平台干扰磁场模型,建立三分量磁通门磁力仪误差模型的磁补偿模型,得到极化电流产生的干扰磁场,对地磁场进行补偿,建立光泵磁力仪方向误差,建立最终的飞机平台磁干扰模型,使用总体最小二乘方法求解出磁补偿系数向量,将求解出的磁补偿系数向量补偿系数,用于飞机平台的实时补偿;本发明将原先的18项T‑L模型扩展到50项甚至更多,解决三了轴磁通门磁力仪误差问题和飞机在非刚性情况下和极化电流产生的干扰磁场的数学模型问题;本发明大大地提高了航磁补偿的精度,减小了飞机平台本身产生的磁场对探测目标信号磁场的干扰。
Description
技术领域
本发明涉及航空磁补偿技术,具体涉及一种考虑飞机非刚性以及极化电流因素的航空磁补偿方法。
背景技术
航空磁补偿技术是为了补偿掉飞机平台产生的干扰磁场,有利于目标信号的检测。经典的T-L模型由三部分组成:恒定磁场、感应磁场和涡流磁场,通过分析每种磁场产生的原因来建立数学模型,即托尔斯·劳森(T-L)方程。1961年,Leach在文章《Aeromagneticcompensation as a linear regression problem》里表示补偿系数的大小与飞机本身的结构和磁力仪的安放位置有关系,所以如果使用同一架飞机并且磁力仪放置位置不变化,补偿系数也不会发生变化。同时Leach在论文《Automatic aeromagnetic compensation》中写出了系数的求解方案,通过飞机在规定航向上做俯仰、偏航、侧滚机动性工作来得到测量数据,由此求解出补偿系数。2016年,韩琦团队在《An aeromagnetic compensationcoefficient-estimating method robust to geomagnetic gradient》一文中建立了地磁梯度模型,补偿掉了环境磁场的一部分干扰。另外,他们团队发表的文章《A modifiedTolley-Lawson model robust to the errors of the three-axis strapdownmagnetometer》中指出三轴磁通门由于存在零偏性、非正交性、测量噪声等误差会导致数据存在误差,并对磁通门进行了修正。此外,郭弘老师团队发表了关于多光系光泵磁力仪的方向误差校正的模型的专利;在胡凯的硕士论文里提到了关于单光系光泵方向误差的处理方法。目前仍然使用广泛的是T-L模型,但是T-L模型建立的条件是飞机是刚性结构,在飞行过程中不会发生形变,且三轴磁通门磁力仪是正交的,没有零飘,飞机飞行区域的环境磁场是固定的,而且没有考虑到环境电场产生的极化电流因素。但是实际上这些条件在真实环境中是发生变化的,因此建立一个更精确的飞机平台磁干扰补偿模型是有重要意义的。
发明内容
本发明提出了一种考虑飞机非刚性以及极化电流因素的航空磁补偿方法,用以解决三轴磁通门磁力仪误差问题和飞机在非刚性情况下和极化电流产生的干扰磁场的数学问题。
本发明的考虑飞机非刚性以及极化电流因素的航空磁补偿方法,包括以下步骤:
1)建立经典的磁补偿T-L模型:
以飞机平台建立坐标系,建立经典的磁补偿T-L模型,得到飞机平台产生的干扰磁场BTL(t):
其中,ai为飞机永久干扰磁场的补偿系数,bi,j为飞机感应干扰磁场的补偿系数,ci,j为飞机涡流干扰磁场的补偿系数,ui(t)和uj(t)为飞机平台坐标系与地磁场的方向余弦u(t)的分量,i=1,2,3,j=1,2,3,在飞机平台坐标系下分别为x、y和z轴,把它们展开写为u1(t)=cos X,u2(t)=cos Y,u3(t)=cos Z,其中X、Y和Z分别为飞机平台坐标系x、y和z轴与地磁场的夹角,cos X、cos Y和cos Z表达式分别如下:
其中,B1(t)、B2(t)和B3(t)分别为在t时刻三分量磁通门磁力仪测量的沿飞机平台坐标系x、y和z轴的地磁场测量值;
2)建立飞机平台干扰磁场模型:
经典的T-L模型是在飞机平台为刚体这个基本假设条件建立的,但是飞机在转弯和做机动动作的时候,方向舵、升降舵和副翼这些活动部件发生了状态变化,机翼发生了弯曲,因此飞机在做机动动作的时候不能看成是一个理想刚体,当飞机在做侧滚、俯仰和偏航机动动作时,飞机的结构状况采用运动状态参数来描述,飞机平台坐标系下地磁场的方向余弦u(t)能够描述整体的飞机姿态,但是不能描述具体的各个活动部件的状态;
b)将补偿系数以近似的线性化表示为:
c)建立飞机平台干扰磁场模型,得到修改补偿系数之后飞机平台产生的干扰磁场Bcoe(t):
其中,di,j,k为飞机主体感应磁场与活动部件永久磁场的耦合的补偿系数,gi,j,k为感应磁场与活动部件涡流磁场的耦合的补偿系数;
3)建立三分量磁通门磁力仪误差模型的磁补偿模型:
三分量磁通门磁力仪存在非正交性和零漂问题,地磁场的真实值为:
其中,为磁通门磁力仪测量的沿飞机平台坐标系x、y和z轴的地磁场真实值,为修正矩阵,该矩阵是未知的,用来修正磁通门存在的非正交性问题,为误差向量,也是未知的向量,用来修正三分量磁通门磁力仪存在的零漂问题;
其中,a′i为修正后的永久磁场的补偿系数,b′i,j为修正后的感应磁场的补偿系数,c′i,j为修正后的涡流磁场的补偿系数,hi为由磁通门零漂和非正交性导致的磁干扰的补偿系数,β(t)是随时间变化的一次函数;
由于飞机的运动姿态也是随时间变化的,因此对式(5)中的补偿系数a′i(t)、b′i,j(t) 和c′i,j(t)进行与式(2)形式一致的线性展开,再与式(5)合并之后得到通过校准磁通门数据和改变补偿系数形式而建立的飞机干扰磁场模型,得到通过校准磁通门数据和改变补偿系数形式之后飞机平台产生的干扰磁场Binterference(t):
其中,hi为由磁通门零漂和非正交性导致的磁干扰的补偿系数;
4)得到极化电流产生的干扰磁场:
在环境场中,不仅有磁场还有电场,经典的磁补偿T-L模型里并未考虑到环境电场产生的极化电流因素,因此忽略了极化电流产生的一部分干扰磁场;
其中,αj为常数项系数,βj,k为一次项系数,γj,k,l为二次项系数,Mi,j为极化电流产生的干扰磁场系数,将该表达式与极化电流产生的干扰磁场结合,得到极化电流产生的干扰磁场Bele(t):
其中,σi,k为极化电流磁场干扰的补偿系数,τi,k,l为飞机感应磁场与极化电流磁场的耦合的干扰磁场的补偿系数;
5)对地磁场进行补偿:
采用国际地磁参考场(IGRF),用IGRF模型算出地磁场值后,再用光泵磁力仪测量的磁场值减去地磁场值,得到补偿掉地磁场后的剩余干扰磁场值;
6)建立光泵磁力仪的方向误差:
在实际实验中,会用到光泵磁力仪测量的总磁场,光泵磁力仪测量的总磁场都存在方向误差磁场,因此分别建立单光系或多光系光泵磁力仪的方向误差Bh(t);
7)建立最终的飞机平台磁干扰模型:
将光泵磁力仪的方向误差加入到通过校准磁通门数据、改变补偿系数形式和增加极化电流磁场而建立的飞机干扰磁场模型中,建立最终的飞机平台磁干扰模型,得到最终的飞机干扰磁场Bf(t):
Bf(t)=Binterference(t)+Bele(t)+Bh(t)
上式简化为:
Bf(t)=A(t)*N (7)
8)使用总体最小二乘方法求解出磁补偿系数向量;
9)将求解出的磁补偿系数向量,用于飞机平台的实时补偿。
其中,在步骤6)中,建立单光系光泵磁力仪的方向误差,包括以下步骤:
对于单光系光泵磁力仪,主要用到的是铯光泵磁力仪,铯光泵磁力仪在转动时,其内部光轴与地磁场之间的夹角发生了改变,因此把方向误差写成关于飞机平台坐标系下地磁场的方向余弦u(t)的函数,经过泰勒函数展开得到的方向误差Bh(t)表达式为:
Bh(t)=k1*u1(t)+k2*u2(t)+k3*u3(t)+k4*u1 2(t)+k5*u2 2(t)+k6*u3 2(t)+k7 *u1(t)*u2(t)+k8*u1(t)*u3(t)+k9*u2(t)*u3(t)
其中,k1,k2,k3,k4,k5,k6,k7,k8,k9为9个待求解的方向误差系数。
在步骤6)中,建立多光系光泵磁力仪的方向误差,包括以下步骤:
多光系光泵磁力仪的方向误差Bh表达式为:
其中,zi为方向误差系数,n为光泵原子气室个数,n=3,分别沿着x,y,z轴方向;每个气室上的交变磁场线圈方向与光传播方向垂直,分别沿着y轴、x轴和x轴方向,hi为与方向误差有关的方向余弦,表达式为:
其中,ηi为原子气室安装方向与地磁场的夹角,ηi=X或Y或Z,εi为原子气室上加的交变磁场方向与地磁场的夹角,εi=X或Y或Z。
在步骤8)中,使用总体最小二乘方法求解出磁补偿系数向量,包括以下步骤:
a)A和b分别为不可观测的无误差基函数数据矩阵和无误差飞机干扰磁场数据向量,实际观测的基函数数据矩阵A0和飞机干扰磁场数据向量b0分别为:
A0=A+ΔA,b0=b+Δb
其中,ΔA和Δb分别为误差数据矩阵和误差数据向量;根据式(7)得到飞机干扰数据向量和基函数数据矩阵的关系为:A*N=b,N为待求的磁补偿系数向量,则若存在误差,该式的形式为:
即(A+ΔA)N=b+Δb,等价为(B+D)q=0;
式中,增广数掘矩阵B=[A,b]和增广校正矩阵D=[ΔA,Δb]均为m×(k+1)维矩
b)计算增广数掘矩阵B的奇异值分解并存储右奇异矩阵V;
c)确定增广数掘矩阵B的有效秩p;
d)总体最小二乘的解向量中,N为由p个线性独立的未知参数组成的列向量,因此总体最小二乘的求解就变成了k+1-p个总体最小二乘问题的求解: Bj (p)q=0,j=1,2...,k+1-p,Bj (p)为B的第j列到第p+j列组成的子矩阵;
e)根掘最小二乘原理,总体最小二乘解等价于求得解向量q使代价函数极小化,代价函数f(q)定义为:其中其中,uj为增广数掘矩阵B左奇异矩阵第i行第j列上的元素,为右奇异矩阵V第i行第j列上的元素;δj为增广数掘矩阵B的奇异值;
g)代价函数f(q)的极小变化量是f(q)对q求导并令其导数等于0,求得S(p)q=λe1,λ为常数表示误能量,e1为单位向量,e1=[1,0,0...,0]T;
h)求S(p)的逆矩阵S-(p);
其中,S-(p)为S(p)的逆矩阵,xtls(i)为磁补偿系数向量N的第i个元素。
进一步,在飞机进行校准飞行前,在飞机上安装光泵磁力仪、三分量磁通门磁力仪、高度计和GPS;光泵磁力仪用来测量的总磁场,三分量磁通门磁力仪实时测量沿飞机平台坐标系x、y和z轴的地磁场测量值,高度计用来测量飞机飞行的高度,GPS用来测量飞机所处位置的经度和纬度。
本发明的优点:
本发明将原先的18项T-L模型扩展到50项甚至更多,解决三了轴磁通门磁力仪误差问题和飞机在非刚性情况下和极化电流产生的干扰磁场的数学模型问题;本发明大大地提高了航磁补偿的精度,减小了飞机平台本身产生的磁场对探测目标信号磁场的干扰。
附图说明
图1为本发明的考虑飞机非刚性以及极化电流因素的航空磁补偿方法的一个实施例的飞机飞行示意图;
图2为本发明的考虑飞机非刚性以及极化电流因素的航空磁补偿方法的流程图。
具体实施方式
下面结合附图,通过具体实施例,进一步阐述本发明。
在飞机进行校准飞行前,在飞机上安装光泵磁力仪、三分量磁通门磁力仪、高度计和GPS;光泵磁力仪用来测量的总磁场,三分量磁通门磁力仪实时测量沿飞机平台坐标系x、y和z轴的地磁场测量值,高度计用来测量飞机飞行的高度,GPS用来测量飞机所处位置的经度和纬度。
本实施例的考虑飞机非刚性以及极化电流因素的航空磁补偿方法,包括以下步骤:
1)建立经典的磁补偿T-L模型:
飞机在飞行过程中进行三种机动动作,俯仰、侧滚、偏航,每个机动动作四组,分为东西南北四个航向,如图1所示;
以飞机平台建立坐标系,建立经典的磁补偿T-L模型,得到飞机平台产生的干扰磁场BTL(t):
其中,ai为飞机永久干扰磁场的补偿系数,bi,j为飞机感应干扰磁场的补偿系数,ci,j为飞机涡流干扰磁场的补偿系数,ui(t)和uj(t)为飞机平台坐标系与地磁场的方向余弦u(t)的分量,i=1,2,3,j=1,2,3,在飞机平台坐标系下分别为x、y和z轴,把它们展开写为u1(t)=cos X,u2(t)=cos Y,u3(t)=cos Z,其中X、Y和Z分别为飞机平台坐标系x、y和z轴与地磁场的夹角,cos X、cos Y和cos Z表达式分别如下:
其中,B1(t)、B2(t)和B3(t)分别为在t时刻三分量磁通门磁力仪测量的沿飞机平台坐标系x、y和z轴的地磁场测量值;
2)建立飞机平台干扰磁场模型:
经典的T-L模型是在飞机平台为刚体这个基本假设条件建立的,但是飞机在转弯和做机动动作的时候,方向舵、升降舵和副翼这些活动部件发生了状态变化,机翼发生了弯曲,因此飞机在做机动动作的时候不能看成是一个理想刚体,当飞机在做侧滚、俯仰、偏航机动动作时,飞机的结构状况采用运动状态参数来描述,飞机平台坐标系下地磁场的方向余弦u(t)能够描述整体的飞机姿态,但是不能描述具体的各个活动部件的状态;
e)将补偿系数以近似的线性化表示为:
f)建立飞机平台干扰磁场模型,得到修改补偿系数之后飞机平台产生的干扰磁场Bcoe(t):
di,j,k为飞机主体感应磁场与活动部件永久磁场的耦合的补偿系数,gi,j,k为感应磁场与活动部件涡流磁场的耦合的补偿系数;
3)建立三分量磁通门磁力仪误差模型的磁补偿模型:
三分量磁通门磁力仪存在非正交性和零漂问题,地磁场的真实值为:
其中,a′i为修正后的永久磁场的补偿系数,b′i,j为修正后的感应磁场的补偿系数,c′i,j为修正后的涡流磁场的补偿系数,hi为由磁通门零漂和非正交性导致的磁干扰的补偿系数,β(t)是随时间变化的一次函数;
由于飞机的运动姿态也是随时间变化的,因此对式(5)中的补偿系数a′i(t)、b′i,j(t) 和c′i,j(t)进行与式(2)形式一致的线性展开,再与式(5)合并之后得到通过校准磁通门数据和改变补偿系数形式而建立的飞机干扰磁场模型,得到通过校准磁通门数据和改变补偿系数形式之后飞机平台产生的干扰磁场Binterference(t):
其中,hi为由磁通门零漂和非正交性导致的磁干扰的补偿系数;
4)极化电流产生的干扰磁场:
在环境场中,不仅有磁场还有电场,经典的磁补偿T-L模型里并未考虑到环境电场产生的极化电流因素,因此忽略了极化电流产生的一部分干扰磁场;
产生的干扰磁场Bele(t)表示为:
其中,αj为常数项系数,βj,k为一次项系数,γj,k,l为二次项系数,Mi,j
为极化电流产生的干扰磁场系数,将该表达式与极化电流产生的干扰磁场结合,得到极化电流产生的干扰磁场Bele(t)如下:
其中,σi,k为极化电流磁场干扰的补偿系数,τi,k,l为飞机感应磁场与极化电流磁场的耦合的干扰磁场的补偿系数;
5)对地磁场进行补偿:
采用国际地磁参考场(IGRF),用IGRF模型算出地磁场值后,再用光泵测量值减去地磁场值,得到补偿后的地磁场值;
6)建立光泵磁力仪的方向误差:
在实际实验中,会用到光泵磁力仪测量的总磁场,光泵磁力仪测量的总磁场都存在方向误差磁场,导致求解系数会不准确,因此分别建立单光系或多光系光泵磁力仪的方向误差Bh(t);
建立单光系光泵磁力仪的方向误差,包括以下步骤:
于单光系光泵磁力仪,主要用到的是铯光泵磁力仪,铯光泵磁力仪在转动时,其内部光轴与地磁场之间的夹角发生了改变,因此可把方向误差写成关于方向余弦u(t)的函数,经过泰勒函数展开得到的方向误差Bh(t)表达式为:
Bh(t)=k1*u1(t)+k2*u2(t)+k3*u3(t)+k4*u1 2(t)+k5*u2 2(t)+k6*u3 2(t) +k7*u1(t)*u2(t)+k8*u1(t)*u3(t)+k9*u2(t)*u3(t)
其中,k1,k2,k3,k4,k5,k6,k7,k8,k9为9个待求解的方向误差系数;
多光系光泵磁力仪的方向误差Bh表达式为:
其中,zi为方向误差系数,n为光泵原子气室个数,n=3,分别沿着x,y,z轴方向;每个气室上的交变磁场线圈方向与光传播方向垂直,分别沿着y轴、x轴和x轴方向, hi为与方向误差有关的方向余弦,表达式为:
其中,ηi为原子气室安装方向与地磁场的夹角,ηi=X或Y或Z,εi为原子气室上加的交变磁场方向与地磁场的夹角,εi=X或Y或Z;
7)建立最终的飞机平台磁干扰模型:
将光泵磁力仪的方向误差加入到通过校准磁通门数据、改变补偿系数形式和增加极化电流磁场而建立的飞机干扰磁场模型中,建立最终的飞机平台磁干扰模型,得到最终的飞机干扰磁场Bf(t):
Bf(t)=Binterference(t)+Bele(t)+Bh(t);
上式简化为:
Bf(t)=A*N (7)
其中,A为方向余弦组成的基函数矩阵,N为待求的磁补偿系数向量;
8)使用总体最小二乘方法求解出磁补偿系数向量:
a)A和b分别为不可观测的无误差基函数数据矩阵和无误差飞机干扰磁场数据向量,实际观测的基函数数据矩阵A0和飞机干扰磁场数据向量b0分别为:
A0=A+ΔA,b0=b+Δb
其中,ΔA和Δb分别为误差数据矩阵和误差数据向量;根据式(7)得到飞机干扰数据向量和基函数数据矩阵的关系为:A*N=b,N为待求的磁补偿系数,则若存在误差,该式的形式为:
即(A+ΔA)N=b+Δb,等价为(B+D)q=0;
式中,增广数据矩阵B=[A,b]和增广校正矩阵D=[ΔA,Δb]均为m×(k+1)维矩阵,q为总体最小二乘的解向量为(k+1)×1,k为无误差基函数数据矩阵A的列数,m为无误差基函数数据矩阵A的行数;
b)计算增广数据矩阵B的奇异值分解并存储右奇异矩阵V;
c)确定增广数据矩阵B的有效秩p;
d)总体最小二乘的解向量中,N为由p个线性独立的未知参数组成的列向量,因此总体最小二乘的求解就变成了k+1-p个总体最小二乘问题的求解: Bj (p)q=0,j=1,2...,k+1-p,Bj (p)为B的第j列到第p+j列组成的子矩阵;
e)根据最小二乘原理,总体最小二乘解等价于使代价函数极小化,代价函数f(q)定义为:其中其中,uj为增广数据矩阵B左奇异矩阵第i行第j列上的元素,为右奇异矩阵V 第i行第j列上的元素;δj为增广数据矩阵B的奇异值;
g)代价函数f(q)的极小变化量是f(q)对q求导并令其导数等于0,求得S(p)q=λe1,λ为常数表示误能量,e1为单位向量,e1=[1,0,0...,0]T;
h)求S(p)的逆矩阵S-(p);
其中,S-(p)为S(p)的逆矩阵,xtls(i)为磁补偿系数向量N的第i个元素。;
9)将求解出的补偿系数,用于飞机平台的实时补偿。
最后需要注意的是,公布实施例的目的在于帮助进一步理解本发明,但是本领域的技术人员可以理解:在不脱离本发明及所附的权利要求的精神和范围内,各种替换和修改都是可能的。因此,本发明不应局限于实施例所公开的内容,本发明要求保护的范围以权利要求书界定的范围为准。
Claims (5)
1.一种考虑飞机非刚性以及极化电流因素的航空磁补偿方法,其特征在于,所述航空磁补偿方法包括以下步骤:
1)建立经典的磁补偿T-L模型:
以飞机平台建立坐标系,建立经典的磁补偿T-L模型,得到飞机平台产生的干扰磁场BTL(t):
其中,ai为飞机永久干扰磁场的补偿系数,bi,j为飞机感应干扰磁场的补偿系数,ci,j为飞机涡流干扰磁场的补偿系数,ui(t)和uj(t)为飞机平台坐标系与地磁场的方向余弦u(t)的分量,i=1,2,3,j=1,2,3,在飞机平台坐标系下分别为x、y和z轴,把它们展开写为u1(t)=cosX,u2(t)=cosY,u3(t)=cosZ,其中X、Y和Z分别为飞机平台坐标系x、y和z轴与地磁场的夹角,cosX、cos Y和cosZ表达式分别如下:
其中,B1(t)、B2(t)和B3(t)分别为在t时刻三分量磁通门磁力仪测量的沿飞机平台坐标系x、y和z轴的地磁场测量值;
2)建立飞机平台干扰磁场模型:
经典的T-L模型是在飞机平台为刚体这个基本假设条件建立的,但是飞机在转弯和做机动动作的时候,方向舵、升降舵和副翼这些活动部件发生了状态变化,机翼发生了弯曲,因此飞机在做机动动作的时候不能看成是一个理想刚体,当飞机在做侧滚、俯仰和偏航机动动作时,飞机的结构状况采用运动状态参数来描述,飞机平台坐标系下地磁场的方向余弦u(t)能够描述整体的飞机姿态,但是不能描述具体的各个活动部件的状态;
b)将补偿系数以近似的线性化表示为:
ai (0),bi,j (0)和ci,j (0)分别表示补偿系数ai、bi,j和ci,j的常数项分量,ai,j (1)为补偿系数ai关于uj(t)的线性系数,bi,j,k (1)为补偿系数bi,j关于uk(t)的线性系数,ci,j,k (1)为补偿系数ci,j关于uk(t)的线性系数;ai,j (2)为补偿系数ai关于的线性系数,bi,j,k (2)为补偿系数bi,j关于的线性系数;
c)建立飞机平台干扰磁场模型,得到修改补偿系数之后飞机平台产生的干扰磁场Bcoe(t):
其中,di,j,k为飞机主体感应磁场与活动部件永久磁场的耦合的补偿系数,gi,j,k为感应磁场与活动部件涡流磁场的耦合的补偿系数;
3)建立三分量磁通门磁力仪误差模型的磁补偿模型:
三分量磁通门磁力仪存在非正交性和零漂问题,地磁场的真实值为:
其中,为磁通门磁力仪测量的沿飞机平台坐标系x、y和z轴的地磁场真实值,为修正矩阵标记为w,该矩阵是未知的,用来修正磁通门存在的非正交性问题,为误差向量,也是未知的向量,用来修正三分量磁通门磁力仪存在的零漂问题;
其中,σ(t)为时间缓变误差函数,W(t)表示为不同时刻t的修正矩阵;将代入式(1),且 是对W(t)的微分,整理后得到包括修正磁通门数据建立的磁补偿模型,得到修正磁通门数据后飞机平台产生的干扰磁场Bcal(t):
其中,a′i为修正后的永久磁场的补偿系数,b′i,j为修正后的感应磁场的补偿系数,c′i,j为修正后的涡流磁场的补偿系数,hi为由磁通门零漂和非正交性导致的磁干扰的补偿系数,β(t)是随时间变化的一次函数;
由于飞机的运动姿态也是随时间变化的,因此对式(5)中的修正后的永久磁场的补偿系数a′i、修正后的感应磁场的补偿系数b′i,j和修正后的涡流磁场的补偿系数c′i,j进行与式(2)形式一致的线性展开,再与式(5)合并之后得到通过校准磁通门数据和改变补偿系数形式而建立的飞机干扰磁场模型,得到通过校准磁通门数据和改变补偿系数形式之后飞机平台产生的干扰磁场Binterference(t):
其中,hi为由磁通门零漂和非正交性导致的磁干扰的补偿系数;
4)得到极化电流产生的干扰磁场:
在环境场中,不仅有磁场还有电场,经典的磁补偿T-L模型里并未考虑到环境电场产生的极化电流因素,因此忽略了极化电流产生的一部分干扰磁场;
其中,αj为常数项系数,βj,k为一次项系数,γj,k,l为二次项系数,Mi,j为极化电流产生的干扰磁场系数,将该表达式与极化电流产生的干扰磁场结合,得到极化电流产生的干扰磁场Bele(t):
其中,σi,k为极化电流磁场干扰的补偿系数,τi,k,l为飞机感应磁场与极化电流磁场的耦合的干扰磁场的补偿系数;
5)对地磁场进行补偿:
采用国际地磁参考场IGRF,用IGRF模型算出地磁场值后,再用光泵磁力仪测量的磁场值减去地磁场值,得到补偿掉地磁场后的剩余干扰磁场值;
6)建立光泵磁力仪的方向误差:
在实际实验中,会用到光泵磁力仪测量的总磁场,光泵磁力仪测量的总磁场都存在方向误差磁场,因此分别建立单光系或多光系光泵磁力仪的方向误差Bh(t);
7)建立最终的飞机平台磁干扰模型:
将光泵磁力仪的方向误差加入到通过校准磁通门数据、改变补偿系数形式和增加极化电流磁场而建立的飞机干扰磁场模型中,建立最终的飞机平台磁干扰模型,得到最终的飞机干扰磁场Bf(t):
Bf(t)=Binterference(t)+Bele(t)+Bh(t)
上式简化为:
Bf(t)=A(t)*N (7)
其中,A(t)为飞机平台坐标系下地磁场的方向余弦组成的基函数矩阵,N为待求的磁补偿系数向量;
8)使用总体最小二乘方法求解出磁补偿系数向量;
9)将求解出的磁补偿系数向量,用于飞机平台的实时补偿。
2.如权利要求1所述的航空磁补偿方法,其特征在于,在步骤6)中,建立单光系光泵磁力仪的方向误差,包括以下步骤:
单光系光泵磁力仪采用铯光泵磁力仪,铯光泵磁力仪在转动时,内部光轴与地磁场之间的夹角发生了改变,因此把方向误差写成关于飞机平台坐标系下地磁场的方向余弦u(t)的函数,经过泰勒函数展开得到的方向误差Bh(t)表达式为:
Bh(t)=k1*u1(t)+k2*u2(t)+k3*u3(t)+k4*u1 2(t)+k5*u2 2(t)+k6*u3 2(t)+k7*u1(t)*u2(t)+k8*u1(t)*u3(t)+k9*u2(t)*u3(t)
其中,k1,k2,k3,k4,k5,k6,k7,k8,k9为9个待求解的方向误差系数。
4.如权利要求1所述的航空磁补偿方法,其特征在于,在步骤8)中,使用总体最小二乘方法求解出磁补偿系数向量,包括以下步骤:
a)A和b分别为不可观测的无误差基函数数据矩阵和无误差飞机干扰磁场数据向量,实际观测的基函数数据矩阵A0和飞机干扰磁场数据向量b0分别为:
A0=A+ΔA,b0=b+Δb
其中,ΔA和Δb分别为误差数据矩阵和误差数据向量;根据式(7)得到飞机干扰数据向量和基函数数据矩阵的关系为:A*N=b,N为待求的磁补偿系数向量,则若存在误差,该式的形式为:
即(A+ΔA)N=b+Δb,等价为((B+D)q=0;
式中,增广数据矩阵B=[A,b]和增广校正矩阵D=[ΔA,Δb]均为m×(k+1)维矩阵,q为总体最小二乘的解向量,而为(k+1)×1向量,k为无误差基函数数据矩阵A的列数,m为无误差基函数数据矩阵A的行数;
b)计算增广数据矩阵B的奇异值分解并存储右奇异矩阵V;
c)确定增广数据矩阵B的有效秩p;
d)总体最小二乘的解向量中,N为由p个线性独立的未知参数组成的列向量,因此总体最小二乘的求解就变成了k+1-p个总体最小二乘问题的求解:Bj (p)q=0,j=1,2...,k+1-p,Bj (p)为B的第j列到第p+j列组成的子矩阵;
e)根据最小二乘原理,总体最小二乘解等价于使代价函数极小化,代价函数f(q)定义为:其中其中,uj为增广数据矩阵B左奇异矩阵第i行第j列上的元素,为右奇异矩阵V第i行第j列上的元素;δj为增广数据矩阵B的奇异值;
g)代价函数f(q)的极小变化量是f(q)对q求导并令导数等于0,求得S(p)q=λe1,λ为常数表示误能量,e1为单位向量,e1=[1,0,0...,0]T;
h)求S(p)的逆矩阵S-(p);
其中,S-(p)为S(p)的逆矩阵,xtls(i)为磁补偿系数向量N的第i个元素。
5.如权利要求1所述的航空磁补偿方法,其特征在于,进一步,在飞机进行校准飞行前,在飞机上安装光泵磁力仪、三分量磁通门磁力仪、高度计和GPS;光泵磁力仪用来测量的总磁场,三分量磁通门磁力仪实时测量沿飞机平台坐标系x、y和z轴的地磁场测量值,高度计用来测量飞机飞行的高度,GPS用来测量飞机所处位置的经度和纬度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110544510.5A CN113281824B (zh) | 2021-05-19 | 2021-05-19 | 一种考虑飞机非刚性以及极化电流因素的航空磁补偿方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110544510.5A CN113281824B (zh) | 2021-05-19 | 2021-05-19 | 一种考虑飞机非刚性以及极化电流因素的航空磁补偿方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113281824A CN113281824A (zh) | 2021-08-20 |
CN113281824B true CN113281824B (zh) | 2022-03-25 |
Family
ID=77279803
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110544510.5A Active CN113281824B (zh) | 2021-05-19 | 2021-05-19 | 一种考虑飞机非刚性以及极化电流因素的航空磁补偿方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113281824B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115993133B (zh) * | 2021-10-20 | 2024-03-15 | 北京三快在线科技有限公司 | 磁力计校准的方法、装置、设备及存储介质 |
CN114184988B (zh) * | 2021-11-11 | 2022-10-11 | 北京大学 | 包含补偿平台电流磁干扰的航磁补偿方法及其装置 |
CN114578439A (zh) * | 2021-12-27 | 2022-06-03 | 北京自动化控制设备研究所 | 磁补偿系数自适应优化方法及系统 |
CN114415073B (zh) * | 2022-03-29 | 2022-08-09 | 中国人民解放军海军工程大学 | 一种航磁矢量梯度仪误差模型的地面快速校准方法及系统 |
CN117031364B (zh) * | 2023-10-10 | 2023-12-12 | 西南交通大学 | 一种多旋翼无人机动态误差补偿及降噪方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104062687A (zh) * | 2014-06-12 | 2014-09-24 | 中国航空无线电电子研究所 | 一种空地一体的地磁场联合观测方法及系统 |
CN105222809A (zh) * | 2015-11-05 | 2016-01-06 | 哈尔滨工业大学 | 一种地磁梯度鲁棒的航磁干扰补偿系数估计的方法 |
CN106940454A (zh) * | 2017-04-27 | 2017-07-11 | 吉林大学 | 航空磁梯度张量探测中校正飞行的地面模拟方法及系统 |
CN108520112A (zh) * | 2018-03-21 | 2018-09-11 | 北京理工大学 | 一种基于吉洪诺夫正则化的飞机干扰磁场补偿方法 |
CN111433634A (zh) * | 2017-09-30 | 2020-07-17 | 中国科学院空天信息创新研究院 | 基于航磁补偿误差模型的磁补偿方法 |
Family Cites Families (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FR2507770A1 (fr) * | 1981-06-11 | 1982-12-17 | Crouzet Sa | Procede de compensations des perturbations magnetiques dans la determination d'un cap magnetique et dispositif pour la mise en oeuvre de ce procede |
EP2621809A4 (en) * | 2010-10-01 | 2017-12-06 | Hillcrest Laboratories, Inc. | Apparatuses and methods for estimating the yaw angle of a device in a gravitational reference system using measurements of motion sensors and a magnetometer attached to the device |
CN105425304B (zh) * | 2015-11-03 | 2017-09-15 | 哈尔滨工业大学 | 一种飞机航磁干扰的补偿方法 |
CN110274586B (zh) * | 2019-01-16 | 2020-10-09 | 北京大学 | 包含多光系原子磁力仪方向误差补偿的航空磁补偿方法 |
CN110967770A (zh) * | 2019-11-15 | 2020-04-07 | 中国科学院电子学研究所 | 一种基于经典航磁补偿模型的改进型平台磁干扰补偿系统 |
CN111123173B (zh) * | 2019-12-10 | 2021-10-22 | 自然资源部第一海洋研究所 | 一种基于浮标的深远海磁力异常探测系统及探测方法 |
CN111413651B (zh) * | 2020-03-30 | 2021-04-13 | 中国科学院上海微系统与信息技术研究所 | 一种磁场总场的补偿方法、装置、系统及存储介质 |
CN112782637B (zh) * | 2021-03-02 | 2024-05-14 | 哈尔滨工业大学 | 一种光泵磁力仪探头转向误差磁干扰校准方法及系统 |
-
2021
- 2021-05-19 CN CN202110544510.5A patent/CN113281824B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104062687A (zh) * | 2014-06-12 | 2014-09-24 | 中国航空无线电电子研究所 | 一种空地一体的地磁场联合观测方法及系统 |
CN105222809A (zh) * | 2015-11-05 | 2016-01-06 | 哈尔滨工业大学 | 一种地磁梯度鲁棒的航磁干扰补偿系数估计的方法 |
CN106940454A (zh) * | 2017-04-27 | 2017-07-11 | 吉林大学 | 航空磁梯度张量探测中校正飞行的地面模拟方法及系统 |
CN111433634A (zh) * | 2017-09-30 | 2020-07-17 | 中国科学院空天信息创新研究院 | 基于航磁补偿误差模型的磁补偿方法 |
CN108520112A (zh) * | 2018-03-21 | 2018-09-11 | 北京理工大学 | 一种基于吉洪诺夫正则化的飞机干扰磁场补偿方法 |
Also Published As
Publication number | Publication date |
---|---|
CN113281824A (zh) | 2021-08-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113281824B (zh) | 一种考虑飞机非刚性以及极化电流因素的航空磁补偿方法 | |
Gebre-Egziabher et al. | A non-linear, two-step estimation algorithm for calibrating solid-state strapdown magnetometers | |
Fang et al. | A novel calibration method of magnetic compass based on ellipsoid fitting | |
US6543146B2 (en) | Electronic compass and compensation of large magnetic errors for operation over all orientations | |
CN106353824B (zh) | 航空磁通门磁梯度张量仪的系统校正及磁干扰补偿融合方法 | |
CN107272069B (zh) | 基于磁异常梯度的磁性目标追踪方法 | |
Crassidis et al. | Real-time attitude-independent three-axis magnetometer calibration | |
CN109556631B (zh) | 一种基于最小二乘的ins/gnss/偏振/地磁组合导航系统对准方法 | |
CN105891755B (zh) | 航空器挂载式磁通门磁梯度张量仪的校正方法 | |
CN108827310A (zh) | 一种船用星敏感器辅助陀螺仪在线标定方法 | |
CN102252689A (zh) | 一种基于磁传感器的电子罗盘校准方法 | |
CN112325886B (zh) | 一种基于重力梯度仪和陀螺仪组合的航天器自主定姿系统 | |
CN108413887A (zh) | 光纤光栅辅助分布式pos的机翼形变测量方法、装置和平台 | |
CN105737858A (zh) | 一种机载惯导系统姿态参数校准方法与装置 | |
CN109000639B (zh) | 乘性误差四元数地磁张量场辅助陀螺的姿态估计方法及装置 | |
CN109708663B (zh) | 基于空天飞机sins辅助的星敏感器在线标定方法 | |
CN113074752A (zh) | 一种用于车载地磁传感器的动态标定方法及系统 | |
CN104121927A (zh) | 一种适用于低精度无方位基准单轴转位设备的惯性测量单元标定方法 | |
CN109668562A (zh) | 一种考虑偏差时引入伪测量的重力梯度运动学导航方法 | |
CN109855623A (zh) | 基于Legendre多项式和BP神经网络的地磁模型在线逼近方法 | |
CN113447993B (zh) | 磁力矢量测量的补偿飞行方法、系统及磁补偿方法、系统 | |
Zhang et al. | On-orbit real-time magnetometer bias determination for micro-satellites without attitude information | |
CN104809352A (zh) | 基于正演的拖曳式航磁全张量梯度数据软补偿方法 | |
Lihui et al. | Algorithms used in restraining random noise in measurements from a geomagnetic navigation magnetometer | |
Guo et al. | Feature extraction and geomagnetic matching |
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 |