发明内容
本发明旨在至少解决现有技术或相关技术中存在的技术问题之一,为此本发明提供了一种无人艇停泊方法、装置及计算机可读存储介质,从而实现对无人艇的精准姿态停放,方便应用于狭窄空间的停放。
本发明实施例提供的具体技术方案如下:
第一方面,提供了一种无人艇自主停泊方法,所述方法包括:
GNSS全局引导:在无人艇接收到入港指令后,执行预先设定的入港任务,进入低速航迹航向保持区域,并使所述无人艇的航向航迹误差处于在一定范围内,以准备进入标签可视区域;
标签像素引导:在进入所述标签可视区域后,根据所述标签可视区域内预设的色块标签,启动标签引导程序,精细调节无人艇姿态进入船坞泊位;
若所述标签像素引导过程中出现连续丢像素帧或者航向航迹偏差超过预设范围,则将重置引导任务至所述低速航迹航向保持区域。
进一步地,所述GNSS全局引导过程中,根据所述无人艇上的GNSS导航设备实时获取所述无人艇的位置和航向,并通过视线引导方法调整所述无人艇的航行偏距和偏航。
进一步地,所述GNSS全局引导具体包括:
在所述无人艇接收到入港指令后,根据泊位位置和入口方向执行高速回港任务,直至进入所述低速航迹航向保持区域;
在进入所述低速航迹航向保持区域后,执行低速回港任务以准备进入所述标签可视区域。
进一步地,所述标签引导程序采用嵌套控制方式,其外层为航迹航向保持控制器,内层为标签像素瞄准控制器,只有当航向航距偏差小于预设范围时才触发内层的标签像素瞄准控制器。
进一步地,所述标签像素瞄准控制器为PID控制器。
进一步地,所述标签像素瞄准控制器的结构如下:
其中,u为基准值,e为特征像素与图像中心的偏差,T
s为伺服周期,K
p、T
i、T
d为离线可调参数。
进一步地,所述标签像素引导进一步包括:
触发所述航迹航向保持控制器检测当前航向航迹偏差是否超过预设范围;
若超过,则重置引导任务到低速航迹航向保持区域进行重新引导;
若未超过,则触发所述标签像素瞄准控制器对所述色块标签进行探测稳定像素位置,并判断在一定时间内是否探测到稳定像素;
若未探测到,则重置引导任务到所述低速航迹航向保持区域进行重新引导;
若探测到,则触发所述标签像素瞄准控制器运行内层伺服环以增稳当前航行姿态,使得无人艇以准确的姿态进入狭窄的入口。
进一步地,所述标签像素引导进一步还包括:
当探测到的所述色块标签大于预设阈值时,确定所述内层伺服环失效;
若预设时长内未检测到成功入港/坞的信号,则重置引导任务到所述低速航迹航向保持区域重新引导,否则确定成功完成入港任务。
第二方面,提供了一种无人艇自主停泊装置,所述装置包括:
GNSS全局引导模块,用于在无人艇接收到入港指令后,执行预先设定的入港任务,进入低速航迹航向保持区域,并使所述无人艇的航向航迹误差处于在一定范围内,以准备进入标签可视区域;
标签像素引导模块,用于在进入所述标签可视区域后,根据所述标签可视区域内预设的色块标签,启动标签引导程序,精细调节无人艇姿态进入船坞泊位;
引导任务重置模块,用于若所述标签像素引导过程中出现连续丢像素帧或者航向航迹偏差超过预设范围,则将重置引导任务至所述低速航迹航向保持区域。
第三方面,提供了一种无人艇,所述无人艇上设置有视觉模块、GNSS模块以及如第二方面所述的无人艇自主停泊装置。
本发明实施例提供的技术方案带来的有益效果是:
(1)低成本:采用低成本的视觉模块或单目摄像头以及通用GNSS模块,在保证精度的条件下,降低技术门槛。
(2)安全稳定:将无人艇自主进港分为多个阶段,同时采用双层嵌套控制方案,将视觉图像短距离精度高和GNSS全天候实时的特点相融合,有效保障无人艇入港/坞的稳定性和安全性。
(3)精度高:在依托GNSS无人艇的姿态大误差控制下,利用短距离作用但精度高的图像伺服以增加进坞/港的姿态刚度,从而提高进港/坞的精度,适用于狭小空间的无人艇停放。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
实施例一
本发明实施例提供了一种无人艇自主停泊方法,如图1所示,该方法可以包括GNSS全局引导过程和标签像素引导过程,其中:
GNSS全局引导:在无人艇接收到入港指令后,执行预先设定的入港任务,进入低速航迹航向保持区域,并使无人艇的航向航迹误差处于在一定范围内,以准备进入标签可视区域。
具体地,GNSS全局引导可以包括两个阶段:高速航迹航向保持阶段和低速航迹航向保持阶段。在高速航迹航向保持阶段,无人艇在接收到入港指令后,根据泊位位置和入口方向执行高速回港任务,直至进入低速航迹航向保持区域,这里,入港指令用于指示无人艇被允许入港停泊。在低速航迹航向保持阶段,自动降低无人艇速度,为进入标签可视区域做准备,保证航迹航向偏差在设定的范围之内。
标签像素引导:在进入标签可视区域后,根据标签可视区域内预设的色块标签,启动标签引导程序,精细调节无人艇姿态进入船坞泊位,若标签像素引导过程中出现连续丢像素帧或者航向航迹偏差超过预设范围,则将重置引导任务至低速航迹航向区域。
其中,标签可视区域为泊位或船坞入口区域,在泊位或船坞入口处设置色块标签,通过调整无人艇主摄像头的角度,确保无人艇靠近泊位时能探测到色块标签。本发明中对泊位色块标签不作过多要求和限定,可以设置成例如长方形、正多边形、圆形等,方便识别即可。
具体地,无人艇可以通过获取泊位色块标签在相机图像中的中心像素位置信息,调整合适的控制量来控制无人艇平稳进入船坞或泊位。在无人艇在入港过程中,可以首先通过GNSS实时调整导航路线航行到港口区域,使得色块标签处于摄像头视场(相机摄像头固定于无人艇艇体正前方),并配合视觉图像控制方式提高停泊精度。
进一步地,GNSS全局引导过程中,根据无人艇上的GNSS导航设备实时获取无人艇的位置和航向,并通过视线引导方法调整无人艇的航行偏距和偏航。
进一步地,GNSS全局引导具体可以包括:
在无人艇接收到入港指令后,根据泊位位置和入口方向执行高速回港任务,直至进入低速航迹航向保持区域,在进入低速航迹航向保持区域后,执行低速回港任务以准备进入标签可视区域。
进一步地,标签引导程序采用嵌套控制方式,其外层为航迹航向保持控制器,内层为标签像素瞄准控制器,只有当航向航距偏差小于预设范围时才触发内层的标签像素瞄准控制器。优选地,标签像素瞄准控制器为PID控制器。
进一步地,标签像素瞄准控制器的结构如下:
其中,u为基准值,e为特征像素与图像中心的偏差,T
s为伺服周期,K
p、T
i、T
d为离线可调参数。
进一步地,标签像素引导可以包括:
触发航迹航向保持控制器检测当前航向航迹偏差是否超过预设范围;
若超过,则重置引导任务到低速航迹航向保持区域进行重新引导;
若未超过,则触发标签像素瞄准控制器对色块标签进行探测稳定像素位置,并判断在一定时间内是否探测到稳定像素;
若未探测到,则重置引导任务到低速航迹航向保持区域进行重新引导;
若探测到,则触发标签像素瞄准控制器运行内层伺服环以增稳当前航行姿态,使得无人艇以准确的姿态进入狭窄的入口。
具体地,标签像素瞄准控制器获取相机摄像头实时采集的色块标签图像,若探测到色块标签的中心像素点,则运行内层伺服环,根据中心像素点的位置和图像平面的中心位置偏差,计算得到速度控制量,通过速度控制量增稳当前航行姿态,使得无人艇以准确的姿态进入狭窄的入口。
进一步地,标签像素引导还包括:
当探测到的色块标签大于预设阈值时,确定内层伺服环失效;
若预设时长内未检测到成功入港/坞的信号,则重置引导任务到低速航迹航向保持区域重新引导,否则确定成功完成入港任务。
本发明实施例提供的一种无人艇自主停泊方法,通过采用低成本的视觉模块或单目摄像头以及通用GNSS模块,在保证精度的条件下,降低技术门槛;通过将无人艇自主进港分为多个阶段,同时采用双层嵌套控制方案,将视觉图像短距离精度高和GNSS全天候实时的特点相融合,有效保障无人艇入港/坞的稳定性和安全性;通过在依托GNSS无人艇的姿态大误差控制下,利用短距离作用但精度高的图像伺服以增加进坞/港的姿态刚度,从而提高进港/坞的精度,适用于狭小空间的无人艇停放。
下面结合图2进行说明本发明实施例提供的方法。图2为本发明实施例提供的一种无人艇自主停泊流程示意图。
(1)判断是否收到入港指令,若收到,则执行步骤(2);
(2)基于GNSS,执行高速航迹航向保持跟踪入港;
(3)基于GNSS,判断是否进入低速航迹航向保持区域,若否,则继续执行高速航迹航向保持跟踪入港,若是,则执行步骤(4);
(4)基于GNSS,执行低速航迹航向保持跟踪入港;
(5)基于GNSS,判断是否进入标签可视区域,若是,则执行步骤(6),若否,则重置引导任务到低速入港区域重新引导;
(6)启动图像标签检测;
(7)基于GNSS,检测当前航向航迹偏差是否在设定范围内,若是,则执行步骤(8),否则,重置引导任务到低速入港区域重新引导;
(8)根据标签像素,执行图像引导入港,若成功完成入港任务,则结束,否则,重置引导任务到低速入港区域重新引导。
实施例二
本发明实施例提供了一种无人艇自主停泊装置,如图3所示,该装置包括:
GNSS全局引导模块,用于在无人艇接收到入港指令后,执行预先设定的入港任务,进入低速航迹航向保持区域,并使无人艇的航向航迹误差处于在一定范围内,以准备进入标签可视区域;
标签像素引导模块,用于在进入标签可视区域后,根据标签可视区域内预设的色块标签,启动标签引导程序,精细调节无人艇姿态进入船坞泊位;
引导任务重置模块,用于若标签像素引导过程中出现连续丢像素帧或者航向航迹偏差超过预设范围,则将重置引导任务至低速航迹航向保持区域。
进一步地,GNSS全局引导模块具体用于:
根据无人艇上的GNSS导航设备实时获取无人艇的位置和航向,并通过视线引导方法调整无人艇的航行偏距和偏航。
进一步地,GNSS全局引导模块具体用于:
在无人艇接收到入港指令后,根据泊位位置和入口方向执行高速回港任务,直至进入低速航迹航向保持区域;
在进入低速航迹航向保持区域后,执行低速回港任务以准备进入标签可视区域。
进一步地,标签像素引导程序采用嵌套控制方式,其外层为航迹航向保持控制器,内层为标签像素瞄准控制器,只有当航向航距偏差小于预设范围时才触发内层的标签像素瞄准控制器。
进一步地,标签像素瞄准控制器为PID控制器。
进一步地,标签像素瞄准控制器的结构如下:
其中,u为基准值,e为特征像素与图像中心的偏差,T
s为伺服周期,K
p、T
i、T
d为离线可调参数。
进一步地,标签像素引导模块触发航迹航向保持控制器检测当前航向航迹偏差是否超过预设范围;
若超过,则引导任务重置模块重置引导任务到低速航迹航向保持区域进行重新引导;
若未超过,则标签像素引导模块触发标签像素瞄准控制器对色块标签进行探测稳定像素位置,并判断在一定时间内是否探测到稳定像素;
若未探测到,则引导任务重置模块重置引导任务到低速航迹航向保持区域进行重新引导;
若探测到,则标签像素引导模块触发标签像素瞄准控制器运行内层伺服环以增稳当前航行姿态,使得无人艇以准确的姿态进入狭窄的入口。
进一步地,当标签像素瞄准控制器探测到的色块标签大于预设阈值时,标签像素引导模块确定内层伺服环失效;
若标签像素引导模块预设时长内检测到成功入港/坞的信号,则确定成功完成入港任务,否则引导任务重置模块重置引导任务到低速航迹航向保持区域重新引导。
本实施例提供的无人艇自主停泊装置,与本发明实施例所提供的无人艇自主停泊方法属于同一发明构思,可执行本发明实施例所提供的无人艇自主停泊方法,具备执行无人艇自主停泊方法相应的功能模块和有益效果。未在本实施例中详尽描述的技术细节,可参见本发明实施例提供的无人艇自主停泊方法,此处不再加以赘述。
此外,本发明实施例还提供一种无人艇,该无人艇无人艇上设置有视觉模块、GNSS模块以及如上述实施例任一所述的无人艇自主停泊装置。
尽管已描述了本发明实施例中的优选实施例,但本领域内的技术人员一旦得知了基本创造性概念,则可对这些实施例作出另外的变更和修改。所以,所附权利要求意欲解释为包括优选实施例以及落入本发明实施例中范围的所有变更和修改。
显然,本领域的技术人员可以对本发明进行各种改动和变型而不脱离本发明的精神和范围。这样,倘若本发明的这些修改和变型属于本发明权利要求及其等同技术的范围之内,则本发明也意图包含这些改动和变型在内。