1.一种基于改进人工势场的智能无人船路径规划方法,其特征是包括以下的步骤:步骤1:将已知电子海图中的环境信息、无人船起始点坐标和目标点坐标输入到路径规划系统;
步骤2:对目标点建立引力势场,使用如下引力势场构造函数:式中,ka为引力势场的增益系数;ρ(X,Xg)为无人船当前位置到目标点位置的距离;ρg为引力势场影响的距离阈值;kg为势场影响系数;η为势场调节参数;
对电子海图中已知的静态障碍物建立斥力势场,使用如下斥力势场构造函数:式中,kr为斥力势场的增益系数;X为无人船当前位置坐标;Xo为障碍物的位置坐标;P(X,Xo)为无人船当前位置距离最近障碍物的欧几里德距离;ρo为障碍物的斥力势场覆盖的最大半径;ρ(X,Xg)为无人船当前位置到目标位置的欧几里德距离;
步骤3:使用梯度下降法解算出一条从无人船的起始点到目标点的路径;
步骤4:使用解算出的路径指导无人船向目标点运动;
步骤5:在无人船向目标点运动的途中,使用障碍物检测装置检测无人船周围的动态障碍物;
步骤6:若检测到动态障碍物,则实时计算无人船与动态障碍物之间的距离,并在动态障碍物处建立动态障碍物斥力势场,使用如下斥力势场构造函数:式中,kr为斥力势场的增益系数;X为无人船当前位置坐标;Xo为障碍物的位置坐标;ρ(X,Xo)为无人船当前位置距离最近障碍物的欧几里德距离;ρo为障碍物的斥力势场覆盖的最大半径;ρ(X,Xg)为无人船当前位置到目标位置的欧几里德距离;ρu为以无人船为中心的圆形威胁区域半径,ρu<ρo;
式中,f为在斥力势场函数中引入的一个斥力势场系数,对f作如下定义:式中,kf为可调的影响系数;vu和vo分别为无人船和障碍物的运动速度;α为无人船运动速度vu方向与无人船和障碍物连线luo的夹角;θ为障碍物运动速度vo方向与无人船和障碍物连线luo的夹角;
步骤7:根据更新的人工势场,不停地利用梯度下降法实时地解算出从当前位置到目标点的路径;
步骤8:重复步骤4至步骤7直到无人船停止运动,此时计算ρ(X,Xg)是否为0,若为0跳转到步骤10,若不为0跳转到步骤9;
步骤9:若ρ(X,Xg)不为0,则表示无人船陷入了局部极小值点,此时在局部极小点处添加2
一个扰动势场ΔU=kdisρ(X,Xg) ,让无人船离开该点;
式中,ΔU为添加的扰动势能;kdis为可调节的扰动势能随机系数;ρ(X,Xg)为无人船当前位置到目标点的距离;
步骤10:无人船到达目标点,路径规划结束。