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

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

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

【技术实现步骤摘要】
全域磁罗盘航向误差修正方法及水下自主航行器导航误差修正方法
本专利技术涉及水下无人自主航行器导航
，具体涉及一种全域磁罗盘航向误差修正方法及水下自主航行器导航误差修正方法。
技术介绍
AUV（AutonomousUnderwaterVehicle，自主式水下航行器）是一种可以自主地完成水下探测、攻击、运载、打捞等多种特定作业任务的水下航器，要求其在水下具有长期自主的定位导航和返航能力，并具有隐蔽性。为了保证其顺利解决水下作业，对AUV提出了更高的导航精度要求。水下无人自主航行器导航误差大小直接影响其导航精度，以往以航位推算为导航算法的水下无人自主航行器主要通过单方面更换更高精度的磁罗盘和速度传感器；或者单方面更换复杂的导航滤波算法、改进导航计算模型，或者单方面对磁罗盘航向信息进行滤波来完成导航误差修正。随着水下无人自主航行器的发展，更换更高精度的姿态及速度传感器的方法难以满足人们对成本控制的要求；更换复杂的导航滤波算法很难有效的提高导航精度，在可靠性及适用性大打折扣；单方面对磁罗盘航向信息进行滤波不能从根本上解决航向信息失真的问题。因此导航误差修正需要从传感器信息根源着手，形成一套完整的修正方法，同时应考虑修正方法的可靠性、易用性及修正效果，才能最终达到有效提高导航精度的目的。
技术实现思路
因此，为了克服现有技术中的上述缺陷，从而提供一种全域磁罗盘航向误差修正方法及水下自主航行器导航误差修正方法。为此，本专利技术实施例的一种全域磁罗盘航向误差修正方法，包括以下步骤：获取磁罗盘提供的当前时刻的航向和水下无人自主航行器工作区域位置的磁偏角；根据所述当前时刻的航向计算获得硬磁场干扰产生的磁罗盘半圆周误差；根据所述当前时刻的航向计算获得磁罗盘象限误差；获取软磁场干扰及安装误差产生的磁罗盘圆周误差；根据所述磁罗盘圆周误差、磁罗盘半圆周误差和磁罗盘象限误差计算获得当前时刻的磁罗盘误差；将所述当前时刻的磁罗盘误差反馈给磁罗盘提供的当前时刻的航向，结合所述磁偏角对磁罗盘航向进行修正计算，获得修正后的当前时刻的航向。优选地，获取水下无人自主航行器工作区域位置的磁偏角的步骤包括：根据全球坐标经纬度及磁偏角变化的规律，以经纬度为预设角度值的S×S方格编制数据单元表，根据方格中央位置上的磁偏角基值、磁偏角在方格内经度方向上及纬度方向上的变化率及磁偏角的月变化率确定数据单元表的内容，根据水下无人自主航行器工作区域的经纬度及日期查数据单元表获取磁偏角，其中S为自然数。优选地，所述磁罗盘半圆周误差的计算公式为：其中，为磁罗盘半圆周误差，为磁罗盘提供的当前时刻的航向，和为补偿系数。优选地，所述磁罗盘象限误差的计算公式为：其中，为磁罗盘象限误差，为磁罗盘提供的当前时刻的航向，和为补偿系数。优选地，所述当前时刻的磁罗盘误差的计算公式为：其中，为当前时刻的磁罗盘误差，为软磁场干扰及安装误差产生的磁罗盘圆周误差，为磁罗盘提供的当前时刻的航向，、、和为补偿系数。优选地，所述对磁罗盘航向进行修正计算的公式为：其中，为修正后的当前时刻的航向，为磁罗盘提供的当前时刻的航向，为当前时刻的磁罗盘误差，为磁偏角。优选地，还包括：对所述修正后的当前时刻的航向进行滤波平滑，获得滤波平滑后的下一时刻的航向。优选地，所述滤波平滑的计算公式为：其中，为滤波平滑后的下一时刻的航向，为修正后的当前时刻的航向，为修正后的下一时刻的航向，和为滤波系数，。本专利技术实施例的一种水下自主航行器导航误差修正方法，包括以下步骤：采用上述的磁罗盘航向误差修正方法，获得航向；将所述航向引入航位推算，获得经纬度值。本专利技术实施例的技术方案，具有如下优点：1.提高导航误差修正结果的可靠性。在导航算法输入传感器信息之前，先对磁罗盘信息进行磁场补偿、安装误差角修正、磁偏角修正，再对航向信息进行输出平滑滤波处理之后才输出给导航算法；对导航算法的信息来源到信息输出逐步进行修正，保证了导航算法输入的可靠性，从根源上逐步减小导航误差。2.传感器信息滤波算法结构更简单、易实现、实用性强。在保证滤波效果的基础上，采用滤波对传感器输出信息进行输出滤波平滑，与目前现有技术中采用的五点二次方法、卡尔曼滤波算法、53H算法、基于数据变化率的平滑算法等算法，滤波结构更简单、参数调节更易操作、工程应用更广的优点。3.成本低、易操作、适用范围广。通过修正导航误差的算法提高导航精度，没有增加硬件成本，间接降低了提高导航精度的成本。整套方法简便易操作，适用于不同型号的磁罗盘。附图说明为了更清楚地说明本专利技术具体实施方式中的技术方案，下面将对具体实施方式描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图是本专利技术的一些实施方式，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。图1为本专利技术实施例1中全域磁罗盘航向误差修正方法的一个具体示例的流程图；图2为未对航向信息做任何处理的推算位置与GPS位置对比图；图3为对航向信息采用滤波平滑前后航向信息对比图；图4为对磁罗盘进行磁场补偿、安装误差角及磁偏角修正后推算位置与GPS位置对比图；图5为采用本专利技术实施例2中水下自主航行器导航误差修正方法的推算位置与GPS位置对比图。具体实施方式下面将结合附图对本专利技术的技术方案进行清楚、完整地描述，显然，所描述的实施例是本专利技术一部分实施例，而不是全部的实施例。基于本专利技术中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本专利技术保护的范围。下面所描述的本专利技术不同实施方式中所涉及的技术特征只要彼此之间未构成冲突就可以相互结合。实施例1本实施例提供一种全域磁罗盘航向误差修正方法，适用于水下无人自主航行器工作区域位置发生较大变化时，即全域范围内均可适用，如图1所示，包括以下步骤：S1、获取磁罗盘提供的当前时刻的航向和水下无人自主航行器工作区域位置的磁偏角；S2、根据当前时刻的航向计算获得硬磁场干扰产生的磁罗盘半圆周误差；S3、根据当前时刻的航向计算获得磁罗盘象限误差；S4、获取软磁场干扰及安装误差产生的磁罗盘圆周误差；S5、根据磁罗盘圆周误差、磁罗盘半圆周误差和磁罗盘象限误差计算获得当前时刻的磁罗盘误差；S6、将当前时刻的磁罗盘误差反馈给磁罗盘提供的当前时刻的航向，结合所述磁偏角对磁罗盘航向进行修正计算，获得修正后的当前时刻的航向。上述磁罗盘航向误差修正方法，通过根据磁罗盘圆周误差、磁罗盘半圆周误差和磁罗盘象限误差计算获得当前时刻的磁罗盘误差，提高了磁罗盘误差的计算精度，从而提高了磁罗盘航向的修正精度。优选地，步骤S1中，获取水下无人自主航行器工作区域位置的磁偏角的步骤包括：根据全球坐标经纬度及磁偏角变化的规律，以经纬度为预设角度值（如1°-3°，优选2°）的S×S方格编制数据单元表，根据方格中央位置上的磁偏角基值、磁偏角在方格内经度方向上及纬度方向上的变化率及磁偏角的月变化率确定数据单元表的内容，根据水下无人自主航行器工作区域的经纬度及日期查数据单元表获取磁偏角，其中S为自然数，例如S=2。优选地，步骤S2中，磁罗盘半圆周误差的计算公式为：其中，为磁罗盘半圆周误差，为磁罗盘提供的当前时刻的航向，和为补偿系数。优选地，步骤S3中，磁罗盘象限误差的计算公式为：其中，本文档来自技高网...

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

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

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