摘要
针对造纸类机械的导向辊生产线存在的多车间室内外导航精度不足、多车间运输通道共用、单车间产线交叉等问题,提出了融合LPA*和DWA算法的导向辊生产车间自动引导车(Automated Guided Vehicle,AGV)组合路径规划方法。首先建立了AGV本体运动模型和导向辊生产车间模型;然后提出了局部与全局组合的路径规划方法,采用LPA*算法进行全局路径规划解决了全局最优路径的问题,采用DWA算法进行局部路径规划解决了避障问题;最后通过实验验证将本研究提出的组合路径规划算法与传统路径规划算法对比,组合路径规划算法较大缩短了路径搜索的时间,效率更高。
导向辊作为造纸类机械中种类最多、需求量最大的零部件之一,被广泛应用于造纸工业和包装印刷工业的纸张、薄膜等材料的传输中,其自动化加工水平直接影响造纸类机械的生产效
AGV的路径规划难点在于难以获得较高精度的AGV当前位姿及如何根据环境需要改变规划路
目前在进行AGV的路径规划时仍存在多种问题,以导向辊生产车间为例,其存在多车间室内外导航精度不足、多车间运输通道共用、单车间产线交叉等问题,导致AGV在工作时路径规划效率不高。因此,为了解决上述问题,本研究提出了融合LPA*算法和DWA算法的导向辊生产车间AGV组合路径规划方法,缩短路径规划的时间,提高AGV物料运输的效率。
目前多数造纸及印刷企业导向辊生产线中,存在下料车间到主体加工车间的室内外导航精度不足、下料车间到主体加工车间与墙板原料到墙板加工车间物料运输通道共用、导向辊主体加工车间辊筒加工与装配产线交叉等问题。针对此现象,本研究设计了一种智能对接辊筒式复合机器人,以实现多种对接高度并独立完成物料的运输,其结构示意图如

图1 智能移动机器人简图
Fig. 1 Intelligent mobile robot schematic
假设车身质量均匀,车的中心位于底座中心,且忽略车轮摩擦,可建立如

图2 AGV运动模型
Fig. 2 Motion model of AGV
AGV的运动模型可表示为
(1) |
由
某印刷装备制造企业导向辊生产线由导向辊主体加工车间、微弧氧化车间、下料车间和墙板生产车间组成,其中导向辊主体加工车间由铝堵加工单元、钢轴加工单元、导向辊装配单元、辊筒加工单元和导向辊精加工单元组成,导向辊生产车间平面图如

图3 导向辊生产车间平面图
Fig. 3 Guide roller production workshop plan
对构建的三维模型进行三维渲染并转换为DAE格式进行输出,结果如

图4 车间三维渲染模型
Fig. 4 3D rendering model of workshop
将保存DAE格式的车间模型导入到ROS系统里进行编译并调用,将车间模型导入到Gazebo里进行仿真,同时打开RVIZ可视化软件实时观察车间仿真模型的情况。车间模型在RVIZ和Gazebo中的显示情况如

图5 仿真空间的车间模型图
Fig. 5 Workshop model of the simulation space
针对导向辊生产车间人员流动大、机器设备多、移动物体多变等问题,本研究提出局部与全局组合的路径规划方法,将整个车间行驶区域的路径规划进一步划分为局部和全局路径规化,在局部路径规化需要解决避障的问题,在全局路径规化中需要解决最优路径的问题。导向辊生产车间物料运输AGV路径规划总体框架如

图6 AGV路径规划总体框架
Fig.6 Overall framework of AGV path planning
局部路径规划的任务是将全局路径规划得到的路径转变为速度控制命令,再发送给机器人执行。通过应用DWA算法,有效地解决复杂的局部路径规划问题。通过采样速度空间,DWA算法可以模拟不同速度下的运动轨迹,并利用评估函数来确定最佳的运动轨迹,从而达到最优的运动效果。
在DWA算法中,需要建立机器人的运动模型,进而模拟机器人的运动轨迹。本研究的机器人使用双轮差速结构,其运动模型可表示为
(2) |
式中,rL和rR分别表示机器人左、右轮径,m。基于该运动模型,可以根据速度推算机器人的航迹,见
(3) |
式中,表示机器人在t时刻的横坐标位置;表示机器人在t时刻的纵坐标位置;表示机器人在t时刻的朝向角度,rad。
利用对速度的采样获取机器人的运动轨迹,并使用评估函数来衡量其精确性和可靠性,速度采样的受限范围见
(4) |
式中,(vm, wm)表示受机器人的速度约束构建可行的速度空间;(vmin, vmax)表示机器人的最小线速度和最大线速度,m/s;(wmin, wmax)表示机器人的最小角速度和最大角速度,rad/s;(vd, wd)表示当前运动过程中最大的加速度约束下,机器人在固定时间段t的速度变化窗口;vc和wc表示当前机器人的线速度(m/s)和角速度(rad/s);αmax表示机器人的最大加速度(m/s²)和最大角加速度(rad/s²);vα和wα表示保证机器人能够在碰撞到障碍物前以最大加速度停下的速度空间;dist(v, m)是机器人速度配置对应的轨迹到障碍物的最小距离,m。
通过速度采样,获得了可行的速度空间。需要对这些速度空间进行评估,选择最优的速度控制指令,评估函数见
(5) |
式中,heading(v, w)表示机器人速度方向与目标点方向的夹角,rad;dist(v, w)表示机器人速度配置(v, w)对应的轨迹到障碍物的最小距离(m),以保证机器人轨迹无碰撞;velocity(v, w)表示机器人的速度(m/s),保证机器人以最大速度运动;α, β, γ分别表示评估函数的权重。
在确定目标点后,机器人需要规划从当前位置到目标点的路径,具体来说,全局路径规划是在栅格地图中找到一条从起始点到目标点的最优路径,即要求路程尽量短、容易控制。本研究采用的全局路径规划LPA*算法属于基于图的启发式搜索算法,在使用搜索算法前,需要先进行网格绘制。
LPA*算法从第一个网格Sstart开始向下扩展,直到扩展到最后一个网格Send或者向下没有可扩展的网格为止。LPA*算法中存在优先级函数k(s),其定义如式(6)~
(6) |
(7) |
(8) |
式中,g(s)表示从Sstart到s的各种损失,rhs(s)是g(s)的一步前瞻估计值,即在扩展到s点前的一个前瞻损失。rhs(s)的定义如
(9) |
式中,c(s’,s)表示从s网格到达s’网格的损失,pred(s)是s的路径直接前驱的集合。当g(s)>rhs(s)时,认为网格s是过一致的;当g(s)<rhs(s)时,认为网格s是欠一致的;当g(s)=rhs(s)时,认为网格s是一致的。

图7 LPA*算法栅格地图
Fig. 7 Raster map with LPA* algorithm
把B4作为k值最小节点选取出来,如

图8 LPA*算法规划栅格地图
Fig. 8 Raster map planned by LPA* algorithm
使用MATLAB对LPA*算法的路径规划过程进行仿真,在栅格地图中,黑色表示障碍物,白色表示可通行区域,黄色和红色分别为起始点和目标点,规划结果如

图9 LPA*算法仿真结果图
Fig. 9 Simulation result of LPA* algorithm
为验证导向辊生产车间AGV的路径规划算法的有效性,给道路2边设置围挡,以此来提示机器人是否到达障碍边界,将导向辊生产车间模型优化如

图10 优化后的车间模型图
Fig. 10 Model of optimized workshop
仿真所用的计算机性能参数为:Inter(R) Core(TM) i7-13700H,频率2.40 Hz,内存为16 G,六核CPU,运行系统为Ubuntu18.04,利用Robo Ware Studio软件对DWA和LPA*算法进行仿真,通过对起始点和目标点的输入实现算法的路径规划。
DWA算法属于局部路径规划算法,集成在路径规划器move_base中,通过RVIZ可视化窗口可以观察到局部路径规划的结果,如

图11 局部路径规划
Fig. 11 Local path planning

图12 躲避出现的障碍物
Fig. 12 Avoiding obstacles
在全局路径规划中,将提前构建好的地图保存为pgm和yaml格式,并把文件存入maps文件夹,对yaml文件参数进行编辑,确定机器人在地图中的坐标位置。运行RVIZ显示地图,给定起始点和目标点,对整个导向辊生产车间进行全局路径规划,见

图13 全局路径规划
Fig. 13 Global path planning
针对导向辊生产车间环境多变的问题,采用融合LPA*算法与DWA算法的组合路径规划方法,解决导向辊生产车间AGV避障与路径规划问题。当明确AGV的初始位姿和目标点,就能规划出一条最优的全局路径,当AGV遇到动态障碍物没有到达目标点时进行局部路径规划,做到及时避障,整体流程图如

图14 组合路径规划流程图
Fig.14 Process diagram of combinatorial path planning
构建导向辊生产车间的仿真环境和二维栅格地图,并基于此进行组合路径规划的实验,如

图15 组合路径规划
Fig. 15 Combined path planning
在制造导向辊的二维栅格地图中,设定一个目标点并使用LPA*算法计算出最优的全局路径,在AGV运动的过程中加入临时障碍物,局部路径规划任务通过绕过障碍物完成避障,最终AGV成功到达设置的目标点。
实验场景为综合楼一楼实验室外的一段楼道,见

图16 组合路径规划示意图
Fig. 16 Schematic diagram of combined path planning
路径规划实验结果如
路径规划算法 | 路径长度/m | 规划时间/s |
---|---|---|
A*算法 | 35.4 | 10.58 |
LPA*算法 | 36.2 | 4.23 |
组合路径规划算法 | 36.0 | 1.99 |
从实验结果可以看出,组合路径规划算法与传统A*算法和LPA*算法相比,均表现出了明显的性能优势。在路径长度方面,组合路径规化算法相较于传统A*算法增加了1.7%,相较于LPA*算法减少了0.6%。路径长度变化不明显,是由于组合路径算法对动态障碍物有冲突预判距离,当遇到动态未知障碍物时,可以避开动态障碍物。在规划时间方面,该算法相较于传统A*算法和LPA*算法分别减少了81.2%和52.9%。本研究提出的组合路径规化算法可以有效地完成移动机器人的路径规划,并且寻路时间更短,极大地提升了路径规划的效率。
本研究以造纸类机械导向辊生产车间物料运输机器人为研究对象,以车间生产导向辊工艺流程为基础,针对导向辊生产车间各工位间的物料运输问题,首先建立了自动引导车(Automated Guided Vehicle,AGV)运动模型与导向辊生产车间模型;之后提出了局部与全局组合的路径规划算法,采用LPA*算法进行全局路径规划,采用DWA算法进行局部路径规划,可有效解决AGV紧急避障和最优路径选取等问题,提高寻路算法的效率;最后针对构建的导向辊生产车间模型将提出的组合路径规划算法进行实验验证。
组合路径规化算法的实验结果表明,相较于传统A*算法和LPA*算法,该算法的规划时间分别减少了81.2%和52.9%,大大降低路径规划的时间和计算量,解决了AGV工作过程中的实时避障和路径规划时间长等问题,验证了组合算法的可靠性与实用性,极大地提升了规划的效率。
参 考 文 献
魏文光, 黄鹏, 王胜丹, 等. 造纸企业智能仓储系统技术研究[J]. 中国造纸, 2023, 42(10): 149-154. [百度学术]
WEI W G, HUANG P, WANG S D, et al. Research on Intelligent Warehousing System Technology for Papermaking Enterprises[J]. China Pulp & Paper, 2023, 42(10): 149-154. [百度学术]
罗喜, 张成峰, 邱杰. 基于人工智能的安全预警装置在纸卷仓储的应用[J]. 中国造纸, 2023, 42(9): 145-147. [百度学术]
LUO X, ZHANG C F, QIU J. Application of AI-based Security Warning Device in Paper Roll Warehousing[J]. China Pulp & Paper, 2023, 42(9): 145-147. [百度学术]
任永杰, 赵显, 郭思阳, 等. 基于wMPS和模糊控制的AGV路径规划控制[J]. 光学学报, 2019, 39(3): 191-198. [百度学术]
REN Y J, ZHAO X, GUO S Y, et al. AGV Path Planning and Control Based on wMPS and Fuzzy Control[J]. Acta Optica Sinica, 2019, 39(3): 191-198. [百度学术]
朱大奇, 颜明重. 移动机器人路径规划技术综述[J]. 控制与决策, 2010, 25(7): 961-967. [百度学术]
ZHU D Q, YAN M Z. Overview of Mobile Robot Path Planning Techniques[J]. Control and Decision, 2010, 25(7): 961-967. [百度学术]
LIMA D G, JOHN G. Fixed Points of N-valued Maps on Surfaces and the Wecken Property—A Configuration Space Approach[J]. Science China(Mathematics), 2017, 60(9): 1561-1574. [百度学术]
JUNG I K, HONG K B, HONG S K, et al. Path Planning of Mobile Robot Using Neural Network[C]//Proceedings of the IEEE International Symposium on Industrial Electronics. Sloveniai: IEEE, 1999. [百度学术]
祝继华, 周颐, 王晓春, 等. 基于图像配准的栅格地图拼接方法[J]. 自动化学报, 2015, 41(2): 285-294. [百度学术]
ZHU J H, ZHOU Y, WANG X C, et al. Grid Map Stitching Method Based on Image Registration[J]. Acta Automatica Sinica, 2015, 41(2): 285-294. [百度学术]
VADAKKEPAT P. Evolutionary Artificial Potential Fields and Their Application in Real Time Robot Path Planning[C]//Proceedings of the 2000 Congress on Evolutionary Computation. LaJolla: IEEE, 2002: 256-263. [百度学术]
ZHANG Q R, GU G C. Path Planning Based on Improved Binary Particle Swarm Optimization Algorithm[C]//2008 IEEE Conference on Robotics, Automation & Mechatronics. Chengdu: IEEE, 2008: 462-466. [百度学术]
HART P E, NILSSON N J, RAPHAEL B. A Formal Basis for the Heuristic Determination of Minimum Cost Paths[J]. IEEE Transactions on Systems Science & Cybernetics, 1972, 4(2): 28-29. [百度学术]
DIJKSTRA E W. A Note on Two Problems in Connexion with Graphs[J]. Numerische Mathematik, 1959, 1(1): 269-271. [百度学术]
STENTZ A. Optimal and Efficient Path Planning for Partially-known Environments[C]//Proceedings of the 1994 IEEE International Conference on Robotics and Automation. San Diego: IEEE, 1994: 3310-3317. [百度学术]
KOENIG S, LIKHACHEV M. Fast replanning for navigation in unknown terrain[J]. IEEE Transactions on Robotics, 2005, 21(3): 354-363. [百度学术]
HARABOR D D, GRASTIEN A. Online Graph Pruning for Pathfinding on Grid Maps[C]//25th AAAI Conference on Artificial Intelligence. San Francesco:Aaai Conference on Artificial Intelligence. 2011: 1114-1119. [百度学术]
YANG Y, LI J T, PENG L L. Multi-robot Path Planning Based on a Deep Reinforcement Learning DQN Algorithm[J]. CAAI Transactions on Intelligence Technology, 2020, 5(3): 177-183. [百度学术]
黄程侃. 基于视觉的激光SLAM AGV初定位与路径规划研究[D]. 杭州: 浙江工业大学, 2020. [百度学术]
HUANG C K. Research on Initial Positioning and Path Planning of Visual-based Laser SLAM AGV[D]. Hangzhou: Zhejiang University of Technology, 2020. [百度学术]