一种基于地磁矢量及粒子滤波的载体干扰磁场在线补偿方法技术

本发明专利技术属于非线性最优估计和地磁测量领域，尤其涉及一种基于地磁矢量及粒子滤波的载体干扰磁场在线补偿方法。本发明专利技术包括：(1)选择一块载体干扰磁场补偿的区域，用标量磁力计测量该区域的总场值||H

Carrier interference magnetic field online compensation method based on geomagnetic vector and particle filter

The invention belongs to the field of nonlinear optimum estimation and geomagnetic measurement, in particular to a vector interference magnetic field online compensation method based on geomagnetic vector and particle filtering. The present invention includes: (1) choose a carrier magnetic interference compensation area, ||H value using scalar magnetometer measurements in the region of the total field

【技术实现步骤摘要】
一种基于地磁矢量及粒子滤波的载体干扰磁场在线补偿方法
本专利技术属于非线性最优估计和地磁测量领域，尤其涉及一种基于地磁矢量及粒子滤波的载体干扰磁场在线补偿方法。
技术介绍
地磁矢量一般使用三轴磁力计进行测量，因此地磁矢量的测量误差主要分为仪器自身误差和干扰磁场误差。由仪器制造工艺和安装精度产生的仪器误差是三轴磁力计的自身误差，磁性物质产生的干扰磁场是一种依赖于外界环境的干扰误差，两者都将影响地磁矢量测量的精度。一般来说，载体硬铁磁场和软铁磁场是干扰磁场的主要成分，本专利技术只针对硬铁磁场和软铁磁场进行在线补偿。硬铁磁场是由铁磁性物质在外来磁场的作用下被磁化而产生剩磁，剩磁的大小和方向不会随着载体姿态的变化而变化。软铁磁场与引起它的外加磁场成正比，也随着载体姿态的变化而变化。李季等人使用无迹卡尔曼算法对干扰磁场参数进行估计，从而对磁测误差进行补偿，但是无迹卡尔曼对非线性较强的系统以及非高斯系统估计性能不佳。一项美国国家专利(美国专利号5182514,1993年1月26日，Automaticcompensatorforanairbornemagneticanomalydetector)提到,采用一个三轴磁场传感器和一个标量磁场传感器，利用两者输出计算出地磁场与飞机坐标系间的方向余弦；但在干扰磁场强度较大时，存在方向余弦无法测出的问题。地磁矢量观测方程具有强的非线性，因此，本专利技术采用对非线性具有较好估计效果的粒子滤波算法对载体干扰磁场参数组成的系统状态量进行估计。但是粒子滤波存在随着迭代次数的增多有效粒子数和粒子多样性都降低的缺陷。本专利技术采用双阈值切割法增加粒子滤波粒子集的有效粒子数，同时采用BP神经网络调整粒子集的权值，由生物多样性的熵函数检验粒子集的多样性，避免了粒子集多样性的贫乏，实现了载体干扰磁场的在线补偿，提高了载体地磁矢量的测量精度。
技术实现思路
为了解决干扰磁场对地磁矢量测量精度影响较大的问题，本专利技术提出了一种基于地磁矢量及粒子滤波的载体干扰磁场在线补偿方法。本专利技术的目的是这样实现的：一种基于地磁矢量及粒子滤波的载体干扰磁场在线补偿方法，包括如下步骤：(1)选择一块载体干扰磁场补偿的区域，用标量磁力计测量该区域的总场值||Ho||；(2)k＝0时刻，对待估参数进行初始化，根据先验概率密度P(X0)产生N个先验粒子集，所有粒子集的权值为1/N；(3)令k＝k+1，载体作改变姿态的机动动作，由捷联于载体的三轴磁力计获得载体干扰磁场存在时的地磁矢量测量值Hmk；(4)将||Hmk||2与||Ho||2作差，其差值作为当前时刻的系统观测值yk；式(1)为系统k时刻的观测方程：yk＝||Hmk||2-||Ho||2＝hk+νk(1)式中,hk＝2H'pkHmk-||Hpk||2-(Hmk-Hpk)'(B+B'+B'B)(Hmk-Hpk)(2)νk＝2(Hmk-Hpk)'(I3×3+B+B'+B'B)εk-εk'(I3×3+B+B'+B'B)εk(3)式中，I3×3为单位矩阵，B为待估参数矩阵，εk为非高斯噪声；待估计的硬铁磁场和软铁磁场系数写成状态向量：X＝[x1,x2,x3,x4,x5,x6,x7,x8,x9]T(4)式中，硬铁磁场Hpk＝[x1,x2,x3]T，软铁磁场系数矩阵其中，由于载体干扰磁场参数都是常量，所以粒子滤波的状态方程为：X(k)＝X(k-1)+ζk(5)式中，ζk为过程噪声，；(5)状态预测：根据状态方程从先验粒子中采样抽取N个样本，根据式(2)计算此时的预测值yk|k-1；权值更新：按式(6)进行权值更新；先验概率作为重要性密度函数：(6)按式(8)，将N个粒子集权值进行归一化处理；(7)按式(9)，计算有效粒子数Neff1，当有效粒子数Neff1≥2N/3时直接进行参数估计；当有效粒子数Neff1＜2N/3时进行步骤(8)；有效粒子数的计算公式为：(8)提高有效粒子数：选大阈值ω1和小阈值ω2作为粒子集的两个权值阈值，选出权值大于ω1的粒子和权值低于ω2的粒子；再将大权值粒子个数和小权值粒子个数进行比较，当小权值粒子个数是大权值粒子的n倍时，将大权值的粒子分割成n个为原来权值的1/n倍的粒子；之后，用分割后的n个粒子替换小权值的粒子；经过粒子分割替换后的N个粒子，粒子的所有粒子权值将集中在ω＞ω2区间，存在粒子多样性贫乏的问题；(9)提高粒子多样性：利用BP神经网络的非线性特征，权值大于ω1的粒子的状态值用于训练输入，该时刻的hk值作为训练BP神经网络的教师信号；然后将权值低于ω1的粒子的M个状态值作为神经网络的预测输入，将此时的输出值利用权值更新公式6计算粒子的权值；将更新后的权值利用熵值作为权值多样性评判函数，当熵D＞0.9M进行步骤10；否则重新进行步骤(9)；生物多样性的熵函数为：式中，S为更新后的权值的种类；(10)对调整多样性后的粒子集，再次利用式(8)进行归一化；(11)按式(9)计算有效粒子数Neff2，当有效粒子数Neff2≥2N/3时直接进行参数估计；否则进行步骤(12)；(12)重采样：将原来的带权样本映射为等权样本(13)参数估计：利用式(11)进行当前时刻的状态参数估计；(14)将状态参数的估计值代入式(12)，对k时刻的地磁矢量测量值进行实时补偿，得到k时刻的地磁矢量补偿值；Hmkb＝(I+B)(Hmk-Hp)(12)(15)k＝k+1，回到步骤(3)；本专利技术的有益效果在于：本专利技术将BP神经网络、双阈值切割法和生物多样性熵函数应用于粒子滤波的参数估计，增加了粒子滤波的有效粒子数同时避免了粒子多样性贫乏的问题，提高载体干扰磁场参数估计与补偿精度。附图说明图1为本专利技术的程序流程示意图；图2为在载体干扰磁场环境下的地磁矢量测量值；图3为硬铁磁场参数估计结果；图4为软铁磁场系数矩阵D的主对角线系数估计结果；图5为软铁磁场系数矩阵D上三角矩阵其余元素的估计结果；图6为补偿后的地磁矢量测量值；图7为双阈值切割示意图；图8为BP神经网络结构示意图。具体实施方式下面结合附图对本专利技术做进一步描述。本专利技术将BP神经网络、双阈值切割法和生物多样性函数用于粒子滤波算法的改进，在增加粒子集的有效粒子数的同时避免了粒子集多样性贫乏的现象，从而提高了粒子滤波的参数估计精度，达到地磁矢量测量参数估计和误差补偿的目的。步骤1，选择一块载体干扰磁场补偿的区域，用标量磁力计测量该区域的总场值||Ho||，在数值仿真时设||Ho||＝60000nT。步骤2，k＝0时刻，对待估参数进行初始化，根据先验概率密度P(X0)产生N个先验粒子集，所有粒子集的权值为1/N，将9个参数的初始值设为0。步骤3，令k＝k+1，载体作改变姿态的机动动作，由捷联于载体的三轴磁力计获得载体干扰磁场存在时的地磁矢量测量值Hmk，设硬铁磁场Hp＝[3000,4000,2000]T，软磁场系数矩阵εk为方差为2的非高斯噪声；根据式(1)仿真得到此时的Hmk，Hmk的仿真结果如图2所示。Hmk＝Hok+Hp+Hi+εk＝(I3*3+D)Hok+Hp+εk(1)步骤4，将||Hmk||2与||Ho||2作差，其差值作为当前时刻的系统观测值yk。式(2)为系统k时刻的观测方程：yk＝||Hmk||2-||Ho||2＝hk本文档来自技高网...

【技术保护点】
一种基于地磁矢量及粒子滤波的载体干扰磁场在线补偿方法，其特征在于，包括如下步骤：(1)选择一块载体干扰磁场补偿的区域，用标量磁力计测量该区域的总场值||H

【技术特征摘要】
1.一种基于地磁矢量及粒子滤波的载体干扰磁场在线补偿方法，其特征在于，包括如下步骤：(1)选择一块载体干扰磁场补偿的区域，用标量磁力计测量该区域的总场值||Ho||；(2)k＝0时刻，对待估参数进行初始化，根据先验概率密度P(X0)产生N个先验粒子集，所有粒子集的权值为1/N；(3)令k＝k+1，载体作改变姿态的机动动作，由捷联于载体的三轴磁力计获得载体干扰磁场存在时的地磁矢量测量值Hmk；(4)将||Hmk||2与||Ho||2作差，其差值作为当前时刻的系统观测值yk；式(1)为系统k时刻的观测方程：yk＝||Hmk||2-||Ho||2＝hk+νk(1)式中,hk＝2H'pkHmk-||Hpk||2-(Hmk-Hpk)'(B+B'+B'B)(Hmk-Hpk)(2)νk＝2(Hmk-Hpk)'(I3×3+B+B'+B'B)εk-εk'(I3×3+B+B'+B'B)εk(3)式中，I3×3为单位矩阵，B为待估参数矩阵，εk为非高斯噪声；待估计的硬铁磁场和软铁磁场系数写成状态向量：X＝[x1,x2,x3,x4,x5,x6,x7,x8,x9]T(4)式中，硬铁磁场Hpk＝[x1,x2,x3]T，软铁磁场系数矩阵其中，由于载体干扰磁场参数都是常量，所以粒子滤波的状态方程为：X(k)＝X(k-1)+ζk(5)式中，ζk为过程噪声，；(5)状态预测：根据状态方程从先验粒子中采样抽取N个样本，根据式(2)计算此时的预测值yk|k-1；权值更新：按式(6)进行权值更新；先验概率作为重要性密度函数：(6)按式(8)，将N个粒子集权值进行归一化处理；

【专利技术属性】
技术研发人员：黄玉，齐瑞云，吕振川，武立华，
申请(专利权)人：哈尔滨工程大学，
类型：发明
国别省市：黑龙江,23