基于改进A*-APF的无人艇安全对接路径规划方法

摘要: 本技术属于无人水面艇路径规划领域。背景技术:1、无人水面艇具有自主航行、人员风险低和任务载荷灵活等特点,已应用于海洋资源勘探、环境监测、海上应急救援、港口作业及...
基于改进A*-APF的无人艇安全对接路径规划方法

本技术属于无人水面艇路径规划领域。

背景技术:

1、无人水面艇具有自主航行、人员风险低和任务载荷灵活等特点,已应用于海洋资源勘探、环境监测、海上应急救援、港口作业及集群协同。多艇自主对接可用于载荷转运、结构重组等任务。对接过程包括远距离接近和近距离精准对接,其中远距离阶段需要后艇在避开障碍物的同时稳定跟踪规划路径,到达目标艇附近的对接准备区域,为后续精准对接提供初始条件。

2、现有全局路径规划方法中,a*算法能够在已知栅格环境内搜索路径。由于传统a*算法通常仅从当前节点周围八个方向选择下一节点,候选方向少,因此在复杂障碍物环境中容易形成折线和路径振荡。现有局部避障方法中,人工势场法计算量小、实时性较好。由于传统人工势场法的斥力势能随无人艇与障碍物之间距离的减小而急剧增大,在无人艇极度靠近障碍物时斥力会趋于无穷大,因此无人艇会产生抖动、大幅偏移甚至被障碍物弹开的现象。由于按照质点进行路径规划时未考虑无人艇船体的实际尺寸,因此即使规划轨迹未穿过障碍物边界,艇体仍可能发生碰撞。在运动控制方面,无人艇会受到模型参数变化以及风、浪、流等外部扰动影响。由于固定参数控制器难以实时补偿未知扰动,因此容易导致路径跟踪误差和轴向偏差增大。由于动态障碍物的位置随时间变化,而路径规划与轨迹跟踪分开执行,因此已有路径可能无法适应障碍物更新,导致原路径失效或控制不连续。

3、因此,在无人艇远距离对接过程中,需要解决的技术问题包括:在传统a*算法因仅从当前节点周围八个方向选择下一节点而候选方向少的情况下,如何减少路径折线和振荡;在传统人工势场法因斥力势能随距离减小而急剧增大而在近障碍物处斥力过大的情况下,如何抑制无人艇抖动、大幅偏移和被弹开的运动失稳;在按质点进行路径规划因未考虑无人艇船体实际尺寸而可能导致艇体碰撞的情况下,如何将船体尺寸纳入避碰约束;在固定参数控制器因难以实时补偿模型参数变化和风、浪、流等外部扰动而导致跟踪误差增大的情况下,如何提高路径跟踪精度和轴向稳定性;在路径规划与轨迹跟踪因分开执行而难以适应动态障碍物更新的情况下,如何实现动态路径更新与轨迹跟踪的同步运行,使规划结果能够被无人艇连续、稳定地执行。

技术实现思路

1、本技术是为了在无人艇远距离对接过程中,降低路径折线与振荡,抑制近障碍物处斥力过大造成的运动失稳,将船体尺寸纳入避碰约束,并在动态障碍物和外部扰动作用下实现规划路径的稳定跟踪,现提供基于改进a*-apf的无人艇安全对接路径规划方法,以环形路径点遍历机制生成a*候选节点,以有界s形斥力势能函数改进人工势场,并利用a*成本、引力势能和斥力势能组成的综合评价函数选择路径点;同时将障碍物等效外包圆按艇长扩张形成碰撞安全域,并采用反步自适应控制器估计和补偿外部扰动,使路径规划与轨迹跟踪在航行过程中同步运行,适用于含静态障碍物、动态障碍物及外部水动力扰动的水面环境。

2、本技术第一方面提供基于改进a*-apf的无人艇安全对接路径规划方法,包括:

3、采用通过环形候选节点遍历机制改进的a*算法在包含障碍物的栅格地图中筛选可通行候选节点;

4、基于所述a*算法的成本函数、通过有界s形函数改进的障碍物斥力势能以及目标点引力势能构建综合评价函数;

5、结合所述综合评价函数和碰撞安全域约束在所有可通行候选节点中选择下一规划路径节点;

6、利用反步自适应控制器控制无人艇移动至所述下一规划路径节点,并根据动态障碍物的当前位置更新碰撞安全域;

7、重复上述步骤,直至所述无人艇到达目标区域。

8、在一个可能的设计中,所述采用通过环形候选节点遍历机制改进的a*算法在包含障碍物的栅格地图中筛选可通行候选节点,包括:

9、在所述栅格地图中,以当前路径节点为圆心,以空间搜索步长为半径,在0至2π范围内按照预设角度间隔生成环形候选节点集;

10、对候选节点依次执行地图边界筛选、障碍物占用筛选和连线可通行性筛选,获得可通行候选节点。

11、在一个可能的设计中,所述环形候选节点集的表达式为:

12、,

13、其中,表示环形候选节点集,为当前路径节点,为半径,为预设角度间隔,为候选节点索引。

14、在一个可能的设计中,所述a*算法的成本函数表达式为:

15、,

16、其中,为路径节点处的成本函数,和分别为路径节点到起始点和终止点的代价。

17、在一个可能的设计中,所述综合评价函数的表达式为:

18、,

19、其中,为综合评价函数,为路径节点处的成本函数,为无人艇在路径节点的目标点引力势能,为无人艇在路径节点的障碍物斥力势能。

20、在一个可能的设计中,所述通过有界s形函数改进的障碍物斥力势能的表达式为:

21、,

22、其中,为障碍物斥力势能,为斥力调节系数,为作用范围调节系数,为无人艇与障碍物的距离。

23、在一个可能的设计中,所述目标点引力势能的表达式为:

24、,

25、其中,为目标点引力势能,为引力系数,为无人艇的当前位置坐标,为目标点的位置坐标。

26、在一个可能的设计中,所述反步自适应控制器的控制率包括:虚拟控制率和实际控制率;

27、所述虚拟控制率的表达式为:

28、,

29、其中,为虚拟控制率,为虚拟控制率的三行三列对角矩阵,为坐标转换矩阵,为位置误差,为无人艇期望位姿;

30、所述实际控制率的表达式为:

31、,

32、其中,为实际控制率,为实际控制率的三行三列对角矩阵,为速度误差,为水动力阻尼矩阵,为船体坐标系下的速度,为任意正数,、和分别为纵荡、横荡和艏摇方向的速度误差。

33、在一个可能的设计中,所述根据动态障碍物的当前位置更新碰撞安全域,包括:

34、将动态障碍物对应的碰撞安全域的中心更新为动态障碍物的当前位置。

35、在一个可能的设计中,所述碰撞安全域的半径为所述动态障碍物的等效圆半径与无人艇船长之和。

36、本技术第二方面提供基于改进a*-apf的无人艇安全对接路径规划设备,所述基于改进a*-apf的无人艇安全对接路径规划设备包括处理器和存储器,所述存储器中存储有至少一条指令,所述至少一条指令由处理器加载并执行以实现如上述基于改进a*-apf的无人艇安全对接路径规划方法。

37、本技术第三方面提供一种计算机存储介质,所述计算机存储介质中存储有至少一条指令,所述至少一条指令由处理器加载并执行以实现如上述基于改进a*-apf的无人艇安全对接路径规划方法。

38、本技术的有益效果:

39、1、由于传统a*算法仅从当前节点周围八个方向选择下一节点,候选方向少,在复杂障碍物环境中容易形成折线和路径振荡,因此本技术采用环形候选节点遍历机制改进a*算法,以当前节点为圆心、以空间搜索步长为半径、按角度间隔生成环形候选节点集,并对候选节点进行可通行性筛选,使路径点选择不再局限于传统八邻域方向。由于该机制增加了路径方向的可选数量,因此能够减少规划路径中的折线和振荡,使规划路径更加平滑。

40、2、本技术采用有界s形函数构造障碍物斥力势能,使斥力幅值随无人艇接近障碍物而先增大、在临界区域达到峰值后保持有界。由于斥力势能和斥力幅值在近障碍物处不再急剧放大,因此能够抑制无人艇的运动失稳,降低抖动、过度偏航和被障碍物瞬间弹开的风险。

41、3、本技术将不规则障碍物等效为外包圆,并按无人艇船长扩张障碍物圆形成碰撞安全域,要求候选路径点及相邻路径段均位于扩张圆之外。由于该碰撞安全域将船体物理尺寸纳入路径避碰约束,并为规划误差和控制延迟保留了安全余量,因此能够降低艇体与障碍物发生碰撞的风险。由于动态障碍物移动时其碰撞安全域中心随障碍物当前位置同步更新,因此碰撞安全域能够持续适应动态障碍物的运动。

42、4、本技术将a*算法的成本函数、目标点引力势能和障碍物斥力势能共同组成综合评价函数,对环形遍历得到的候选节点逐一计算综合评价值,并将综合评价值最小且满足碰撞安全域约束的候选点作为下一路径点。由于该综合评价函数使全局路径代价、目标引导、局部避障和转角平滑性共同参与候选路径点评价,因此能够在保证避障安全的同时缩短路径长度。

43、5、本技术采用规划小幅超前、控制连续跟随的规控一体化机制,路径规划器根据动态障碍物的当前位置在线更新局部路径,控制器在规划更新期间保持连续输出。由于规划与跟踪同步运行,因此能够避免规划中断引起的控制停顿,并降低动态障碍物移动导致原路径失效的风险。

44、6、本技术采用反步自适应控制器,通过虚拟控制率和实际控制率驱动无人艇跟踪规划路径,并利用自适应更新率在线估计和补偿未知外部扰动。由于该控制器能够根据速度误差在线修正扰动估计值,因此能够在风、浪、流和模型参数不确定条件下保持较高的路径跟踪精度和轴向稳定性。闭环系统在有界时变扰动下全局一致最终有界,在常值扰动条件下可实现渐近跟踪。