基于地磁强度和梯度的地磁匹配导航方法技术

技术编号:9237221 阅读:319 留言:0更新日期:2013-10-10 00:45
本发明专利技术公开了一种基于地磁强度和梯度的地磁匹配导航方法,其特征在于:1)建立基于积分形式指标函数的正则化模型;2)采用离散化手段对正则化模型进行极小化求解,得线性方程组;3)采用迭代算法求解方程组;4)根据方程组的解修正轨迹,得到匹配结果。该技术利用了地磁场强度信息以及地磁场强度的梯度信息,采用迭代算法实现地磁匹配导航,能够有效的解决地磁等值线匹配算法中匹配精度、匹配步长和匹配算法实时性相互制约的问题。

【技术实现步骤摘要】

【技术保护点】
一种基于地磁强度和梯度的地磁匹配导航方法,其特征在于:?(1)建立基于积分形式指标函数的正则化模型:?其中,s为待匹配轨迹,m为待匹配轨迹上某点对应的地磁数据库中磁场强度,?为该点在地磁数据库中磁场强度的梯度,x为经度坐标,y为纬度坐标,e=[ex,ey]T为该点与真实轨迹对应点在x和y方向上的偏差,l为磁强计在该点的实际磁场测量值,为该点与真实轨迹对应点经度偏差的梯度,为该点与真实轨迹对应点纬度偏差的梯度,λ是拉格朗日乘数,根据地磁数据库中坐标量纲的大小选择λ,使?与处于同一数量级。?(2)采用离散化手段对上述模型进行极小化求解,得如下方程组?其中i=1,2,…,N,N为待匹配总的点数,mi为待匹配轨迹上第i点对应的地磁数据库中磁场强度,为地磁数据库中磁场强度的梯度在第i点上的数值,exi为待匹配轨迹第i点与真实轨迹对应点的经度偏差,eyi为待匹配轨迹第i点与真实轨迹对应点的纬度偏差,li为磁强计在第i点的实际磁场测量值,?和为待匹配轨迹第i点与真实轨迹对应点经度偏差平均值和纬度偏差平均值,按如下方式计算:?(3)对式(2)采用迭代算法求解,求解出待匹配轨迹第i点与真实轨迹对应点的经度偏差exi和纬度偏差eyi。?(4)匹配结果为?其中pxi为匹配结果第i点的经度,pyi为匹配结果第i点的纬度,rxi为待匹配轨迹第i点的经度,ryi为待匹配轨迹第i点的纬度。?FSA0000092411730000011.tif,FSA0000092411730000012.tif,FSA0000092411730000013.tif,FSA0000092411730000014.tif,FSA0000092411730000015.tif,FSA0000092411730000016.tif,FSA0000092411730000017.tif,FSA0000092411730000018.tif,FSA0000092411730000019.tif,FSA00000924117300000110.tif,FSA00000924117300000111.tif,FSA00000924117300000112.tif...

【技术特征摘要】

【专利技术属性】
技术研发人员:解伟男屈桢深李清华白俊林
申请(专利权)人:哈尔滨工业大学
类型:发明
国别省市:

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1