一种地磁航向误差修正方法与流程

文档序号:20357057发布日期:2020-04-10 23:25阅读:来源:国知局

技术特征:

1.一种地磁航向误差修正方法,其特征在于,所述方法包括:

利用地磁传感器获取地磁航向ψm;

建立地磁航向误差表,地磁航向误差表分为360段,分别与地磁航向ψm的0-360°一一对应;

在卫星导航接收机定向标志字有效的情况下,对地磁航向误差表进行更新,得到更新后的地磁航向误差表δψmi(i=1...360);

对更新后的地磁航向误差表δψmi(i=1...360)进行平滑处理,得到平滑后的地磁航向误差表

在卫星导航接收机定向标志字无效的情况下,基于平滑后的地磁航向误差表和地磁航向ψm获取修正后的地磁航向ψ。

2.根据权利要求1所述的一种地磁航向误差修正方法,其特征在于,所述对地磁航向误差表进行更新,得到更新后的地磁航向误差表δψmi(i=1...360)包括:

利用卫星导航接收机获取卫星航向ψg;

基于地磁航向ψm和卫星航向ψg获取地磁航向误差δψm;

确定地磁航向误差表中与地磁航向ψm对应的段数;

基于地磁航向ψm对应的段数获取上一时刻的地磁航向误差修正值δψmj,k-1;

基于地磁航向误差δψm和上一时刻的地磁航向误差修正值δψmj,k-1获取当前时刻的地磁航向误差修正值δψmj,k;

将当前时刻的地磁航向误差修正值δψmj,k更新到地磁航向误差表中,得到更新后的地磁航向误差表δψmi(i=1...360)。

3.根据权利要求2所述的一种地磁航向误差修正方法,其特征在于,通过下式获取当前时刻的地磁航向误差修正值δψmj,k:

δψmj,k=αδψmj,k-1+(1-α)δψm,

式中,α为滤波器平滑系数。

4.根据权利要求1-3中任一项所述的一种地磁航向误差修正方法,其特征在于,所述基于平滑后的地磁航向误差表和地磁航向ψm获取修正后的地磁航向ψ包括:

确定平滑后的地磁航向误差表中与地磁航向ψm对应的段数;

基于地磁航向ψm对应的段数获取平滑后的地磁航向误差修正值

基于平滑后的地磁航向误差修正值修正地磁航向ψm获取修正后的地磁航向ψ。

5.根据权利要求4所述的一种地磁航向误差修正方法,其特征在于,通过下式获取修正后的地磁航向ψ:

6.根据权利要求2所述的一种地磁航向误差修正方法,其特征在于,通过下式获取地磁航向误差δψm:

δψm=ψg-ψm。

7.根据权利要求1-3中任一项所述的一种地磁航向误差修正方法,其特征在于,通过下式获取平滑后的地磁航向误差表

式中,n为平滑窗口。


技术总结
本发明提供了一种地磁航向误差修正方法,所述方法包括:利用地磁传感器获取地磁航向ψM;建立地磁航向误差表,地磁航向误差表分为360段,分别与地磁航向ψM的0‑360°一一对应;在卫星导航接收机定向标志字有效的情况下,对地磁航向误差表进行更新,得到更新后的地磁航向误差表δψMi(i=1...360);对更新后的地磁航向误差表δψMi(i=1...360)进行平滑处理,得到平滑后的地磁航向误差表在卫星导航接收机定向标志字无效的情况下,基于平滑后的地磁航向误差表和地磁航向ψM获取修正后的地磁航向ψ。本发明的技术方案在卫星导航接收机定向标志字有效时对地磁航向误差进行建模,在卫星导航接收机定向标志字无效时利用所建立的地磁航向误差模型对地磁航向进行修正,从而保证航向精度。

技术研发人员:徐超;张东明;孟现春;张界林;于华男;吴衍记
受保护的技术使用者:北京自动化控制设备研究所
技术研发日:2019.11.28
技术公布日:2020.04.10
当前第2页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1