Time Optimal Trajectory Planning for Tandem Manipulator of Electric Energy Meter Test Platform

doi:10.3778/j.issn.1002-8331.2009-0455

Abstract

Abstract: Time optimal trajectory planning is helpful to shorten the movement time and improve the working efficiency of the manipulator, which plays a crucial role in the practical application scenarios of the manipulator. An optimal trajectory planning method based on an improved multi-population genetic algorithm is proposed to solve the point-to-point time-optimal trajectory planning problem of tandem robotic arms. The algorithm firstly fits the motion path of the robot arm through the fifth-degree polynomial interpolation and then optimizes the motion time of the robot arm by using the improved multi-population genetic algorithm. The improvements include：designing the fitness function with penalty term to reduce the probability of the individual being selected who does not meet the kinematic constraints. Greedy selection strategy is introduced to retain the excellent individuals in the parent population and replace the poor ones in the offspring population in proportion. The convergence speed of the algorithm is accelerated by adaptive adjustment of crossover and mutation probability. Finally, the feasibility of the proposed algorithm is verified by simulation experiments with ER-4iA robotic arm and compared with ant colony algorithm, particle swarm algorithm, standard genetic algorithm, and standard multi-population genetic algorithm, the results show that the proposed algorithm has better performance.

Key words: time optimal, trajectory planning, tandem manipulator, multi-population genetic algorithm

摘要： 时间最优轨迹规划有助于缩短机械臂运动时间，提高工作效率，在机械臂实际应用场景中起着至关重要的作用。针对串联机械臂点到点运动的时间最优轨迹规划问题，提出一种基于改进多种群遗传算法的最优轨迹规划方法。通过五次多项式插值对机械臂运动路径进行拟合，利用改进的多种群遗传算法对机械臂运动时间进行优化，改进之处包括：设计含有惩罚项的适应度函数，降低不满足运动学约束条件的个体被选择的概率；引入贪婪选择策略，按照比例保留父代种群优秀个体，替换子代种群较差个体；自适应调整交叉和变异概率，加快算法收敛速度。以ER-4iA机械臂为实验对象，通过仿真实验验证所提算法的可行性，并将所提算法与蚁群算法、粒子群算法、标准遗传算法和标准多种群遗传算法进行比较，结果表明所提算法具有更优的性能。

关键词: 时间最优, 轨迹规划, 串联机械臂, 多种群遗传算法

OU Xin, ZHOU Lu, ZHANG Zhi, WU Yuejia, ZHAO Yunbin. Time Optimal Trajectory Planning for Tandem Manipulator of Electric Energy Meter Test Platform[J]. Computer Engineering and Applications, 2022, 58(6): 250-255.

欧新, 周璐, 张鸷, 吴月家, 赵云斌. 电能表检验台体串联机械臂时间最优轨迹规划[J]. 计算机工程与应用, 2022, 58(6): 250-255.

References

[1] NAGY A，VAJK I.Nonconvex time-optimal trajectory planning for robot manipulators[J].Journal of Dynamic Systems，Measurement，and Control，2019，141（11）.
[2] 康代轲，陈明.基于改进混沌搜索算法的机器人轨迹规划[J].计算机工程与应用，2017，53（14）：143-147.
KANG D K，CHEN M.Planning and simulation of robot optimal trajectory based on improved chaotic search algorithm[J].Computer Engineering and Applications，2017，53（14）：143-147.
[3] 李黎，尚俊云，冯艳丽，等.关节型工业机器人轨迹规划研究综述[J].计算机工程与应用，2018，54（5）：36-50.
LI 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.
[4] LIU C，CAO G H，QU Y Y，et al.An improved PSO algorithm for time-optimal trajectory planning of Delta robot in intelligent packaging[J].International Journal of Advanced Manufacturing Technology，2020，107（1）.
[5] COLLINS C，TIAN L F.An effective robot trajectory planning method using a genetic algorithm[J].Mechatronics：The Science of Intelligent Machines，2004，14（5）：455-470.
[6] YE T D，CHENG T B，ZHOU S B.Trajectory planning method of robot teaching based on multi-knots spline interpolation[C]//Advances in Communication Technology and Systems，2015：399-406.
[7] 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.
[8] 浦玉学，舒鹏飞，蒋祺，等.工业机器人时间-能量最优轨迹规划[J].计算机工程与应用，2019，55（22）：86-90.
PU 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.
[9] ROY R，MAHADEVAPPA M，KUMAR C S.Trajectory path planning of EEG controlled robotic arm using GA[J].Procedia Computer Science，2016，84.
[10] FATIMA Z B，LARBI E B，YASSINE L.Optimization of arm manipulator trajectory planning in the presence of obstacles by ant colony algorithm[J].Procedia Engineering，2017，181：560-567.
[11] KIM J，LEE J.Trajectory optimization with particle swarm optimization for manipulator motion planning[J].IEEE Transactions on Industrial Informatics，2015，11（3）：620-631.
[12] 严浙平，邓超，迟冬南，等.双种群粒子群算法及其在UUV路径规划中的应用[J].计算机工程与应用，2013，49（15）：1-5.
YAN Z P，DENG C，CHI D N，et al.Two-subpopulation particle swarm optimization and its application in UUV path planning[J].Computer Engineering and Applications，2013，49（15）：1-5.
[13] XIDIAS E K.Time-optimal trajectory planning for hyper-redundant manipulators in 3D workspaces[J].Robotics and Computer Integrated Manufacturing，2018，50：286-298.
[14] LIU Y，GUO C，WENG Y P.Online time-optimal trajectory planning for robotic manipulators using adaptive elite genetic algorithm with singularity avoidance[J].IEEE Access，2019（99）：1.
[15] 殷凤健，梁庆华，程旭，等.基于时间最优的机械臂关节空间轨迹规划算法[J].机械设计与研究，2017，33（5）：12-15.
YIN F J，LIANG Q H，CHENG X，et al.Research on mechanical arm joint space trajectory planning algorithm based on optimal time[J].Machine Design & Research，2017，33（5）：12-15.
[16] 邓伟，张其万，刘平，等.基于双种群遗传混沌优化算法的最优时间轨迹规划[J].计算机集成制造系统，2018，24（1）：101-106.
DENG W，ZHANG Q W，LIU P，et al.Optimal time trajectory planning based on dual population genetic and chaotic optimization algorithm[J].Computer Integrated Manufacturing Systems，2018，24（1）：101-106.
[17] 秦律，汪木兰，朱晓春，等.基于改进遗传算法的机器人时间最优轨迹规划[J].机械设计与制造工程，2018，47（11）：63-67.
QIN L，WANG M L，ZHU X C，et al.The time-optimal trajectory planning of robot based on improved genetic algorithm[J].Machine Design and Manufacturing Engineering，2018，47（11）：63-67.
[18] DENAVIT J，HARTENBERG R S.A kinematic notation for lower-pair mechanism based on matrices[J].Journal of Applied Mechanism，1955，22：215-221.
[19] KHALIL W，KLEINFINGER J.A new geometric notation for open and closed-loop robots[J].IEEE International Conference on Robotics and Automation，1986，3：1174-1179.