多障碍复杂环境下欠驱动无人艇的自主靠泊方法技术

本发明专利技术公开了多障碍复杂环境下欠驱动无人艇的自主靠泊方法，属于水面无人艇局部动态靠泊规划领域。包括：计算目标泊位的一级引导点，二级引导点；判断无人艇是否到达一级引导点，二级引导点；计算无人艇当前位置与目标泊位间的距离；结合LOS视线法计算当前无人艇的靠泊约束集；计算当前无人艇与周围障碍物的最短碰撞时间；计算当前情况下无人艇的椭圆碰撞锥；利用基于COLREGS的多障碍启发式算法，选择无人艇速度矢量；计算无人艇下一时刻的位置。在传统速度障碍法中加入多级目标引导和靠泊约束集，成功实现多障碍复杂环境下欠驱动无人艇的自主靠泊，充分考虑了无人艇自身动力学、运动学和目标泊位的约束特性，使无人艇在自主靠泊中遵守海事规则。

【技术实现步骤摘要】
多障碍复杂环境下欠驱动无人艇的自主靠泊方法
本专利技术属于水面无人艇局部动态靠泊规划领域，具体涉及多障碍复杂环境下欠驱动无人艇的自主靠泊方法。
技术介绍
无人艇作为一种典型的欠驱动系统，在多障碍复杂环境下的局部动态靠泊规划一直是其研究领域的核心之一。该问题的主要难点在于多数局部动态规划方法没有考虑目标点对无人艇速度艏向的约束以及靠泊过程中的避障效率，这些方法在视野开阔的海域也许可以得到令人满意的结果，但是在交通复杂的港口码头里面，这些方法并不能完成无人艇的自主靠泊任务。公开日2017年6月13日，公开号CN106845716A，专利技术名称为“一种基于导航误差约束的水面无人艇局部分层路径规划方法”的专利申请采用了分层思想，将局部路径规划划分为静态路径规划和动态路径规划两个层面，即解决了静态障碍物规避问题，又解决了动态障碍物规避问题，考虑了水面无人艇自身的动力学约束，并融合了海事规则，提高了规划路径的安全性。该方法虽然结合了海事规则和无人艇自身动力学约束，却没有考虑目标点约束和靠泊过程中无人艇的运动学约束，无法直接用于无人艇低速状态下的自主靠泊任务。公开日2018年1月5日，公开号CN107544500A，专利技术名称为“一种考虑约束的无人艇靠泊行为轨迹规划方法”的专利申请采用了改进人工势场法，考虑无人艇自身运动约束，为无人艇的自主靠泊控制问题提供便利。但该方法没有考虑无人艇靠泊过程中遇到的动态障碍，在规划的过程中也没有遵守海事规则，因此在复杂的动态环境中很难保证其规划的有效性。文献“基于速度障碍原理的无人艇自动避碰算法”中，吴博等人提出了一种考虑风浪流影响下的无人艇操纵运动特性的改进速度障碍法，有效克服了局部路径规划的局限性，并且更符合无人艇实际航行避碰操纵要求，能够使无人艇在具有多个动态障碍物的复杂环境中安全避让。该方法虽然经过了仿真验证，但它没有结合COLREGS海事规则对无人艇的避让机动进行调整，且没有考虑目标点对无人艇的速度艏向约束。本专利技术针对多障碍复杂环境下欠驱动无人艇的自主靠泊实际问题，在经典速度障碍方法的基础上，加入目标泊位对无人艇的艏向和速度约束，并在满足欠驱动无人艇靠泊过程中运动特性的前提下，利用基于COLREGS的多障碍启发式算法，完成多障碍复杂环境下欠驱动无人艇的自主靠泊任务并通过仿真试验取得了优良的效果。
技术实现思路
本专利技术的目的在于提供使无人艇在遵守国际海事公约的基础上以尽可能高的效率进行自主靠泊的多障碍复杂环境下欠驱动无人艇的自主靠泊方法。本专利技术的目的通过如下技术方案来实现：多障碍复杂环境下欠驱动无人艇的自主靠泊方法，包括以下步骤：(1)由传感器获取无人艇当前的位置P(xc,yc)，速度vc，角速度ωc和艏向fc；目标泊位的位置(xA,yA)和目标姿态角周围障碍物的个数n位置(xi,yi)，速度vi，艏向fi，其中i＝0,1,2…n，并将碰撞障碍数j初始化为0；(2)根据(xA,yA)和以及无人艇的最大速度Vmax和最大加速度amax计算目标泊位的一级引导点Aim1(xA1,yA1)；(3)根据(xA1,yA1)、(xc,yc)、vc、ωc计算二级引导点Aim2(xA2,yA2)；(4)根据(xc,yc)和(xA2,yA2)判断当前无人艇是否到达Aim2，是则转步骤(5)，否则以Aim2的方向为目标艏向Kf；(5)根据(xc,yc)和(xA1,yA1)判断当前无人艇是否到达Aim1，是则以Aim的方向为目标艏向Kf，否则沿回转引导圆行驶直到抵达Aim1；(6)计算当前无人艇(xc,yc)与目标泊位间的相对距离Kd；(7)判断Kd是否为0，是则结束，否则转步骤(8)；(8)根据当前无人艇的速度vc和艏向dc，结合LOS视线法计算当前无人艇的靠泊约束集[vd]；(9)利用公式tmin(i)＝Lu2c(i)/vu2c(i)分别计算当前无人艇与第i个障碍物的最短碰撞时间tmin(i)，i＝0,1,2…n，其中Lu2c和vu2c分别是当前无人艇与障碍物i间的相对距离和相对速度；(10)判断tmin(i)是否小于时间阈值Tc(由无人艇动力学特性获得)，是则令j等于j加1转步骤(16)，否则转步骤(15)；(11)根据障碍j与无人艇的相对距离速度艏向信息计算当前情况下的椭圆碰撞锥[vo]＝(Tan1，Tan2)(1)∪(Tan1，Tan2)(2)∪…∪(Tan1，Tan2)(j)，其中Tan1和Tan2是无人艇与障碍j间绝对速度矢量空间内的两个切线艏向角；(12)计算[vd]∩[vo]，得到当前无人艇的可行速度矢量集[Cand]；(13)判断[Cand]是否为空，是则将无人艇速度置0并转步骤(16)，否则转步骤(14)；(14)利用基于COLREGS的多障碍启发算方法，在[Cand]集合中选择合适的无人艇速度矢量(v*，f*)；(15)判断i是否等于n，是则令无人艇速度等于缺省值Vdef，艏向等于Kf并转步骤(17)，否则令i等于i加1并返回步骤(10)；(16)判断i是否等于n，是则转步骤(11)，否则令i等于i加1并返回步骤(10)；(17)根据新的无人艇速度艏向，利用公式计算无人艇下一时刻的位置P*，令P等于P*，返回步骤(1)。目标泊位的一级二级引导点和回转引导圆是本专利技术的一个核心，其计算步骤包括：(a)根据无人艇最大速度Vmax和最大加速度amax计算无人艇舵效消失的最短距离lmin，其中lmin＝Vmax2/(2amax)；(b)根据目标姿态角和目标位置(xA,yA)计算Aim1(xA1,yA1)，其中(c)计算当前无人艇与目标泊位的相对角度Kf，公式为判断Kf是否大于是则转步骤(d)并记flag＝’R’，否则转步骤(e)并记flag＝’L’；(d)计算回转引导圆的圆心(xO,yO)等于(xOR,yOR)，其中(e)计算回转引导圆的圆心(xO,yO)等于(xOL,yOL)，其中Rl为回转引导圆的半径长，大于等于那一刻无人艇的最小回转半径；(f)若flag为’R’，计算当前无人艇与回转引导圆的左切点为Aim2，否则计算当前无人艇与回转引导圆的右切点为Aim2。结合LOS视线法的靠泊约束集是本专利技术的第二个核心，其计算步骤包括：(8.1)根据Kd利用视线法计算目标点对无人艇的速度约束LosV，公式为其中Δ为视线法有效距离参数。(8.2)根据vc和fc计算当前无人艇运动学艏向约束(fkinmin，fkinmax)，公式为其中ωmax是无人艇的最大回转角速度，et是单位时间；(8.3)根据vc，ωc和fc计算当前无人艇的动力学速度约束(vdymin，vdymax)和艏向角约束(fdymin，fdymax)，公式为其中amax是无人艇最大加速度，αmax是无人艇最大回转角加速度；(8.4)比较vdymax与LosV的大小，若LosV小于vdymax，则转步骤(8.5)，否则转步骤(8.6)；(8.5)比较vdymin与LosV的大小，若LosV小于vdymin，则令vdymin等于0，vdymax等于LosV，否则令vdymax等于LosV；(8.6)(fkinmin，fkinmax)与(fdymin，fdymax)取交集，与(vdymin，vdymax)共同构成无人艇的靠泊约束集[vd本文档来自技高网...

【技术保护点】
1.多障碍复杂环境下欠驱动无人艇的自主靠泊方法，其特征在于，包括以下步骤：(1)由传感器获取无人艇当前的位置P(xc,yc)，速度vc，角速度ωc和艏向fc；目标泊位的位置(xA,yA)和目标姿态角

【技术特征摘要】
1.多障碍复杂环境下欠驱动无人艇的自主靠泊方法，其特征在于，包括以下步骤：(1)由传感器获取无人艇当前的位置P(xc,yc)，速度vc，角速度ωc和艏向fc；目标泊位的位置(xA,yA)和目标姿态角周围障碍物的个数n位置(xi,yi)，速度vi，艏向fi，其中i＝0,1,2…n，并将碰撞障碍数j初始化为0；(2)根据(xA,yA)和以及无人艇的最大速度Vmax和最大加速度amax计算目标泊位的一级引导点Aim1(xA1,yA1)；(3)根据(xA1,yA1)、(xc,yc)、vc、ωc计算二级引导点Aim2(xA2,yA2)；(4)根据(xc,yc)和(xA2,yA2)判断当前无人艇是否到达Aim2，是则转步骤(5)，否则以Aim2的方向为目标艏向Kf；(5)根据(xc,yc)和(xA1,yA1)判断当前无人艇是否到达Aim1，是则以Aim的方向为目标艏向Kf，否则沿回转引导圆行驶直到抵达Aim1；(6)计算当前无人艇(xc,yc)与目标泊位间的相对距离Kd；(7)判断Kd是否为0，是则结束，否则转步骤(8)；(8)根据当前无人艇的速度vc和艏向dc，结合LOS视线法计算当前无人艇的靠泊约束集[vd]；(9)利用公式tmin(i)＝Lu2c(i)/vu2c(i)分别计算当前无人艇与第i个障碍物的最短碰撞时间tmin(i)，i＝0,1,2…n，其中Lu2c和vu2c分别是当前无人艇与障碍物i间的相对距离和相对速度；(10)判断tmin(i)是否小于时间阈值Tc(由无人艇动力学特性获得)，是则令j等于j加1转步骤(16)，否则转步骤(15)；(11)根据障碍j与无人艇的相对距离速度艏向信息计算当前情况下的椭圆碰撞锥[vo]＝(Tan1，Tan2)(1)∪(Tan1，Tan2)(2)∪…∪(Tan1，Tan2)(j)，其中Tan1和Tan2是无人艇与障碍j间绝对速度矢量空间内的两个切线艏向角；(12)计算[vd]∩[vo]，得到当前无人艇的可行速度矢量集[Cand]；(13)判断[Cand]是否为空，是则将无人艇速度置0并转步骤(16)，否则转步骤(14)；(14)利用基于COLREGS的多障碍启发算方法，在[Cand]集合中选择合适的无人艇速度矢量(v*，f*)；(15)判断i是否等于n，是则令无人艇速度等于缺省值Vdef，艏向等于Kf并转步骤(17)，否则令i等于i加1并返回步骤(10)；(16)判断i是否等于n，是则转步骤(11)，否则令i等于i加1并返回步骤(10)；(17)根据新的无人艇速度艏向，利用公式计算无人艇下一时刻的位置P*，令P等于P*，返回步骤(1)。2.根据权利要求1所述的多障碍复杂环境下欠驱动无人艇的自主靠泊方法，其特征在于，步骤(2)中目标泊位的一级引导点，步骤(3)中目标泊位的二级引导点和步骤(5)中回转引导圆的计算步骤包括：(a)根据无人艇最大速度Vmax和最大加速度amax计算无人艇舵效消失的最短距离lmin，其中lmin＝Vmax2/(2amax)；(b)根据目标姿态角和目标位置(xA,yA)计算Aim1(xA1,yA1)，其中(c)计算当前无人艇与目标泊位的相对角度Kf，公式为判断Kf是否大于是则转步骤(d)并记...

【专利技术属性】
技术研发人员：贾知浩，李晔，廖煜雷，张伟，陈启贤，张伟斌，王磊峰，潘恺文，姜权权，范佳佳，
申请(专利权)人：哈尔滨工程大学，
类型：发明
国别省市：黑龙江,23