CN103591973A - 一种非线性最小二乘的三轴矢量传感器高精度校正方法 - Google Patents
一种非线性最小二乘的三轴矢量传感器高精度校正方法 Download PDFInfo
- Publication number
- CN103591973A CN103591973A CN201310487366.1A CN201310487366A CN103591973A CN 103591973 A CN103591973 A CN 103591973A CN 201310487366 A CN201310487366 A CN 201310487366A CN 103591973 A CN103591973 A CN 103591973A
- Authority
- CN
- China
- Prior art keywords
- linear
- square
- axial vector
- axial
- sensor
- 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
Images
Landscapes
- Indication And Recording Devices For Special Purposes And Tariff Metering Devices (AREA)
Abstract
本发明涉及一种非线性最小二乘的三轴矢量传感器高精度校正方法。综合考虑三轴不正交、标定系数不一致和零点偏置三个方面对测量值的影响,得到对常用三轴矢量传感器具有普遍适用性的传感器误差校正模型;引入高精度标量背景场测量仪提供期望输出;进一步建立三轴矢量传感器固有参数辨识的最优化模型;结合非线性最小二乘的基本思想对模型进行求解,实现三轴矢量传感器的固有参数辨识和误差校正。本发明同现有技术相比,具有针对常用三轴矢量传感器的普遍适用性;综合考虑了三轴不正交、各轴标定系数不一致和零点偏置对测量值带来的影响;消除了仪器系统误差对测量结果的影响;对实验操作和仪器设备要求不高。
Description
技术领域
本发明属于电子仪器测量、标定与校正技术领域,涉及一种非线性最小二乘的三轴矢量传感器高精度校正方法
背景技术
三轴矢量传感器既能实现对空间物理场的标量测量又能实现矢量测量,在实际测量工作中有着独特优势和广泛应用。但受加工和安装工艺的限制,实际的三轴矢量传感器各测量轴的敏感元件不完全正交,各轴的灵敏性和激励放大电路的电器性能也有差异,加之零点偏置等因素的影响,使得传感器测量值与实际值之间存在较大误差,大大限制了三轴矢量传感器的应用领域。因此,在高精度测量工作中,必须对传感器进行误差校正。用专业计量设备可测量得到传感器固有参数,但设备昂贵,过程繁琐。因此,通常采用数值计算的方法,结合实验中三轴矢量传感器的实际输出,实现固有参数的辨识和误差校正。
在本发明以前的技术中,对三轴矢量传感器的误差校正存在以下四个方面的局限性:(1)校正方法仅局限在某一特定传感器,不具有针对常用三轴矢量传感器的普遍适用性;(2)没有综合分析三轴不正交、各轴标定系数不一致和零点偏置对测量值带来的影响;(3)将三轴矢量传感器自身测量值的平均值作为期望输出,无法消除仪器系统误差对测量结果的影响;(4)在校正试验中,传感器的姿态变化都围绕某一固定轴进行旋转,对实验操作和仪器设备要求高。
发明内容
针对上述现有技术状况,本发明提供一种基于非线性最小二乘的三轴矢量传感器高精度校正方法。
本发明的技术构思及技术解决方案是:分析三轴矢量传感器的工作原理,综合考虑三轴不正交、标定系数不一致和零点偏置三个方面对测量值的影响,得到对常用三轴矢量传感器具有普遍适用性的传感器误差校正模型。针对传感器固有参数的辨识,引入高精度标量背景场测量仪提供期望输出,以此弥补仅靠被校正仪器提供测量数据所带来的系统误差无法弥补的不足,进一步根据非线性最小二乘的计算要求,建立三轴矢量传感器固有参数辨识的最优化模型;结合非线性最小二乘的基本思想对模型进行求解,实现三轴矢量传感器的固有参数辨识和误差校正。本发明方法具体包括如下步骤:
步骤1:建立三轴矢量传感器的误差校正公式
根据正交坐标系(参见图1、2)OX1Y1Z1与实际测量坐标系OXYZ之间的位置关系和传感器三个轴的电路原理,得出三轴矢量传器误差的三个来源:三轴不正交、标度系数不一致和零点偏置,综合考虑这三方面因素建立三轴矢量传感器的误差校正公式:
V1=P·K-1·(V-b) (1)
其中,b=(b1,b2,b3)T为零点偏置向量,b1、b2、b3分别对应x、y、z轴的零点偏置;K=diag(k1,k2,k3)为标度系数矩阵,k1、k2、k3分别对应x、y、z轴的标度系数; α、β、γ为非正交坐标系与正交坐标系之间的正交误差角;V=[vx,vy,vz]T为实际传感器测量值,V1=[v1x,v1y,v1z]T为理想传感器测量值;
步骤2:建立三轴矢量传感器固有参数辨识的最优化模型:
其中,X=[b1,b2,b3,k1,k2,k3,α,β,γ]T,|V1i(x)|为测量值|Vi(X)|经过校正公式校正后的总场强度,|VSC|为高精度标量背景场测量仪测控量得到的总场强度。当目标函数F(X)→0时,|V1i|→|VSC|,此时对应的校正参数X即为矢量传感器的固有误差参数。该模型符合典型的非线性最小二乘问题的基本形式;
步骤3:运用非线性最小二乘理论对参数进行辨识
求解非线性最小二乘问题的基本思想是,通过求解一系列线性最小二乘问题来得到非线性最小二乘问题的解;因此,运用非线性最小二乘理论对三轴矢量传感器的固有参数进行辨识,具体分为以下几个步骤:
步骤3.1:令k=0,设定校正参数的初始值X(0),迭代终止条件ε,最大迭代次数kmax;
步骤3.2:将非线性最小二乘问题F(X)在X(k)处近似为线性最小二乘问题φ(X);
令
i=1,2,…,m
令
用φ(X)在X(k)处近似F(X),从而将非线性最小二乘问题近似为求解线性最小二乘问题:minφ(X)。
步骤3.3:求解线性最小二乘问题:minφ(X)
由步骤1所建立的校正公式(1)可得,|V1i(X)|的表达式为:
则fi(X)对三轴矢量传感器9个固有参数的偏导数分别为:
其中,j=1,2,3,
其中,j=1,2,3,
其中,θ1=α,θ2=β,θ3=γ,
记
则φ(X)可写成矩阵形式为:
φ(X)=(AkX-Bk)T(AkX-Bk)
由于矩阵Ak为列满秩,则由最小二乘理论可得函数φ(X)的极小值点为:
步骤3.4:判断迭代是否终止
若F(X(k+1))<ε或k=kmax,则终止迭代,输出参数向量X(k+1);否则,转到步骤3.1继续进行迭代计算;
步骤4:将得到的三轴矢量传感器的固有参数值带入到校正公式,即可实现对测量误差的校正。
本发明同现有技术相比,具有针对常用三轴矢量传感器的普遍适用性;综合考虑了三轴不正交、各轴标定系数不一致和零点偏置对测量值带来的影响;消除了仪器系统误差对测量结果的影响;对实验操作和仪器设备要求不高。
附图说明
图1:本发明测量坐标系与标准郑家坐标系位置关系图
图2:三轴矢量传感器各轴测量原理图
图3:三轴零偏求解值变化曲线图
图4:三轴灵敏度求解值变化曲线图
图5:正交误差角求解值变化曲线图
图6:目标函数值变化曲线图
图7:FGM-2000三轴磁通门传感器误差校正效果图
具体实施方式
下面以FGM-2000三轴磁通门传感器为误差校正对象,通过开展校正试验,对本发明校正方法进行验证。选定的高精度背景场标量测量仪为GSMP-35高精度光泵磁力仪,该仪器技术指标如表1所示:
表1GSMP-35光泵磁力仪技术指标列表
*注:该技术指标为中国计量研究院标定
实验验证的具体过程如下:
步骤1选定地磁场均匀稳定区域为试验区,按照要求连接仪器设备,将FGM-2000三轴磁通门传感器固定在实验区内的有精密刻度的无磁转台上,检查无误后接通电源,检验仪器性能。
步骤2待仪器性能稳定后,每隔10°转动一次转台,待传感器测量值稳定后记录对应姿态下的FGM-2000的三轴输出,完整记录传感器旋转360°得到的35组测量数据。
步骤3:保持无磁转台在测量点位置和姿态不变。取下FGM-2000三轴磁通门磁力仪,将GSMP-35光泵磁力仪固定在无磁转台的同一位置,以Step2中同样的方法将转台旋转360°,记完整录对应姿态下磁力仪测量得到的地磁总场数据。
步骤4结合测量得到的两组磁场数据,运用基于非线性最小二乘的三轴磁通门传感器固有参数辨识算法对固有参数进行求解。
求解得到的结果如图3~7所示。
经过1200次循环迭代后,得到的FGM-2000三轴磁通门传感器的固有参数如表2所示。
表2FGM-2000固有参数求解结果
将表2中的固有参数代入到校正公式V1=P·K-1·(V-b)中,得到校正前后测量结果及误差对比如表3所示。
表3校正前后结果及误差对比
根据表3中数据进一步计算,得到FGM-2000对地磁总场测量的均方根误差校正前为rmse(0)=305.75nT,校正后为rmse(1200)=4.36nT,测量误差减小了98.57%,传感器测量精度显著提高,校正后仪器的性能更加接近理想器件,验证了方法的有效性。
Claims (4)
1.一种非线性最小二乘的三轴矢量传感器高精度校正方法,其特征在于:综合考虑三轴不正交、标定系数不一致和零点偏置三个方面对测量值的影响,得到对常用三轴矢量传感器具有普遍适用性的传感器误差校正模型;针对传感器固有参数的辨识,引入高精度标量背景场测量仪提供期望输出,以此弥补仅靠被校正仪器提供测量数据所带来的系统误差无法弥补的不足;进一步根据非线性最小二乘的计算要求,建立三轴矢量传感器固有参数辨识的最优化模型;结合非线性最小二乘的基本思想对模型进行求解,实现三轴矢量传感器的固有参数辨识和误差校正。
2.根据权利要求1所述的一种非线性最小二乘的三轴矢量传感器高精度校正方法,其特征在于:具体包括如下步骤:
步骤1:建立三轴矢量传感器的误差校正公式
根据正交坐标系OX1Y1Z1与实际测量坐标系OXYZ之间的位置关系和传感器三个轴的电路原理,得出三轴矢量传器误差的三个来源:三轴不正交、标度系数不一致和零点偏置,综合考虑这三方面因素建立三轴矢量传感器的误差校正公式:
V1=P·K-1·(V-b) (1)
其中,b=(b1,b2,b3)T为零点偏置向量,b1、b2、b3分别对应x、y、z轴的零点偏置;K=diag(k1,k2,k3)为标度系数矩阵,k1、k2、k3分别对应x、y、z轴的标度系数; α、β、γ为非正交坐标系与正交坐标系之间的正交误差角;V=[vx,vy,vz]T为实际传感器测量值,v1=[v1x,v1y,v1z]T为理想传感器测量值;
步骤2:建立三轴矢量传感器固有参数辨识的最优化模型:
其中,X=[b1,b2,b3,k1,k2,k3,α,β,γ]T,|V1i(X)|为测量值|V1(X)|经过校正公式校正后的总场强度,|VSC|为高精度标量背景场测量仪测控量得到的总场强度。当目标函数F(X)→0 时,|V1i|→|VSC|,此时对应的校正参数X即为矢量传感器的固有误差参数。该模型符合典型的非线性最小二乘问题的基本形式;
步骤3:运用非线性最小二乘理论对参数进行辨识:通过求解一系列线性最小二乘问题来得到非线性最小二乘问题的解,运用非线性最小二乘理论对三轴矢量传感器的固有参数进行辨识;
步骤4:将得到的三轴矢量传感器的固有参数值带入到校正公式,即可实现对测量误差的校正。
3.根据权利要求2所述的一种非线性最小二乘的三轴矢量传感器高精度校正方法,其特征在于:步骤3中所述的“运用非线性最小二乘理论对参数进行辨识”具体分为以下几个步骤:
步骤3.1:令k=0,设定校正参数的初始值X(0),迭代终止条件ε,最大迭代次数kmax;
步骤3.2:将非线性最小二乘问题F(X)在X(k)处近似为线性最小二乘问题φ(X);
令
i=1,2,…,m
用φ(X)在X(k)处近似F(X),从而将非线性最小二乘问题近似为求解线性最小二乘问题:minφ(X);
步骤3.3:求解线性最小二乘问题:minφ(X);
步骤3.4:判断迭代是否终止
若F(X(k+1))<ε或k=kmax,则终止迭代,输出参数向量X(k+1);否则,转到步骤3.1继续进行迭代计算。
4.根据权利要求2所述的一种非线性最小二乘的三轴矢量传感器高精度校正方法,其特征在于:步骤3.3中所述的“求解线性最小二乘问题:minφ(X)”具体分为以下几个步骤:
由步骤1所建立的校正公式(1)可得,|V1i(X)|的表达式为:
则fi(X)对三轴矢量传感器9个固有参数的偏导数分别为:
步骤3.3.2:将带入到φ(X)的极小值点计算公式
记
则φ(X)可写成矩阵形式为:
φ(X)=(AkX-Bk)T(AkX-Bk)
由于矩阵Ak为列满秩,则由最小二乘理论可得函数φ(X)的极小值点为:
。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310487366.1A CN103591973A (zh) | 2013-10-12 | 2013-10-12 | 一种非线性最小二乘的三轴矢量传感器高精度校正方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310487366.1A CN103591973A (zh) | 2013-10-12 | 2013-10-12 | 一种非线性最小二乘的三轴矢量传感器高精度校正方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN103591973A true CN103591973A (zh) | 2014-02-19 |
Family
ID=50082204
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310487366.1A Pending CN103591973A (zh) | 2013-10-12 | 2013-10-12 | 一种非线性最小二乘的三轴矢量传感器高精度校正方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103591973A (zh) |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103885020A (zh) * | 2014-03-28 | 2014-06-25 | 卢兆兴 | 一种基于自适应遗传算法的三轴磁强计误差校正技术 |
CN106501868A (zh) * | 2016-10-17 | 2017-03-15 | 中国矿业大学(北京) | 三轴地磁传感器实时校正方法 |
CN106840247A (zh) * | 2017-04-13 | 2017-06-13 | 深圳怡化电脑股份有限公司 | 一种传感器线性校正方法和装置 |
CN109459711A (zh) * | 2018-12-26 | 2019-03-12 | 中国船舶重工集团公司第七〇九研究所 | 一种水下高精度磁场测量系统 |
CN109541704A (zh) * | 2018-12-05 | 2019-03-29 | 加泰科(深圳)科技有限公司 | 一种三轴磁通门航磁测量系统及矫正补偿方法 |
CN110118948A (zh) * | 2019-06-04 | 2019-08-13 | 中国科学院上海微系统与信息技术研究所 | 一种基于超导量子干涉仪的总场测量方法及装置 |
CN112327618A (zh) * | 2020-10-21 | 2021-02-05 | 江南大学 | 贪婪正交最小二乘法及基于此方法的参数与时滞辨识方法 |
CN113758515A (zh) * | 2021-08-16 | 2021-12-07 | 深圳市睿联技术股份有限公司 | 零点校准方法、装置、电子设备及计算机可读存储介质 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101251584A (zh) * | 2008-04-09 | 2008-08-27 | 武汉大学 | 三轴磁强计校正方法以及三轴磁梯度计校正方法 |
US20110301897A1 (en) * | 2010-06-02 | 2011-12-08 | Stefan Weiss | Calibration of a triaxial magnetic field sensor |
-
2013
- 2013-10-12 CN CN201310487366.1A patent/CN103591973A/zh active Pending
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101251584A (zh) * | 2008-04-09 | 2008-08-27 | 武汉大学 | 三轴磁强计校正方法以及三轴磁梯度计校正方法 |
US20110301897A1 (en) * | 2010-06-02 | 2011-12-08 | Stefan Weiss | Calibration of a triaxial magnetic field sensor |
Non-Patent Citations (1)
Title |
---|
庞鸿锋等: "基于高斯牛顿迭代算法的三轴磁强计校正", 《仪器仪表学报》 * |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103885020A (zh) * | 2014-03-28 | 2014-06-25 | 卢兆兴 | 一种基于自适应遗传算法的三轴磁强计误差校正技术 |
CN103885020B (zh) * | 2014-03-28 | 2017-01-25 | 卢兆兴 | 一种基于自适应遗传算法的三轴磁强计误差校正方法 |
CN106501868A (zh) * | 2016-10-17 | 2017-03-15 | 中国矿业大学(北京) | 三轴地磁传感器实时校正方法 |
CN106501868B (zh) * | 2016-10-17 | 2018-06-26 | 中国矿业大学(北京) | 三轴地磁传感器实时校正方法 |
CN106840247A (zh) * | 2017-04-13 | 2017-06-13 | 深圳怡化电脑股份有限公司 | 一种传感器线性校正方法和装置 |
CN109541704A (zh) * | 2018-12-05 | 2019-03-29 | 加泰科(深圳)科技有限公司 | 一种三轴磁通门航磁测量系统及矫正补偿方法 |
CN109459711A (zh) * | 2018-12-26 | 2019-03-12 | 中国船舶重工集团公司第七〇九研究所 | 一种水下高精度磁场测量系统 |
CN110118948A (zh) * | 2019-06-04 | 2019-08-13 | 中国科学院上海微系统与信息技术研究所 | 一种基于超导量子干涉仪的总场测量方法及装置 |
CN112327618A (zh) * | 2020-10-21 | 2021-02-05 | 江南大学 | 贪婪正交最小二乘法及基于此方法的参数与时滞辨识方法 |
CN112327618B (zh) * | 2020-10-21 | 2022-07-15 | 江南大学 | 传感器网络系统的参数与时滞辨识方法 |
CN113758515A (zh) * | 2021-08-16 | 2021-12-07 | 深圳市睿联技术股份有限公司 | 零点校准方法、装置、电子设备及计算机可读存储介质 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103591973A (zh) | 一种非线性最小二乘的三轴矢量传感器高精度校正方法 | |
CN107024674B (zh) | 一种基于递推最小二乘法的磁强计现场快速标定方法 | |
CN108508390B (zh) | 矢量磁传感器的标定方法及其简便标定方法 | |
CN107544042B (zh) | 一种磁力计阵列校正方法 | |
CN103852085B (zh) | 一种基于最小二乘拟合的光纤捷联惯导系统现场标定方法 | |
CN103941309B (zh) | 地磁传感器校准设备及其方法 | |
CN107797080A (zh) | 采用nmr设备实现霍尔传感器校准标定的设备和方法 | |
Estler | Uncertainty analysis for angle calibrations using circle closure | |
Lee et al. | Magnetic tensor sensor for gradient-based localization of ferrous object in geomagnetic field | |
CN106896337A (zh) | 用于磁传感器校准的方法 | |
CN105157723A (zh) | 一种基于光纤陀螺的捷联惯导系统的标定方法 | |
CN108982918A (zh) | 基准不确定情况下加速度计组合误差系数分离与标定方法 | |
CN102298121B (zh) | 一种三轴磁场线圈正交角度的测量方法 | |
Jager et al. | SWARM Absolute Scalar Magnetometer accuracy: analyses and measurement results | |
CN103235278B (zh) | 一种测量磁强计三磁轴之间的正交性的方法 | |
Yang et al. | Hybrid calibration method for three-axis gradiometer | |
Zikmund et al. | Precise scalar calibration of a tri-axial Braunbek coil system | |
CN109633510B (zh) | 基于地面备份单机的卫星磁强计磁环境分析方法 | |
Ji et al. | Integrated compensation method of three-axis magnetometer in geomagnetic navigation | |
CN105758422B (zh) | 一种积分式闭环光纤陀螺的测试方法 | |
Dorveaux et al. | On-the-field calibration of an array of sensors | |
CN207586410U (zh) | 采用nmr设备实现霍尔传感器校准标定的设备 | |
CN110987000A (zh) | 一种准确测量激光陀螺零偏磁场灵敏度的方法 | |
CN102445230A (zh) | 相位差法测定双轴磁传感器正交度的方法及装置 | |
CN107037380B (zh) | 一种宽磁场范围测量方法及装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for 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: 20140219 |