Analyzing and Optimizing Parameters of 6R Dual-arm Service Robot Collaborative Space
-
摘要: 针对双臂机器人协作空间及其机构参数优化问题, 以6R双臂服务机器人为研究对象, 根据D-H参数求出运动学正解, 利用蒙特卡洛法求解双臂各自的工作空间, 以协作空间最大为优化目标, 求解机械臂机构最优参数, 通过MATLAB进行编程对具体运算结果进行验证。结果表明, 在一定约束之内, 以双臂机器人协作空间最大为目标, 优化机构连杆长度和关节范围大小, 对双臂服务机器人的设计改进有着重要意义, 为后续的双臂协调操作奠定了基础。Abstract: This paper studies the 6R dual-arm service robot independently developed by lab personnel and finds the forward kinematics solution according to Denavit-Hartenberg(D-H) parameters. It uses the Monte Carlo method to get its working space and extract the common area points set within the allowable error range. It proposes to quantify the size of collaborative space volume using the number of space cloud points. To get the maximum collaborative space volume, this paper iteratively searches for the optimal mechanical parameters of the robot arm. The results show that it is of great significance to optimize the mechanism parameters of the robot in order to get the largest cooperation space of the dual arm robot within the constraints of its joints, thus laying the foundation for coordinated operations.
-
Key words:
- dual-arm robot /
- collaborative space /
- Monte Carlo method /
- optimization
-
表 1 双臂机器人-左臂DH参数表
关节 αi-1/rad ai-1/m θi/rad di/m 1 0 a0 θ1 0 2 a1 d2 3 0 a2 0 4 0 θ4 d4 5 0 θ5 0 6 0 θ6 0 表 2 各个连杆长度最大值和最小值
连杆参数 a0 a1 d2 a2 d4 最大值/m 0.16 0.17 0.082 0.307 0.256 最小值/m 0.08 0.09 0.002 0.227 0.186 表 3 连杆原始参数、改进参数、协作空间增加幅度
连杆参数 a0 a1 d2 a2 d4 原始参数/m 0.12 0.13 0.04 0.26 0.24 改进参数/m 0.11 0.09 0.05 0.23 0.22 增加幅度/% 6 1 0.3 1.5 0.4 表 4 关节转角范围
关节 θ1 θ2 θ3 θ4 θ5 θ6 关节上限/(°) 90 90 180 180 90 180 关节下限/(°) -90 -120 0 -180 -90 -180 -
[1] 谭民, 王硕. 机器人技术研究进展[J]. 自动化学报, 2013, 39(7): 963-972 https://www.cnki.com.cn/Article/CJFDTOTAL-MOTO201307003.htmTAN M, WANG S. Research progress on robotics[J]. Acta Automatica Sinica, 2013, 39(7): 963-972 (in Chinese) https://www.cnki.com.cn/Article/CJFDTOTAL-MOTO201307003.htm [2] ABE F, NAKAMURA K, KEITARO N. Stable pulling out motion for a dual-arm robot[J]. Artificial Life and Robotics, 2019, 24(2): 203-211 doi: 10.1007/s10015-018-0488-0 [3] 田海波, 马宏伟, 魏娟. 串联机器人机械臂工作空间与结构参数研究[J]. 农业机械学报, 2013, 44(4): 196-201 https://www.cnki.com.cn/Article/CJFDTOTAL-NYJX201304035.htmTIAN H B, MA H W, WEI J. Workspace and structural parameters analysis for manipulator of serial robot[J]. Transactions of the Chinese Society for Agricultural Machinery, 2013, 44(4): 196-201 (in Chinese) https://www.cnki.com.cn/Article/CJFDTOTAL-NYJX201304035.htm [4] 王威, 许勇, 刘勇, 伟等. 基于MATLAB的双机器人协作空间求解及分析[J]. 轻工学报, 2019, 34(4): 102-108WANG W, XU Y, LIU Y, et al. Double-robot collaborative workspace solution and analysis based on MATLAB[J]. Journal of Light Industry, 2019, 34(4): 102-108 (in Chinese) [5] 谢生良, 刘祚时. 双臂机器人工作空间的分析与仿真[J]. 机械传动, 2018, 42(6): 139-143 https://www.cnki.com.cn/Article/CJFDTOTAL-JXCD201806029.htmXIE S L, LIU Z S. Analysis and simulation of workspace of dual-arm robot[J]. Journal of Mechanical Transmission, 2018, 42(6): 139-143 (in Chinese) https://www.cnki.com.cn/Article/CJFDTOTAL-JXCD201806029.htm [6] 许卫斌, 平雪良, 应再恩, 等. 6R型串联机器人工作空间快速求解方法[J]. 机械设计, 2013, 30(6): 28-31 doi: 10.3969/j.issn.1001-2354.2013.06.007XU W B, PING X L, YING Z E, et al. Rapid solving method for 6R serial-type robot working space[J]. Journal of Machine Design, 2013, 30(6): 28-31 (in Chinese) doi: 10.3969/j.issn.1001-2354.2013.06.007 [7] 徐振邦, 赵智远, 贺帅, 等. 机器人工作空间求解的蒙特卡洛法改进和体积求取[J]. 光学精密工程, 2018, 26(11): 2703-2713 https://www.cnki.com.cn/Article/CJFDTOTAL-GXJM201811012.htmXU Z B, ZHAO Z Y, HE S, et al. Improvement of Monte Carlo method for robot workspace solution and volume calculation[J]. Optics and Precision Engineering, 2018, 26(11): 2703-2713 (in Chinese) https://www.cnki.com.cn/Article/CJFDTOTAL-GXJM201811012.htm [8] 李宪华, 孙青, 范凯杰, 等. 双臂6R服务机器人的协作空间分析与仿真[J]. 机械传动, 2018, 42(9): 130-134 https://www.cnki.com.cn/Article/CJFDTOTAL-JXCD201809026.htmLI X H, SUN Q, FAN K J, et al. Analysis and simulation of collaborative space of the dual arm 6R service robot[J]. Journal of Mechanical Transmission, 2018, 42(9): 130-134 (in Chinese) https://www.cnki.com.cn/Article/CJFDTOTAL-JXCD201809026.htm [9] 李宪华, 孙青, 张雷刚, 等. 服务机器人双臂协调操作的灵活性分析[J]. 华中科技大学学报, 2019, 47(5): 33-38 https://www.cnki.com.cn/Article/CJFDTOTAL-HZLG201905007.htmLI X H, SUN Q, ZHANG L G, et al. Flexibility analysis of coordination operation of dual-arm service robot[J]. Journal of Huazhong University of Science and Technology, 2019, 47(5): 33-38 (in Chinese) https://www.cnki.com.cn/Article/CJFDTOTAL-HZLG201905007.htm [10] 周律, 周昱明, 汪亮, 等. 基于蒙特卡罗方法的双臂机器人工作空间分析[J]. 机械传动, 2014, 38(6): 85-87, 118 https://www.cnki.com.cn/Article/CJFDTOTAL-JXCD201406024.htmZHOU L, ZHOU Y M, WANG L, et al. Dual-arm robot workspace analysis based on the Monte Carlo method[J]. Journal of Mechanical Transmission, 2014, 38(6): 85-87, 118 (in Chinese) https://www.cnki.com.cn/Article/CJFDTOTAL-JXCD201406024.htm [11] 刘志忠, 柳洪义, 罗忠, 等. 机器人工作空间求解的蒙特卡洛法改进[J]. 农业机械学报, 2013, 44(1): 230-235 https://www.cnki.com.cn/Article/CJFDTOTAL-NYJX201301044.htmLIU Z Z, LIU H Y, LUO Z, et al. Improvement on Monte Carlo method for robot workspace determination[J]. Transactions of the Chinese Society for Agricultural Machinery, 2013, 44(1): 230-235 (in Chinese) https://www.cnki.com.cn/Article/CJFDTOTAL-NYJX201301044.htm [12] CRAIG J J. Introduction to robotics: mechanics and control, 3/E[M]. Pearson Education India, 2009 [13] CORKE P. Robotics, vision and control[M]. 2nd ed. Cham, Switzerland: Springer, 2017 [14] 鲁可, 曹毅, 李秀娟. 双臂机器人协作空间的解算[J]. 工程图学学报, 2009, 30(5): 39-43 doi: 10.3969/j.issn.1003-0158.2009.05.007LU K, CAO Y, LI X J. Cooperative workspace of dual-arm space robot[J]. Journal of Engineering Graphics, 2009, 30(5): 39-43 (in Chinese) doi: 10.3969/j.issn.1003-0158.2009.05.007 [15] 刘冠隆, 贺晓莹, 高兴宇, 等. 七自由度双臂机器人旋量理论正向运动学与工作空间分析[J]. 机械科学与技术, 2019, 38(5): 704-712 https://www.cnki.com.cn/Article/CJFDTOTAL-JXKX201905008.htmLIU G L, HE X Y, GAO X Y, et al. Forward kinematics and workspace analysis of screw theory of seven-DOF dual-arm robot[J]. Mechanical Science and Technology for Aerospace Engineering, 2019, 38(5): 704-712 (in Chinese) https://www.cnki.com.cn/Article/CJFDTOTAL-JXKX201905008.htm