1.一种基于改进人工势场法的仓储AGV静态路径规划方法,其特征在于,根据无人化仓储场景构建地图,根据静态障碍物斥力和目标节点的引力、连通值确定路径,包括以下几个步骤:步骤1、使用栅格法对无人化仓储环境建模,根据实地测量设置地图大小和静态障碍物坐标,静态障碍物所占区域标记为1,不满一格的区域视为满格;将可通行的区域栅格标记为0,步骤2、确认起始节点和目标节点之前,对所有的可行区域进行所受静态斥力的计算,并保存静态斥力Fi的大小与斥力的合力方向θFi,步骤3、确认起始节点和目标节点之后,对所有的可行区域的引力Gi与引力方向θGi的计算;并通过BFS算法反向计算目标节点至起始节点AGV之间可行区域的连通值Ci大小,目标节点的连通值初始为1,表示该节点与目标节点的可通行程度最高,步骤4、结合各可行区域的引力Gi与可行区域的连通值Ci,再与静态斥力Fi计算得出该可行区域的合力Ri大小与合力方向Rθ,对比选择最优的可行区域作为最优路径节点,步骤5、在AGV运行过程中,如出现动态障碍物,根据动态障碍物的轨迹判断是否存在路径交叉,若出现轨迹交叉,则对其速度识别,并预测是否有碰撞危险,进而选择避障策略。
2.根据权利要求1所述的一种基于改进人工势场法的仓储AGV静态路径规划方法,其特征在于,其中,步骤2包括:
2-1、当可行区域受力范围内存在多个障碍物时,判断障碍物之间是否相邻,若相邻,则将多个相邻的障碍物视作一个障碍物簇,使用合并后的障碍物质心来计算其对可行区域的斥力方向,并通过可行区域到障碍物簇边缘距离计算斥力大小;
2-2、若不相邻,则分别计算各个障碍物对可行区域的斥力作用;当可行区域受力范围内存在多个不相邻的障碍物时,将斥力进行衰减,以确保机器人能够通过复杂环境;
2-3、当可行区域受力范围内存在单个障碍物或不存在障碍物时,计算单个障碍物对可行区域的斥力作用或斥力为0,静态斥力计算公式:
其中,Fi是静态斥力,||Fi||是可行区域i受范围内静态障碍物作用下的斥力向量,α是衰减系数,Fi,x和Fi,y分别为||Fi||的x坐标和y坐标,Fji是障碍物j对可行区域i的斥力大小,θji是障碍物j对可行区域i的斥力方向,θFi是可行区域i的所受斥力的合力方向,atan2函数将点坐标转换为极坐标,用于求力的角度,k是斥力常数,dji是障碍物j与可行区域i之间的直线距离,pix和piy分别为可行区域i的x坐标和y坐标,pjx和pjy分别为障碍物质心的x坐标和y坐标;fi(j)表示可行区域i受斥力范围内障碍物的数量。
3.根据权利要求2所述的一种基于改进人工势场法的仓储AGV静态路径规划方法,其特征在于,其中,步骤3包括:
3-1、设置初始引力Go为大于斥力的固定值g,方向为起始节点AGv指向目标节点,引力计算公式:其中初始引力Go为固定值g,大于斥力,θGi是从可行区域i指向目标点t的方向角度;ptx和pty分别为目标节点t的x坐标和y坐标,
3-2、若待计算的可行区域与目标节点之间存在障碍物,将相邻前节点的连通值乘以障碍物衰减系数γ1,赋予待计算区域,其中γ1为0.8,并进行步骤3-3;
3-3、若待计算的可行区域距离目标节点的步长超过5即5格,将相邻前节点的连通值乘以距离衰减系数系数γ2,并赋予待计算节点,γ2为0.9,
3-4、若待计算的可行区域i与目标节点t之间的步长距离在5以内且不存在障碍物,那么直接复制目标节点的连通值;在一批次连通值计算完成时即计算至起始节点的相邻节点,或相邻未计算区域均为障碍物,则结束本批次计算,并将本批次逆向遍历的可行区域节点赋值为0,表示路线无法抵达,将该批次目标节点相邻的可行区域即与起始节点相邻的可行区域的连通值与前一批次目标节点相邻的可行区域的连通值进行比较,如果本批次连通值比前一批次大,则覆盖路线上所有可行区域的连通值,否则不变,连通值计算公式:
其中,Ci为可行区域的连通值,Cg为目标节点相邻可行区域的连通值,设定为1;Cg-i为Cg前i个节点的连通值;γ1为障碍物衰减系数,γ2为距离衰减系数,bit(j)为待计算区域与目标区域之间的障碍物j数量;dit表示为目标区域与待计算区域之间的步长距离。
4.根据权利要求1所述的一种基于改进人工势场法的仓储AGV静态路径规划方法,其特征在于,其中,步骤4包括:
4-1、对于每个可行区域i,结合初始合力计算最终合力的大小与方向,初始合力为静态障碍物的斥力作用与引力常量的合力值,最终合力为加入可行区域的连通值Ci之后的合力大小与方向;
4-2、存在多个直接指向目标节点的可行区域节点时,选择合力最大的节点压入栈中;从压入栈的第一个节点开始,遍历其相邻的可行区域节点,选择可行区域的合力Ri最大的待选节点,当Ri相等时,比较合力方向Rθ,选择方向差小的可行区域节点,并重复步骤4-2,直至将起始节点压入栈中,依次取出栈中节点,直接作为最佳路径使用,最终合力计算公式:
其中Ri为可行区域i的所受合力大小;Rθ为可行区域i的所受引力、斥力的合力方向;Ci为可行区域i的连通值;Gi为可行区域i所受引力值的大小;Fi为可行区域i所受斥力值的大小;θGi为可行区域i所受引力合力方向;θFi为可行区域i所受斥力合力方向。
5.根据权利要求3所述的一种基于改进人工势场法的仓储AGV静态路径规划方法,其特征在于,其中,步骤3-2包括:3-21、使用Bresenham算法从待计算区域到目标节点生成一条直线;
3-22、沿着这条直线遍历所有经过的网格单元,检查这些单元是否为障碍物,若是则标记为“1”;
3-23、如果直线上的所有网格单元都为“0”,则没有视线遮挡,如果直线上的某个或多个网格单元为“1”,则表示有视线遮挡。
6.一种电子设备,包括存储器、处理器及存储在所述存储器上并可在所述处理器上运行的计算机程序,其特征在于:所述处理器执行所述程序时实现如上述权利要求1至5中的任意一项所述的一种基于改进人工势场法的仓储AGV静态路径规划方法。
7.一种计算机可读存储介质,其上存储有计算机指令,其特征在于:该计算机指令被处理器执行时实现如权利要求1-5中任一项所述的一种基于改进人工势场法的仓储AGV静态路径规划方法。