全域磁罗盘航向误差修正方法及水下自主航行器导航误差修正方法技术

本发明专利技术提供一种全域磁罗盘航向误差修正方法及水下自主航行器导航误差修正方法，属于水下无人自主航行器导航技术领域，其中全域磁罗盘航向误差修正方法包括：获取磁罗盘提供的当前时刻的航向和水下无人自主航行器工作区域位置的磁偏角；根据当前时刻的航向计算获得硬磁场干扰产生的磁罗盘半圆周误差和磁罗盘象限误差；获取软磁场干扰及安装误差产生的磁罗盘圆周误差；根据磁罗盘圆周误差、磁罗盘半圆周误差和磁罗盘象限误差计算获得磁罗盘误差；将当前时刻的磁罗盘误差反馈给当前时刻的航向，结合磁偏角对磁罗盘航向进行修正计算获得修正后的当前时刻的航向。本发明专利技术具有成本低、易操作、适用范围广的优点，提高了导航误差修正结果的可靠性。

Correction method of heading error of whole domain magnetic compass and correction method for navigation error of underwater autonomous vehicle

【技术实现步骤摘要】
全域磁罗盘航向误差修正方法及水下自主航行器导航误差修正方法
本专利技术涉及水下无人自主航行器导航
，具体涉及一种全域磁罗盘航向误差修正方法及水下自主航行器导航误差修正方法。
技术介绍
AUV（AutonomousUnderwaterVehicle，自主式水下航行器）是一种可以自主地完成水下探测、攻击、运载、打捞等多种特定作业任务的水下航器，要求其在水下具有长期自主的定位导航和返航能力，并具有隐蔽性。为了保证其顺利解决水下作业，对AUV提出了更高的导航精度要求。水下无人自主航行器导航误差大小直接影响其导航精度，以往以航位推算为导航算法的水下无人自主航行器主要通过单方面更换更高精度的磁罗盘和速度传感器；或者单方面更换复杂的导航滤波算法、改进导航计算模型，或者单方面对磁罗盘航向信息进行滤波来完成导航误差修正。随着水下无人自主航行器的发展，更换更高精度的姿态及速度传感器的方法难以满足人们对成本控制的要求；更换复杂的导航滤波算法很难有效的提高导航精度，在可靠性及适用性大打折扣；单方面对磁罗盘航向信息进行滤波不能从根本上解决航向信息失真的问题。因此导航误差修正需要从传感器信息根源着手，形成本文档来自技高网...

【技术保护点】
一种全域磁罗盘航向误差修正方法，其特征在于，包括以下步骤：获取磁罗盘提供的当前时刻的航向和水下无人自主航行器工作区域位置的磁偏角；根据所述当前时刻的航向计算获得硬磁场干扰产生的磁罗盘半圆周误差；根据所述当前时刻的航向计算获得磁罗盘象限误差；获取软磁场干扰及安装误差产生的磁罗盘圆周误差；根据所述磁罗盘圆周误差、磁罗盘半圆周误差和磁罗盘象限误差计算获得当前时刻的磁罗盘误差；将所述当前时刻的磁罗盘误差反馈给磁罗盘提供的当前时刻的航向，结合所述磁偏角对磁罗盘航向进行修正计算，获得修正后的当前时刻的航向。

【技术特征摘要】
1.一种全域磁罗盘航向误差修正方法，其特征在于，包括以下步骤：获取磁罗盘提供的当前时刻的航向和水下无人自主航行器工作区域位置的磁偏角；根据所述当前时刻的航向计算获得硬磁场干扰产生的磁罗盘半圆周误差；根据所述当前时刻的航向计算获得磁罗盘象限误差；获取软磁场干扰及安装误差产生的磁罗盘圆周误差；根据所述磁罗盘圆周误差、磁罗盘半圆周误差和磁罗盘象限误差计算获得当前时刻的磁罗盘误差；将所述当前时刻的磁罗盘误差反馈给磁罗盘提供的当前时刻的航向，结合所述磁偏角对磁罗盘航向进行修正计算，获得修正后的当前时刻的航向。2.根据权利要求1所述的磁罗盘航向误差修正方法，其特征在于，获取水下无人自主航行器工作区域位置的磁偏角的步骤包括：根据全球坐标经纬度及磁偏角变化的规律，以经纬度为预设角度值的S×S方格编制数据单元表，根据方格中央位置上的磁偏角基值、磁偏角在方格内经度方向上及纬度方向上的变化率及磁偏角的月变化率确定数据单元表的内容，根据水下无人自主航行器工作区域的经纬度及日期查数据单元表获取磁偏角，其中S为自然数。3.根据权利要求1或2所述的磁罗盘航向误差修正方法，其特征在于，所述磁罗盘半圆周误差的计算公式为：其中，为磁罗盘半圆周误差，为磁罗盘提供的当前时刻的航向，和为补偿系数。4.根据权利要求1-3...

【专利技术属性】
技术研发人员：蔡挺，杨晶，潘常军，黄江成，陈建峰，王英，
申请(专利权)人：西安天和海防智能科技有限公司，
类型：发明
国别省市：陕西,61