【技术实现步骤摘要】
阵列式MEMS磁传感器实时标定方法
本专利技术涉及MEMS磁传感器领域，具体涉及一种阵列式MEMS磁传感器实时标定方法。
技术介绍
MEMS磁传感器是MEMS惯性导航系统中常用的一种传感器，可以为MEMS惯性导航系统提供航向信息。由于存在硬铁和软铁干扰，影响航向测量准确度，因此在进行航向确定之前需要对MEMS磁传感器进行标定。传统技术存在以下技术问题：传统的MEMS磁传感器标定方法是基于代价函数最小化的解析方法，该方法易受MEMS磁传感器测量噪声的影响使得标定参数存在偏置误差，从而影响航向测量精度。为此，需要对测量噪声进行抑制，并通过参数估计等优化方法对标定参数进行估计，完成标定过程。
技术实现思路
为克服传统方法在测量噪声大的MEMS磁传感器标定过程中存在偏置误差的问题，采用一种阵列式MEMS磁传感器实时标定方法。在对阵列式MEMS磁传感器统一测量模型构造的基础上，通过构造参数模型、设计自适应Kalman滤波算法实现参数估计，完成标定过程。为了解决上述技术问题，本专利技术提供了一...
【技术保护点】
1.一种阵列式MEMS磁传感器实时标定方法，其特征在于，包括：/n获取阵列MEMS磁传感器实时数据并进行预处理。/n将阵列式MEMS磁传感器数据进行均值运算；/n建立统一的阵列式MEMS磁传感器标定模型；/n通过参数模型，设计自适应Kalman滤波算法，实现参数估计，标定过程采样点数为M，若k＝M，则输出标定结果，完成阵列式MEMS磁传感器标定过程，若k＜M，表示标定过程未完成，则重复上述步骤，直至标定过程结束，其中，k和M都是正整数。/n
【技术特征摘要】
1.一种阵列式MEMS磁传感器实时标定方法，其特征在于，包括：
获取阵列MEMS磁传感器实时数据并进行预处理。
将阵列式MEMS磁传感器数据进行均值运算；
建立统一的阵列式MEMS磁传感器标定模型；
通过参数模型，设计自适应Kalman滤波算法，实现参数估计，标定过程采样点数为M，若k＝M，则输出标定结果，完成阵列式MEMS磁传感器标定过程，若k＜M，表示标定过程未完成，则重复上述步骤，直至标定过程结束，其中，k和M都是正整数。
2.如权利要求1所述的阵列式MEMS磁传感器实时标定方法，其特征在于，“获取阵列MEMS磁传感器实时数据并进行预处理；”具体包括：
由MEMS磁传感器测量模型可知：
式中，表示MEMS磁传感器测量结果；Sf表示比例因子，Cno表示非正交矩阵，Csi表示软铁干扰误差，表示导航系到载体系的方向余弦矩阵，mn表示导航系下地磁场矢量，bhi表示硬铁干扰误差，bm表示偏置误差，ηm表示随机噪声；
当不考虑MEMS磁传感器存在位置变化时，MEMS磁传感器测量模型可以表示为：
式中，表示MEMS磁传感器测量结果；C＝SfCnoCsi表示综合变换误差矩阵；b＝SfCnobhi+bm表示综合偏置误差；表示载体系下地磁场矢量；η＝ηm表示随机噪声；
考虑阵列式MEMS磁传感器测量时，其测量模型可以表示为：
式中，表示第i个磁传感器测量结果；Ci表示第i个磁传感器综合变换误差矩阵；表示地磁矢量在第i个磁传感器坐标系上的映射；bi表示第i个磁传感器综合偏置误差；ηi表示第i个传感器随机噪声。
3.如权利要求1所述的阵列式MEMS磁传感器实时标定方法，其特征在于，“将阵列式MEMS磁传感器数据进行均值运算；”具体包括：
阵列式MEMS磁传感器测量模型可知，对测量参数进行均值运算为：
式中，表示阵列式MEMS磁传感器测量均值；N表示构成阵列式MEMS磁传感器的个数；Ci表示第i个磁传感器综合变换误差矩阵；表示地磁矢量在第i个磁传感器坐标系上的映射；表示阵列式MEMS磁传感器综合偏置误差的均值；表示阵列式MEMS磁传感器随机噪声均值；参数可以用下式计算：
式中，表示阵列式MEMS磁传感器测量均值；表示第i个磁传感器测量结果；N表示构成阵列式MEMS磁传感器的个数；表示阵列式MEMS磁传感器综合偏置误差的均值；bi表示第i个磁传感器综合偏置误差；表示阵列式MEMS磁传感器随机噪声均值；ηi表示第i个传感器随机噪声。
4.如权利要求1所述的阵列式MEMS磁传感器实时标定方法，其特征在于，“建立统一的阵列式MEMS磁传感器标定模型；”具体包括：对阵列式MEMS磁传感器，在阵列中心定义一个载体坐标系b，此时每个MEMS磁传感器坐标系上的地磁场映射值与中心处的载体坐标系上的地磁场映射值之间的关系可以表示为：
式中，表示地磁矢量在第i个磁传感器坐标系上的映射；表示载体坐标系到第i个MEMS磁传感器坐标系的方向余弦矩阵；mb表示载体系下地磁场矢量；
由于每个MEMS磁传感器坐标系与阵列中心载体坐标系之间不存在相对运动，因此可以认为是一个常值；所以，阵列式MEMS磁传感器测量模型可以重新表示为
式中，表示阵列式MEMS磁传感器测量均值；N表示构成阵列式MEMS磁传感器的个数；Ci表示第i个磁传感器综合变换误差矩阵；表示载体坐标系到第i个MEMS磁传感器坐标系的方向余弦矩阵；mb表示载体系下地磁场矢量；表示阵列式MEMS磁传感器综合偏置误差的均值；表示阵列式MEMS磁传感器随机噪声均值；
定义
式中，表示综合变换误差均值矩阵；N表示构成阵列式MEMS磁传感器的个数；Ci表示第i个磁传感器综合变换误差矩阵；表示载体坐标系到第i个MEMS磁传感器坐标系的方向余弦矩阵；
由上面推导可知，统一的阵列式MEMS磁传感器测量模型可以表示为：
式中，表示阵列式MEMS磁传感器测量均值；表示综合变换误差均值矩阵；mb表示载体系下地磁场矢量；表示阵列式MEMS磁传感器综合偏置误差的均值；表示阵列式MEMS磁传感器随机噪声均值。
5.如权利要求1所述的阵列式MEMS磁传感器实时标定方法，其特征在于，“通过参数模型，设计自适应Kalman滤波算法，实现参数估计；”具体为：
对统一的阵列式MEMS磁传感器测量模型进行变换之后可得：
式中，mb表示载体系下地磁场矢量；表示综合变换误差均值矩阵；表示阵列式MEMS磁传感器测量均值；表示阵列式MEMS磁传感器综合偏置误差的均值；表示阵列式MEMS磁传感器随机噪声均值；
对上式两边进行模值平方运算：
式中，mb表示载体系下地磁场矢量；表示阵列式MEMS磁传感器测量均值；表示阵列式MEMS磁传感器综合偏置误差的均值；表示阵列式MEMS磁传感器随机噪声均值；R表示由综合变换误差均值矩阵构造的中间矩阵，可以由下式表示：
式中，表示综合变换误差均值矩阵；T表示矩阵转置运算；
定义阵列式MEMS磁传感器测量均值为阵列式MEMS磁传感器综合偏置误差的均值为则可构造参数模型：
式中，表示位置参数矢量的微分；y表示量测；H表示参数矩阵；x表示未知参数；ν表示量测噪声；其中各参数可以表示为：
x＝[x1x2x3x4x5x6x7x8x9]T
H＝[h1h2h3h4h5h6h7h8h9]
式中，xi(i＝1…9)表示参数矢量的第i个元素；hi(i＝1…9)表示参数矩阵的第i个元素；y表示量测；表示阵列式MEMS磁传感器测量均值在x轴上的分量；表示阵列式MEMS磁传感器测量均值在y轴上的分量；表示阵列式MEMS磁传感器测量均值在z轴上的分量；ν表示量测噪声；表示阵列式MEMS磁传感器测量均值；表示阵列式MEMS磁传感器综合偏置误差的均值；分别表示阵列式MEMS磁传感器综合偏置误差均值在x、y、z轴上的分量；表示阵列式MEMS磁传感器随机噪声均值；R表示由综合变换误差均值矩阵构造的中间矩阵；mb表示载体系下地磁场矢量；rij(i＝1…3,j＝1…3)表示矩阵中的第i行j列元素；
基于上述统一的阵列式MEMS磁传感器测量模型构造的参数方程，可以构造自适应Kalman滤波参数估计算法：
式中，ek表示k时刻的残差；yk表示k时刻的量测；Hk表示k时刻的参数矩阵；表示k-1时刻的估计参数矢量；Λk表示k时刻的自适应量测噪声；Λk-1表示k-1时刻的自适应量测噪声；表示测量速度噪声的标准差；Kk表示k时刻的增益矩阵；Pk-1表示k-1时刻的误差协方差阵；表示k时刻的估计参数矢量；Pk表示k时刻的误差协方差阵；根据上述参数估计，结合参数解算，即可实现阵列式MEMS磁传感器统一量测模型下的参数标定...
【专利技术属性】
技术研发人员：徐祥，朱琳，徐大诚，白春风，
申请(专利权)人：苏州大学，
类型：发明
国别省市：江苏;32
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。