[发明专利]基于人工势场的船舶智能避障方法及系统

权利要求书

1.一种基于人工势场的船舶智能避障方法，其特征在于：它包括以下步骤：

S1、实时采集船舶自身信息、内河航道信息和障碍物信息；船舶自身信息包括船舶位置、航速和航向，内河航道信息包括航道边界位置，障碍物信息包括障碍物位置和障碍物的速度；

S2、根据采集的信息建立内河航道坐标系，建立基于人工势场法的航道边界斥力势场和障碍物斥力势场模型；

S3、依据船舶航行过程中受到航道边界斥力势场和障碍物斥力势场叠加而成的复合场作用来建立平衡方程，求解得到船舶在智能避障中要经过的位置点，位置点拟合在一起得到避障路径；

S4、依据避障路径控制船舶的航向和航速，船舶进入所述的复合势场后，船舶的航速及航向随着与障碍物的距离减小而逐渐减小，当远离障碍物斥力势场后，船舶航速逐渐增大，直到驶出障碍物势场，船舶航速将不再受到障碍物影响。

2.根据权利要求1所述的基于人工势场的船舶智能避障方法，其特征在于：所述的S2具体包括：

S2.1、建立内河航道坐标系：

根据雷达图像和AIS数据，以船舶自身为坐标原点建立经纬坐标系，根据内核航道信息和障碍物信息获取航道边界和障碍物在经纬坐标系中的坐标；

S2.2、建立航道边界斥力势场：

提取航道边界的数据，对航道边界的数据进行分析处理后建立航道边界斥力势场：

式中，U_L.i和U_R.i分别表示航道左右边界斥力势场，k_L.i和k_R.i分别表示航道左右边界施加斥力的系数，表示船舶的质心、航道左右边界对应点坐标，W_船为船宽；

S2.3、根据障碍物信息和船舶自身信息建立障碍物斥力势场：

将静态障碍物描述为圆形和圆角矩形，按船舶领域将船舶自身描述为一个质点，规定静态障碍物的障碍物斥力势场的作用范围，当船舶进入该作用范围内时受到由静态障碍物指向船舶自身的斥力势场作用，在该方向上的速度分量开始减小；

将动态障碍物描述为移动的椭圆形，计算动态障碍物速度方向与船舶自身速度方向夹角为α＝θ-β，动态障碍物与船舶自身的间距障碍物影响范围为ρ₀，

当时，动态障碍物的障碍物斥力势场U_req为：

当时，动态障碍物的障碍物斥力势场U_req为：

当时，船舶不在动态障碍物的障碍物斥力势场作用范围内，不受斥力作用：

U_req＝0；

k_ob表示动态障碍物的障碍物斥力势场的比例系数，表示船舶质心对应点的坐标向量，W_船表示船宽，表示动态障碍物的位置向量，ρ₀表示动态障碍物作用半径，v表示船舶自身的航行速度，v₀表示动态障碍物的运动速度，θ表示船舶自身航行方向，φ为动态障碍物的运动方向，η为放大系数。