[发明专利]一种基于改进的人工协调场的气垫船避障方法

说明书

技术领域

本发明涉及的是一种气垫船避障方法，特别是基于改进的人工协调场的气垫船避障方法。

背景技术

气垫船在海上航行过程中不可避免的会遇到障碍物，由于气垫船的速度较大，因此发生碰撞的概率增大。针对气垫船手操模式，驾驶人员要想控制船成功避开障碍物需要经历信息采集、信息分析、路径规划以及控船等几个步骤，由于气垫船速度很大留给操作人员的决策时间有限，这给驾驶人员很大的工作压力。

国内外关于水面船的避碰控制研究大多集中在专家避碰辅助系统，利用专家的经验对当前的避碰局面给出指导，但是专家系统存在以下缺点：第一，海上情况复杂多变，对于每只船(即便是完全相同的船)都存在各自特殊的问题，需要适合的避碰方案来解决问题，所以对于经验总结的方案来说是无法做到完全适合的；第二，由于每个驾驶员对于海上航行的知识认知不同，无法与总结经验的科学家的认知完全一样，所以这些方案不但无法对驾驶员产生帮助，反而可能会对其产生误导。另外还有一些学者利用电子海图提前对路径规划实现避障。但由于路径规划需要进行在线寻优，算法复杂，并不适合对实时性要求比较高的气垫船。

人工协调场作为一种改进的人工势场，应用于船舶避碰具有计算简单，实时性好，避免了局部极小值，但容易在目标点附近振荡，并且没有考虑到气垫船的运动约束。

发明内容

本发明的目的在于提供一种在考虑气垫船运动约束下实现避障，同时减小气垫船的抖动，提高操气垫船航行安全性的基于改进的人工协调场的气垫船避障方法。

本发明的目的是这样实现的：

(1)获取气垫船状态信息、目标点位置以及障碍物位置；

(2)根据气垫船状态和目标点位置设计PID控制律，代替人工协调场中的吸引力；

(3)根据气垫船状态信息和障碍物位置计算风险度，若风险度大于设定的风险度则进入步骤(4)，否则进入步骤(6)；

(4)设计斥力场，并利用气垫船的最大加速度约束设计斥力场的场强参数，进而计算出斥力；

(5)根据斥力计算出协调力；

(6)将吸引力、排斥力以及协调力合成，算出大地坐标下的合力，然后将所述合力的方向作为气垫船的期望艏向设计艏向PID控制律，将所述合力的大小作为气垫船的纵向控制力对气垫船进行控制。

人工协调场作为一种改进的人工势场，应用于船舶避碰具有计算简单，实时性好，避免了局部极小值，但容易在目标点附近振荡，并且没有考虑到气垫船的运动约束。本发明提出了一种基于改进的人工协调场的气垫船避障方法则很好的解决了这些问题，目的在于在考虑气垫船运动约束下实现避障，同时减小气垫船的抖动，提高操气垫船航行安全性。

本发明相对现有技术具有如下的优点及效果：

人工协调场中的吸引力通过PID控制律产生，由于该控制律将位置偏差、速度以及偏差积分考虑在内，克服了以往吸引力只依赖于位置信息造成的气垫船在目标点附近的抖动。排斥力中的场强参数是根据气垫船的最大加速度设计的，因此协调场的设计考虑了气垫船的运动约束。最后通过转换坐标将水平面协调场的合力转换为气垫船的纵向力和回转力矩，解决了气垫船横向欠驱动的问题。

本发明通过PID控制率来改进人工协调场中的吸引力，减小了传统吸引力只与位置有关而造成的气垫船在目标点附近的抖动，将排斥力与气垫船的运动约束结合在一起实现了有约束的避碰。另外，协调力只根据斥力的大小和方向确定，不需要再设计场强参数，简化了设计过程。本发明能够在气垫船的性能范围内实现安全避障，具有很强的实用价值。

附图说明

图1改进的人工协调场示意图。

图2气垫船避障算法流程图。

图3气垫船避让静态障碍物过程。

图4气垫船与障碍物距离变化曲线。

具体实施方式

下面结合附图对本发明作进一步的详细描述。

结合图2，气垫船避障方法的实现包括如下步骤：

1.读取当前时刻气垫船的位置(x,y)、速度(u,v)、艏向ψ以及回转率r，目标点的位置(x_g,y_g)，障碍物的位置(x_o,y_o)；

2.根据气垫船状态和目标点位置设计如下PID控制律计算吸引力F_a：