一种基于改进的人工协调场的气垫船避障方法
【技术领域】
[0001] 本发明设及的是一种气垫船避障方法，特别是基于改进的人工协调场的气垫船避 障方法。
【背景技术】
[0002] 气垫船在海上航行过程中不可避免的会遇到障碍物，由于气垫船的速度较大，因 此发生碰撞的概率增大。针对气垫船手操模式，驾驶人员要想控制船成功避开障碍物需要 经历信息采集、信息分析、路径规划W及控船等几个步骤，由于气垫船速度很大留给操作人 员的决策时间有限，运给驾驶人员很大的工作压力。
[0003] 国内外关于水面船的避碰控制研究大多集中在专家避碰辅助系统，利用专家的经 验对当前的避碰局面给出指导，但是专家系统存在W下缺点：第一，海上情况复杂多变，对 于每只船（即便是完全相同的船）都存在各自特殊的问题，需要适合的避碰方案来解决问 题，所W对于经验总结的方案来说是无法做到完全适合的；第二，由于每个驾驶员对于海上 航行的知识认知不同，无法与总结经验的科学家的认知完全一样，所W运些方案不但无法 对驾驶员产生帮助，反而可能会对其产生误导。另外还有一些学者利用电子海图提前对路 径规划实现避障。但由于路径规划需要进行在线寻优，算法复杂，并不适合对实时性要求比 较高的气垫船。
[0004] 人工协调场作为一种改进的人工势场，应用于船舶避碰具有计算简单，实时性好， 避免了局部极小值，但容易在目标点附近振荡，并且没有考虑到气垫船的运动约束。
【发明内容】
[0005] 本发明的目的在于提供一种在考虑气垫船运动约束下实现避障，同时减小气垫船 的抖动，提高操气垫船航行安全性的基于改进的人工协调场的气垫船避障方法。
[0006] 本发明的目的是运样实现的：
[0007] (1)获取气垫船状态信息、目标点位置W及障碍物位置；
[0008] (2)根据气垫船状态和目标点位置设计PID控制律，代替人工协调场中的吸引力；
[0009] (3)根据气垫船状态信息和障碍物位置计算风险度，若风险度大于设定的风险度 则进入步骤（4)，否则进入步骤化）；
[0010] (4)设计斥力场，并利用气垫船的最大加速度约束设计斥力场的场强参数，进而计 算出斥力；
[0011] 妨根据斥力计算出协调力；
[001引 （6)将吸引力、排斥力W及协调力合成，算出大地坐标下的合力，然后将所述合力 的方向作为气垫船的期望腊向设计腊向PID控制律，将所述合力的大小作为气垫船的纵向 控制力对气垫船进行控制。
[0013]人工协调场作为一种改进的人工势场，应用于船舶避碰具有计算简单，实时性好， 避免了局部极小值，但容易在目标点附近振荡，并且没有考虑到气垫船的运动约束。本发明 提出了一种基于改进的人工协调场的气垫船避障方法则很好的解决了运些问题，目的在于 在考虑气垫船运动约束下实现避障，同时减小气垫船的抖动，提高操气垫船航行安全性。
[0014] 本发明相对现有技术具有如下的优点及效果：
[0015] 人工协调场中的吸引力通过PID控制律产生，由于该控制律将位置偏差、速度W 及偏差积分考虑在内，克服了W往吸引力只依赖于位置信息造成的气垫船在目标点附近的 抖动。排斥力中的场强参数是根据气垫船的最大加速度设计的，因此协调场的设计考虑了 气垫船的运动约束。最后通过转换坐标将水平面协调场的合力转换为气垫船的纵向力和回 转力矩，解决了气垫船横向欠驱动的问题。
[0016] 本发明通过PID控制率来改进人工协调场中的吸引力，减小了传统吸引力只与位 置有关而造成的气垫船在目标点附近的抖动，将排斥力与气垫船的运动约束结合在一起实 现了有约束的避碰。另外，协调力只根据斥力的大小和方向确定，不需要再设计场强参数， 简化了设计过程。本发明能够在气垫船的性能范围内实现安全避障，具有很强的实用价值。
【附图说明】
[0017] 图1改进的人工协调场示意图。
[0018] 图2气垫船避障算法流程图。
[0019] 图3气垫船避让静态障碍物过程。
[0020] 图4气垫船与障碍物距离变化曲线。
【具体实施方式】
[0021] 下面结合附图对本发明作进一步的详细描述。
[0022] 结合图2,气垫船避障方法的实现包括如下步骤：
[0023]1.读取当前时刻气垫船的位置（x，y)、速度（u，v)、腊向11) W及回转率r，目标点 的位置（Xg，yg)，障碍物的位置（X。，y。）；
[0024] 2.根据气垫船状态和目标点位置设计如下PID控制律计算吸引力F。：
[00巧]
[0026] 其中，Pg=[Xg，yg]T，P=[X，y]T，户=/r;义.'，
U=山v]T， Kp，Ki，Kd为2X2的增益矩阵；
[0027] 3.计算碰撞风险度risk,并与设定的;r_d比较：
[0028]
[0029] 其中d为设定的障碍物与气垫船安全距离，e为设定的安全余量。若risk>r_ d，则进行下一步计算，否则转至步骤6 ;
[0030] 4.设计斥力场并计算斥力Ff;
[0031] Ff=kr(P-P。）
[0032]其中，P"=[XwyjT;
[0033] 场强参数kr如下计算：
[0034]
[00巧]其中，m> 1，pos(x) =max(x, 0)，U"为气垫船相对于障碍物的相对速度，因为运 里考虑的是静态障碍物，因此有U"=U，e(X)表示向量X的单位向量，am。、表示气垫船的最 大加速度；
[0036] 5.根据斥力计算协调力Fn:
[0037] Fn=kn*^*Fr
[0038] 其中，k。为标量的可调参数，
A的主要作用就是产生垂直于斥力的 协调力，避免局部极小值的出现。
[0039] 6.计算气垫船在大地坐标下的合力F，并转换成气垫船的纵向力和回转力矩：
[0040]
[0041] 设二维合力F =[n，f2]T，fl，f2分别为合力在大地坐标下的北向分力和东向分 力，则气垫船的期望腊向il>d:
[0042]
[0043] 气垫船的回转控制力矩T。可根据PID计算为
[0044] T n= k P(广1]〇+ki / (1]5广1]〇dt+kd (fd-r)
[004引其中，kp，ki，kd为标量的可调PID参数，於，为期望的腊向，約为期望的腊 向回转率。
[0046] 气垫船的纵向控制力Tx为
[0047]
[0048] 运样就把大地坐标下计算的合力转换为气垫船的纵向控制力和回转控制力矩。
【主权项】
1. 一种基于改进的人工协调场的气垫船避障方法，其特征是： (1) 获取气垫船状态信息、目标点位置以及障碍物位置； (2) 根据气垫船状态和目标点位置设计PID控制律，代替人工协调场中的吸引力； (3) 根据气垫船状态信息和障碍物位置计算风险度，若风险度大于设定的风险度则进 入步骤（4)，否则进入步骤（6); (4) 设计斥力场，并利用气垫船的最大加速度约束设计斥力场的场强参数，进而计算出 斥力； (5) 根据斥力计算出协调力； (6) 将吸引力、排斥力以及协调力合成，算出大地坐标下的合力，然后将所述合力的方 向作为气垫船的期望艏向设计艏向PID控制律，将所述合力的大小作为气垫船的纵向控制 力对气垫船进行控制。2. 根据权利要求1所述的基于改进的人工协调场的气垫船避障方法，其特征是：所述 气垫船状态信息包括当前时刻位置（X，y)、速度（u，V)、艏向Φ以及回转率r，目标点位置用 (x g，yg)表示，障碍物位置用（Xc^yci)表示。3. 根据权利要求2所述的基于改进的人工协调场的气垫船避障方法，其特征是吸引力 Fa为：为2X2的增益矩阵。4. 根据权利要求3所述的基于改进的人工协调场的气垫船避障方法，其特征是：风险 度risk为，其中d为设定的障碍物与气垫船安全距离，ε为设定的安全余量。5. 根据权利要求4所述的基于改进的人工协调场的气垫船避障方法，其特征是斥力F ^ 为： Fr= kr (P-P0) 其中，P。= [X。，yJT; 场强参数I如下计算：其中，m彡1，pos(x) = max(X，0)，Uot为气垫船相对于障碍物的相对速度，因为这里考 虑的是静态障碍物，因此有Uot= U，e (X)表示向量X的单位向量，a _表示气垫船的最大加 速度。6. 根据权利要求5所述的基于改进的人工协调场的气垫船避障方法，其特征是协调力其中，kn为标量的可调参数，，：λ的作用就是产生垂直于斥力的协调力，避 免局部极小值的出现。7.根据权利要求6所述的基于改进的人工协调场的气垫船避障方法，其特征是大地坐 标下的合力为F为：设二维合力F = [fl，f2]T，fl，f2分别为合力在大地坐标下的北向分力和东向分力，则 气垫船的期望艏向气垫船的回转控制力矩τη根据PID计算为其中，kp，Ic1, kd为标量的可调PID参数，G =么，％为期望的艏向，匕为期望的艏向回 转率。 气垫船的纵向控制力^为
【专利摘要】本发明提供的是一种基于改进的人工协调场的气垫船避障方法。(1)获取状态信息、目标点位置以及障碍物位置；(2)设计PID控制律，代替人工协调场中的吸引力；(3)计算风险度，若风险度大于设定的风险度则进入步骤(4)，否则进入步骤(6)；(4)设计斥力场，并利用最大加速度约束设计斥力场的场强参数，进而计算出斥力；(5)根据斥力计算出协调力；(6)算出大地坐标下的合力，将合力的方向作为期望艏向设计艏向PID控制律，将合力的大小作为纵向控制力对气垫船进行控制。本发明减小了传统吸引力只与位置有关而造成的气垫船在目标点附近的抖动，实现了有约束的避碰，能够在气垫船的性能范围内实现安全避障，具有很强的实用价值。
【IPC分类】G05D1/02
【公开号】CN105182975
【申请号】CN201510593659
【发明人】付明玉, 徐玉杰, 王成龙, 丁福光, 林孝工, 王元慧, 赵大威, 刘向波
【申请人】哈尔滨工程大学
【公开日】2015年12月23日
【申请日】2015年9月17日