Study on Planning Method of Joint Space Optimal Path for Solder Robot
-
摘要: 为减少焊接机器人点焊工况中的耗时、耗能, 提出一种基于关节空间的最优路径规划方法。首先, 对3-RRR并联焊锡机模型进行分析, 通过几何法建立该并联焊锡机的运动学模型。其次, 建立基于关节空间角度加权和的路径规划数学模型, 并设计一种带有精英策略和信息挥发因子自适应调节函数的改进蚁群算法对该模型进行优化。最后, 针对3-RRR并联焊锡机的焊锡工况, 使用所改进蚁群算法对该焊锡机的关节空间角度加权和最优路径进行规划。仿真数据表明, 与传统的笛卡尔空间下的最优路径规划相比, 基于关节空间角度加权和数学模型的最优路径规划缩短了关节总的角度变化值, 能实现焊锡机器人的快速焊锡作业, 对提高传统焊接机器人的加工效率和减少机器人能量损耗具有一定的参考价值。Abstract: In order to reduce the time and energy consumption in spot welding, a planning method based on joint space optimal path is proposed. Firstly, the model for 3-RRR parallel soldering machine is analyzed, and the kinematics model for 3-RRR parallel soldering machine is established via geometric method. Secondly, a model for path planning based on joint space angular weighted sum is established, and an improved ant colony algorithm with elite strategy and information volatile factor adaptive regulation function is used to optimize the model. Finally, the improved ant colony algorithm is used to plan the joint space angle weighting and the optimal path of 3-RRR parallel soldering machine. The simulation data show that, comparing with the optimal path planning under the traditional Cartesian space, the optimal path planning based on the joint space angular weighting and mathematical model can shorten the total joint angle variation, and can realize the soldering robot's fast soldering operation. This path planning method has certain reference for improving the machining efficiency of the traditional welding robot and reducing the energy loss of the robot.
-
表 1 焊点位置点及对应的关节空间角度值
焊点位置/mm φ1/(°) φ2/(°) φ3/(°) (0, 0) 87.95 -152.17 -32.11 (40, 20) 81.43 -154.78 -23.68 (100, 20) 70.16 -154.58 -16.4 (60, 40) 78.39 -158.59 -17.92 (80, 40) 74.6 -158.62 -15.37 (20, 60) 86.48 -163.07 -20.76 (50, 54) 80.65 -161.46 -17.11 (60, 80) 84.9 -166.76 -16.19 (100, 80) 71.29 -167.19 -6.05 (20, 100) 86.91 -170.75 -14.91 (60, 24) 77.85 -155.3 -20.44 (90, 90) 73.29 -168.95 -5.54 (30, 15) 83.08 -154.01 -25.78 (70, 35) 76.35 -157.54 -17.43 (60, 70) 79.04 -164.62 -13.13 (55, 27) 78.9 -155.97 -20.62 (48, 92) 81.52 -168.94 -11.38 (70, 70) 77.11 -164.66 -11.71 表 2 关节空间和传统笛卡尔空间路径规划比较
路径规划 焊点路径距离和 关节空间角度加权和 基于笛卡尔空间 430.75 mm 176.26° 基于关节空间 473.64 mm 158.68° 两种模型差值 42.89 mm 17.58° -
[1] 李海宁, 纪茂峰. 液压支架焊接工艺装备现状与自动化焊接技术解决方案[J]. 煤矿机械, 2006, 26(5): 825-826 doi: 10.3969/j.issn.1003-0794.2006.05.043LI H N, JI M F. Status of weld equipment and project to robotize weld process for powered support producing[J]. Coal Mine Machinery, 2006, 26(5): 825-826 (in Chinese) doi: 10.3969/j.issn.1003-0794.2006.05.043 [2] 吕文壮, 曹家勇, 党铭章, 等. 改进蚁群算法在焊接机器人路径规划中的应用[J]. 机械设计与研究, 2019, 35(6): 32-36 https://www.cnki.com.cn/Article/CJFDTOTAL-JSYY201906013.htmLYU W Z, CAO J Y, DANG M Z, et al. Application of improved ant colony algorithm in path planning of welding robots[J]. Machine Design & Research, 2019, 35(6): 32-36 (in Chinese) https://www.cnki.com.cn/Article/CJFDTOTAL-JSYY201906013.htm [3] 侯仰强, 王天琪, 李亮玉, 等. 基于蚁群算法-粒子群算法的白车身侧围点焊机器人路径规划[J]. 中国机械工程, 2017, 28(24): 2990-2994 doi: 10.3969/j.issn.1004-132X.2017.24.015HOU Y Q, WANG T Q, LI L Y, et al. Path planning of spot welding robots in sides of BIW based on ACO-PSO[J]. China Mechanical Engineering, 2017, 28(24): 2990-2994 (in Chinese) doi: 10.3969/j.issn.1004-132X.2017.24.015 [4] 刘海江, 张春伟, 徐君杰, 等. 基于遗传算法的白车身焊接机器人焊点分配[J]. 同济大学学报(自然科学版), 2010, 38(5): 725-729 doi: 10.3969/j.issn.0253-374x.2010.05.017LIU H J, ZHANG C W, XU J J, et al. Assigning welding point of car-body-in-white to multi-robots based on genetic algorithm[J]. Journal of Tongji University (Natural Science), 2010, 38(5): 725-729 (in Chinese) doi: 10.3969/j.issn.0253-374x.2010.05.017 [5] 姚江云, 吴方圆. 基于改进蜂群算法的焊接机器人路径规划方法研究[J]. 机床与液压, 2019, 47(15): 49-52+76 doi: 10.3969/j.issn.1001-3881.2019.15.011YAO J Y, WU F Y. Research on path planning method for welding robot based on improved bee colony algorithm[J]. Machine Tool & Hydraulics, 2019, 47(15): 49-52+76 (in Chinese) doi: 10.3969/j.issn.1001-3881.2019.15.011 [6] 陈立, 谢富强, 张亮. 基于消除交叉点的蚁群算法锡焊机器人路径优化[J]. 计算机系统应用, 2015, 24(7): 254-258 doi: 10.3969/j.issn.1003-3254.2015.07.048CHEN L, XIE F Q, ZHANG L. Soldering robot path optimization based on removed cross point ant colony algorithm[J]. Computer Systems & Applications, 2015, 24(7): 254-258 (in Chinese) doi: 10.3969/j.issn.1003-3254.2015.07.048 [7] 王海东. 基于视觉的卷钢内边缘识别技术与喷码轨迹规划研究[D]. 哈尔滨: 哈尔滨工业大学, 2019WANG H D. Research on recognition technology of inner edge of coil of strip based on machine vision and coding trajectory planning[D]. Harbin: Harbin Institute of Technology, 2019 (in Chinese) [8] 马旭东, 王朝, 孙理. 基于蚁群算法塑模孔群加工路径优化[J]. 制造技术与机床, 2020(10): 97-101 https://www.cnki.com.cn/Article/CJFDTOTAL-ZJYC202010022.htmMA X D, WANG C, SUN L. Optimization of machining path of plastic mold hole group based on ant colony algorithm[J]. Manufacturing Technology & Machine Tool, 2020(10): 97-101 (in Chinese) https://www.cnki.com.cn/Article/CJFDTOTAL-ZJYC202010022.htm [9] 王学武, 汤彬, 顾幸生. 焊接机器人避障策略研究[J]. 机械工程学报, 2019, 55(17): 77-84 https://www.cnki.com.cn/Article/CJFDTOTAL-JXXB201917012.htmWANG X W, TANG B, GU X S. Research on obstacle avoidance strategy for welding robot[J]. Journal of Mechanical Engineering, 2019, 55(17): 77-84 (in Chinese) https://www.cnki.com.cn/Article/CJFDTOTAL-JXXB201917012.htm [10] 李黎, 尚俊云, 冯艳丽, 等. 关节型工业机器人轨迹规划研究综述[J]. 计算机工程与应用, 2018, 54(5): 36-50 https://www.cnki.com.cn/Article/CJFDTOTAL-JSGG201805005.htmLI L, SHANG J Y, FENG Y L, et al. Research of trajectory planning for articulated industrial robot: a review[J]. Computer Engineering and Applications, 2018, 54(5): 36-50 (in Chinese) https://www.cnki.com.cn/Article/CJFDTOTAL-JSGG201805005.htm [11] 浦玉学, 舒鹏飞, 蒋祺, 等. 工业机器人时间-能量最优轨迹规划[J]. 计算机工程与应用, 2019, 55(22): 86-90+151 doi: 10.3778/j.issn.1002-8331.1903-0413PU Y X, SHU P F, JIANG Q, et al. Time-energy optimum trajectory planning for industrial robot[J]. Computer Engineering and Applications, 2019, 55(22): 86-90+151 (in Chinese) doi: 10.3778/j.issn.1002-8331.1903-0413 [12] 李素, 袁志高, 王聪, 等. 群智能算法优化支持向量机参数综述[J]. 智能系统学报, 2018, 13(1): 70-84 https://www.cnki.com.cn/Article/CJFDTOTAL-ZNXT201801009.htmLI S, YUAN Z G, WANG C, et al. Optimization of support vector machine parameters based on group intelligence algorithm[J]. CAAI Transactions on Intelligent Systems, 2018, 13(1): 70-84 (in Chinese) https://www.cnki.com.cn/Article/CJFDTOTAL-ZNXT201801009.htm [13] 刘建华, 杨建国, 刘华平, 等. 基于势场蚁群算法的移动机器人全局路径规划方法[J]. 农业机械学报, 2015, 46(9): 18-27 https://www.cnki.com.cn/Article/CJFDTOTAL-NYJX201509003.htmLIU J H, YANG J G, LIU H P, et al. Robot global path planning based on ant colony optimization with artificial potential field[J]. Transactions of the Chinese Society for Agricultural Machinery, 2015, 46(9): 18-27 (in Chinese) https://www.cnki.com.cn/Article/CJFDTOTAL-NYJX201509003.htm [14] 刘天孚, 程如意. 带精英策略和视觉探测蚁群算法的机器人路径规划[J]. 计算机应用, 2008, 28(1): 92-93+96 https://www.cnki.com.cn/Article/CJFDTOTAL-JSJY200801032.htmLIU T F, CHENG R Y. Ant algorithm with elitist strategy and vision detection for mobile robot path planning[J]. Journal of Computer Applications, 2008, 28(1): 92-93+96 (in Chinese) https://www.cnki.com.cn/Article/CJFDTOTAL-JSJY200801032.htm [15] 李娟, 游晓明, 刘升, 等. 动态混沌蚁群系统及其在机器人路径规划中的应用[J]. 计算机应用, 2018, 38(1): 126-131 https://www.cnki.com.cn/Article/CJFDTOTAL-JSJY201801024.htmLI J, YOU X M, LIU S, et al. Dynamic chaotic ant colony system and its application in robot path planning[J]. Journal of Computer Applications, 2018, 38(1): 126-131 (in Chinese) https://www.cnki.com.cn/Article/CJFDTOTAL-JSJY201801024.htm