CN116736867B - 一种无人船避障控制系统 - Google Patents
一种无人船避障控制系统 Download PDFInfo
- Publication number
- CN116736867B CN116736867B CN202311004989.9A CN202311004989A CN116736867B CN 116736867 B CN116736867 B CN 116736867B CN 202311004989 A CN202311004989 A CN 202311004989A CN 116736867 B CN116736867 B CN 116736867B
- Authority
- CN
- China
- Prior art keywords
- obstacle
- propulsion
- unmanned ship
- module
- preset
- 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.)
- Active
Links
- 238000012937 correction Methods 0.000 claims abstract description 53
- 238000001514 detection method Methods 0.000 claims abstract description 14
- 238000007667 floating Methods 0.000 claims description 25
- 230000008859 change Effects 0.000 claims description 9
- 238000004458 analytical method Methods 0.000 claims description 6
- 230000002596 correlated effect Effects 0.000 claims description 3
- 230000000007 visual effect Effects 0.000 claims description 3
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 abstract description 13
- 230000000694 effects Effects 0.000 abstract description 9
- 238000000034 method Methods 0.000 description 22
- 238000010586 diagram Methods 0.000 description 10
- 230000008569 process Effects 0.000 description 9
- 238000010276 construction Methods 0.000 description 5
- 238000012986 modification Methods 0.000 description 4
- 230000004048 modification Effects 0.000 description 4
- 230000001133 acceleration Effects 0.000 description 2
- 230000009471 action Effects 0.000 description 2
- 230000008447 perception Effects 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 238000006467 substitution reaction Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 230000001276 controlling effect Effects 0.000 description 1
- 230000000875 corresponding effect Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明涉及无人船技术领域,尤其涉及一种无人船避障控制系统,本发明通过设置检测模组、推进模组、避障模组以及补偿模组,通过避障模组基于障碍物状态以及移动速度判定无人船的避障方式,包括,控制无人船沿预先确定的绕行轨迹航行,或,控制无人船保持静止,在前方无障碍时再次前进,通过补偿模组基于海浪推进方向与无人船航行方向的偏差夹角判定对推进模组的运行参数的修正方式,包括,对第一发动机组的推进速率进行修正,或,对第二发动机组的推进方向进行修正,实现了对不同障碍物采取不同的避障方式,减少了海况、水流等因素对避障效果的影响,避障方式的多样性提高了系统的适应性,修正方式的引入提升了系统的避障效果。
Description
技术领域
本发明涉及无人船技术领域,尤其涉及一种无人船避障控制系统。
背景技术
随着人类对海洋资源的重视程度加剧,需要越来越频繁地对海洋进行巡视探索,无人船是一种无需遥控,借助卫星定位和自身传感器即可按照预设路线在水面航行的全自动水面机器人,在航行过程中可根据设置在船体的各类传感器完成对障碍物的适应性避障,针对无人船的避障控制系统也需要适应复杂的海洋环境,相关领域技术人员也在对无人船的避障控制系统进行更加精确化以及智能化的研究,使无人船更加满足生产以及科研的需求。
中国专利公开号:CN115328122A,该发明提供了一种基于多雷达感知的无人船避障方法及系统,其中,方法包括:步骤1:动态获取无人船上设置的多雷达对水域中周边环境进行感知获得的点云数据包;步骤2:获取辅助构建信息,基于辅助构建信息和点云数据包,构建动态三维场景模型;步骤3:基于动态三维场景模型,规划避障行驶路线;步骤4:基于所述避障行驶路线,控制无人船进行避障行驶,该发明的基于多雷达感知的无人船避障方法及系统,基于雷达动态获取的点云数据包和辅助构建信息,构建动态三维场景模型,提升了场景构建的实时性;在动态三维场景模型中规划避障行驶路线,无需人工遥控避障,降低了人力成本,同时,提高了避障的精确性,但是,该发明的场景模型构建缺乏对固定障碍物以及移动障碍物的区分,且在基于规划好的避障行驶路线上行驶时未考虑海洋复杂环境对行驶路线的影响。
现有技术中还存在以下问题,
1、现有技术中,未考虑对固定障碍物以及不同移动速度的漂浮障碍物采取不同的避障方式,导致避障方式单一;
2、现有技术中,未考虑海况、水流等因素在无人船避障过程中对无人船避障轨迹的影响,影响避障控制系统的避障效果。
发明内容
为此,本发明提供一种无人船避障控制系统,用以克服现有技术中没有对固定障碍物以及不同移动速度的漂浮障碍物采取不同的避障方式导致的避障方式单一以及容易受海况、水流等因素影响避障控制系统的避障效果的问题。
为实现上述目的,本发明提供一种无人船避障控制系统,包括:
检测模组,其包括设置在无人船前端用以检测所述无人船周围是否有障碍物以及检测所述障碍物的移动速度的雷达单元,设置在所述无人船四周用以采集海浪推进方向以及海浪高度的视觉单元;
推进模组,其包括设置在所述无人船尾部且推进速率以及推进方向可控的第一发动机组以及设置在所述无人船侧部且推进速率以及推进方向可控的第二发动机组;
避障模组,其与所述检测模组以及推进模组连接,包括相互连接的分析单元以及控制单元,所述分析单元用以在第一预设条件下,判定障碍物状态,所述障碍物状态包括固定障碍物状态以及漂浮障碍物状态;
所述控制单元用以基于所述障碍物状态以及障碍物的移动速度判定所述无人船的避障方式,其中,
第一避障方式为确定绕行轨迹,控制所述推进模组改变推进方向以及推进速率以使所述无人船沿所述绕行轨迹航行;
第二避障方式为控制所述推进模组改变推进方向以及推进速率以使无人船保持静止,在第二预设条件下,控制所述推进模组推进所述无人船再次前进;
所述第一预设条件为所述雷达单元判定所述无人船周围有障碍物,所述第二预设条件为所述雷达单元判定所述无人船周围没有障碍物;
补偿模组,其与所述检测模组、推进模组以及避障模组连接,用以基于所述海浪推进方向与无人船航行方向的偏差夹角以及海浪高度与预设海浪高度阈值的对比结果判定是否需要对所述推进模组的运行参数进行修正,并判定对推进模组的运行参数进行修正时的修正方式,包括,
对第一发动机组的推进速率进行修正;
或,对第二发动机组的推进方向进行修正。
进一步地,所述控制单元还用以在所述雷达单元判定所述障碍物状态为漂浮障碍物状态下,获取所述障碍物的移动速度,并将所述障碍物的移动速度与预设的速度对比值进行比对,根据比对结果判定所述障碍物的速度状态,其中,
若所述障碍物的移动速度小于等于所述速度对比值,则所述控制单元判定所述障碍物的速度状态为第一速度状态;
若所述障碍物的移动速度大于所述速度对比值,则所述控制单元判定所述障碍物的速度状态为第二速度状态。
进一步地,所述控制单元基于所述障碍物状态以及障碍物的移动速度判定所述无人船的避障方式,其中,
在第一预设判定条件下,所述控制单元判定所述无人船的避障方式为第一避障方式;
在第二预设判定条件下,所述控制单元判定所述无人船的避障方式为第二避障方式;
所述第一预设判定条件为所述障碍物状态为固定障碍物状态或所述障碍物状态为漂浮障碍物状态且所述障碍物的速度状态为第一速度状态;
所述第二预设判定条件为所述障碍物状态为漂浮障碍物状态,且,所述障碍物的速度状态为第二速度状态。
进一步地,所述第一避障方式下的绕行轨迹为围绕所述障碍物的航行轨迹,所述航行轨迹基于所述雷达单元检测到障碍物的宽度确定,所述航行轨迹的曲率与所述障碍物的宽度成正相关。
进一步地,所述补偿模组还用以确定所述偏差夹角,其中,所述补偿模组将所述海浪推进方向与无人船航行方向之间的夹角确定为所述偏差夹角。
进一步地,所述补偿模组判定是否需要对所述推进模组的运行参数进行修正,其中,
所述补偿模组将所述偏差夹角与预设的偏差夹角阈值进行对比,将海浪高度与预设海浪高度阈值进行对比,
在预设对比条件下,所述补偿模块判定需要对所述推进模组的运行参数进行修正;
在非所述预设对比条件下,所述补偿模块判定不需要对所述推进模组的运行参数进行修正;
所述预设对比条件为,所述偏差夹角小于等于所述偏差夹角阈值且所述海浪高度大于预设海浪高度阈值,或所述偏差夹角大于所述偏差夹角阈值。
进一步地,所述补偿模组判定对推进模组的运行参数进行修正时的修正方式,其中,
若所述偏差夹角小于等于所述偏差夹角阈值且所述海浪高度大于预设海浪高度阈值,或所述偏差夹角处于第一预设区间,则所述补偿模组判定对推进模组的第一发动机组的推进速率进行修正;
若所述偏差夹角处于第二预设区间,则所述补偿模组判定对推进模组的第二发动机组的推进方向进行修正;
其中,所述第一预设区间为(150°,180°],所述第二预设区间为(30°,150°]。
进一步地,所述补偿模组内部设置有若干基于所述偏差夹角以及海浪高度修正所述第一发动机组的推进速率的速率修正方式,
各所述速率修正方式对所述第一发动机组的推进速率的修正比例不同。
进一步地,所述补偿模组内部设置有若干基于所述偏差夹角确定所述第二发动机组的推进方向的确定方式,各所述确定方式中所确定的推进方向不同。
进一步地,所述检测模组内还设置有存储单元,用以存储所述雷达单元以及视觉单元所检测的数据。
与现有技术相比,本发明的有益效果为,本发明通过设置检测模组、推进模组、避障模组以及补偿模组,通过避障模组判定障碍物状态为固定障碍物状态或漂浮障碍物状态,基于障碍物状态以及障碍物的移动速度判定无人船的避障方式,包括,控制无人船沿预先确定的绕行轨迹航行,或,控制推进模组改变推进方向以及推进速率以使无人船保持静止,在前方无障碍时再次前进,通过补偿模组基于海浪推进方向与无人船航行方向的偏差夹角以及海浪高度判定对推进模组的运行参数进行修正时的修正方式,包括,对第一发动机组的推进速率进行修正,或,对第二发动机组的推进方向进行修正,进而,实现了对不同状态以及移动速度的障碍物采取不同的避障方式,减少了海况、水流等因素对避障效果的影响,避障方式的多样性提高了避障控制系统的适应性,修正方式的引入提升了系统的避障效果。
进一步地,本发明通过避障模组判定障碍物状态,在实际情况中,障碍物状态可以为海面上固定的礁石,也可以为漂浮的杂物,不同类型的障碍物具有不同的特征,进而,便于系统对不同障碍物采取不同的避障方式。
进一步地,本发明基于障碍物状态以及障碍物的移动速度判定所述无人船的避障方式,在实际情况中,对于固定状态的障碍物需要系统规划绕行轨迹,并控制无人船沿绕行轨迹进行避障,对于漂浮状态的障碍物,需要获取障碍物的移动速度,移动速度慢的漂浮障碍物也要基于规划好的绕行轨迹进行避障,移动速度快的漂浮障碍物变化情况多端,规划的绕行路线很难适用,可以控制无人船保持静止,待障碍物快速移出对无人船的航行方向造成影响的区域,无人船的雷达单元检测航行方向没有障碍物时再按航行方向行进,进而,实现了对固定障碍物以及不同移动速度的漂浮障碍物采取不同的避障方式,提高了避障控制系统的适应性。
进一步地,本发明通过补偿模组判定是否需要对推进模组的运行参数进行修正,在实际情况中,海况、水流等因素在无人船避障过程中对无人船避障轨迹的影响,海浪的推进方向与无人船的航行方向之间存在偏差夹角,偏差夹角在不同的角度区间对无人船的航行方向造成的影响不同,在偏差夹角小于等于30°且海浪高度较低时,对航行方向造成的影响较小,可以不去调整推进模组的运行参数,但在海浪高度较高时,海浪的起伏会导致无人船前进方向的速度向量被分解至海浪起伏方向,在无人船向心加速度的作用下容易偏航,需要调整推进模组的运行参数,在偏差夹角大于30°时,对航行方向造成的影响较大,需要调整推进模组的运行参数,以避免无人船避障过程中海况、水流等因素对无人船避障轨迹的影响。
进一步地,本发明通过补偿模组基于偏差夹角判定对推进模组的运行参数进行修正时的修正方式,在实际情况中,由于偏差夹角较大,需要对无人船的航行方向进行调整,偏差夹角在不同的角度区间对无人船的航行方向造成的影响不同,在偏差夹角在(30°,150°]的状态下,海浪推进方向容易使无人船左右偏出原先的航行方向,此时需要设置在船体侧部的第二发动机组对无人船的左右方向进行修正,在偏差夹角在(150°,180°]的状态下,海浪推进方向容易使无人船前进的推进速率受到阻碍,进而影响沿避障轨迹的航行,此时需要修正第一发动机组的推进速率,并且,本发明考虑了海浪高度对航行的影响,海浪高度会对航行方向的速度向量产生抵消,本发明进而基于海浪高度对应的修正第一发动机组的推进速率,进而提升了系统的避障效果。
进一步地,本发明通过补偿模组确定对第一发动机组的推进速率的速率修正方式以及对第二发动机组的推进方向的方向修正方式,在实际情况中,由于偏差夹角的大小不同,对无人船的航行方向造成的影响程度也不同,所以需要确定对第一发动机组的推进速率的修正比例以及第二发动机组的推进方向,以使补偿单元控制推进模组的运行参数,减少了海况、水流等因素在无人船避障过程中对无人船避障轨迹的影响,提升了系统的避障效果。
附图说明
图1为本发明实施例的无人船避障控制系统的结构框图;
图2为本发明实施例的推进模组的结构示意图;
图3为本发明实施例的避障模组的结构框图;
图4为本发明实施例的第一预设区间的示意图;
图5为本发明实施例的第二预设区间的示意图;
图中,1:第一发动机组,2:第二发动机组,3:航行方向,4:第一预设区间,5:第二预设区间。
具体实施方式
为了使本发明的目的和优点更加清楚明白,下面结合实施例对本发明做进一步描述;应当理解,此处所描述的具体实施例仅仅用于解释本发明,并不用于限定本发明。
下面参照附图来描述本发明的优选实施方式。本领域技术人员应当理解的是,这些实施方式仅仅用于解释本发明的技术原理,并非在限制本发明的保护范围。
需要说明的是,在本发明的描述中,术语“上”、“下”、“左”、“右”、“内”、“外”等指示的方向或位置关系的术语是基于附图所示的方向或位置关系,这仅仅是为了便于描述,而不是指示或暗示所述装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本发明的限制。
此外,还需要说明的是,在本发明的描述中,除非另有明确的规定和限定,术语“安装”、“相连”、“连接”应做广义理解,例如,可以是固定连接,也可以是可拆卸连接,或一体的连接;可以是机械连接,也可以是电连接;可以是直接相连,也可以通过中间媒介间接相连,可以是两个元件内部的连通。对于本领域技术人员而言,可根据具体情况理解上述术语在本发明中的具体含义。
请参阅图1至图3所示,图1为本发明实施例的无人船避障控制系统的结构框图,图2为本发明实施例的推进模组的结构示意图,图3为本发明实施例的避障模组的结构框图,本发明的无人船避障控制系统,包括:
检测模组,其包括设置在无人船前端用以检测所述无人船周围是否有障碍物以及检测所述障碍物的移动速度的雷达单元,设置在所述无人船四周用以采集海浪推进方向的视觉单元;
推进模组,其包括设置在所述无人船尾部且推进速率以及推进方向可控的第一发动机组1以及设置在所述无人船侧部且推进速率以及推进方向可控的第二发动机组2;
避障模组,其与所述检测模组以及推进模组连接,包括相互连接的分析单元以及控制单元,所述分析单元用以在第一预设条件下,判定所述障碍物状态,所述障碍物状态包括固定障碍物状态以及漂浮障碍物状态;
所述控制单元用以基于所述障碍物状态以及障碍物的移动速度判定所述无人船的避障方式,所述避障方式包括,
第一避障方式为确定绕行轨迹,控制所述推进模组改变推进方向以及推进速率以使所述无人船沿所述绕行轨迹航行;
第二避障方式为控制所述推进模组改变推进方向以及推进速率以使无人船保持静止,在第二预设条件下,控制所述推进模组推进所述无人船再次前进;
所述第一预设条件为所述雷达单元判定所述无人船周围有障碍物,所述第二预设条件为所述雷达单元判定所述无人船周围没有障碍物;
补偿模组,其与所述检测模组、推进模组以及避障模组连接,用以基于所述海浪推进方向与无人船航行方向的偏差夹角以及海浪高度与预设海浪高度阈值的对比结果判定是否需要对所述推进模组的运行参数进行修正,并判定对推进模组的运行参数进行修正时的修正方式,包括,
对第一发动机组1的推进速率进行修正;
或,对第二发动机组2的推进方向进行修正。
具体而言,本发明对雷达单元的具体结构不做限定,其可以是X波段雷达或者是激光雷达,只需能够实现对无人船周围是否有障碍物进行判定,以及检测障碍物的移动速度即可,此为现有技术,此处不再赘述。
具体而言,本发明对视觉单元的具体结构不做限定,其可以通过安装在无人船上的摄像头来拍摄海面上的图像,并使用计算机视觉技术分析图像中的海浪方向,可以通过监控图像中海浪的形状、大小和运动轨迹来确定海浪的方向,此为本领域技术人员所熟知的,此处不再赘述。
具体而言,本发明对避障模组及其内部各功能单元的具体结构不做限定,其可以为可实现信息数据接收处理发送的微型控制计算机,也可以为集成功能算法的CPU单元,此为现有技术,此处不再赘述。
具体而言,本发明对补偿模组的具体结构不作限定,其可以为可实现信息数据接收处理发送的微型控制计算机,也可以为集成功能算法的CPU单元,此为现有技术,此处不再赘述。
具体而言,本发明对推进模组的各发动机组的推进方向的控制方式不做限定,优选的,本实施例选用直流电机驱动喷泵,通过控制喷泵速度来实现控制发动机组的推进方向,此技术是本领域技术人员熟知的,此处不再赘述。
具体而言,本发明中通过雷达单元对障碍物进行检测,通过对障碍物位置、距离和速度等信息的采集,雷达单元可以探测到移动物体和固定物体,优选的,本实施例中,选用X波段雷达与毫米波雷达结合的方式对障碍物进行检测,对障碍物状态属于固定障碍物状态还是漂浮障碍物状态进行判定,此处不再赘述。
具体而言,所述控制单元还用以在所述雷达单元判定所述障碍物状态为漂浮障碍物状态下,获取所述障碍物的移动速度V,并将所述障碍物的移动速度V与预设的速度对比值V’进行比对,根据比对结果判定所述障碍物的速度状态,其中,
若所述障碍物的移动速度V小于等于所述速度对比值V’,则所述控制单元判定所述障碍物的速度状态为第一速度状态;
若所述障碍物的移动速度V大于所述速度对比值V’,则所述控制单元判定所述障碍物的速度状态为第二速度状态;
其中,在本实施例中,所述预设的速度对比值V’在区间[4,8]内选定,区间单位为km/h。
具体而言,所述控制单元基于所述障碍物状态以及障碍物的移动速度判定所述无人船的避障方式,其中,
在第一预设判定条件下,所述控制单元判定所述无人船的避障方式为第一避障方式;
在第二预设判定条件下,所述控制单元判定所述无人船的避障方式为第二避障方式;
所述第一预设判定条件为所述障碍物状态为固定障碍物状态或所述障碍物状态为漂浮障碍物状态且所述障碍物的速度状态为第一速度状态;
所述第二预设判定条件为所述障碍物状态为漂浮障碍物状态,且,所述障碍物的速度状态为第二速度状态。
具体而言,本发明基于障碍物状态以及障碍物的移动速度判定所述无人船的避障方式,在实际情况中,对于固定状态的障碍物需要系统规划绕行轨迹,并控制无人船沿绕行轨迹进行避障,对于漂浮状态的障碍物,需要获取障碍物的移动速度,移动速度慢的漂浮障碍物也要基于规划好的绕行轨迹进行避障,移动速度快的漂浮障碍物变化情况多端,规划的绕行路线很难适用,可以控制无人船保持静止,待障碍物快速移出对无人船的航行方向3造成影响的区域,无人船的雷达单元检测航行方向3没有障碍物时再按航行方向3行进,进而,实现了对固定障碍物以及不同移动速度的漂浮障碍物采取不同的避障方式,提高了避障控制系统的适应性。
具体而言,所述控制单元确定航行轨迹,其中,所述航行轨迹基于所述雷达单元检测到障碍物的宽度D确定,所述航行轨迹的曲率K与所述障碍物的宽度成正相关。
具体而言,所述航行轨迹的确定方式可以为,以雷达单元检测到航行方向3上有障碍物时无人船所在位置为起始点,以障碍物的最小绕行宽度确定绕行障碍物过程的终止点,将所述起止点与终止点通过平滑曲线连接,确定航行轨迹,此处不再赘述。
具体而言,所述控制单元确定航行轨迹后基于航行轨迹对应确定第一发动机组的推进速率以及推进方向,将所述推进速率以及推进方向确定为所述第一发动机组的初始推进速率以及初始推进方向,
所述控制单元内设置有数据库,数据库中的数据为若干在实验环境下测得的无人船以不同曲率航行轨迹航行时第一发动机组所需的推进速率以及推进方向,所述控制单元确定航行轨迹后基于所述数据库中的数据调用所需的推进速率以及推进方向。
具体而言,所述补偿模组还用以确定所述偏差夹角,其中,将所述海浪推进方向与无人船航行方向3之间的夹角确定为所述偏差夹角。
具体而言,所述补偿模组判定是否需要对所述推进模组的运行参数进行修正,其中,
所述补偿模组将所述偏差夹角与预设的偏差夹角阈值进行对比,将海浪高度与预设海浪高度阈值进行对比,
在预设对比条件下,所述补偿模块判定需要对所述推进模组的运行参数进行修正;
在非所述预设对比条件下,所述补偿模块判定不需要对所述推进模组的运行参数进行修正;
所述预设对比条件为,所述偏差夹角小于等于所述偏差夹角阈值且所述海浪高度大于预设海浪高度阈值,或所述偏差夹角大于所述偏差夹角阈值。
其中,所述预设的偏差夹角阈值为30°,所述预设海浪高度阈值H0基于所述无人船的船高Hd确定,设定H0=0.8Hd。
具体而言,本发明通过补偿模组判定是否需要对推进模组的运行参数进行修正,在实际情况中,海况、水流等因素在无人船避障过程中对无人船避障轨迹的影响,海浪的推进方向与无人船的航行方向3之间存在偏差夹角,偏差夹角在不同的角度区间对无人船的航行方向3造成的影响不同,在偏差夹角小于等于30°且海浪高度较低时,对航行方向3造成的影响较小,可以不去调整推进模组的运行参数,但在海浪高度较高时,海浪的起伏会导致无人船前进方向的速度向量被分解至海浪起伏方向,在无人船向心加速度的作用下容易偏航,需要调整推进模组的运行参数,在偏差夹角大于30°时,对航行方向3造成的影响较大,需要调整推进模组的运行参数,以避免无人船避障过程中海况、水流等因素对无人船避障轨迹的影响。
请参阅图4以及图5所示,图4为本发明实施例的第一预设区间4的示意图,图5为本发明实施例的第二预设区间5的示意图。
具体而言,所述补偿模组判定对推进模组的运行参数进行修正时的修正方式,其中,
若所述偏差夹角小于等于所述偏差夹角阈值且所述海浪高度大于预设海浪高度阈值,或所述偏差夹角处于第一预设区间,则所述补偿模组判定对推进模组的第一发动机组的推进速率进行修正;
若所述偏差夹角处于第二预设区间,则所述补偿模组判定对推进模组的第二发动机组的推进方向进行修正;
其中,所述第一预设区间为(150°,180°],所述第二预设区间为(30°,150°],所述偏差夹角阈值为30°。
具体而言,本发明通过补偿模组基于偏差夹角判定对推进模组的运行参数进行修正时的修正方式,在实际情况中,由于偏差夹角较大,需要对无人船的航行方向3进行调整,偏差夹角在不同的角度区间对无人船的航行方向3造成的影响不同,在偏差夹角在(30°,150°]的状态下,海浪推进方向容易使无人船左右偏出原先的航行方向3,此时需要设置在船体侧部的第二发动机组2对无人船的左右方向进行修正,在偏差夹角在(150°,180°]的状态下,海浪推进方向容易使无人船前进的推进速率受到阻碍,进而影响沿避障轨迹的航行,此时需要修正第一发动机组1的推进速率,并且,本发明考虑了海浪高度对航行的影响,海浪高度会对航行方向的速度向量产生抵消,本发明进而基于海浪高度对应的修正第一发动机组1的推进速率,进而提升了系统的避障效果。
具体而言,所述补偿模组内部设置有若干基于所述偏差夹角以及海浪高度修正所述第一发动机组的推进速率的速率修正方式,
各所述速率修正方式对所述第一发动机组1的推进速率的修正比例不同。
在本实施例中,
补偿模组中设置有至少四种修正方式,其中,
第一修正方式为将第一发动机组1的当前推进速率V0修正至第一推进速率V1,设定V1=V0×α1;
第二修正方式为将第一发动机组1的当前推进速率V0修正至第二推进速率V2,设定V2=V0×α2;
第三修正方式为将第一发动机组1的当前推进速率V0修正至第三推进速率V3,设定V3=V0×α3;
第四修正方式为将第一发动机组1的当前推进速率V0修正至第四推进速率V4,设定V4=V0×α4;
其中,α1表示第一推进速率修正参数,α2表示第二推进速率修正参数,α3表示第三推进速率修正参数,α4表示第四推进速率修正系数。
第一修正方式以及第二修正方式适用于偏差夹角小于等于所述偏差夹角阈值且所述海浪高度大于预设海浪高度阈值的情况,
并且,第一修正方式时需满足,海浪高度小于预设的第一海浪高度对比阈值,第二修正方式需满足,海浪高度大于等于预设的第一海浪高度对比阈值,第一海浪高度对比阈值Hde基于无人船的船高Hd所设定,设定Hde=1.2Hd。
第三修正方式以及第四修正方式适用于偏差夹角属于第一预设区间的情况,
并且,第三修正方式需满足偏差夹角小于第一预设夹角对比阈值β1,第四修正方式需满足偏差夹角大于等于第一预设夹角对比阈值β1,在本实施例中第一预设夹角对比阈值为165°。
在本实施例中,α1以及α2基于海浪影响下的速率衰减比例计算所得,海浪影响下的速率衰减比例为预先实验所得,其中,获取无海浪高度时第一发动机组以固定推进速率推进时无人船的第一移动速度,并获取海浪高度为第一海浪高度对比阈值时无人船的第二移动速度,将第二移动速度与第一移动速度的比值确定为速率衰减比例K,设定α1=1.2/K,α2=1.4/K。
在本实施例中α3为预定比例区间[1.3,1.4)中选定所得,α3为预定比例区间[1.4,1.6]中选定所得。
具体而言,所述补偿模组内部设置有若干基于所述偏差夹角确定所述第二发动机组2的推进方向的确定方式,各所述确定方式中所确定的推进方向不同。
具体而言,优选的,在本实施例中,所述补偿模组中设置有至少三种确定方式,其中,
第一确定方式为确定所述第二发动机组的推进方向为第一推进方向,
第二确定方式为确定所述第二发动机组的推进方向为第二推进方向,
第三确定方式为确定所述第二发动机组的推进方向为第三推进方向,
第一修正方式需满足偏差夹角属于区间(30°,60°],第二修正方式需满足偏差夹角属于区间(120°,135°],第三修正方式需满足偏差夹角属于区间,(135°,150°]。
所述第一推进方向为与当前航行方向成135°,且与海浪推进方向的夹角大于105°的方向;
所述第二推进方向为与当前航行方向成90°,且与海浪推进方向的夹角大于30°的方向;
所述第三推进方向为与当前航行方向成45°,且与海浪推进方向的夹角大于105°的方向。
所述检测模组内还设置有存储单元,用以存储所述雷达单元以及视觉单元所检测的数据。
具体而言,本发明通过补偿模组确定对第一发动机组1的推进速率的速率修正方式以及对第二发动机组2的推进方向的方向修正方式,在实际情况中,由于偏差夹角的大小不同,对无人船的航行方向3造成的影响程度也不同,所以需要确定对第一发动机组1的推进速率的修正比例以及第二发动机组2的推进方向,以使补偿单元控制推进模组的运行参数,减少了海况、水流等因素在无人船避障过程中对无人船避障轨迹的影响,提升了系统的避障效果。
至此,已经结合附图所示的优选实施方式描述了本发明的技术方案,但是,本领域技术人员容易理解的是,本发明的保护范围显然不局限于这些具体实施方式。在不偏离本发明的原理的前提下,本领域技术人员可以对相关技术特征做出等同的更改或替换,这些更改或替换之后的技术方案都将落入本发明的保护范围之内。
以上所述仅为本发明的优选实施例,并不用于限制本发明;对于本领域的技术人员来说,本发明可以有各种更改和变化。凡在本发明的精神和原则之内,所做的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (5)
1.一种无人船避障控制系统,其特征在于,包括:
检测模组,其包括设置在无人船前端用以检测所述无人船周围是否有障碍物以及检测所述障碍物的移动速度的雷达单元,设置在所述无人船四周用以采集海浪推进方向以及海浪高度的视觉单元;
推进模组,其包括设置在所述无人船尾部且推进速率以及推进方向可控的第一发动机组以及设置在所述无人船侧部且推进速率以及推进方向可控的第二发动机组;
避障模组,其与所述检测模组以及推进模组连接,包括相互连接的分析单元以及控制单元,所述分析单元用以在第一预设条件下,判定障碍物状态,所述障碍物状态包括固定障碍物状态以及漂浮障碍物状态;
所述控制单元还用以在所述雷达单元判定所述障碍物状态为漂浮障碍物状态下,获取所述障碍物的移动速度,并将所述障碍物的移动速度与预设的速度对比值进行比对,根据比对结果判定所述障碍物的速度状态,其中,
若所述障碍物的移动速度小于等于所述速度对比值,则所述控制单元判定所述障碍物的速度状态为第一速度状态;
若所述障碍物的移动速度大于所述速度对比值,则所述控制单元判定所述障碍物的速度状态为第二速度状态;
所述控制单元基于所述障碍物状态以及障碍物的移动速度判定所述无人船的避障方式,其中,
在第一预设判定条件下,所述控制单元判定所述无人船的避障方式为第一避障方式;
在第二预设判定条件下,所述控制单元判定所述无人船的避障方式为第二避障方式;
所述第一预设判定条件为所述障碍物状态为固定障碍物状态或所述障碍物状态为漂浮障碍物状态且所述障碍物的速度状态为第一速度状态;
所述第二预设判定条件为所述障碍物状态为漂浮障碍物状态,且,所述障碍物的速度状态为第二速度状态;
所述控制单元用以基于所述障碍物状态以及障碍物的移动速度判定所述无人船的避障方式,其中,
第一避障方式为确定绕行轨迹,控制所述推进模组改变推进方向以及推进速率以使所述无人船沿所述绕行轨迹航行;
第二避障方式为控制所述推进模组改变推进方向以及推进速率以使无人船保持静止,在第二预设条件下,控制所述推进模组推进所述无人船再次前进;
所述第一预设条件为所述雷达单元判定所述无人船周围有障碍物,所述第二预设条件为所述雷达单元判定所述无人船周围没有障碍物;
补偿模组,其与所述检测模组、推进模组以及避障模组连接,用以基于所述海浪推进方向与无人船航行方向的偏差夹角以及海浪高度与预设海浪高度阈值的对比结果判定是否需要对所述推进模组的运行参数进行修正,并判定对推进模组的运行参数进行修正时的修正方式,包括,
对第一发动机组的推进速率进行修正;
或,对第二发动机组的推进方向进行修正;
所述补偿模组还用以确定所述偏差夹角,其中,所述补偿模组将所述海浪推进方向与无人船航行方向之间的夹角确定为所述偏差夹角;
所述补偿模组判定是否需要对所述推进模组的运行参数进行修正,其中,
所述补偿模组将所述偏差夹角与预设的偏差夹角阈值进行对比,将海浪高度与预设海浪高度阈值进行对比,
在预设对比条件下,所述补偿模组判定需要对所述推进模组的运行参数进行修正;
在非所述预设对比条件下,所述补偿模组判定不需要对所述推进模组的运行参数进行修正;
所述预设对比条件为,所述偏差夹角小于等于所述偏差夹角阈值且所述海浪高度大于预设海浪高度阈值,或所述偏差夹角大于所述偏差夹角阈值;
所述补偿模组判定对推进模组的运行参数进行修正时的修正方式,其中,
若所述偏差夹角小于等于所述偏差夹角阈值且所述海浪高度大于所述预设海浪高度阈值,或所述偏差夹角处于第一预设区间,则所述补偿模组判定对推进模组的第一发动机组的推进速率进行修正;
若所述偏差夹角处于第二预设区间,则所述补偿模组判定对推进模组的第二发动机组的推进方向进行修正;
其中,所述第一预设区间为(150°,180°],所述第二预设区间为(30°,150°]。
2.根据权利要求1所述的无人船避障控制系统,其特征在于,所述控制单元确定航行轨迹,其中,所述航行轨迹基于所述雷达单元检测到障碍物的宽度确定,所述航行轨迹的曲率与所述障碍物的宽度成正相关。
3.根据权利要求1所述的无人船避障控制系统,其特征在于,所述补偿模组内部设置有若干基于所述偏差夹角以及海浪高度修正所述第一发动机组的推进速率的速率修正方式,
各所述速率修正方式对所述第一发动机组的推进速率的修正比例不同。
4.根据权利要求1所述的无人船避障控制系统,其特征在于,所述补偿模组内部设置有若干基于所述偏差夹角确定所述第二发动机组的推进方向的确定方式,各所述确定方式中所确定的推进方向不同。
5.根据权利要求1所述的无人船避障控制系统,其特征在于,所述检测模组内还设置有存储单元,用以存储所述雷达单元以及视觉单元所检测的数据。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202311004989.9A CN116736867B (zh) | 2023-08-10 | 2023-08-10 | 一种无人船避障控制系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202311004989.9A CN116736867B (zh) | 2023-08-10 | 2023-08-10 | 一种无人船避障控制系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN116736867A CN116736867A (zh) | 2023-09-12 |
CN116736867B true CN116736867B (zh) | 2023-11-10 |
Family
ID=87917205
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202311004989.9A Active CN116736867B (zh) | 2023-08-10 | 2023-08-10 | 一种无人船避障控制系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN116736867B (zh) |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104345326A (zh) * | 2013-07-24 | 2015-02-11 | 古野电气株式会社 | 状态计算装置、移动体、状态计算方法 |
KR20170088123A (ko) * | 2016-01-22 | 2017-08-01 | 대우조선해양 주식회사 | 무인 선박의 항해 시스템 및 이를 이용한 항해 제어 방법 |
CN109373983A (zh) * | 2018-11-19 | 2019-02-22 | 华南农业大学 | 一种检测海浪行波参数的方法及姿态自调整的无人船 |
CN110580043A (zh) * | 2019-08-12 | 2019-12-17 | 中国科学院声学研究所 | 一种基于图像目标识别的水面目标规避方法 |
KR20200070758A (ko) * | 2018-12-10 | 2020-06-18 | ㈜버틀러네트워크 | 적외선 카메라를 이용한 무인 선박 운항 시스템 및 그 방법 |
KR20200075506A (ko) * | 2018-12-18 | 2020-06-26 | 한국전기연구원 | 선수각 제어 방법 |
CN111338350A (zh) * | 2020-03-10 | 2020-06-26 | 青岛蓝海未来海洋科技有限责任公司 | 基于贪婪机制粒子群算法的无人船路径规划方法及系统 |
CN113110514A (zh) * | 2021-05-20 | 2021-07-13 | 江苏海事职业技术学院 | 一种基于大数据的无人船航行避障系统及方法 |
CN113625726A (zh) * | 2021-09-08 | 2021-11-09 | 一溪古(上海)人工智能科技有限公司 | 无人船避障方法及其系统 |
KR20220132910A (ko) * | 2021-03-24 | 2022-10-04 | 김대인 | 자율운항선박의 충돌회피 시스템 |
-
2023
- 2023-08-10 CN CN202311004989.9A patent/CN116736867B/zh active Active
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104345326A (zh) * | 2013-07-24 | 2015-02-11 | 古野电气株式会社 | 状态计算装置、移动体、状态计算方法 |
KR20170088123A (ko) * | 2016-01-22 | 2017-08-01 | 대우조선해양 주식회사 | 무인 선박의 항해 시스템 및 이를 이용한 항해 제어 방법 |
CN109373983A (zh) * | 2018-11-19 | 2019-02-22 | 华南农业大学 | 一种检测海浪行波参数的方法及姿态自调整的无人船 |
KR20200070758A (ko) * | 2018-12-10 | 2020-06-18 | ㈜버틀러네트워크 | 적외선 카메라를 이용한 무인 선박 운항 시스템 및 그 방법 |
KR20200075506A (ko) * | 2018-12-18 | 2020-06-26 | 한국전기연구원 | 선수각 제어 방법 |
CN110580043A (zh) * | 2019-08-12 | 2019-12-17 | 中国科学院声学研究所 | 一种基于图像目标识别的水面目标规避方法 |
CN111338350A (zh) * | 2020-03-10 | 2020-06-26 | 青岛蓝海未来海洋科技有限责任公司 | 基于贪婪机制粒子群算法的无人船路径规划方法及系统 |
KR20220132910A (ko) * | 2021-03-24 | 2022-10-04 | 김대인 | 자율운항선박의 충돌회피 시스템 |
CN113110514A (zh) * | 2021-05-20 | 2021-07-13 | 江苏海事职业技术学院 | 一种基于大数据的无人船航行避障系统及方法 |
CN113625726A (zh) * | 2021-09-08 | 2021-11-09 | 一溪古(上海)人工智能科技有限公司 | 无人船避障方法及其系统 |
Non-Patent Citations (2)
Title |
---|
无人船路径跟随控制方法综述;张旋武;谢磊;初秀民;谢朔;柳晨光;张代勇;;交通信息与安全(01);全文 * |
波浪干扰下固定双桨无人水面艇的路径跟踪方法;郑体强;王建华;赵梦铠;吴恭兴;;计算机应用研究(01);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN116736867A (zh) | 2023-09-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113759939B (zh) | 一种受限水域智能航行方法及装置 | |
EP1873052B1 (en) | Automatic mooring system | |
CN101833335B (zh) | 小型水面机器人装置及自适应水流优化导航方法 | |
CN110083159B (zh) | 基于sbg和动态窗口约束的无人船自主动态避碰方法 | |
CN107329477A (zh) | 一种无人船导航和自动驾驶设备及其方法 | |
CN105652878B (zh) | 一种多推进器结合的水下目标低速抵近与悬停潜航体 | |
CN112960078B (zh) | 一种无人帆船自动驾驶系统及其方法 | |
CN109835441B (zh) | 水质监测智能小船的自动驾驶方法及其系统 | |
CN106896815B (zh) | 一种无人船自动停泊系统及方法 | |
CN111290410A (zh) | 一种基于毫米波雷达的船舶自动离靠泊系统及方法 | |
EP3696078B1 (en) | A method and system for piloting an unmanned surface vessel | |
US11987340B2 (en) | Hull behavior control system and marine vessel | |
CN108549372A (zh) | 无人艇控制方法及控制装置 | |
US11161576B2 (en) | Navigation system | |
JP2003127983A (ja) | 自律型水中航走体の航走制御装置 | |
CN107878669A (zh) | 智慧水面监测三体船 | |
CN112068565A (zh) | 一种结构化环境中的无人船自主导航方法和系统 | |
CN116736867B (zh) | 一种无人船避障控制系统 | |
CN113655802A (zh) | 基于差分双桨驱动的无人艇运动控制系统及其方法 | |
CN113625726A (zh) | 无人船避障方法及其系统 | |
CN117130389B (zh) | 一种高可靠性倾转旋翼双模态物流无人机 | |
CN116859948A (zh) | 基于目标检测算法的航道扫测无人船自主航行控制方法及系统 | |
CN115202366B (zh) | 一种基于环境感知的无人艇自主靠泊方法及系统 | |
CN116395111A (zh) | 一种基于多个推进器的水下悬停控制潜航体及其控制方法 | |
CN214150420U (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |