AGV路径优化与效率提高的路径生成方法技术

本发明专利技术的AGV路径优化与效率提高的路径生成方法，通过增加转向代价E值计算，较好地减少路径寻路过程中的拐点次数,从而使AGV运行长期保持在直线上,使得实际运行时的转向次数减少,提高了AGV路径搜寻过程运行计算的效率。在计算E的过程中输出TempUn l ockPo i ntL i st使得算法的效率提高,减少工控机对算力的要求,减少了对重复步骤的执行,以毫秒数量级减少寻路时间。少寻路时间。少寻路时间。

【技术实现步骤摘要】
AGV路径优化与效率提高的路径生成方法


[0001]本专利技术属于AGV路线规划
，具体涉及AGV路径优化与效率提高的路径生成方法。

技术介绍

[0002]A*(A
‑
Star)算法是一种AGV在静态路网中求解最短路径的方法。其最短路径计算公式表示为：f(n)＝g(n)+h(n)，其中f(n)是节点n从初始点到目标点的估价函数，g(n)是在状态空间中从初始节点到n节点的实际代价，h(n)是从n到目标节点最佳路径的估计代价。在网格寻路的传统A
‑
Star仅仅只有对距离的代价限定却没有对转向的代价限定。出来的结果虽然距离的路径代价是最短的但是会存在多个拐点,在有多个拐点的情况下无疑是会增加无人载具的拐弯次数,却兼顾不了时间的最优性。并且当所在点与终点共线的时候,传统的A
‑
Star算法还是会继续往下检索,这个做法虽然可以得到最后的最优路径却因为检索次数过多而忽略了寻路的效率。

技术实现思路

[0003]本专利技术的目的在于克服现有的静态路网中求解最短路径方法存在没有兼顾AGV在静态路网中因拐弯次数没有达到计算出时间的最优性以及路径计算检索时间长存在的问题，提供一种减少AGV在静态路网中拐弯次数以及节省路径计算搜索时间以便AGV可直线到达终点的AGV路径优化与效率提高的路径生成方法。
[0004]为了达到上述目的，本专利技术采用以下技术方案：
[0005]AGV路径优化与效率提高的路径生成方法，AGV的路径网络包括若干路径点和若干行驶路径，路径点之间通过行驶路径连接,并规划AGV的任务终点位置，所述方法包括以下步骤：
[0006]a.AGV读取当前位置作为起始点，以起始点作为参数创建PathNode类的对象,PathNode内包含用于记录起始点的位置信息以及起始点对应的终点代价H值、起点代价G值和转向代价E值，新建一个PathNode类对象cur作为寻路中转点,把Start的值赋给cur。
[0007]b开始寻点：在cur寻点的次数等于以cur为起点的路径数，每搜寻到一个点就把cur点放入Transfer数组,当Transfer内含有本次搜索到的点时,则会再搜索新的匹配的点,再新建PathNode类对象newpn,把搜索到新的匹配的点代入,计算各cur点对应的终点代价H值、起点代价G值和转向代价E值。
[0008]c.计算转向代价E值：把无人载具的角度与cur到newpn路径的角度作比较,如果是同角度则代价为0，若两个角度相差90
°
则判断为需要拐弯,若newpn靠近终点则代价为N1,反之为newpn远离终点则代价则为N2，若两个角度相差180
°
,则判定需要掉头,掉头至靠近终点的newpn的代价为N3,掉头至远离终点的newpn的代价为N4，直到newpn与总终点在同一直线上，将上述转向代价的标准减半。
[0009]d.计算终点代价H值和起点代价G值：起点代价G值为起点到newpn的路径距离,终
点代价H为newpn到终点的路径距离。
[0010]f.根据f(n)＝G(n)+H(n)+E(n)，将G值、E值与H值相加起来得出总代价F,把newpn放入到已建的UnLockList,再把UnLockList内的所有以总代价F的形式进行升序排列,把F最小的放在第一位,使cur等于UnLockList[0]，把cur往已建Path内放置,然后把cur又重新赋值成其父节点,重复此操作直到cur没有父节点得到的Path就是终点到起点最短路径的点集合,把Path倒序得到起点到终点的最短路径点的集合，得到起点到终点的路径集合。
[0011]与现有技术相比，本专利技术的AGV路径优化与效率提高的路径生成方法，通过增加转向代价E值计算，较好地减少路径寻路过程中的拐点次数,从而使AGV运行长期保持在直线上,使得实际运行时的转向次数减少,提高了AGV路径搜寻过程运行计算的效率。
[0012]进一步的，在计算E值的过程中,若newpn可以直达总终点会把在newpn到总终点中间的所有点按顺序的放入TempUnlockPointList，把cur赋值成为TempUnlockPointList的最后一个值；通过这样设置，在计算E的过程中输出的TempUnlockPointList使得算法的效率提高,减少工控机对算力的要求,减少了对重复步骤的执行,以毫秒数量级减少寻路时间，提高。
[0013]进一步的，在步骤c中，若newpn能直线达总终点,则此newpn的代价减少N1，若newpn与总终点在同一直线上但不能直线达总终点，则此newpn的代价增加N5，其中N5远大于N1；通过这样设置，若newpn与总终点在同一直线上但不能直线达总终点，则使newpn的代价会增加到一个很大的值使得系统寻路过程中不会选择这个点，较好地避免系统重复选择这个若newpn点。
[0014]进一步的，在步骤f中，当起点与终点相邻时,把终点赋值给UnLockList[0]；通过这样设置，较好地保证系统规划的路径是AGV在起点直接达到终点。
[0015]进一步的，N1＝100，N2＝200，N3＝300，N4＝400。
附图说明
[0016]图1为本专利技术的AGV路径优化与效率提高的路径生成方法的流程图
[0017]图2为图1流程图中转向代价黑盒的流程图
[0018]图3为图1流程图中起点代价黑盒和终点代价黑盒的流程图
[0019]图4为使用AGV路径优化与效率提高的路径生成方法的路径生成图
具体实施方式
[0020]以下结合附图说明本专利技术的技术方案：
[0021]参见图1至图4，本专利技术的AGV路径优化与效率提高的路径生成方法，在寻路开始之前,会创造一个起点、路径映射的字典,AGV的路径网络形成包括若干路径点和若干行驶路径，路径点之间通过行驶路径连接,并规划AGV的任务终点位置，字典的key是地图内点的ID号,value是以key为起点发散出去的路径ID号集合。并且新建LockList和UnLockList分别存放确认好的点和检索过的点。所述方法包括以下步骤：
[0022]a.AGV读取当前位置的二维码位置作为起始点，以起始点作为参数创建PathNode类的对象,PathNode内包含用于记录起始点的位置信息以及起始点对应的终点代价H值、起点代价G值和转向代价E值，新建一个PathNode类对象cur作为寻路中转点,把Start的值赋
给cur。
[0023]b开始寻点：在cur寻点的次数等于以cur为起点的路径数，每搜寻到一个点就把cur点放入Transfer数组(此数组可以为了防止重复搜索到与上一次搜索的点,需要把以cur为起点的路径的终点全部搜索到),当Transfer内含有本次搜索到的点时,则会再搜索新的匹配的点,再新建PathNode类对象newpn,把搜索到新的匹配的点代入,计算各cur点对应的终点代价H值、起点代价G值和转本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.AGV路径优化与效率提高的路径生成方法,其特征在于，AGV的路径网络包括若干路径点和若干行驶路径，路径点之间通过行驶路径连接,并规划AGV的任务终点位置，所述方法包括以下步骤：a.AGV读取当前位置作为起始点，以起始点作为参数创建PathNode类的对象,PathNode内包含用于记录起始点的位置信息以及起始点对应的终点代价H值、起点代价G值和转向代价E值，新建一个PathNode类对象cur作为寻路中转点,把Start的值赋给cur；b开始寻点：在cur寻点的次数等于以cur为起点的路径数，每搜寻到一个点就把cur点放入Transfer数组,当Transfer内含有本次搜索到的点时,则会再搜索新的匹配的点,再新建PathNode类对象newpn,把搜索到新的匹配的点代入,计算各cur点对应的终点代价H值、起点代价G值和转向代价E值；c.计算转向代价E值：把无人载具的角度与cur到newpn路径的角度作比较,如果是同角度则代价为0，若两个角度相差90
°
则判断为需要拐弯,若newpn靠近终点则代价为N1,反之为newpn远离终点则代价则为N2，若两个角度相差180
°
,则判定需要掉头,掉头至靠近终点的newpn的代价为N3,掉头至远离终点的newpn的代价为N4，直到newpn与总终点在同一直线上，将上述转向代价的标准减半；d.计算终点代价H值和起点代价G值：起点代价G值为起点到newpn的路径距离,终点代价H为newpn到终点的...

【专利技术属性】
技术研发人员：吴迪希，
申请(专利权)人：广东嘉腾机器人自动化有限公司，
类型：发明
国别省市：