一种变胞式工业机器人时间最优轨迹规划

doi:10.3901/JME.2023.05.100

摘要/Abstract

摘要： 根据变胞式工业机器人工作原理，建立了其工作轨迹模型，并基于该模型提出了一种变胞式工业机器人时间最优的轨迹规划方法。该方法着重考虑机器人构态变换过程，将轨迹规划问题转化为内外层嵌套的优化问题进行分析。分别给出该优化问题的设计变量、目标函数以及约束条件，得到了变胞式工业机器人时间最优轨迹规划问题的数学模型。运用所提出的方法对本课题组自研制的变胞式码垛机器人进行轨迹规划研究，根据其工作轨迹模型，建立了优化设计问题数学模型，在给出关节角度插值函数系数的确定方法后，采用嵌套粒子群算法对该优化问题进行求解，得到了优化后的关节角度函数以及理论工作轨迹，与实验所得的实际工作轨迹进行对比，验证了所提方法的可行性。该研究工作为变胞式机器人的运动规划研究提供了参考。

关键词: 变胞机构, 工业机器人, 轨迹规划, 时间最优, 嵌套粒子群算法

Abstract: According to the working principle of the metamorphic industrial robot, its working trajectory model is established. And based on this model, a time optimization trajectory planning method of the metamorphic industrial robot is proposed. This method focuses on the transformation process of robot configuration and transforms the trajectory planning problem into an internal and external nested optimization problem for analysis. The design variables, objective function and constraints of the optimization problem are presented respectively, and the mathematical model of the time optimization trajectory planning problem of the metamorphic industrial robot is obtained. The proposed method is used to study the trajectory planning of the metamorphic palletizing robot developed by our research group. According to its working trajectory model, the mathematical model of the optimization design problem is established. After presenting the calculation method for coefficients of the joint angle interpolation functions, the optimization problem is solved by nested PSO algorithm, and the optimized joint angle functions and theoretical working trajectory are calculated. Compared with the actual working track gained by the experiment, the feasibility of the proposed method is verified. This work provides a reference for the research of motion planning of metamorphic robots.

Key words: metamorphic mechanisms, industrial robot, trajectory planning, time optimization, nested PSO algorithm

中图分类号:

TP242

王汝贵, 董奕辰, 陈辉庆. 一种变胞式工业机器人时间最优轨迹规划[J]. 机械工程学报, 2023, 59(5): 100-111.

WANG Rugui, DONG Yichen, CHEN Huiqing. A Time Optimal Trajectory Planning of the Metamorphic Industrial Robot[J]. Journal of Mechanical Engineering, 2023, 59(5): 100-111.

参考文献

[1] DAI J S,JONES J R. Mobility in metamorphic mechanisms of foldable/erectable kinds[J]. Transactions of the ASME:Journal of Mechanical Design,1999,121(3):375-382.
[2] GAN D,DAI J S,LIAO Q. Constraint analysis on mobility change of a novel metamorphic parallel mechanism[J]. Mechanism & Machine Theory,2010,45(12):1864-1876.
[3] 康熙,戴建生. 机构学中机构重构的理论难点与研究进展——变胞机构演变内涵、分岔机理、设计综合及其应用[J]. 中国机械工程,2020,31(1):57-71. KANG Xi,DAI Jiansheng. Theoretical difficulties and research progresses of mechanism reconfiguration in mechanisms[J]. China Mechanical Engineering,2020,31(1):57-71.
[4] YANG Q,HAO G,LI S,et al. Practical structural design approach of multiconguration planar single-loop metamorphic mechanism with a single actuator[J]. Chinese Journal of Mechanical Engineering,2020,33(5):29-43.
[5] 贾璞,李端玲,李海源,等. 基于变胞铰链的并联机构结构设计与构型分析[J]. 机械工程学报,2020,56(19):92-102. JIA Pu,LI Duanling,LI Haiyuan,et al. Structural design and configuration analysis of parallel mechanism with metamorphic joint[J]. Journal of Mechanical Engineering,2020,56(19):92-102.
[6] 宋艳艳,畅博彦,金国光,等. 变胞机构构态切换时的冲击问题分析与仿真研究[J]. 机械工程学报,2020,56(17):48-58. SONG Yanyan,CHANG Boyan,JIN Guoguang,et al. Analysis and simulation of impact problem of metamorphic mechanism considering configuration transformation[J]. Journal of Mechanical Engineering,2020,56(17):48-58.
[7] 王汝贵,陈辉庆. 变胞机构多失效模式运动可靠性分析与优化[J]. 机械工程学报,2021,57(11):184-194. WANG Rugui,CHEN Huiqing. Analysis and optimization on kinematic reliability of metamorphic mechanisms with multiple failure modes[J]. Journal of Mechanical Engineering,2021,57(11):184-194.
[8] AN W,WEI J,LU X,et al. Geometric design-based dimensional synthesis of a novel metamorphic multi-ngered hand with maximal workspace[J]. Chinese Journal of Mechanical Engineering,2021,34(3):224-238.
[9] 李树军,王洪光,李小彭,等. 面向作业任务的约束变胞机构设计方法[J]. 机械工程学报,2018,54(3):26-35. LI Shujun,WANG Hongguang,LI Xiaopeng,et al. Task-orientated design method of practical constraint metamorphic mechanisms[J]. Journal of Mechanical Engineering,2018,54(3):26-35.
[10] BRUZZONE L,BOZZINI G. A flexible joints microassembly robot with metamorphic gripper[J]. Assembly Automation,2010,30(3),240-247.
[11] DAI Z,SUN J. A biomimetic study of discontinuous-constraint metamorphic mechanism for gecko-like robot[J]. Journal of Bionic Engineering,2007,4(2):91-95.
[12] CHEN H,WANG R,DONG Y,et al. Dynamic reliability analysis for configuration transformation of a controllable metamorphic palletizing robot[J]. Proceedings of the Institution of Mechanical Engineers,Part C:Journal of Mechanical Engineering Science,2022,236(10):5208-5222.
[13] 王汝贵,陈辉庆,戴建生. 新型可控变胞式码垛机器人机构动态稳定性研究[J]. 机械工程学报,2017,53(13):39-47. WANG Rugui,CHEN Huiqing,DAI Jiansheng. Dynamic stability study of a novel controllable metamorphic palletizing robot mechanism[J]. Journal of Mechanical Engineering,2017,53(13):39-47.
[14] 丁希仑,徐坤. 一种新型变结构轮腿式机器人的设计与分析[J]. 中南大学学报(自然科学版),2009,40(S1):91-101. DING Xilun,XU Kun. Design and analysis of a novel metamorphic wheel-legged rover mechanism[J]. Journal of Central South University (Science and Technology),2009,40(S1):91-101.
[15] 刘超,谭稀岑,姚燕安,等. 一种新型可变形轮腿式机器人的设计与分析[J]. 机械工程学报,2022,58(3):65-74. LIU Chao,TAN Xicen,YAO Yanan,et al. Design and analysis of a novel deformable wheel-legged robot[J]. Journal of Mechanical Engineering,2022,58(3):65-74.
[16] 甄伟鲲,康熙,张新生,等. 一种新型四足变胞爬行机器人的步态规划研究[J]. 机械工程学报,2016,52(11):26-33. ZHEN Weikun,KANG Xi,ZHANG Xinsheng,et al. Gait planning of a novel metamorphic quadruped robot[J]. Journal of Mechanical Engineering,2016,52(11):26-33.
[17] 牛建业,王洪波,史洪敏,等. 变自由度轮足复合机器人轨迹规划验证及步态研究[J]. 农业工程学报,2017,33(23):38-47. NIU Jianye,WANG Hongbo,SHI Hongmin,et. al. Trajectory planning verification and gait analysis of wheel-legged hybrid robot with variable degree of freedom[J]. Transactions of the Chinese Society of Agricultural Engineering,2017,33(23):38-47.
[18] 王圣捷,戴建生. 变胞四足机器人倾覆后的变胞恢复机理及其特性研究[J]. 中国机械工程,2021,32(11):1274-1282. WANG Shengjie,DAI Jiansheng. Research on metamorphic self-recovery strategy and characteristics of metamorphic quadruped robots after overturning[J]. China Mechanical Engineering,2021,32(11):1274-1282.
[19] SUN J,HAN X,ZUO Y,et al. Trajectory planning in joint space for a pointing mechanism based on a novel hybrid interpolation algorithm and NSGA-II algorithm[J]. IEEE Access,2020,8:228628-228638.
[20] SIDOBRE D,DESORMEAUX K. Smooth cubic polynomial trajectories for human-robot interactions[J]. Intelligent & Robotic Systems,2019,95(3-4):851-869.
[21] ZHANG J,MENG Q,FENG X,et al. A 6-DOF robot-time optimal trajectory planning based on an improved genetic algorithm[J]. Robotics and Biomimetics,2018,5(1):1-7.
[22] WANG W,TAO Q,CAO Y,et al. Robot time-optimal trajectory planning based on improved cuckoo search Algorithm[J]. IEEE Access,2020,8:86923-86933.
[23] WANG L,WU Q,LIN F,et al. A new trajectory-planning beetle swarm optimization algorithm for trajectory planning of robot manipulators[J]. IEEE Access,2019,7:154331-154345.
[24] KIM J,CROFT E A. Online near time-optimal trajectory planning for industrial robots[J]. Robotics and Computer Integrated Manufacturing,2019,58:158-171.
[25] 孙晓军,宋代平,林敬周,等. 风洞上攻角机器人轨迹规划算法研究与实现[J]. 中国机械工程,2021,32(16):1963-1971. SUN Xiaojun,SONG Daiping,LIN Jingzhou,et al. Research and implementation of trajectory planning algorithm for attacking robots on wind tunnel[J]. China Mechanical Engineering,2021,32(16):1963-1971.
[26] GASPARETTO A,ZANOTTO V. Optimal trajectory planning for industrial robots[J]. Advances in Engineering Software,2010,41(4):548-556.
[27] HUANG J,HU P,WU K,et al. Optimal time-jerk trajectory planning for industrial robots[J]. Mechanism and Machine Theory,2018,121:530-544.
[28] LIN H I. A fast and unified method to find a minimum-jerk robot joint trajectory using particle swarm optimization[J]. Intelligent & Robotic Systems,2014,75(3-4):379-392.
[29] 王汝贵,董奕辰,金聪,等. 可控变胞码垛机器人控制系统设计及实验[J]. 广西大学学报(自然科学版),2021,46(6):1505-1513. WANG Rugui,DONG Yichen,JIN Cong,et al. Design and experiment of control system for controllable metamorphic palletizing robot[J]. Journal of Guangxi University (Natural Science Edition),2021,46(6):1505-1513.
[30] 王汝贵,陈辉庆,孙家兴,等. 一种变胞机构式码垛机器人:中国,201711082276.9[P]. 2020-04-21. WANG Rugui,CHEN Huiqing,SUN Jiaxing,et. al. A metamorphic mechanism palletizing robot:China,201711082276.9[P]. 2020-04-21.
[31] 王汝贵,陈辉庆. 一种变胞式码垛机器人:中国,202011042641.5[P]. 2020-09-28. WANG Rugui,CHEN Huiqing. A metamorphic palletizing robot:China,202011042641.5[P]. 2020-09-28.
[32] ZHAO Y. Intelligent control and planning for industrial robots[D]. Berkeley:University of California,2018.
[33] 段旭洋,王皓,赵勇,等. 基于嵌套粒子群算法的平面机构尺度综合与构型优选[J]. 机械工程学报,2013,49(13):32-39. DUAN Xuyang,WANG Hao,ZHAO Yong,et al. Dimensional synthesis and optimal type selection of planar mechanisms based on nested particle swarm optimization[J]. Journal of Mechanical Engineering,2013,49(13):32-39.