[发明专利]基于拉格朗日乘数法的地磁矢量测量系统误差校正方法有效
申请号: | 201710067382.3 | 申请日: | 2017-02-07 |
公开(公告)号: | CN106990451B | 公开(公告)日: | 2018-10-19 |
发明(设计)人: | 张琦;万成彪;潘孟春;陈棣湘;刘中艳;孙晓永;吴凤贺 | 申请(专利权)人: | 中国人民解放军国防科学技术大学 |
主分类号: | G01V13/00 | 分类号: | G01V13/00 |
代理公司: | 国防科技大学专利服务中心 43202 | 代理人: | 曹德斌 |
地址: | 410073 湖*** | 国省代码: | 湖南;43 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | 本发明属于磁测量领域,具体涉及一种基于拉格朗日乘数法的地磁矢量测量系统误差校准方法,包括以下步骤:(S1)选取校准区域,在区域中心位置设置一个无磁平台,用质子磁力仪测量无磁平台上方的地磁场总量;(S2)将地磁矢量测量系统封装在一个无磁L面箱体中,将箱体放置在无磁平面上;(S3)翻转无磁L面箱体,依次使箱体的每个面作为底面放置在无磁平台上;当每个面作为底面时,使L面箱体绕无磁平台的垂轴等角度差值旋转R个姿态,记录每个姿态时刻的三轴磁传感器和惯导系统的输出值;(S4)建立线性方程组,以地磁场总量作为约束条件,联合求解,得到综合误差模型参数;进一步得到校准后的地理坐标系和磁传感器坐标系下的地磁矢量值。 | ||
搜索关键词: | 基于 拉格朗日 乘数 地磁 矢量 测量 系统误差 校正 方法 | ||
【主权项】:
1.一种基于拉格朗日乘数法的地磁矢量测量系统误差校正方法,其特征在于,包括以下步骤:(S1)选取校准区域,在区域中心位置设置一个无磁平台,用质子磁力仪测量无磁平台上方的地磁场总量,记作:Te;(S2)将地磁矢量测量系统封装在一个无磁L面箱体中,L≥4且取整数,将箱体放置在无磁平面上;所述地磁矢量测量系统包括三轴磁传感器和惯导系统;所述惯导系统由陀螺仪和加速度计组成;(S3)翻转无磁L面箱体,依次使箱体的每个面作为底面放置在无磁平台上;当每个面作为底面时,使六面箱体绕无磁平台的垂轴等角度差值旋转R个姿态,R≥4,且取整数,记录每个姿态时刻的三轴磁传感器输出值和惯导系统的输出值;(S4)根据步骤(S3)中所有姿态下的三轴磁传感器和惯导系统输出值,建立线性方程组,以步骤(S1)中地磁场总量作为约束条件,联合求解,得到综合误差模型参数;进一步得到校准后的地理坐标系和磁传感器坐标系下的地磁矢量值;具体步骤为:(S41)建立线性方程组记为ATAX=λDX,求线性方程组ATAX=λDX的广义特征值λi和特征向量ai得到(λi,ai),(i=1,2,...,15),其中矩阵A为三轴磁传感器和三轴惯性元件输出值构成的3N×15矩阵;N=L×R是翻转姿态数;
(S42)选取广义特征值λi(i=1,2,...,15)中对应于最小正特征值λk的那组特征向量ak,令
T表示转置符号,则最优估计矢量为μkak;(S43)根据最优估计矢量分别计算以下地磁矢量和综合误差模型参数:
其中
表示地磁场矢量在地理坐标系下的投影矢量估计值,
是综合干扰系数,
是综合偏置磁场;
表示矩阵
的逆矩阵;(S44)根据所述综合误差模型参数,根据下式计算:![]()
对地磁矢量测量系统测得的磁场值进行实时校准,得到校准后的地理坐标系下的地磁矢量值
和磁传感器坐标系下的地磁矢量值
其中Tin是惯导坐标系至地理坐标系的欧拉旋转矩阵,由惯导系统输出数据构成,Bt1为三轴磁传感器的测量值,
表示矩阵Tin的逆矩阵。
下载完整专利技术内容需要扣除积分,VIP会员可以免费下载。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于中国人民解放军国防科学技术大学,未经中国人民解放军国防科学技术大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/patent/201710067382.3/,转载请声明来源钻瓜专利网。