欢迎来到知嘟嘟! 联系电话:13336804447 卖家免费入驻,海量在线求购! 卖家免费入驻,海量在线求购!
知嘟嘟
我要发布
联系电话:13336804447
知嘟嘟经纪人
收藏
专利号: 2020113282586
申请人: 浙大宁波理工学院
专利类型:发明专利
专利状态:未下证
专利领域: 控制;调节
更新日期:2026-11-16
缴费截止日期: 暂无
价格&联系人
年费信息
委托购买

摘要:

权利要求书:

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:无人船到达目标点,路径规划结束。