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

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

Correction method of direction error of magnetic compass and correction method of navigation error of underwater autonomous vehicle

The present invention provides a magnetic compass error correction method and AUV Navigation error correction method, which belongs to the technical field of autonomous navigation of unmanned underwater navigation devices, including magnetic compass error correction method: the current time to get the magnetic compass provides direction; calculate the hard magnetic interference generated half cycle error of magnetic compass according to the current time course; according to the current time course obtained magnetic compass quadrant error; soft magnetic interference and installation error caused by the circumferential magnetic compass error acquisition; according to the circular magnetic compass error, magnetic compass error and semi circle magnetic compass quadrant error calculation error of magnetic compass at the moment; the error of magnetic compass at the moment the current feedback to the magnetic compass course of magnetic compass is used to calculate the current, obtained after correction The course of the moment. The invention has the advantages of low cost, easy operation and wide application range, and improves the reliability of the correction result of navigation error.

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

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

【技术特征摘要】
1.一种磁罗盘航向误差修正方法，其特征在于，包括以下步骤：获取磁罗盘提供的当前时刻的航向；根据所述当前时刻的航向计算获得硬磁场干扰产生的磁罗盘半圆周误差；根据所述当前时刻的航向计算获得磁罗盘象限误差；获取软磁场干扰及安装误差产生的磁罗盘圆周误差；根据所述磁罗盘圆周误差、磁罗盘半圆周误差和磁罗盘象限误差计算获得当前时刻的磁罗盘误差；将所述当前时刻的磁罗盘误差反馈给磁罗盘提供的当前时刻的航向，对磁罗盘航向进行修正计算，获得修正后的当前时刻的航向。2.根据权利要求1所述的磁罗盘航向误差修正方法，其特征在于，所述磁罗盘半圆周误差的计算公式为：其中，为磁罗盘半圆周误差，为磁罗盘提供的当前时刻的航向，和为补偿系数。3.根据权利要求1或2所述的磁罗盘航向误差修正方法，其特征在于，所述磁罗盘象限误差的计算公式为：其中，为磁罗盘象限误差，为磁罗盘提供的当前时刻的航向，和为补偿系数。4.根据权利要求1-3任一项所述的磁罗盘航向误差修正方法，其特征在于，所述当前时...

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