一种采用机器视觉和惯导融合的水面导航方法

技术领域

本发明涉及无人船水面导航技术领域，具体涉及一种采用机器视觉和惯导融合的水面导航方法。

背景技术

随着自动化水平日益提高，水面无人作业船舶的研究愈来愈迫切，无人作业船的航迹控制研究更是其中的热点问题。可靠的无人作业船导航系统不仅是无人作业船实现自主作业的基本保障，还是判断系统的自动化程度的主要标准。船舶的导航精度和可靠性制约着无人船舶的自主作业水平，这也成为实现水产养殖自动化的一道瓶颈。

如专利号为201810975531.0的发明公开了一种无人艇基于毫米波雷达的跟踪和避障系统，包括无人艇和设置在无人艇上的毫米波雷达、卫星定位系统、惯性导航系统、主控计算机，其中，毫米波雷达均匀安装在无人艇的周围，测量无人艇前方、后方和左右两侧的环境相对于无人艇的位置、速度和加速度信息，所述卫星定位系统和惯性导航系统检测无人艇的位置、速度和加速度信息，所述卫星定位系统、惯性导航系统、毫米波雷达通过电缆与主控计算机连接。

如专利号为201910875242.8的发明公开了一种基于自适应联邦卡尔曼滤波的无人船组合导航方法，利用无人船组合导航系统进行导航，所述无人船组合导航系统包括SINS、GPS、Compass和嵌入式处理器。所述嵌入式处理器内采用自适应联邦卡尔曼滤波算法进行传感器信息融合，输出无人船的位置、速度和姿态信息。该发明应用了无人船SINS/GPS/Compass组合导航的误差模型和观测模型，减小各个子系统之间的故障干扰，提高无人船导航系统的可靠性与稳定性。

目前无人船系统深度依赖于高精度卫星导航系统，但在狭窄内陆水道环境下，卫星信号容易受到河岸植被、河道旁建筑以及桥梁的遮挡，导致卫星导航系统定位精度显著下降，在这种情况下，内河航道的准确定位与导航，依赖于对无人船与周围环境的感知；而在内河中，水面上的雾和强光反射会降低激光雷达探测精度；对于视觉系统，水面雾气和强光反射，岸边物体的反射和雨滴引起的涟漪也会带来干扰。此外，不同于路面车辆，水面上船只的横向漂移较大，船只的运动模型更为复杂，给精确定位带来新的挑战。因此，很有必要研发一种新型高精度水面导航方法。

发明内容

本发明针对背景技术所提出的的问题，而设计了一种采用机器视觉和惯导融合的水面导航方法，解决城市河流水域复杂、卫星信号差等导航难题，可自动驾驶连续作业水域面积比达95％。

本发明是通过以下技术方案实现的：

一种采用机器视觉和惯导融合的水面导航方法，包括以下步骤：

(1)在船身上布置RTK定位系统、惯性导航系统、毫米波雷达及视觉感知设备，然后将会它们全部接入船身内部的船端工控计算机，船端工控计算机内部装载船载主控软件；

(2)通过RTK定位系统结合惯性导航系统测量无人船艇的实时速度，再由船端工控计算机将RTK定位系统和惯性导航系统测量的速度传入毫米波雷达，标定船体当前的运动信息，视觉感知设备通过对拍摄的图像信息进行特征提取、检测，最后通过卡尔曼滤波融合算法实现精确地定位；

(3)岸基端综合显控系统通过无线以太网络与船端工控计算机建立通讯连接，并获取船端数据，实现对无人船运动状态和设备状态的实时显示和更新，并对异常情况进行报警；

(4)岸基端设置有全局性航线规划模块，再根据具体的任务目标以调用栅格化方法计算一条规划的航线，岸基端的控制指令发送模块向无人船发送即时的全局航线数据；

(5)船端工控计算机接收到全局航线数据时，并在此基础上进行障碍物碰撞危险的判断并计算避碰策略，将相应的运动指令发送到下位机PLC，下位机PLC根据船载主控软件发送给它的控制命令，生成相应的舵角和转速命令，驱动无人船对应的执行机构，以完成对无人船的运动控制。

作为对上述方案的进一步改进，所述RTK定位系统、惯性导航系统、毫米波雷达及视觉感知设备的工作基于障碍物距离模型算法，障碍物距离模型算法中10～100m范围目标使用毫米波雷达自动生成点云参与导航；0～10m近距离目标使用视觉感知设备进行三维实时重建参与导航；卫星数≤10颗时惯性导航系统参与导航，卫星数＞11颗时RTK定位系统参与导航。

作为对上述方案的进一步改进，所述下位机PLC与所述船端工控计算机之间双向电性连接，所述下位机PLC的信号输出端与信号切换器电学连接，所述信号切换器的信号输出端与无人船的舵机、电子调速器电性连接。

作为对上述方案的进一步改进，所述船身上还布置交换机，所述交换机同样与所述船端工控计算机之间双向电性连接，所述交换机与所述视觉感知设备之间双向电性连接。

作为对上述方案的进一步改进，所述RTK定位系统基于载波相位观测值的实时动态定位方法，实时地提供检测点在指定坐标系中的维定位结果，并达到厘米级精度；所述RTK定位系统在作业模式下，基准站通过数据链将其观测值和测站坐标信息一起传送给流动站，流动站不仅通过数据链接收来自基准站的数据，还要采集GPS观测数据，并在系统内组成差分观测值进行实时处理，同时给出厘米级定位结果。

作为对上述方案的进一步改进，所述岸基端上还设立数据管理模块并建立数据库，对船端传回的实时运动数据、设备状态数据进行存储，以供后续的分析和处理。

作为对上述方案的进一步改进，所述步骤(4)中栅格化方法需使用栅格化地图，所述栅格地图是由许多精细粒度的栅格构成，每个栅格代表了地图中的一个小区域即是环境信息，可以将地图表示为：

作为对上述方案的进一步改进，所述栅格化地图中每个栅格与一个二值占用变量对应，即是代表该栅格是否被占用的概率，其中每个栅格被占据的概率为：ρ(n|x

其中，每个栅格的状态有两种，一种为占据用1表示，另外的一种为空闲用0表示，那么根据二值化概率的方法每个栅格被占据的状态为：

为了避免概率接近0或者1的截断问题，采用对数占用概率来表示：

则每个栅格的后验概率为：

作为对上述方案的进一步改进，所述船端工控计算机使用Linux系统作为操作系统，通过串口连接STM32F103处理器。

作为对上述方案的进一步改进，所述步骤(5)中在进行障碍物碰撞危险的判断并计算避碰策略时，先预测环境障碍物的运动状态，计算无人船与目标障碍之间的最近会遇距离和最近会遇时间，分析碰撞风险，并且在存在碰撞可能的前提下，调用速度障碍模型算法，计算局部最优避碰策略并发送给执行机构，当碰撞不可避免时，直接执行减速停车操作。

与现有技术相比，本发明的有益效果是：RTK定位系统、惯性导航系统、毫米波雷达及视觉感知设备

1、本发明首次采用RTK定位系统、惯性导航系统、机器视觉、毫米波雷达及多传感器数据融合组合导航和定位技术，在存在卫星信号的环境下，利用各种传感器构建组合导航系统，利用各种传感器和船只自身的运动学信息辅助卫星导航系统，提高卫星导航系统精度；当卫星信号不可用时，利用自身的传感器和环境信息尽量辅助惯性导航系统保持导航定位精度。

2、本发明解决了城市河流水域复杂、卫星信号差等导航难题，可自动驾驶连续作业水域面积比达95％，因此开展了城市内河无人系统导航和定位技术发展的新方向；同时具有较好的可靠性和稳定性，能够指导水面无人艇完成基本的航线规划跟踪和自主避障任务。

附图说明

为了更清楚地说明本发明实施例的技术方案，下面将对实施例描述所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。

图1为本发明无人船控制系统架构框图；

图2为本发明无人船自主导航的系统控制策略图；

图3为本发明中地图栅格化的结构示意图；

图4为本发明在栅格地图上规划处航线的示意图。

具体实施方式

为了使本技术领域的人员更好地理解本申请方案，下面将结合本申请实施例中的附图，对本申请实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本申请一部分的实施例，而不是全部的实施例。基于本申请中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都应当属于本申请保护的范围。

下面结合附图对本发明的技术方案进一步说明。

实施例1

如图1和图2所示，一种采用机器视觉和惯导融合的水面导航方法，包括以下步骤：

(1)在船身上布置RTK定位系统、惯性导航系统、毫米波雷达及视觉感知设备，然后将会它们全部接入船身内部的船端工控计算机，船端工控计算机使用Linux系统作为操作系统，通过串口连接STM32F103处理器，船端工控计算机内部装载船载主控软件；

(2)通过RTK定位系统结合惯性导航系统测量无人船艇的实时速度，再由船端工控计算机将RTK定位系统和惯性导航系统测量的速度传入毫米波雷达，标定船体当前的运动信息，视觉感知设备通过对拍摄的图像信息进行特征提取、检测，最后通过卡尔曼滤波融合算法实现精确地定位；

(3)岸基端综合显控系统通过无线以太网络与船端工控计算机建立通讯连接，并获取船端数据，实现对无人船运动状态和设备状态的实时显示和更新，并对异常情况进行报警；

(4)岸基端设置有全局性航线规划模块，再根据具体的任务目标以调用栅格化方法计算一条规划的航线，岸基端的控制指令发送模块向无人船发送即时的全局航线数据，岸基端上还设立数据管理模块并建立数据库，对船端传回的实时运动数据、设备状态数据进行存储，以供后续的分析和处理；

(5)船端工控计算机接收到全局航线数据时，并在此基础上进行障碍物碰撞危险的判断并计算避碰策略，将相应的运动指令发送到下位机PLC，下位机PLC根据船载主控软件发送给它的控制命令，生成相应的舵角和转速命令，驱动无人船对应的执行机构，以完成对无人船的运动控制。

RTK定位系统、惯性导航系统、毫米波雷达及视觉感知设备的工作基于障碍物距离模型算法，障碍物距离模型算法中10～100m范围目标使用毫米波雷达自动生成点云参与导航；0～10m近距离目标使用视觉感知设备进行三维实时重建参与导航；卫星数≤10颗时惯性导航系统参与导航，卫星数＞11颗时RTK定位系统参与导航；由此可知，在存在卫星信号的环境下，利用各种传感器构建组合导航系统，利用各种传感器和船只自身的运动学信息辅助卫星导航系统，提高卫星导航系统精度；当卫星信号不可用时，利用自身的传感器和环境信息尽量辅助惯性导航系统保持导航定位精度。

下位机PLC与船端工控计算机之间双向电性连接，下位机PLC的信号输出端与信号切换器电学连接，信号切换器的信号输出端与无人船的舵机、电子调速器电性连接；船身上还布置交换机，交换机同样与船端工控计算机之间双向电性连接，交换机与视觉感知设备之间双向电性连接。

其中，RTK定位系统基于载波相位观测值的实时动态定位方法，实时地提供检测点在指定坐标系中的维定位结果，并达到厘米级精度；RTK定位系统在作业模式下，基准站通过数据链将其观测值和测站坐标信息一起传送给流动站，流动站不仅通过数据链接收来自基准站的数据，还要采集GPS观测数据，并在系统内组成差分观测值进行实时处理，同时给出厘米级定位结果。

在进行障碍物碰撞危险的判断并计算避碰策略时，先预测环境障碍物的运动状态，计算无人船与目标障碍之间的最近会遇距离和最近会遇时间，分析碰撞风险，并且在存在碰撞可能的前提下，调用速度障碍模型算法，计算局部最优避碰策略并发送给执行机构，当碰撞不可避免时，直接执行减速停车操作，由此可见，该导航方法具有较好的可靠性和稳定性，能够指导水面无人艇完成基本的航线规划跟踪和自主避障任务。

实施例2

实施例2在实施例1的基础上，如图3和图4所示，栅格化方法需使用栅格化地图，栅格地图是由许多精细粒度的栅格构成，每个栅格代表了地图中的一个小区域即是环境信息，可以将地图表示为：

栅格化地图中每个栅格与一个二值占用变量对应，即是代表该栅格是否被占用的概率，其中每个栅格被占据的概率为：，ρ(n|x

每个栅格的状态有两种，一种为占据用1表示，另外的一种为空闲用0表示，那么根据二值化概率的方法每个栅格被占据的状态为：

为了避免概率接近0或者1的截断问题，采用对数占用概率来表示：

则每个栅格的后验概率为：

综合实施例1和实施例2，本发明是首次采用RTK定位系统、惯性导航系统、机器视觉、毫米波雷达及多传感器数据融合组合导航和定位技术，在存在卫星信号的环境下，利用各种传感器构建组合导航系统，利用各种传感器和船只自身的运动学信息辅助卫星导航系统，提高卫星导航系统精度；当卫星信号不可用时，利用自身的传感器和环境信息尽量辅助惯性导航系统保持导航定位精度；解决了城市河流水域复杂、卫星信号差等导航难题，可自动驾驶连续作业水域面积比达95％；同时具有较好的可靠性和稳定性，能够指导水面无人艇完成基本的航线规划跟踪和自主避障任务，

以上所述仅为本发明的较佳实施例而已，并不用以限制本发明，凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等，均应包含在本发明的保护范围之内。