Joint Trajectory Planning Algorithm for Industrial Robots Based on Mixed Interpolation

Abstract

Abstract: B-spline curves were widely used in trajectory planning of industrial robots in joint spaces due to the multi-order continuous derivative and local supporting characteristics.Derivative values of B-spline existed with sudden changes at the beginning and end positions，which might result in vibrations for industrial robots when starting and stopping.A new method to optimize interpolation of high order polynomials and B-splines was proposed herein，so the kinematics parameters of robot joints would be continuous and not mutational.Thus the robots may run more smoothly，the operations of the robot states are improved without increasing operating burden of the robot control systems.

Key words: B-spline interpolation, trajectory planning, mixed interpolation optimization, industrial robot, joint space

摘要： B样条曲线由于其多阶导数连续和局部支撑性的特点，被广泛用于工业机器人关节空间的轨迹规划。标准B样条在起止点位置存在导数值的突变，致使工业机器人在启动和停止时产生振动。提出一种采用高次多项式与B样条混合插值优化的方法，使机器人关节运动学参数连续无突变，在不增加机器人控制系统运行负担的情况下，能够使机器人运行更加平稳，改善了机器人的运行状态。

关键词: B样条插值, 轨迹规划, 混合插值优化, 工业机器人, 关节空间

CLC Number:

TP242.2

HAN Jiang;GU Taotao;XIA Lian;DONG Fangfang. Joint Trajectory Planning Algorithm for Industrial Robots Based on Mixed Interpolation[J]. China Mechanical Engineering.

韩江；谷涛涛；夏链;董方方. 基于混合插值的工业机器人关节轨迹规划算法[J]. 中国机械工程.

References

[1]谭民，徐德，侯增广，等.先进机器人控制[M].北京：高等教育出版社，2007：90-107.
TAN Min，XU De，HOU Zengguang.Advanced Robot Control [M].Beijing：Higher Education Press，2007：90-107.
[2]王卫忠，赵杰，高永生，等.机器人的平面曲线轨迹规划方法[J].哈尔滨工业大学学报，2008，40（3）：389-392.
WANG Weizhong，ZHAO Jie，GAO Yongsheng,et al.An Approach for Robot Plane Curve Trajectory Planning [J].Journal of Harbin Institute of Technology，2008，40（3）：389-392.
[3]MENASRI R，MENASRIJ R.Smooth Trajectory Planning for Robot Using Particle Swarm Optimization [C]//International Conference on Swarm Intelligence Based Optimization.Mulhouse，France:ICSIBO，2014：50-59.
[4]ABU-DAKKA J，ASSAD F.Parallel-populations Genetic Algorithm for the Optimization of Cubic Polynomial Joint Trajectories for Industrial Robot [C]//International Conference on Intelligent Robotics and Applications.Aachen，2011：83-92.
[5]胡小平，彭涛.一种基于多项式和牛顿插值法的机械手轨迹规划方法[J].中国机械工程，2012，23（24）：2946-2949.
HU Xiaoping，PENG Tao.A Trajectory Planning Method Based on Newton Interpolation and Polynomial for Manipulator [J].China Mechanical Engineering，2012，23（24）：2946-2949.
[6]李小霞，汪木兰.基于五次B样条的机械手关节空间平滑轨迹规划[J].组合机床与自动化加工技术，2012，8（8）：39-42.
LI Xiaoxia，WANG Mulan.Smooth Trajectory Planning Based on Five Degrees B-spline for Manipulators in Joint Space [J].Modular Machine Tool & Automatic Manufacturing Technique，2012，8（8）：39-42.
[7]邓乾旺，罗正平.点焊机器人轨迹能耗模型及其优化算法研究[J].中国机械工程，2016，27（1）：14-20.
DENG Qianwang，LUO Zhengping.Study on Energy Consumption Model and Its Optimization Algorithm for Spot Welding Robot Trajectory [J].China Mechanical Engineering，2016，27（1）:14-20.
[8]朱世强，刘松国.机械手时间最优脉动连续轨迹规划算法[J].机械工程学报，2010，46（3）：47-52.
ZHU Shiqiang，LIU Songguo.Time-optimal and Jerk-continuous Trajectory Planning Algorithm for Manipulators [J].Journal of Mechanical Engineering，2010，46（3）:47-52.
[9]LIU Liang，CHEN Chaoying.Smooth Trajectory Planning for a Parallel Manipulator with Joint Friction and Jerk Constraints [J].International Journal of Control，Automation and Systems，2016，8（14）：1022-1036.
[10]施法中.计算机辅助几何设计与非均匀有理B样条[M].北京：高等教育出版社，2013：78-110.
SHI Fazhong.Computer Aided Geometric Design and Non Uniform Rational B Spline （CAGD & NURBS）[M].Beijing：Higher Education Press，2013:78-110.
[11]高艺，马国庆，于正林，等.一种六自由度工业机器人运动学分析及三维可视化仿真[J].中国机械工程，2016，27（13）：1726-1731.
GAO Yi，MA Guoqing，YU Zhenglin，et al.Kinematics Analysis of a 6-DOF Industrial Robot and Its 3D Visualization Simulation [J].China Mechanical Engineering，2016，27（13）：1726-1731.

[1]	JIANG Jiguang, HOU Jue, SU Chengzhi, BA Qijiao, TIAN Aixin, XU Mingyu. Research on Optimal Pose Set Planning Method under Physical Constraint Robot Kinematics Calibration [J]. China Mechanical Engineering, 2024, 35(03): 472-480.
[2]	CHEN Zhuofan, ZHOU Kun, QIN Feifei, WANG Binrui. Inverse Kinematics Solution of Robots Based on IQPSO Algorithm [J]. China Mechanical Engineering, 2024, 35(02): 293-304.
[3]	RONG Yu, CHEN Gang, DOU Tianci, . A Multi Index Comprehensive Optimal Anti Impact Trajectory Planning Method [J]. China Mechanical Engineering, 2024, 35(02): 305-316.
[4]	WU Chaoqun, ZHAO Song, LEI Ting. Robot Welding Trajectory Planning and High Frequency Control for Curved Seams [J]. China Mechanical Engineering, 2023, 34(14): 1723-1728.
[5]	YANG Fei, JIANG Wei, CHEN Cheng, HUANG Zhigao, ZHOU Huamin, . Study on Infrared Heat Source-assisted Open-space Industrial Robotic FDM Equipment Design and Forming Performance [J]. China Mechanical Engineering, 2023, 34(11): 1343-1352,1385.
[6]	ZHANG Junxin, CHEN Wei, HUANG Sikai, WU Haibin. Control Strategies for Industrial Robot Motion along Slot Based on Force and Position Hybrid Guidances [J]. China Mechanical Engineering, 2023, 34(06): 712-719，726.
[7]	TUO Junbo, PENG Qiuyuan, ZHANG Xianmin, LI Congbo. Energy Consumption Prediction Method for Industrial Robots [J]. China Mechanical Engineering, 2022, 33(22): 2727-2732,2740.
[8]	LIU Huailan, ZHAO Wenjie, LI Shizhuang, YUE Peng, MA Baorui. Construction Method of Virtual-real Drive Systems for Robots in Digital Twin Workshops [J]. China Mechanical Engineering, 2022, 33(21): 2623-2632.
[9]	NI Huakang, YANG Zeyuan, YANG Yifan, CHEN Xindu, YAN Sijie, DING Han. Robot Kinematics Calibration Method Considering Base Frame Errors [J]. China Mechanical Engineering, 2022, 33(06): 647-655.
[10]	SUN Xiaojun, SONG Daiping, LIN Jingzhou, HAN Weihang. Research and Implementation of Trajectory Planning Algorithm for Attacking Robots on Wind Tunnel [J]. China Mechanical Engineering, 2021, 32(16): 1963-1971.
[11]	ZHANG Enzheng, TANG Ningmin, CHEN Gang, LIU Cuiping. Industrial Robot Calibration Based on Improved IGG3 Weight Function of Distance Error Model#br# [J]. China Mechanical Engineering, 2021, 32(13): 1539-1546.
[12]	JI Yangzhen, HOU Li, LUO Lan, LUO Pei, LIU Xubin, LIANG Shuang. Solution of Inverse Kinematics for 6R Robots Based on Combinatorial Optimization Algorithm#br# [J]. China Mechanical Engineering, 2021, 32(10): 1222-1232.
[13]	WU Jinhui1,2；TAO Yourui1,2. Review on Research Status of Positioning Accuracy Reliability of Industrial Robots [J]. China Mechanical Engineering, 2020, 31(18): 2180-2188.
[14]	LIU Zhiqiang1;GU Xianan1;GUO Hao1;XI Hao1;WANG Mingqiang1;LI Junli2. A Trajectory Planning Method for Automatic Placement of Carbon n Fiber Screw Propellers [J]. China Mechanical Engineering, 2020, 31(17): 2079-2084,2094.
[15]	LIU Jicheng;JI Hongchao. Gait Planning Strategy for a New Type of Wheel-legged Robot [J]. China Mechanical Engineering, 2019, 30(18): 2257-2262.