CN110632920A - 一种无人船控制方法 - Google Patents
一种无人船控制方法 Download PDFInfo
- Publication number
- CN110632920A CN110632920A CN201910806185.8A CN201910806185A CN110632920A CN 110632920 A CN110632920 A CN 110632920A CN 201910806185 A CN201910806185 A CN 201910806185A CN 110632920 A CN110632920 A CN 110632920A
- Authority
- CN
- China
- Prior art keywords
- ship
- propeller
- module
- laser ranging
- unmanned
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/0206—Control of position or course in two dimensions specially adapted to water vehicles
Abstract
本发明公开了一种无人船控制方法,应用于无人船控制系统,所述系统包括:岸基监控子系统、下位机控制子系统、推进器控制子系统、舵机控制模块、螺旋桨控制模块、图像采集模块、激光测距模块、通信模块、温湿度模块,其中,无人船包括:船体,包括第一船体结构和第二船体结构;连接结构,连接结构连接第一船体结构和第二船体结构;密闭防水箱,对称设置于第一船体结构第二船体结构之间;推进器组,包括第一组推进器和第二组推进器,第一组推进器位于船体一端的连接结构上,第二组推进器位于船体另一端的连接结构上,且推进器组沿着中线对称分布,中线为第一船体结构和第二船体结构所对应的中线。应用本发明,适应大型无人船的控制和结构改进。
Description
技术领域
本发明涉及无人船技术领域,尤其涉及一种无人船控制方法。
背景技术
无人船是一种依靠自身携带的能源进行自主航行的水面平台,其体量小、吃水浅,无人船是因水面反恐、探测等需求而发展起来的新型智能水面机器人。
目前,国内外的无人船种类繁多,小型无人船如:无人测绘船、无人探测船、水质采样检测无人船等,小型无人船多为一体结构;而大型无人货船目前只是停留在概念阶段,并没有实际应用的无人货船,更缺乏无人船的自动运行控制方法。
发明内容
本发明的目的在于提供一种无人船控制方法,旨在提供一种适应大型无人船的自动控制运行方法。
为了实现上述目的,本发明提供一种无人船控制方法,应用于无人船控制系统,所述系统包括:岸基监控子系统、下位机控制子系统、推进器控制子系统、舵机控制模块、螺旋桨控制模块、图像采集模块、激光测距模块、通信模块、温湿度模块;
所述无人船控制方法包括离岸控制方法,所述离岸控制方法包括步骤:
岸基监控子系统发送离岸指令;
下位机控制子系统将GPS或北斗接收机的无人船的位置与岸基监控子系统下发的目的地进行比较,从而规划出最佳路径;所述下位机控制子系统发出控制指令给舵机控制模块,以控制舵机旋转至垂直船体的位置;
图像采集模块采集船舶周围环境,包括水岸、船舶正前方和正后方的物体;位于船舶一侧的4个激光测距模块实时测量船舶离岸的距离,任意两个激光测距模块所测距离之差不大于±10cm;以及,利用船艏、艉4个激光测距模块实时测量船舶离前后障碍物的距离,在每个激光测距模块所测距离均大于 100cm,通过舵机控制模块调整舵机旋转至平行于船体的位置,螺旋桨加速运行,驶离泊位;
通信模块向所述岸基监控子系统发送完成离岸的信号。
一种实现方式中,所述无人船控制方法包括靠岸控制方法,所述靠岸控制方法包括步骤:
所述通信模块接收所述岸基监控子系统发送的靠岸指令;
所述下位机控制子系统将GPS或北斗接收机的无人船的位置与所述岸基监控子系统下发的目的地进行比较,从而规划出最佳路径;
所述舵机控制模块调整船舶姿态,直到船舶一侧4激光测距模块都能测到离岸距离,并且任意两个激光测距模块所测距离之差不大于±10cm;
所述下位机控制子系统发送指令至所述舵机控制模块,使舵机旋转至垂直船体的位置,控制螺旋桨运行,使无人船进行泊位;
所述图像采集模块采集船舶周围环境,并利用船艏、艉前后4个激光测距模块实时测量船舶离前后物体的距离,并且每个激光测距模块所测距离都大于 50cm,并在船舶一侧4个激光测距模块实时测量船舶离岸的距离小于10cm,停止螺旋桨运行;
所述通信模块向所述岸基监控子系统发送完成靠岸的信号。
一种实现方式中,所述无人船控制方法包括避障控制方法,所述避障控制方法包括步骤:
所述岸基监控子系统发送自主航行指令;
所述下位机控制子系统将GPS或北斗接收机的无人船的位置与岸基监控子系统下发的目的地进行比较,规划出最佳路径;
所述图像采集模块,获得障碍物的轮廓信息;
所述下位机控制子系统发送指令给推进器控制子系统,使得螺旋桨减速,将遇到障碍物的信息通过所述通信模块发送给所述岸基监控子系统;
所述激光测距模块实时监测与障碍物的距离,在船艏任意一个激光测距模块距离小于100cm,螺旋桨停止运行;
所述下位机控制子系统发送指令至所述舵机控制模块,使舵机旋转至垂直船体的位置,螺旋桨运行,使船舶平移,直到船艏两个激光测距模块距离均超过100cm,以及,所述下位机控制子系统发送指令至所述舵机控制模块,使舵机旋转至平行船体的位置,螺旋桨运行,直至完全绕开障碍物,并通过所述通信模块发送新的位置信号给岸基监控子系统,所述下位机控制子系统将GPS或北斗接收机获得无人船的位置重新与岸基监控子系统下发的目的地进行比较,再次规划出最佳路径,继续航行。
一种实现方式中,所述无人船控制方法包括故障控制方法,所述故障控制方法包括步骤:
温湿度模块发送温湿度报警信号至所述下位机控制子系统;
所述下位机控制子系统发送指令至推进器控制子系统,以使得螺旋桨控制模块减速或停车;
所述通信模块发送温湿度报警信号至所述岸基监控子系统。
一种实现方式中,所述无人船还包括:
船体,包括第一船体结构和第二船体结构,所述第一船体结构和所述第二船体结构为对称结构;
连接结构,所述连接结构连接所述第一船体结构和所述第二船体结构;
密闭防水箱,对称设置于所述第一船体结构所述第二船体结构之间;
以及,推进器为推进器组,包括第一组推进器和第二组推进器,所述第一组推进器位于所述船体一端的所述连接结构上,所述第二组推进器位于所述船体另一端的所述连接结构上,且所述推进器组沿着中线对称分布,所述中线为所述第一船体结构和所述第二船体结构所对应的中线;
所述图像采集模块设置于所述连接结构的上方,且位于所述第一组推进器的中心线上;
多个激光测距模块对称设置于所述第一船体结构、所述第二船体结构上和所述连接结构上;
舵机控制模块,通过下位机与所述图像采集模块和所述多个激光测距模块相连。
一种实现方式中,所述密闭防水箱包括:第一电池密闭防水箱、第二电池密闭防水箱和其他设备密闭防水箱,所述他设备密闭防水箱设置于所述第一电池密闭防水箱和所述第二电池密闭之间,且所述第一电池密闭防水箱、所述第二电池密闭防水箱、述其他设备密闭防水箱、所述第一船体结构和所述第二船体结构为对称设置。
一种实现方式中,所述第一推进器组与所述第二推进器组呈对称设置,均包括两个推进器。
一种实现方式中,所述多个激光测距模块包括四组激光测距模块;
第一组激光测距模块设置于所述第一船体结构上方,且位于第一边长的两端;
第二组激光测距模块设置于所述第二船体结构上方,且位于第二边长的两端;
第三组激光测距模块设置于所述连接结构的所述第一边长上方;
第四组激光测距模块设置于所述连接结构的所述第二边长上方;
所述第一边长为所述连接结构位于所述第一船体结构上方的部分;
所述第二边长为所述连接结构位于所述第二船体结构上方的部分。
一种实现方式中,每一个推进器通过推进器连接部件连接至所述连接结构,所述推进器连接部件包括:安装座、卡槽、推进器连杆、固定件;
所述安装座的底部固定设置于所述连接结构,所述卡槽设置于所述安装座的一侧,所述推进器连杆的一端通过所述固定件固定于所述卡槽,所述推进器连杆的一端连接有推进器。
一种实现方式中,第一电池密闭防水箱、第二电池密闭防水箱;
所述第一推进器组、所述第二推进器组、所述下位机和所述舵机控制模块分别与所述第一电池密闭防水箱和所述第二电池密闭防水箱内的电源模块相连本发明提供的无人船,具有有益效果:
(1)自动实现无人船的离岸控制、靠岸控制、避障控制和故障控制。
(2)双体船,包括对称设置的第一船体结构和第二船体结构,无人船的材质为聚氯乙烯(PVC),船体由可充气式的聚氯乙烯(PVC)材料制成,可实现船体的折叠,方便运输和携带。此外,采用双体船的结构优点,提高了无人船的适航性和平稳性;
(3)船体的外形是两端朝外的V形尖端,中部为圆柱体状,可以大大地减小无人船航行中的兴波阻力。第一船体结构和第二船体结构的内部均构造为独立的密闭气室,可以减轻船体的重量,从而可以提高无人船的有效载荷并降低驱动装置的能耗,例如推进器的能耗;
(4)通过连接结构所搭建的平台,以便搭载各种实验仪器,实现一船多用的功能;
(5)通过安装座上开有多组螺纹孔,可以根据不同的水深环境,调节推进器的吃水深度,使无人船适应各种水域环境;
(6)激通过光测距模块为围绕船体四周的12个激光测距仪,其中船艏2 个,船艉2个,无人船左右舷侧各4个,用以实时获取无人船前方、后方、左右舷侧及障碍物的距离信息;
(7)形成整体对称的船体结构,易于在水面平稳行驶。
附图说明
图1是本发明实施例的一种无人船控制方法的流程示意图。
图2是本发明实施例的一种无人船的俯视示意图。
图3是本发明实施例的一种无人船的侧视示意图。
图4是本发明实施例的一种无人船的前视示意图。
图5是本发明实施例的一种无人船的后视示意图。
图6为本发明的安装座示意图。
图7为本发明无人船离岸控制结构示意图。
图8为本发明无人船离岸控制流程图。
图9为本发明无人船靠岸控制流程图。
图10为本发明无人船避碰控制流程图。
图11为本发明无人船离岸控制示意图。
图12为本发明无人船靠岸控制示意图。
图13为本发明无人船避障控制示意图。
具体实施方式
以下通过特定的具体实例说明本发明的实施方式,本领域技术人员可由本说明书所揭露的内容轻易地了解本发明的其他优点与功效。本发明还可以通过另外不同的具体实施方式加以实施或应用,本说明书中的各项细节也可以基于不同观点与应用,在没有背离本发明的精神下进行各种修饰或改变。
请参阅图1-图13。需要说明的是,本实施例中所提供的图示仅以示意方式说明本发明的基本构想,遂图式中仅显示与本发明中有关的组件而非按照实际实施时的组件数目、形状及尺寸绘制,其实际实施时各组件的型态、数量及比例可为一种随意的改变,且其组件布局型态也可能更为复杂。
如图1所示,本发明实施例中的无人船控制方法,包括步骤:
S101,离岸控制方法。
离岸控制方法:无人船接收到岸基监控子系统的离岸指令,并结合GPS或北斗接收机、图像采集模块、激光测距模块采集的信息,控制舵机和螺旋桨,船舶进行离岸运动。
具体包括:当前无人船停止在固定泊位,当接收到岸基监控子系统发送的离岸指令,下位机控制子系统将GPS或北斗接收机的无人船的位置与岸基监控子系统下发的目的地进行比较,从而规划出最佳路径。下位机控制子系统发出控制指令给舵机控制模块,舵机旋转至垂直船体的位置。图像采集模块采集船舶周围环境,包括水岸、船舶正前方和正后方的物体。利用船舶一侧(如左侧) 4个激光测距模块实时测量船舶离岸的距离,同时,螺旋桨慢速运行,在螺旋桨的推力作用下,实时调整船舶姿态,使任意两个激光测距模块所测距离之差不大于±10cm;另外,利用船艏、艉4个激光测距模块实时测量船舶离前后障碍物的距离,并且每个激光测距模块所测距离都大于100cm,然后舵机旋转至平行于船体的位置,螺旋桨加速运行,驶离泊位,通过通信模块向岸基监控子系统发送完成离岸的信号。具体的,通信模块为5G或者4G通信模块。
S102,靠岸控制方法。
靠岸控制方法:无人船接收到岸基监控子系统的靠岸指令,并结合GPS或北斗接收机、图像采集模块、激光测距模块采集的信息,控制舵机和螺旋桨,船舶进行靠岸运动。
具体步骤包括:当前无人船处于航行状态,当通过通信模块接收到岸基监控子系统发送的靠岸指令,下位机控制子系统将GPS或北斗接收机的无人船的位置与岸基监控子系统下发的目的地进行比较,从而规划出最佳路径。当行驶到距泊位1.5倍船长处,螺旋桨慢速运行。利用船舶一侧(如左侧)4个激光测距模块实时测量船舶离岸的距离,并利用舵机控制模块不停地调整船舶姿态,直到4激光测距模块都能测到离岸距离,并且任意两个激光测距模块所测距离之差不大于±10cm,下位机控制子系统发送指令给舵机控制模块,使舵机旋转至垂直船体的位置,控制螺旋桨运行,使无人船慢慢靠近泊位。同时,图像采集模块采集船舶周围环境,并利用船艏、艉前后4个激光测距模块实时测量船舶离前后物体的距离,并且每个激光测距模块所测距离都大于50cm。同时,船舶一侧4个激光测距模块实时测量船舶离岸的距离小于10cm,停止螺旋桨运行,通过通信模块向岸基监控子系统发送完成靠岸的信号。
S103,避障控制方法。
避障控制方法:无人船在航行过程中,遇到障碍物,根据图像采集模块、激光测距模块采集的信息,控制舵机和螺旋桨,船舶进行避障控制,成功避障后,利用GPS或北斗接收机的无人船位置重新规划路线。
具体步骤包括:避障控制:无人船接收到岸基监控子系统发送的自主航行指令,下位机控制子系统将GPS或北斗接收机的无人船的位置与岸基监控子系统下发的目的地进行比较,从而规划出最佳路径。在航行路线上如遇静止的障碍物,基于图像采集模块,获得障碍物的轮廓信息,下位机控制子系统发送指令给推进器控制子系统,使得螺旋桨减速;同时,将遇到障碍物的信息通过通信模块发送给岸基监控子系统。等到无人船接近障碍物,船艏激光测距模块实时监测与障碍物的距离,船艏任意一个激光测距模块距离小于100cm,螺旋桨停止运行,下位机控制子系统发送指令给舵机控制模块,使舵机旋转至垂直船体的位置,螺旋桨运行,使船舶平移,直到船艏两个激光测距模块距离均超过 100cm,下位机控制子系统发送指令给舵机控制模块,使舵机旋转至平行船体的位置,螺旋桨运行,如此往复,直至完全绕开障碍物,并通过通信模块发送新的位置信号给岸基监控子系统;下位机控制子系统将GPS或北斗接收机获得无人船的位置重新与岸基监控子系统下发的目的地进行比较,再次规划出最佳路径,继续航行。
S104,故障控制方法。
故障控制方法:通过温湿度模块实时监测无人船的温度和湿度,一旦船舶出现异常温度或者湿度,发送报警信号给下位机控制子系统,将控制权交给岸基监控子系统,由岸基人员通过遥控的方式,操纵无人船就近靠泊。
具体步骤包括:若无人船的温度或湿度出现异常情况,温湿度模块发送温湿度报警信号给下位机控制子系统,由下位机控制子系统发送指令给推进器控制子系统,使得螺旋桨控制模块减速或停车;同时,下位机控制子系统通过通信模块发送温湿度报警信号给岸基监控子系统,由岸基人员通过遥控的方式,操纵无人船就近靠泊。
如图2-图5所示,无人船,包括:船体1,包括第一船体结构101和第二船体结构102,第一船体结构101和第二船体结构102为对称结构;连接结构7,连接结构7连接第一船体结构101和第二船体结构102;密闭防水箱,对称设置于第一船体结构101第二船体结构102之间;推进器组,包括第一组推进器和第二组推进器,第一组推进器位于船体一端的连接结构7上,第二组推进器位于船体另一端的连接结构7上,且推进器组沿着中线对称分布,中线为第一船体结构101和第二船体结构102所对应的中线;图像采集模块4,设置于连接结构7的上方,且位于第一组推进器的中心线上;多个激光测距模块,对称设置于第一船体结构101、第二船体结构102上和连接结构7上;舵机控制模块,通过下位机与图像采集模块4和多个激光测距模块相连。
需要说明的是,无人船船体是双体船,包括对称设置的第一船体结构101 和第二船体结构102,无人船的材质为聚氯乙烯(PVC),船体由可充气式的聚氯乙烯(PVC)材料制成,可实现船体的折叠,方便运输和携带。此外,采用双体船的结构优点,提高了无人船的适航性和平稳性。
船体的外形是两端朝外的V形尖端,中部为圆柱体状,可以大大地减小无人船航行中的兴波阻力。第一船体结构101和第二船体结构102的内部均构造为独立的密闭气室,可以减轻船体的重量,从而可以提高无人船的有效载荷并降低驱动装置的能耗,例如推进器的能耗。
连接结构7是不锈钢平台,可以设置为长方形结构,长方形的相对的两个边分别固定连接于双船体的第一船体结构101和第二船体结构102上方,连接结构7连接第一船体结构101的是第一边长71,连接第二船体结构102的是第二边长72。具体的,可以采用开放式设计连接结构7,以便搭载各种实验仪器,实现一船多用的功能。
密闭防水箱,对称设置于第一船体结构101第二船体结构102之间,具体的,密闭防水箱包括:第一电池密闭防水箱5.1、第二电池密闭防水箱5.2和其他设备密闭防水箱6,他设备密闭防水箱设置于第一电池密闭防水箱5.1和第二电池密闭之间,且第一电池密闭防水箱5.1、第二电池密闭防水箱5.2、述其他设备密闭防水箱6、第一船体结构101和第二船体结构102为对称设置。
第一电池密闭防水箱5.1、第二电池密闭防水箱5.2和其他设备密闭防水箱 6均放置于连接结构7上,可以根据其位置进行放置不同的待密闭防水处理的设备。
需要说明的是,推进器是将任何形式的能量转化为机械能的装置,通过旋转叶片或喷气(水)来产生推力的,可以用来驱动交通工具前进。
在连接结构7为长方形的条件下,除了第一边长71、第二边长72,还包括另外相对设置的第三边长73和第四边长74,第三边长73位于无人船的船头也就是前进方向的前方。
本发明的实施例中,采用四个推进器的结构设计,第三边长73上固定设置推进器3.1、推进器3.2和第四边长74上推进器3.3、推进器3.4,通过这四个推进器使得无人船能够在水域中进行前进、后退及转向操作等,提高了无人船航行的灵活性。
针对四个推进器,推进器3.1、推进器3.2、推进器3.3、推进器3.4,每个推进器除了可以带动螺旋桨旋转之外,推进器自身还可以随着垂直于推进器的轴进行270°回转(左右转角各135°),额定功率为600瓦,额定电压DC 24 伏,额定转速4000转/分钟。无人船的向前或向后推力由螺旋桨不同旋转方向产生,无人船的转向由推进器回转产生,推进器的回转由舵机控制,从而实现了灵活转弯动作,使得船舶靠离岸操纵变得更加简单,节约船舶靠离岸时间。
图像采集模块4,设置于第三边长73中线的上方,用于对运行过程中图像的采集,图像采集和处理过程为现有技术,本发明中主要是确定图像采集模块4 的位置,而不对其处理过程进行具体限定。
多个激光测距模块,对称设置于第一船体结构101、第二船体结构102上和连接结构7上。多个激光测距模块包括四组激光测距模块,第一组激光测距模块设置于第一船体结构101上方,例如为,且位于第一边长71的两端,例如为激光测距模块2.2、激光测距模块2.7;第二组激光测距模块设置于第二船体结构102上方,且位于第二边长72的两端,例如为激光测距模块2.8、激光测距模块2.1;第三组激光测距模块设置于连接结构7的第一边长71上方,例如为激光测距模块2.3、激光测距模块2.4、激光测距模块2.5、激光测距模块2.6;第四组激光测距模块设置于连接结构7的第二边长72上方,例如为激光测距模块2.9、激光测距模块2.10、激光测距模块2.11、激光测距模块2.12;第一边长71为连接结构7位于第一船体结构101上方的部分;第二边长72为连接结构7位于第二船体结构102上方的部分。
激光测距模块将实时检测船舶与泊位的距离和其他方向与障碍物的距离,保证无人船的安全。具体的,通过设置激光测距模块为围绕船体四周的12个激光测距仪,其中船艏2个,船艉2个,无人船左右舷侧各4个,用以实时获取无人船前方、后方、左右舷侧及障碍物的距离信息。
本发明中,每一个推进器对应一个卡槽,如图所示的卡槽8.1、卡槽8.2、卡槽8.3、卡槽8.4。每一个卡槽的结构可以是相同的,针对任意一个推进器,例如,推进器3.3通过推进器连接部件连接至连接结构7,推进器连接部件包括:安装座11、卡槽8.3、推进器连杆9、固定件10;安装座11的底部固定设置于连接结构7,卡8.3设置于安装座的一侧,推进器连杆9的一端通过固定件固定于卡槽8.3,推进器连杆9的一端连接有推进器3.3。
一种实现方式中,安装座的垂直方向上设置有多组螺纹孔,每一组螺纹孔均可以与卡槽相连。
如图6所示,具体实现方式中,安装座11的尺寸为:高120mm,宽42mm,上有6个10mm的螺纹孔,每个孔相距20mm,孔11.1和孔11.2为一组,孔12.1 和12.2为一组,孔13.1和孔13.2为一组,可以根据不同的水深环境,调节推进器的吃水深度,使无人船适应各种水域环境。
每一个推进器可以通过连接杆9和卡槽与不锈钢制平台7上的安装座11固定。
具体实现方式中,无人船还包括:通信模块、GPS或北斗接收机、温湿度模块;通信模块、GPS或北斗接收机、温湿度模块分别通过下位机与舵机控制模块相连。无人船在航行过程中,按照规划的路线行驶到指定泊位附近时,结合泊位GPS或北斗信息、图像采集模块4和激光测距模块,发送指令给舵机,调整船舶方位,使得船舶的一侧平行于泊位,在对准泊位后,开始自动靠离岸作业。
GPS或北斗接收机放置于密闭防水箱,用以实时获取无人船的位置信息。4G 或5G通信模块放置于密闭防水箱中,用以与岸基监控子系统的实时通信。自动靠离岸功能以PLC和嵌入式工控机作为主控制中心,放置于密闭防水箱中,用于对接收和采集的数据进行融合处理分析,并根据结果进行路径规划和跟踪。控制过程采用现有方案实现,不作为本发明的发明点。
具体的,第一电池密闭防水箱5.1、第二电池密闭防水箱5.2;第一推进器组、第二推进器组、下位机和舵机控制模块分别与第一电池密闭防水箱5.1和第二电池密闭防水箱5.2内的电源模块相连。
5个16000mAh的锂电池为动力能源,分别为无人船的控制系统和推进器提供能源,且为无人船控制系统和推进器提供能源的电池分开布置,用来提高系统的安全性。
下位机控制子系统的控制中心采用嵌入式工控机和PLC控制,两者间通过以太网通讯,形成冗余控制,提高控制系统的可靠性。
进一步地,无人船网络通信子系统,是基于4G或5G模块进行通信,通过 Easyconnect软件,将岸基监控子系统与下位机接入同一个局域网内。
控制过程如图7-图13所示,下位机控制子系统通过PWM发生器向电调输出控制命令,包括螺旋桨旋转方向(顺时针或逆时针)、螺旋桨转速;通过霍尔传感器获得当前螺旋桨转速。下位机控制子系统通过485总线通讯模块向舵机控制模块发送舵机控制命令,并同时通过485总线通讯模块获得舵机旋转角度。下位机控制子系统通过PWM发生器向电调输出控制命令,包括螺旋桨旋转方向 (顺时针或逆时针)、螺旋桨转速;通过霍尔传感器获得当前螺旋桨转速。下位机控制子系统通过485总线通讯模块向舵机控制模块发送舵机控制命令,并同时通过485总线通讯模块获得舵机旋转角度。
上述实施例仅例示性说明本发明的原理及其功效,而非用于限制本发明。任何熟悉此技术的人士皆可在不违背本发明的精神及范畴下,对上述实施例进行修饰或改变。因此,举凡所属技术领域中具有通常知识者在未脱离本发明所揭示的精神与技术思想下所完成的一切等效修饰或改变,仍应由本发明的权利要求所涵盖。
Claims (10)
1.一种无人船控制方法,其特征在于,应用于无人船控制系统,所述系统包括:岸基监控子系统、下位机控制子系统、推进器控制子系统、舵机控制模块、螺旋桨控制模块、图像采集模块、激光测距模块、通信模块、温湿度模块;
所述无人船控制方法包括离岸控制方法,所述离岸控制方法包括步骤:
岸基监控子系统发送离岸指令;
下位机控制子系统将GPS或北斗接收机的无人船的位置与岸基监控子系统下发的目的地进行比较,从而规划出最佳路径;所述下位机控制子系统发出控制指令给舵机控制模块,以控制舵机旋转至垂直船体的位置;
图像采集模块采集船舶周围环境,包括水岸、船舶正前方和正后方的物体;
位于船舶一侧的4个激光测距模块测量船舶离岸的距离,任意两个激光测距模块所测距离之差不大于±10cm;以及,利用船艏、艉4个激光测距模块实时测量船舶离前后障碍物的距离,在每个激光测距模块所测距离均大于100cm,通过舵机控制模块调整舵机旋转至平行于船体的位置,螺旋桨加速运行,驶离泊位;
通信模块向所述岸基监控子系统发送完成离岸的信号。
2.根据权利要求1所述的无人船控制方法,其特征在于,所述无人船控制方法包括靠岸控制方法,所述靠岸控制方法包括步骤:
所述通信模块接收所述岸基监控子系统发送的靠岸指令;
所述下位机控制子系统将GPS或北斗接收机的无人船的位置与所述岸基监控子系统下发的目的地进行比较,从而规划出最佳路径;
所述舵机控制模块调整船舶姿态,直到船舶一侧4激光测距模块都能测到离岸距离,并且任意两个激光测距模块所测距离之差不大于±10cm;
所述下位机控制子系统发送指令至所所述舵机控制模块,使舵机旋转至垂直船体的位置,控制螺旋桨运行,使无人船进行泊位;
所述图像采集模块采集船舶环境,并利用船艏、艉前后4个激光测距模块实时测量船舶离前后物体的距离,并且每个激光测距模块所测距离都大于50cm,并在船舶一侧4个激光测距模块实时测量船舶离岸的距离小于10cm,停止螺旋桨运行;
所述通信模块向所述岸基监控子系统发送完成靠岸的信号。
3.根据权利要求1或2所述的无人船控制方法,其特征在于,所述无人船控制方法包括避障控制方法,所述避障控制方法包括步骤:
所述岸基监控子系统发送自主航行指令;
所述下位机控制子系统将GPS或北斗接收机的无人船的位置与岸基监控子系统下发的目的地进行比较,规划出最佳路径;
所述图像采集模块,获得障碍物的轮廓信息;
所述下位机控制子系统发送指令给推进器控制子系统,使得螺旋桨减速,将遇到障碍物的信息通过所述通信模块发送给所述岸基监控子系统;
所述激光测距模块实时监测与障碍物的距离,在船艏任意一个激光测距模块距离小于100cm,螺旋桨停止运行;
所述下位机控制子系统发送指令至所述舵机控制模块,使舵机旋转至垂直船体的位置,螺旋桨运行,使船舶平移,直到船艏两个激光测距模块距离均超过100cm,以及,所述下位机控制子系统发送指令至所述舵机控制模块,使舵机旋转至平行船体的位置,螺旋桨运行,直至完全绕开障碍物,并通过所述通信模块发送新的位置信号给岸基监控子系统,所述下位机控制子系统将GPS或北斗接收机获得无人船的位置重新与岸基监控子系统下发的目的地进行比较,再次规划出最佳路径,继续航行。
4.根据权利要求3所述的无人船控制方法,其特征在于,所述无人船控制方法包括故障控制方法,所述故障控制方法包括步骤:
温湿度模块发送温湿度报警信号至所述下位机控制子系统;
所述下位机控制子系统发送指令至推进器控制子系统,以使得螺旋桨控制模块减速或停车;
所述通信模块发送温湿度报警信号至所述岸基监控子系统。
5.根据权利要求1所述的无人船控制方法,其特征在于,所述无人船还包括:
船体,包括第一船体结构和第二船体结构,所述第一船体结构和所述第二船体结构为对称结构;
连接结构,所述连接结构连接所述第一船体结构和所述第二船体结构;
密闭防水箱,对称设置于所述第一船体结构所述第二船体结构之间;
以及,推进器为推进器组,包括第一组推进器和第二组推进器,所述第一组推进器位于所述船体一端的所述连接结构上,所述第二组推进器位于所述船体另一端的所述连接结构上,且所述推进器组沿着中线对称分布,所述中线为所述第一船体结构和所述第二船体结构所对应的中线;
所述图像采集模块设置于所述连接结构的上方,且位于所述第一组推进器的中心线上;
多个激光测距模块对称设置于所述第一船体结构、所述第二船体结构上和所述连接结构上;
舵机控制模块,通过下位机与所述图像采集模块和所述多个激光测距模块相连。
6.根据权利要求5所述的无人船控制方法,其特征在于,所述密闭防水箱包括:第一电池密闭防水箱、第二电池密闭防水箱和其他设备密闭防水箱,所述他设备密闭防水箱设置于所述第一电池密闭防水箱和所述第二电池密闭之间,且所述第一电池密闭防水箱、所述第二电池密闭防水箱、所述其他设备密闭防水箱、所述第一船体结构和所述第二船体结构为对称设置。
7.根据权利要求5或6所述的无人船控制方法,其特征在于,所述第一推进器组与所述第二推进器组呈对称设置,均包括两个推进器。
8.根据权利要求7所述的无人船控制方法,其特征在于,所述多个激光测距模块包括四组激光测距模块;
第一组激光测距模块设置于所述第一船体结构上方,且位于第一边长的两端;
第二组激光测距模块设置于所述第二船体结构上方,且位于第二边长的两端;
第三组激光测距模块设置于所述连接结构的所述第一边长上方;
第四组激光测距模块设置于所述连接结构的所述第二边长上方;
所述第一边长为所述连接结构位于所述第一船体结构上方的部分;
所述第二边长为所述连接结构位于所述第二船体结构上方的部分。
9.根据权利要求8所述的无人船控制方法,其特征在于,每一个推进器通过推进器连接部件连接至所述连接结构,所述推进器连接部件包括:安装座、卡槽、推进器连杆、固定件;
所述安装座的底部固定设置于所述连接结构,所述卡槽设置于所述安装座的一侧,所述推进器连杆的一端通过所述固定件固定于所述卡槽,所述推进器连杆的一端连接有推进器。
10.根据权利要求9所述的无人船控制方法,其特征在于,第一电池密闭防水箱、第二电池密闭防水箱;
所述第一推进器组、所述第二推进器组、所述下位机和所述舵机控制模块分别与所述第一电池密闭防水箱和所述第二电池密闭防水箱内的电源模块相连。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910806185.8A CN110632920A (zh) | 2019-08-29 | 2019-08-29 | 一种无人船控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910806185.8A CN110632920A (zh) | 2019-08-29 | 2019-08-29 | 一种无人船控制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN110632920A true CN110632920A (zh) | 2019-12-31 |
Family
ID=68969380
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910806185.8A Pending CN110632920A (zh) | 2019-08-29 | 2019-08-29 | 一种无人船控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110632920A (zh) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111221331A (zh) * | 2020-01-08 | 2020-06-02 | 北京航天发射技术研究所 | 一种小型船艇多控制终端同步控制处理系统及方法 |
CN111678492A (zh) * | 2020-06-24 | 2020-09-18 | 平湖市中地测绘规划有限公司 | 用于水下断面测量的无人船系统 |
CN113008621A (zh) * | 2021-02-23 | 2021-06-22 | 杭州环研科技有限公司 | 一种5g多通道智能采样无人船 |
CN113570748A (zh) * | 2021-07-23 | 2021-10-29 | 上海外高桥造船有限公司 | 一种面向智能船舶的远程运维调试支持系统及船舶 |
CN114115264A (zh) * | 2021-11-19 | 2022-03-01 | 四方智能(武汉)控制技术有限公司 | 无人船测绘航行系统及其控制方法 |
CN111221331B (zh) * | 2020-01-08 | 2024-04-26 | 北京航天发射技术研究所 | 一种小型船艇多控制终端同步控制处理系统及方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107229276A (zh) * | 2017-05-27 | 2017-10-03 | 浙江大学 | 基于ARM Cortex‑M7处理器的智能无人船平台及其控制方法 |
CN108267955A (zh) * | 2018-01-17 | 2018-07-10 | 哈尔滨工程大学 | 面向无人艇自主靠泊的运动控制方法 |
CN109285389A (zh) * | 2018-09-18 | 2019-01-29 | 广州中国科学院沈阳自动化研究所分所 | 一种无人船自动靠泊系统及方法 |
CN109584636A (zh) * | 2018-11-20 | 2019-04-05 | 武汉理工大学 | 用于港船机协同安全监测的靠泊辅助装置及其监控方法 |
CN109613559A (zh) * | 2018-12-18 | 2019-04-12 | 河海大学常州校区 | 基于视觉和激光雷达的水陆边界漂浮物判别装置与方法 |
CN109739238A (zh) * | 2019-01-16 | 2019-05-10 | 大连海事大学 | 一种船舶自动靠离泊系统及其工作方法 |
-
2019
- 2019-08-29 CN CN201910806185.8A patent/CN110632920A/zh active Pending
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107229276A (zh) * | 2017-05-27 | 2017-10-03 | 浙江大学 | 基于ARM Cortex‑M7处理器的智能无人船平台及其控制方法 |
CN108267955A (zh) * | 2018-01-17 | 2018-07-10 | 哈尔滨工程大学 | 面向无人艇自主靠泊的运动控制方法 |
CN109285389A (zh) * | 2018-09-18 | 2019-01-29 | 广州中国科学院沈阳自动化研究所分所 | 一种无人船自动靠泊系统及方法 |
CN109584636A (zh) * | 2018-11-20 | 2019-04-05 | 武汉理工大学 | 用于港船机协同安全监测的靠泊辅助装置及其监控方法 |
CN109613559A (zh) * | 2018-12-18 | 2019-04-12 | 河海大学常州校区 | 基于视觉和激光雷达的水陆边界漂浮物判别装置与方法 |
CN109739238A (zh) * | 2019-01-16 | 2019-05-10 | 大连海事大学 | 一种船舶自动靠离泊系统及其工作方法 |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111221331A (zh) * | 2020-01-08 | 2020-06-02 | 北京航天发射技术研究所 | 一种小型船艇多控制终端同步控制处理系统及方法 |
CN111221331B (zh) * | 2020-01-08 | 2024-04-26 | 北京航天发射技术研究所 | 一种小型船艇多控制终端同步控制处理系统及方法 |
CN111678492A (zh) * | 2020-06-24 | 2020-09-18 | 平湖市中地测绘规划有限公司 | 用于水下断面测量的无人船系统 |
CN111678492B (zh) * | 2020-06-24 | 2022-02-08 | 平湖市中地测绘规划有限公司 | 用于水下断面测量的无人船系统 |
CN113008621A (zh) * | 2021-02-23 | 2021-06-22 | 杭州环研科技有限公司 | 一种5g多通道智能采样无人船 |
CN113570748A (zh) * | 2021-07-23 | 2021-10-29 | 上海外高桥造船有限公司 | 一种面向智能船舶的远程运维调试支持系统及船舶 |
CN114115264A (zh) * | 2021-11-19 | 2022-03-01 | 四方智能(武汉)控制技术有限公司 | 无人船测绘航行系统及其控制方法 |
CN114115264B (zh) * | 2021-11-19 | 2024-04-30 | 四方智能(武汉)控制技术有限公司 | 无人船测绘航行系统及其控制方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110632920A (zh) | 一种无人船控制方法 | |
CN108312151B (zh) | 漂流探测水下机器人装置及控制方法 | |
Brekke et al. | milliAmpere: An autonomous ferry prototype | |
GB2511731B (en) | Autonomous Vessel Robot AI System | |
CN207889964U (zh) | 一种无人帆船动力及转向装置 | |
CN107878669B (zh) | 智慧水面监测三体船 | |
CN108321598B (zh) | 一种模块化水下自治航行器 | |
CN108945366A (zh) | 一种支持风帆推进的水中航行器 | |
Gomáriz et al. | GUANAY-II: an autonomous underwater vehicle for vertical/horizontal sampling | |
CN112550571B (zh) | 一种高海况下可长期驻守的小型无人水面航行器 | |
Friebe et al. | A marine research ASV utilizing wind and solar power | |
Raimondi et al. | A innovative semi-immergible USV (SI-USV) drone for marine and lakes operations with instrumental telemetry and acoustic data acquisition capability | |
US20210053660A1 (en) | Sensor system for maritime vessels | |
Aage et al. | Hydrodynamic manoeuvrability data of a flatfish type AUV | |
EP3696078B1 (en) | A method and system for piloting an unmanned surface vessel | |
Jeong et al. | Catabot: Autonomous surface vehicle with an optimized design for environmental monitoring | |
Yaakob et al. | Development of unmanned surface vehicle (USV) for sea patrol and environmental monitoring | |
CN107097924B (zh) | 一种湖库作业船对偶变向侧桨在线自动控制装置 | |
Pairet et al. | Nukhada usv: a robot for autonomous surveying and support to underwater operations | |
Terao et al. | Application of wave devouring propulsion system for ocean engineering | |
RU193275U1 (ru) | Безэкипажный парусный катамаран | |
Martorell-Torres et al. | Xiroi ASV: a modular autonomous surface vehicle to link communications | |
Yamagata et al. | Development of AUV MONACA-Hover-Capable Platform for Detailed Observation Under Ice– | |
CN211076245U (zh) | 一种无人船 | |
CN212556702U (zh) | 一种可以自主连接的无人船 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination |