CN105022270B - 基于速度矢量坐标系的船自动避碰方法 - Google Patents
基于速度矢量坐标系的船自动避碰方法 Download PDFInfo
- Publication number
- CN105022270B CN105022270B CN201510124602.2A CN201510124602A CN105022270B CN 105022270 B CN105022270 B CN 105022270B CN 201510124602 A CN201510124602 A CN 201510124602A CN 105022270 B CN105022270 B CN 105022270B
- Authority
- CN
- China
- Prior art keywords
- ship
- barrier
- velocity
- speed
- collision
- 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.)
- Expired - Fee Related
Links
- 238000000034 method Methods 0.000 title claims abstract description 27
- 239000002245 particle Substances 0.000 claims abstract description 7
- 230000002093 peripheral effect Effects 0.000 claims abstract description 4
- 230000004888 barrier function Effects 0.000 claims description 74
- 229910052717 sulfur Inorganic materials 0.000 claims description 10
- 229910052760 oxygen Inorganic materials 0.000 claims description 9
- 230000003068 static effect Effects 0.000 claims description 2
- 230000032696 parturition Effects 0.000 claims 1
- 230000002265 prevention Effects 0.000 abstract description 33
- 230000033001 locomotion Effects 0.000 description 14
- 238000004458 analytical method Methods 0.000 description 5
- 238000011160 research Methods 0.000 description 5
- 238000004088 simulation Methods 0.000 description 4
- 238000005516 engineering process Methods 0.000 description 3
- 238000002474 experimental method Methods 0.000 description 3
- 230000008569 process Effects 0.000 description 3
- 230000008859 change Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 2
- QXOQNNAWFUXKMH-UHFFFAOYSA-N 1-(Malonylamino)cyclopropanecarboxylic acid Chemical compound OC(=O)CC(=O)NC1(C(O)=O)CC1 QXOQNNAWFUXKMH-UHFFFAOYSA-N 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000036461 convulsion Effects 0.000 description 1
- 238000000354 decomposition reaction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 235000013399 edible fruits Nutrition 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 239000012530 fluid Substances 0.000 description 1
- 229910052739 hydrogen Inorganic materials 0.000 description 1
- 238000013178 mathematical model Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 229910052757 nitrogen Inorganic materials 0.000 description 1
- 229910052698 phosphorus Inorganic materials 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
- 238000013519 translation Methods 0.000 description 1
- 239000003643 water by type Substances 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Traffic Control Systems (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明提供一种基于速度矢量坐标系的船自动避碰方法:包括:(1)、以某一船舶作为质点,获取该船舶周围的障碍物信息;(2)、通过碰撞预测模型判断船舶与周围障碍物是否有碰撞危险,若存在危险,则进入步骤(3),若不存在危险,则返回步骤(1);(3)、在速度矢量坐标系下,解算该船舶能够移出碰撞区域的相对速度,根据相对速度求解出船舶的绝对速度;(4)、利用船舶的绝对速度在自动舵控制器下调整船舶的航向,直到船舶的当前速度为所述绝对速度;(5)、反复循环步骤(1)‑步骤(4),以实现基于速度矢量坐标系的船自动避碰.本发明不仅能判断出船舶间是否有碰撞风险还能提供避碰方法。
Description
技术领域
本发明涉及航海技术领域,具体涉及一种基于速度矢量坐标系的船自动避碰方法。
背景技术
船舶智能避碰技术研究一直以来是智能航海研究领域的热点和前沿课题,是实现船舶自动化的关键技术之一。由于涉及因素较多,尽管人们对船舶避碰的研究已经付出了很大的努力,但是船舶智能避碰技术研究进展相对还是比较缓慢。例如关于多船会遇避碰决策问题还没有得到很好解决,特别是较为复杂的多船会遇避碰决策问题。
船舶的局部避碰是指船舶在水面航行过程中,遇到如岛屿、船只、浮标等障碍物时,能够考虑到其操纵运动特性,自主地识别避让障碍物。目前,国内外专家学者解决船舶局部避碰问题多采用局部路径规划、轨迹规划方法,并且将多种智能算法注入其中,使得规划时间降低,规划精度提高。目前已有的船舶局部路径规划研究为船舶避碰提供了一定的参考,但是这些方法实施的前提多是将船舶视为质点,忽略其操纵运动特性,并且不考虑外界条件对船舶航行的影响。然而,在复杂的海洋环境中,船舶在躲避障碍物的同时,还会受到风浪流的影响,所以这种理想化的方法对于船舶在实际海面上航行避碰的借鉴意义是有限的,船舶避碰不仅要考虑如何进行固定会遇情况下的路径规划,还需要考虑动态情况下的路径规划。
发明内容
本发明的目的在于解决上述现有技术存在的缺陷,提供一种不仅能判断出船舶间是否有碰撞风险,同时也能提供避碰方法的于速度矢量坐标系的船自动避碰方法。
一种基于速度矢量坐标系的船自动避碰方法,包括以下步骤:
(1)、以某一船舶作为质点,获取该船舶周围的障碍物信息;
(2)、通过碰撞预测模型判断船舶与周围障碍物是否有碰撞危险,若存在危险,则进入步骤(3),若不存在危险,则返回步骤(1);所述通过碰撞预测模型判断船舶与周围障碍物是否有碰撞危险的方法为:
当本船舶处于单目标障碍物情形时:
在全局坐标系XOY中,船舶S位于点(XS,YS),速度为VS;O视为运动障碍物,位于点(XO,YO),速度为VO,首先将船舶S模型化为一个质点,然后将障碍物O根据船舶S的大小进行膨化,其膨化后的半径扩展为RO,并且使得膨化后的障碍物边界为安全区域,称膨化障碍物O为船舶S的一个位置障碍PO, lMO和lNO是船舶S与PO两侧切线方向的射线,DSO为lSO方向上测量到的S与 O之间的距离,定义S和O的相对速度为VSO=VS-VO,则通过相对速度可以把 O当作静止障碍物,S的速度则看作为VSO,如果VSO保持不变,lSO为其方向上的射线,则船舶将和障碍物O发生碰撞的条件为:
使上述条件成立的相对速度VSO的集合,定义为速度空间中的相对碰撞区 RCC:
即射线lMO和lNO之间的区域,对于本船的任一相对速度VSO,如果VSO∈ RCC,则船舶将与障碍物O发生碰撞;
把RCC平移Vo后得到的区域称为绝对碰撞区域ACC:其中表示闵可夫斯基矢量和运算,则VS的末端点位于ACC等价于VSO∈RCC,所以当VS的末端点位于ACC时,船舶将与障碍物O发生碰撞,ACC表示S与 O会发生碰撞的速度VSO的集合,称为S对O的速度障碍VO:
VO(VO)={VS|(VS-VO)∈RCC}
在多目标标障碍物情形时,设障碍物O1的速度为VO1,相应的障碍速度为 OV1;障碍物O2的速度为VO2,相应的速度障碍为OV2,则VS位于ACC1和ACC2之中,即VS∈OV1且VS∈OV2,如果在接下来的时刻VS保持不变,则S将与 O1、O2发生碰撞;
(3)、在速度矢量坐标系下,解算该船舶能够移出碰撞区域的相对速度,根据相对速度求解出船舶的绝对速度;设k时刻,本船S向障碍物O两侧切线方向发射射线lNO和lMO,lNO和lMO与x轴的夹角分别为θ1和θ2;本船S和障碍物O的速度分别为和两者相对速度为 与x轴的夹角θa,避让障碍物所需要的相对速度的方向为θrr,本船S避让障碍物O所需要的相对速度的方向θrr应满足:
0<θrr<θ1或θ2<θrr<2π
取其边界值为本船k时刻避让障碍物所需要的相对速度的方向θrr,则:
根据速度三角形求解本船k时刻避让障碍物所需要的绝对速度方向;
(4)、利用船舶的绝对速度在自动舵控制器下调整船舶的航向,直到船舶的当前速度为所述绝对速度;
(5)、反复循环步骤(1)-步骤(4),以实现基于速度矢量坐标系的船自动避碰。
进一步地,如上所述的基于速度矢量坐标系的船自动避碰方法,其特征在于,所述步骤(3)包括:
船舶针对区域内的所有障碍物分别作切线,其切线l1,l2...l2n与x轴的夹角分
别为θ1,θ2…θ2n,n=1,2…船舶每隔一段较短的时间都要重新计算
θa,θ1,θ2……θ2n;
设本船k时刻避让障碍物所需要的相对速度θrr,取边界值为本船k时刻避让障碍物所需要的相对速度θrr,则船舶避让障碍物所需要的相对速度θrr应满足:
判断出所需的θrr后,根据速度三角形求解本船k时刻避让障碍物所需要的绝对速度方向。
本发明的有益效果是:本发明提供的基于速度矢量坐标系的船自动避碰方法不仅能判断出船舶间是否有碰撞风险,同时也能提供避碰方法,本发明将速度障碍方法应用于船舶避碰领域,深入分析多目标船下船舶避碰的约束条件及操纵要求,构建以速度障碍为核心的基于速度矢量坐标系的多目标船情形下的船舶自动避碰数学模型,并提出本船转向避碰的操纵方案,通过仿真结果表明,该方法能够实现多目标船情形下船舶的自动避碰,本发明建立的基于速度矢量坐标系的多目标船自动避碰问题模型及求解的转向避碰操纵方案是可行的。
附图说明
图1为本发明基于速度障碍的单目标碰撞预测示意图;
图2为本发明基于速度障碍的多目标碰撞预测示意图;
图3为本发明避碰流程图;
图4为本发明速度矢量坐标系下单目标避碰示意;
图5为本发明速度矢量坐标系下多目标避碰示意;
图6为本发明离散化PID转向自动舵的控制流程;
图7(a)为多动态目标且有障碍较为密集情景下船舶避碰的初始场景图;
图7(b)为多动态目标船且有障碍较为密集情景下本船逐渐避开目标船场景图;
图8(a)为动静障碍物结合场景下的初始场景图;
图8 (b)为动静障碍物结合场景下本船逐渐避开静态和动态障碍物。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚,下面本发明中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
本文将速度障碍方法应用于船舶避碰领域,深入分析多目标船下船舶避碰的约束条件及操纵要求,构建以速度障碍为核心的基于速度矢量坐标系的多目标船情形下的船舶自动避碰数学模型,提出避碰的操纵方法,并进行仿真试验;
基于速度障碍的碰撞预测模型
单避让目标情形
如图1所示,全局坐标系XOY中,船舶S位于点(XS,YS),绝对速度为 VS;O视为运动障碍物,位于点(XO,YO),速度为VO。为了简化,将船舶及障碍物(此处以目标船为例)看作为圆形进行分析。首先将船舶S模型化为一个质点,然后将障碍物O根据船舶S的大小进行“膨化”,其半径扩展为RO,所述RO一般取本船的长度,若本船较小,一般取300m,并且使得“膨化”后的障碍物边界为安全区域。称“膨化”障碍物O为船舶S的一个位置障碍(PositionObstacle,PO),lMO和lNO是船舶S与PO两侧切线方向的射线,DSO为lSO方向上测量到的S与O之间的距离。
定义S与O的相对速度:
VSO=VS-VO
则通过相对速度可以把O当作静止障碍物,S的速度则看作为VSO,如果 VSO保持不变,lSO为其方向上的射线,则船舶将和障碍物O发生碰撞的条件为:
使上述条件成立的相对速度VSO的集合,定义为速度空间中的相对碰撞区(Relative Collision Cone,RCC):
即图1中射线lMO和lNO之间的区域,对于本船的任一相对速度VSO,如果VSO∈RCC,则船舶将与障碍物O发生碰撞。
把RCC平移Vo后得到的区域称为绝对碰撞区域(Absolute Collision Cone,ACC):
其中表示闵可夫斯基矢量和运算。
可以看出,则VS的末端点位于ACC等价于VSO∈RCC,所以当VS的末端点位于ACC时,船舶将与障碍物O发生碰撞,ACC表示S与O会发生碰撞的速度VSO的集合,称为S对O的速度障碍(Velocity Obstacle,VO):
VO(VO)={VS|(VS-VO)∈RCC}
多目标避让情形
图2为船舶S遇到多运动障碍物(其他船舶)的一个例子,其中障碍物O1的速度为VO1,相应的障碍速度为OV1;障碍物O2的速度为VO2,相应的速度障碍为OV2。可以看出VS位于ACC1和ACC2之中(即VS∈OV1且VS∈OV2),如果在接下来的时刻VS保持不变,则S将与O1、O2发生碰撞。
速度矢量坐标系的船舶自动避碰方案
船舶运动数学模型
船舶运动规律与传统机器人或车辆有较大区别,难以像移动机器人那样急停急转,其紧急刹车性能和快速转艏性能严重弱于移动机器人,控制时滞性严重,避碰过程中必须要考虑船舶的运动特性。
船舶避碰主要考虑船舶的水面运动,所以需要建立本船前进、横移、转首三个自由度上的运动方程。基于分离模型(MMG)的思想可以分别计算力和力矩,推导得到船舶三自由度动力学方程为[9]:
式中:x、y、ψ为大地坐标系下的横向坐标、纵向坐标、船舶航向;u、v、r 分别为纵向、横向和垂向的速度及绕Oz轴的角速度;m为船舶质量;mx、my、 mz分别为纵向、横向和垂向船舶的附加质量;X、Y、N为船船舶在纵向、横向上的受力及绕Oz轴转动的力矩;下标H、P、R、wind、wave与current的分别代表船体、桨、舵、风、浪、流,表示力或力矩的种类;Izz为绕Oz轴的转动惯量;Jzz为绕Oz轴的附加转动惯量。
为了使问题简化暂不考虑环境中的扰动力,不失一般性,对(2)式进行变换,获得如下形式的分别以三个自由度位置坐标为因变量的二阶微分方程组:
船体各个方向上的附加质量可用相应的经验公式计算,可以表达为船体外形尺度的函数,因此对于某个固定的船,附加质量是常数。船体所受到的流体力用贵岛模型来计算。
基于速度矢量的船舶避碰
在以下分析中,所有船舶以及障碍物都简化为圆形。通过相对速度的概念把物体的相对运动转化为本船以相对速度相对于静止障碍物的避障问题。由碰撞预测模型可知,避障过程就是使相对速度VSO移出碰撞区的过程。由于障碍物速度是不可控的,只有改变本船速度来控制合速度。其核心问题就是在速度矢量坐标系(随船坐标系)求解能使相对速度VSO移出碰撞区的VS的期望速度。即,船舶避碰的策略就是求解能使相对速度VSO移出碰撞区的VS的期望速度方向θr。
避碰的输入量包括目标船的位置信息和速度、其他静态障碍物的位置和本船的位置信息与速度。目标船的相关信息通过AIS来获取,其他障碍物,如礁石或浮标,本文通过搜索矢量电子海图获取本船周边的部分环境信息。通过船上现有设备实现了船舶避碰环境的构建。避碰流程如图3所示。
单避让目标情形
对于船舶与单运动障碍物O,分别计算出PO、RCC及VO,则避碰条件为:且(即VS的末端点位于ACC之外),如图4所示。
设k时刻,本船S向障碍物O两侧切线方向发射射线lNO和lMO,lNO和lMO与x轴的夹角分别为θ1和θ2;本船S和障碍物O的速度分别为和两者相对速度为 与x轴的夹角θa,避让障碍物所需要的相对速度的方向为θrr。则由图4,本船S避让障碍物O所需要的相对速度的方向θrr应满足:
0<θrr<θ1或θ2<θrr<2π
取其边界值为本船k时刻避让障碍物所需要的相对速度的方向θrr,则:
判断出所需的θrr后,对本船S、障碍物O的速度进行x,y方向分解,分别得到VSX、VSY、VOX和VOY,则:
根据速度三角形求解本船k时刻避让障碍物所需要的真实速度方向。
多避让目标情形
在一定水域内随机分布着多个障碍物时,这些障碍物碰撞危险区域可能互相重叠,或者是一个面积较大、覆盖区域较广的障碍物无法直接进行膨化处理,那么可以将该障碍物视作多个小障碍物重叠紧密相连,如图5所示。
船舶针对区域内的所有障碍物分别作切线,其切线l1,l2...l2n与x轴的夹角分别为θ1,θ2…θ2n,n=1,2…船舶每隔一段较短的时间都要重新计算θa,θ1,θ2……θ2n;如果有:
|θ2-θ1|∪|θ3-θ2|∪…∪|θ2n-θ2n-1|
=|θ2n-θ1|
那么就称多个障碍物紧密重叠相连。
对于船舶与多运动障碍物{O1、O2...On},分别计算出Oi(i=1,2,3...n)对应的POi、ACCi及VOi,则船舶与多个运动障碍物的避碰条件为:且(即VR的末端点位于MACC之外),其中:
设本船k时刻避让障碍物所需要的相对速度θrr,取边界值为本船k时刻避让障碍物所需要的相对速度θrr,则由图5,船舶避让障碍物所需要的相对速度θrr应满足:
判断出所需的θrr后,根据速度三角形求解本船k时刻避让障碍物所需要的绝对速度方向θr。
前面已经求出了相对速度的方向θrr,求出相对速度的方向后,才能解算真实的方向
其中,s是相对速度方向的正切值,在每一秒固定,假如相对速度方向固定,反过来要求本船的方向,就要求解期望速度方向θr,所以变形上式,可得:
令
继续整理推导上式,全部化成cosθr的二次方程,求解关于它的二次方程,在求反余弦函数。
V2(1-n)=[m(Vn-v)+u]2
V2(1-n)=m2(Vn-v)2+u2+2mu(Vn-v)
V2(1-n)=m2(V2n2+v2-2Vnv)+u2+2mu(Vn-v)
0=m2V2n2+m2V2-2m2Vnv+u2+2muVn-2mun-V2+V2n
m2V2n2+n(-2m2Vv+2muV+V2)+m2V2+u2-2muv-V2=0
求根公式:
仿真实验
船舶自动舵控制器
由速度障碍计算得到的期望速度方向θr后,采用离散化的PID算法对本船转向避碰进行自动操舵,控制流程如图6所示。
图6中,离散化PID算法构成为:
其中,k表示计算时间;eθ为由速度障碍计算得到的期望速度方向θr与实测本船当前速度方向θ的偏差,即:
eθ=er-θ
经整定后,本文取KP=2.1,KI=0.01,KD=0.9。
场景设置及仿真结果分析
仅有动态多目标船的场景
图7(a)图7(b)所示为有多个动态目标,且有障碍较为密集情景下的船舶避碰。设置前方三艘,后方两艘来船,均朝向本船航行。选取本船的参数:m=55000t、 l=280m、b=35.5m、d=9.45m,初速度10m/s,方向0°。其中m为质量,l 为船长,b为船舶型宽,d为船舶型深。对本船以(1)~(3)式建立其运动模型。选取目标船1#、2#、3#、4#、5#,其初始运动参数分别为:初速度5m/s,方向 180°;初速度6m/s,方向180°;初速度7m/s,方向180°;初速度7m/s,方向0°;初速度7m/s,方向0°。目标船匀速直线运动。试验中,膨化范围取为 300m。
图7(a)为初始场景,图7(b)为避让过程。观察到,本船较好地避开了多条来船,并对前方较为密集的障碍物采取了大角度转弯避碰的策略,较好地避开了障碍物,保证了安全。
同时有静态障碍物和动态多目标船的场景
图8(a)图8(b)所示,场景中既有礁石作为静态障碍物,又有来船作为动态障碍物。选取本船的参数:m=55000t、l=280m、b=35.5m、d=9.45m,初速度10m/s,方向0°。其中m为质量,l为船长,b为船舶型宽,d为船舶型深。对本船以(1)~(3)式建立其运动模型。选取目标船运动速度为5m/s,方向 180°。目标船匀速直线运动,并设置礁石两处。试验中,膨化范围取为300m。
图8(a)为初始场景,图8(b)为一段时间后的避让结果。结果表明船舶对同时有静态和动态障碍物的避碰效果也较理想,在障碍物不密集的时候,采取从两障碍物之间穿越的策略,在保证安全的同时,航行的路径较短达到了预期目标。
本发明将速度障碍方法应用于船舶避碰领域,深入分析多目标船下船舶避碰的约束条件及操纵要求,构建以速度障碍为核心的基于速度矢量坐标系的多目标船情形下的船舶自动避碰数学模型,并提出本船转向避碰的操纵方案。仿真结果表明,该方法能够实现多目标船情形下船舶的自动避碰,本文所建立的基于速度矢量坐标系的多目标船自动避碰问题模型及求解的转向避碰操纵方案是可行的。
最后应说明的是:以上实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围。
Claims (2)
1.一种基于速度矢量坐标系的船自动避碰方法,其特征在于,包括以下步骤:
(1)、以某一船舶作为质点,获取该船舶周围的障碍物信息;
(2)、通过碰撞预测模型判断船舶与周围障碍物是否有碰撞危险,若存在危险,则进入步骤(3),若不存在危险,则返回步骤(1);所述通过碰撞预测模型判断船舶与周围障碍物是否有碰撞危险的方法为:
当本船舶处于单目标障碍物情形时:
在全局坐标系XOY中,船舶S位于点(XS,YS),速度为VS;O视为运动障碍物,位于点(XO,YO),速度为VO,首先将船舶S模型化为一个质点,然后将障碍物O根据船舶S的大小进行膨化,其膨化后的半径扩展为RO,并且使得膨化后的障碍物边界为安全区域,称膨化障碍物O为船舶S的一个位置障碍PO,lMO和lNO是船舶S与PO两侧切线方向的射线,DSO为lSO方向上测量到的S与O之间的距离,定义S和O的相对速度为VSO=VS-VO,则通过相对速度可以把O当作静止障碍物,S的速度则看作为VSO,如果VSO保持不变,lSO为其方向上的射线,则船舶将和障碍物O发生碰撞的条件为:
使上述条件成立的相对速度VSO的集合,定义为速度空间中的相对碰撞区RCC:
即射线lMO和lNO之间的区域,对于本船的任一相对速度VSO,如果VSO∈RCC,则船舶将与障碍物O发生碰撞;
把RCC平移Vo后得到的区域称为绝对碰撞区域ACC:其中表示闵可夫斯基矢量和运算,则VS的末端点位于ACC等价于VSO∈RCC,所以当VS的末端点位于ACC时,船舶将与障碍物O发生碰撞,ACC表示S与O会发生碰撞的速度VSO的集合,称为S对O的速度障碍VO:
VO(VO)={VS|(VS-VO)∈RCC}
在多目标标障碍物情形时,设障碍物O1的速度为VO1,相应的障碍速度为OV1;障碍物O2的速度为VO2,相应的速度障碍为OV2,则VS位于ACC1和ACC2之中,即VS∈OV1且VS∈OV2,如果在接下来的时刻VS保持不变,则S将与O1、O2发生碰撞;
(3)、在速度矢量坐标系下,解算该船舶能够移出碰撞区域的相对速度,根据相对速度求解出船舶的绝对速度;设k时刻,本船S向障碍物O两侧切线方向发射射线lNO和lMO,lNO和lMO与x轴的夹角分别为θ1和θ2;本船S和障碍物O的速度分别为和两者相对速度为 与x轴的夹角θa,避让障碍物所需要的相对速度的方向为θrr,本船S避让障碍物O所需要的相对速度的方向θrr应满足:
0<θrr<θ1或θ2<θrr<2π
取其边界值为本船k时刻避让障碍物所需要的相对速度的方向θrr,则:
根据速度三角形求解本船k时刻避让障碍物所需要的绝对速度方向;
(4)、利用船舶的绝对速度在自动舵控制器下调整船舶的航向,直到船舶的当前速度为所述绝对速度;
(5)、反复循环步骤(1)-步骤(4),以实现基于速度矢量坐标系的船自动避碰。
2.根据权利要求1所述的基于速度矢量坐标系的船自动避碰方法,其特征在于,所述步骤(3)包括:
船舶针对区域内的所有障碍物分别作切线,其切线l1,l2…l2n与x轴的夹角分别为θ1,θ2…θ2n,n=1,2…船舶每隔一段较短的时间都要重新计算θa,θ1,θ2……θ2n;
设本船k时刻避让障碍物所需要的相对速度θrr,取边界值为本船k时刻避让障碍物所需要的相对速度θrr,则船舶避让障碍物所需要的相对速度θrr应满足:
判断出所需的θrr后,根据速度三角形求解本船k时刻避让障碍物所需要的绝对速度方向。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510124602.2A CN105022270B (zh) | 2015-03-20 | 2015-03-20 | 基于速度矢量坐标系的船自动避碰方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510124602.2A CN105022270B (zh) | 2015-03-20 | 2015-03-20 | 基于速度矢量坐标系的船自动避碰方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105022270A CN105022270A (zh) | 2015-11-04 |
CN105022270B true CN105022270B (zh) | 2018-02-02 |
Family
ID=54412320
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510124602.2A Expired - Fee Related CN105022270B (zh) | 2015-03-20 | 2015-03-20 | 基于速度矢量坐标系的船自动避碰方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105022270B (zh) |
Families Citing this family (26)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105717923B (zh) * | 2016-01-16 | 2019-02-19 | 上海大学 | 基于椭圆聚类-碰撞锥推演的无人艇海洋动态避障控制算法 |
CN105549601B (zh) * | 2016-02-05 | 2018-03-02 | 哈尔滨工程大学 | 一种基于虚拟膨化的运动障碍与uuv同向航行的规避方法 |
CN106022274B (zh) * | 2016-05-24 | 2024-01-12 | 零度智控(北京)智能科技有限公司 | 一种避障方法、避障装置及无人驾驶机器 |
CN106292712B (zh) * | 2016-10-25 | 2018-12-07 | 中国人民解放军海军航空大学 | 一种基于速度障碍圆弧法的无人飞行器避障方法 |
CN107065596B (zh) * | 2017-05-17 | 2019-11-26 | 武汉理工大学 | 一种紧迫危险下船舶应急避碰行动效果的仿真评价方法 |
CN107577230B (zh) * | 2017-08-16 | 2020-01-14 | 武汉理工大学 | 一种面向无人船的智能避碰系统 |
CN107729866A (zh) * | 2017-10-31 | 2018-02-23 | 武汉理工大学 | 基于时序图像的船舶碰标自动检测装置及方法 |
CN109062198B (zh) * | 2018-06-07 | 2021-10-01 | 广东工业大学 | 一种船舶的航行控制方法、装置、设备及介质 |
CN109334661B (zh) * | 2018-09-06 | 2020-05-29 | 上海工程技术大学 | 基于速度障碍模型和碰撞概率密度模型的避障预判方法 |
CN109213164A (zh) * | 2018-09-07 | 2019-01-15 | 上海大学 | 基于水面无人艇船体模型的模型预测控制的高速紧急避障方法 |
CN109637195B (zh) * | 2019-02-01 | 2021-06-08 | 大连海事大学 | 一种海上安全航行智能诱导装置 |
CN110400491A (zh) * | 2019-06-10 | 2019-11-01 | 北京海兰信数据科技股份有限公司 | 一种宽水域多目标辅助避碰决策方法及决策系统 |
CN110411448B (zh) * | 2019-06-14 | 2021-03-02 | 青岛科技大学 | 一种船舶感知区域动态网格内代表船的选取方法 |
CN110362074B (zh) * | 2019-06-18 | 2021-11-23 | 华南理工大学 | 一种基于航迹重规划的水面无人艇动态避碰方法 |
CN112542064B (zh) * | 2019-09-23 | 2024-03-26 | 廖秉军 | 一种快速移动物体与慢速移动物体动态避碰方法 |
CN110825108B (zh) * | 2019-11-11 | 2023-03-14 | 浙江理工大学 | 一种在同一空域内多架跟踪无人机的协同防碰撞方法 |
CN110979564B (zh) * | 2019-12-23 | 2021-10-29 | 智慧航海(青岛)科技有限公司 | 一种用于智能船舶实船测试的浮标系统及其控制方法 |
CN111487977B (zh) * | 2020-05-11 | 2023-06-23 | 大连海事大学 | 一种不确定环境下的船舶动态避障优化方法及系统 |
CN111930123B (zh) * | 2020-08-13 | 2024-06-18 | 上海船舶研究设计院(中国船舶工业集团公司第六0四研究院) | 多目标综合优化决策方法、装置及电子设备 |
CN112085969A (zh) * | 2020-09-04 | 2020-12-15 | 中国船舶重工集团公司第七0七研究所九江分部 | 一种本船安全航向区间的确定方法及相关系统 |
CN113012473B (zh) * | 2021-02-07 | 2022-04-19 | 中电科(宁波)海洋电子研究院有限公司 | 一种低成本波浪滑翔器海上航行避碰方法 |
CN113110460B (zh) * | 2021-04-20 | 2022-09-02 | 哈尔滨工程大学 | 一种动态环境下获取水面无人艇艏向可行区间的方法 |
CN113436467B (zh) * | 2021-06-23 | 2022-10-28 | 中国船舶重工集团公司第七0七研究所 | 一种水面无人艇在河道航行时的避碰决策方法 |
CN113744569B (zh) * | 2021-11-03 | 2022-02-18 | 武汉理工大学 | 开阔水域船舶自主避碰方法、系统、设备及存储介质 |
CN113759939B (zh) * | 2021-11-11 | 2022-03-29 | 武汉理工大学 | 一种受限水域智能航行方法及装置 |
CN117826824B (zh) * | 2024-01-18 | 2024-06-21 | 交通运输部水运科学研究所 | 船舶自适应自主航行决策方法、装置及电子设备 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US3981008A (en) * | 1969-12-15 | 1976-09-14 | Iotron Corporation | Navigational and collision avoidance apparatus |
CN101639988A (zh) * | 2009-05-15 | 2010-02-03 | 天津七一二通信广播有限公司 | 避免船只碰撞的方法 |
US7957858B1 (en) * | 2007-05-07 | 2011-06-07 | The United States Of America As Represented By The Secretary Of The Navy | Method for determining projected obstacle areas for moving obstacles |
CN102147981A (zh) * | 2010-12-20 | 2011-08-10 | 成都天奥信息科技有限公司 | 一种船载自动识别系统警戒区域报警的方法 |
CN104050329A (zh) * | 2014-06-25 | 2014-09-17 | 哈尔滨工程大学 | 一种检测船舶碰撞危险度的方法 |
-
2015
- 2015-03-20 CN CN201510124602.2A patent/CN105022270B/zh not_active Expired - Fee Related
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US3981008A (en) * | 1969-12-15 | 1976-09-14 | Iotron Corporation | Navigational and collision avoidance apparatus |
US7957858B1 (en) * | 2007-05-07 | 2011-06-07 | The United States Of America As Represented By The Secretary Of The Navy | Method for determining projected obstacle areas for moving obstacles |
CN101639988A (zh) * | 2009-05-15 | 2010-02-03 | 天津七一二通信广播有限公司 | 避免船只碰撞的方法 |
CN102147981A (zh) * | 2010-12-20 | 2011-08-10 | 成都天奥信息科技有限公司 | 一种船载自动识别系统警戒区域报警的方法 |
CN104050329A (zh) * | 2014-06-25 | 2014-09-17 | 哈尔滨工程大学 | 一种检测船舶碰撞危险度的方法 |
Non-Patent Citations (3)
Title |
---|
基于改进速度障碍法的多机器人避碰规划算法;黄永龙;《计算机工程与应用》;20121231;第48卷(第32期);正文第2节 * |
基于电子海图的船舶避碰技术的研究;陈立家;《武汉理工大学学报(交通科学与工程版)》;20131031;第37卷(第5期);第980-982页 * |
速度矢量坐标系下水下机器人动态避障方法;毛宇峰;《哈尔滨工程大学学报》;20100228;第31卷(第2期);正文第2节 * |
Also Published As
Publication number | Publication date |
---|---|
CN105022270A (zh) | 2015-11-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105022270B (zh) | 基于速度矢量坐标系的船自动避碰方法 | |
CN110362074B (zh) | 一种基于航迹重规划的水面无人艇动态避碰方法 | |
He et al. | Quantitative analysis of COLREG rules and seamanship for autonomous collision avoidance at open sea | |
CN107168335B (zh) | 一种考虑混合多目标避障的水面无人艇路径跟踪制导方法 | |
CN106959698B (zh) | 一种路径跟踪避障制导方法 | |
Song et al. | A two-level dynamic obstacle avoidance algorithm for unmanned surface vehicles | |
Fang et al. | A simplified simulation model of ship navigation for safety and collision avoidance in heavy traffic areas | |
Xue et al. | Automatic simulation of ship navigation | |
Wang et al. | An obstacle avoidance strategy for the wave glider based on the improved artificial potential field and collision prediction model | |
CN113759939B (zh) | 一种受限水域智能航行方法及装置 | |
Han et al. | Automatic berthing for an underactuated unmanned surface vehicle: A real-time motion planning approach | |
Zhang et al. | An adaptive obstacle avoidance algorithm for unmanned surface vehicle in complicated marine environments | |
CN107966152A (zh) | 一种具有碰撞风险预测机制的避碰及路径跟踪制导方法 | |
CN108829134A (zh) | 一种深海机器人实时自主避障方法 | |
Lee et al. | A collision avoidance method for multi-ship encounter situations | |
Hedjar et al. | An automatic collision avoidance algorithm for multiple marine surface vehicles | |
Wang et al. | A distributed model predictive control using virtual field force for multi-ship collision avoidance under COLREGs | |
Nie et al. | Planar path-following tracking control for an autonomous underwater vehicle in the horizontal plane | |
Liu et al. | COLREGS-based collision avoidance algorithm for unmanned surface vehicles using modified artificial potential fields | |
Shuai et al. | An effective ship control strategy for collision-free maneuver toward a dock | |
Zhou et al. | Navigation safety domain and collision risk index for decision support of collision avoidance of USVs | |
Yu et al. | Dynamic adaptive autonomous navigation decision-making method in traffic separation scheme waters: A case study for Chengshanjiao waters | |
Lee et al. | An automatic collision avoidance and route generating algorithm for ships based on field model | |
Qiaomei et al. | Autopilot design for unmanned surface vehicle tracking control | |
Zhang et al. | Collision avoidance path planning of open water ships based on velocity obstacle method |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20180202 Termination date: 20190320 |
|
CF01 | Termination of patent right due to non-payment of annual fee |