Trajectory optimization of the 6-degrees-of-freedom high-speed parallel robot based on B-spline curve

摘要

According to the problem that the existing high-speed parallel robot cannot satisfy the operation requirements of non-planar industrial production line, a 6-degrees-of-freedom high-speed parallel robot is proposed to carry out the kinematic and dynamic analyses. Combining with the door-type trajectory commonly used by the parallel robot, it adopts 3-, 5-, and 7-time B-spline curve motion law to conduct the trajectory planning in operation space. Taking the average cumulative effect of joint jerky as the optimization target, a trajectory optimization method is proposed to improve the smoothness of robot end-effector motion with the selected motion law. Furthermore, to solve the deformation problem of the horizontal motion stage of the trajectory, a mapping model between the control point subset of B-spline and the motion point subset of trajectory is established. Based on the main diagonally dominant characteristic of the coefficient matrix, the trajectory deformation evaluation index is constructed to optimize the smoothness and minimum deformation of the robot motion trajectory. Finally, compared to without the optimization, the maximum robot joint jerk decreases by 69.4% and 72.3%, respectively, and the maximum torque decreases by 51.4% and 38.9%, respectively, under a suitable trajectory deformation.