发明内容

(一)解决的技术问题

针对现有技术的不足，本发明提供了一种基于多方法融合的深水高精度导航定位技术，解决了水下导航定位技术存在的问题。

(二)技术方案

为实现以上目的，本发明通过以下技术方案予以实现：一种基于多方法融合的深水高精度导航定位技术，包括水声定位系统、惯性导航系统、地图匹配定位系统和多传感器数据融合定位系统，对水声定位系统、惯性导航系统、地图匹配定位系统和多传感器数据融合定位系统进行连接融合，在使用前需要通过多普勒计程仪、压力传感器对惯性导航系统进行初步的修正，水声定位系统由基阵、换能器、水下应答器组成，通过测定声波信号传播时间或相位差，进行水下定位，利用水声定位系统测定的信息可以为作为信息融合的输入，为惯性导航系统的累计误差修正提供参考数据，所述地图匹配定位系统为利用视觉、声纳传感器构建水下高精度地图，传感器不断采集信息后生成三维点云数据，经过前端、后端、回环检测等过程，生成用于导航和定位的高精度地图，高精度地图的构建是进行地图匹配的基础，通过水声定位系统和惯性导航系统可以确定水下机器人的大概位置，缩小局部搜索的范围。在已知水下机器人姿态信息的情况下，将传感器的实时数据与预先制作好的高精度地图数据变换到同一个坐标系内进行匹配，匹配成功后可以得到水下机器人的位置信息，所述多传感器数据融合定位系统的输入信息主要来自惯性导航系统、水声定位系统、地图匹配定位系统，通过数据融合算法实现多传感器数据的融合，完成状态估计，输出可靠的导航定位信息，多传感器信息融合是实现多个定位系统融合的前提，多传感器独立获得信息后，进行多级别、多方位和多层次的处理，产生最佳协同的信息，达到单一传感器无法实现的效果。

优选的，所述基于多方法融合的深水高精度导航定位技术主要为通过缆线实现地面设备与换能器之间的通信，以声波为载体实现换能器与应答器之间的信息交流，通过水上设备与水下设备的协同工作，完成水上与水下的通讯，实现高精度实时导航定位。

优选的，所述惯性导航系统包括惯性测量单元、信号预处理和机械力学编排模块惯性测量单元主要包括3个相互正交的单轴加速度计和3个相互正交的单轴陀螺仪，根据机械力学编排形式的不同，可以将惯性导航系统分为平台式惯性导航系统和捷联式惯性导航系统。

优选的，所述惯性导航测量单元的工作原理为：惯性导航系统是一种以陀螺仪和加速度计为感知原件的导航参数解算系统，通过由陀螺仪和加速度计组成的惯性测量单元完成数据信息的采集，通过加速度计测量载体相对惯性空间的绝对加速度和重力加速度之和，经过加速度计坐标系投影变换、重力补偿、速度和位置积分解算后输出速度计位置信息，陀螺仪可以采集载体相对于惯性坐标系的角加速度信号，姿态积分解算后输出姿态信息。

优选的，所述地图匹配定位系统的工作原理为：高精度地图是进行地图匹配的基础，包含用于地图匹配的特征，利用水声定位系统和惯性导航系统可以判断水下机器人的大概位置，确定地图匹配的局部搜索范围，通过惯性导航系统判断水下机器人的姿态，姿态信息用于指导地图匹配，基于感知信息生成实时点云数据，将点云数据与高精度地图信息变换到同一个坐标系中内进行匹配，匹配成功后即可确认定位信息。

(三)有益效果

本发明提供了一种基于多方法融合的深水高精度导航定位技术。具备以下有益效果：

多方法融合的水下定位系统可以有效的避免水声定位系统更新频率低、实时性相对较差、易受环境影响、当机器人被障碍物遮挡时信号传输可能会受到干扰等缺点。惯性导航系统信息更新速度快，一定时间内可以提供连续的、较高精度的定位信息，但其误差会随着系统运行时间而累积，造成导航失效。地图匹配定位系统可以提供高精度的定位信息，但随着地图信息的增加，搜索区域将会增大，造成匹配效率下降等缺陷，通过信息融合的方法可以实现高效、高精度、高可靠性的水下导航定位，指导水下机器人完成各种复杂任务。

本发明的导航定位精度是其他单一导航方法无法实现的，水下导航定位精度可以达到厘米级。在导航的实时性方面，该方法也具备较好的表现，完全满足水下机器人高精度、高实时性的导航定位需求。通过多方法融合，使得水下导航可以克服深水环境的影响，提高了导航定位的可靠性。在达到同等导航精度的前提下，地图匹配效率远高于使用单一方法的地图匹配定位系统，显示出了该方法的高效性。