电子罗盘自适应方位角矫正方法
摘要文本
本发明公开了一种电子罗盘自适应方位角矫正方法，包括电子罗盘在校准地对三轴磁传感器和三轴加速度计进行温度校准、正交性校准、倾角解算以及倾斜补偿校准；在校准地搭建一标准磁场环境进行参数计算，包括对校准地的环境磁场校准、构造电子罗盘的方位角计算式α、磁北锁定并解算此时的方位角标记为到α0；在应用场所对电子罗盘进行自适应校准。本发明既能实现对磁干扰进行识别并实现自动干扰剔除，也能不依靠同时移动罗盘和安装载体的校准方式来提升校准精度，降低环境磁场校准时对安装载体移动的要求，达到对罗盘输出方位角矫正的目的，增加了罗盘在应用端的适应能力。使用了本方法后，电子罗盘校准得到了简化，且方位角精度得到了提升。
申请人信息
- 申请人:西南应用磁学研究所(中国电子科技集团公司第九研究所)
- 申请人地址:621000 四川省绵阳市滨河北路西段268号
- 发明人: 西南应用磁学研究所(中国电子科技集团公司第九研究所)
专利详细信息
| 项目 | 内容 |
|---|---|
| 专利名称 | 电子罗盘自适应方位角矫正方法 |
| 专利类型 | 发明申请 |
| 申请号 | CN202410006208.8 |
| 申请日 | 2024/1/3 |
| 公告号 | CN117537792A |
| 公开日 | 2024/2/9 |
| IPC主分类号 | G01C17/38 |
| 权利人 | 西南应用磁学研究所(中国电子科技集团公司第九研究所) |
| 发明人 | 唐宝权; 张芦; 白雪; 彭根斋; 文鸿琛; 张志红; 袁荟烽; 郭缘; 徐元兵 |
| 地址 | 四川省绵阳市滨河北路西段268号 |
专利主权项内容
1.一种电子罗盘自适应方位角矫正方法，其特征在于，包括以下步骤：(1)电子罗盘置于校准地，对电子罗盘的三轴磁传感器和三轴加速度计进行温度校准，得到三轴磁传感器和三轴加速度计对应的温度校准参数矩阵和；TjmTjg(2)对三轴磁传感器和三轴加速度计进行正交性校准，得到三轴磁传感器对应的正交误差矩阵、零偏误差矩阵，三轴加速度计对应的正交误差矩阵、零偏误差矩阵；ApmBpmApgBpg(3)对电子罗盘进行倾角解算以及倾斜补偿校准，得到俯仰角、横滚角、倾斜补偿后的X轴磁场值、倾斜补偿后的Y轴磁场值；ηγMIxMIy(4)在校准地搭建一标准磁场环境，完成参数计算与记录，包括步骤(41)~(43)；(41)在标准磁场环境下，用椭圆校准方法对校准地的环境磁场校准，并构造电子罗盘的方位角计算式；
(1)，式中，为方位角，、分别为旋转偏置角后的X轴磁场值和Y轴磁场值，为椭圆校准后X轴偏移量、为椭圆校准后Y轴偏移量、为环境磁场补偿后的X轴磁场、为环境磁场补偿后的Y轴磁场；αM’IxM’IyθBcxBcyMCxMCy(42)查询校准地的地磁偏角、根据地理北极和确定校准地的地球磁北方向M，使电子罗盘北向指向M，完成校准地的磁北锁定；φ0φ000(43)获取此时环境磁场补偿后的X轴磁场，环境磁场补偿后的Y轴磁场、俯仰角、横滚角、正交性校准后的三轴磁场值，代入方位角计算式解算，解算结果标记为；M0CxM0Cyη0γ0MPxyz0αα0(5)在应用场所对电子罗盘进行自适应校准，包括步骤(51)~(56)；(51)确定电子罗盘在应用场所的安装位置，查询安装位置的地磁偏角φ，与φ比对，当差值≤0.5°时，直接进入下一步，否则在安装位置搭建一标准磁场环境，重复步骤(4)更新后再进入下一步；10α0(52)根据地理北极和确定安装位置的地球磁北方向M，使电子罗盘北向指向M，完成安装位置的磁北锁定；φ111(53)获取此时环境磁场补偿后的X轴磁场，环境磁场补偿后的Y轴磁场、俯仰角、横滚角、正交性校准后的三轴磁场值，代入方位角计算式解算α，解算结果标记为θ；M1CxM1Cyη1γ1M1Pxyz1(54)根据下式进行干扰磁场存在检测；若－≤Δ，安装位置无磁场干扰，方位角为θ，无需矫正；|M1PzM0Pz|MPz1若－|＞Δ，安装位置存在磁场干扰，进入步骤(55)；|M1PzM0PzMPz式中，为中的Z轴磁场值，为中的Z轴磁场值，Δ为Z轴磁场变化阈值，通过实验测得；M1PzM1PxyzMPz0M0PxyzMPz(55)在安装位置，旋转电子罗盘至任一位置2，按步骤(53)方法解算此时的，解算结果标记为θ，计算自适应方位角ε，ε=θ-θ；α22212(56)根据下式对自适应方位角进行补偿，得到补偿后方位角α’；
(2)，
(3)，公式(2)中，k为方位角补偿置信因子，为补偿方位角；1公式(3)中，为标准磁场与干扰磁场矢量夹角，为位置2处干扰磁场下方位角，k为补偿比例系数，/>为补偿方位角修正量。ω2 （macrodatas.cn） （来 自 马 克 数 据 网）