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

摘要:

权利要求书:

1.一种无人艇全局路径规划方法,其特征在于:基于代价评估函数,引入局部障碍斥力项和偏流角度得到优化代价函数,计算各个拓展点的代价值,选取代价值最低的拓展点作为路径的下一节点,包括以下步骤:步骤一:设置了2个数据集合:open list和closed list;初始化open list和closed list,将起点S放入open list中;

步骤二:对当前节点x和其父节点p(x)进行视线检查,从而判断视线是否存在;

步骤三:若所述视线不存在,将当前节点x放入closed list,则选择领域closed list中g(x′)+c(x,x')最小的点为当前节点x的父节点;x'表示当前节点x的拓展点,g(x′)+c(x,x')表示起始点到拓展点的路径代价加当前节点到拓展点的路径代价;

步骤四:若所述视线存在,遍历所述当前节点x的领域,计算领域拓展节点x'的g(x'),g(x')表示当前节点x的拓展点的g值,即表示起始点到该拓展点的路径代价;

步骤五:重复所述步骤四直到算法结束,根据每个节点间的父子关系形成一条规划路径。

2.根据权利要求1所述的一种无人艇全局路径规划方法,其特征在于:所述局部障碍斥力的计算公式为:偏流角度的计算公式为:

Δθ(x)=θyaw(x)‑θstream(x)

其中,θ(x)表示偏流角度项代价,Δθ(x)表示当前位置路径方向与水流方向夹角,θyaw(x)表示当前位置路径方向角,θstream(x)表示当前位置水流流向角;ρ(x,xobs)表示无人艇所在位置与障碍物之间的距离;ρ0表示障碍物影响距离;xobs障碍物位置;x表示当前节点。

3.根据权利要求2所述的一种无人艇全局路径规划方法,其特征在于:

所述优化代价函数为:

其中,c(x,p(x))表示当前节点到其父节点的欧式距离, 为局部障碍斥力项,表示一定范围内障碍物对当前节点的斥力之和,krep为局部障碍斥力项系数,n表示一定范围内障碍物的数量;kstreamθ(x)为偏流角度项,反应路径与水流夹角大小,kstream为偏流角度系数;p(x)表示当前节点的父节点;g(p(x))表示起始点到当前节点的父节点的路径代价。

4.根据权利要求1所述的一种无人艇全局路径规划方法,其特征在于:所述步骤二中对当前节点x和其父节点p(x)进行视线检查的方法为采用路径安全距离检查和偏流角度检查;所述路径安全距离检查为检查无人艇距障碍物的距离是否大于路径安全距离。

5.根据权利要求4所述的一种无人艇全局路径规划方法,其特征在于:所述步骤二中偏流角度检查为检查无人艇路径与水流流向的夹角是否小于路径允许偏流角度。

6.根据权利要求5所述的一种无人艇全局路径规划方法,其特征在于:所述步骤二中判断视线存在的条件为:无人艇距障碍物的距离始终大于路径安全距离且路径与水流流向的夹角始终小于路径允许偏流角度。

7.根据权利要求1所述的一种无人艇全局路径规划方法,其特征在于:所述步骤四的计算包括以下情况:如果open list为空表示无路可走,算法结束;

若拓展节点为终点,从终点追踪父节点到达起点形成路径,算法完成;

若拓展节点为障碍物或是closed list中的节点则忽略该节点;

若拓展节点是open list中的点,判断g(x')是否比旧值更小,如果是,更新该拓展节点f(x')值,f(x')表示预估的总代价,包括转角代价和路径距离代价;

若当前节点不是以上任何情况,判断g(p(x))+c(p(x),x')是否小于g(x'),g(p(x))+c(p(x),x')表示起始点到当前节点的父节点的路径代价加当前节点的父节点到拓展点的路径代价;如果是则将该拓展点加入open list并更新拓展点g、f值,g表示起始点到该拓展点的路径代价;f为预估的总代价,记拓展节点x'的父节点为p(x)。

8.根据权利要求1所述的一种无人艇全局路径规划方法,其特征在于:还包括步骤六:使用圆弧过度的方法对规划路径进行折角平滑优化处理。

9.根据权利要求1所述的一种无人艇全局路径规划方法,其特征在于:所述步骤八中对规划路径进行折角平滑优化处理的方法为:在路径折角处取相邻三点,根据几何关系求出圆弧圆心,将折线转换为圆弧。

10.根据权利要求9所述的一种无人艇全局路径规划方法,其特征在于:折角平滑优化处理的具体方法为:已知线段三点P1、P2和P3,以及圆弧半径R,求优化之后线段新端点P4、P5和圆弧圆心R(xR,yR);根据几何关系可得出P1、P2、P3与P4、P5及圆弧圆心R(xR,yR)之间的转化关系为:其中,β表示未加路径优化的转向角;d21表示P1与P2之间的距离;d23表示P2与P3之间的距离; 表示P2到P1的向量; 表示P3到P2的向量;atan表示方位角的四象限反正切函数。