CHENG Hao-tian, ZHU Xi-jing, FENG Xin-yu, ZHAO Jing, CAI Zhan-peng, DING Shuai-shuai
To improve the working performance of the robot and meet the needs of actual complex working conditions, the motion state and trajectory planning of the SNR3-C30 6R industrial robot were studied. First, the coordinate system and kinematics equations of the robot arm link are established according to the D-H method. Secondly, based on the posture matrix characteristics of its end effector, a geometric inversion optimization algorithm combined with posture separation is proposed. This algorithm uses the geometric positional relationship of each joint of the robot relative to the wrist to solve the first three joint angles θ1, θ2, θ3, and then on the basis of this, the remaining joint angles θ4, θ5, θ6 are solved by rotating the sub-matrix. Finally, the improved algorithm is verified in the MATLAB Robotics simulation module, and the polynomial interpolation method is used to plan the joint space trajectory. The research results show that the improved algorithm has superiority and effectiveness, and when the fifth-order polynomial interpolation method is used for trajectory planning, the robot runs more smoothly.