| Industrial robots used in manufacturing can be a substantial increase in labor productivity and product quality. Various robots with different functions also have different control systems. And industrial robot trajectory planning and joint control module is an essential part of all kinds of robot control system, play a pivotal role in the accuracy of the motion.This thesis is focused on the trajectory planning and joint control algorithm research. The main contents are as follows:Firstly, according to the theory of transformation matrix and the analysis of structure parameters of robot, we create the robot kinematics model based on D-H parameters, in addition the robot kinematics model can be verified by means of the MATLAB software.Secondly, research on trajectory planning algorithm for task space based on the kinematics model of the robot. Use parabolic interpolate robot task point, make the parabolic chord approximate cure based on equal length chord.Thirdly, use various parameters of the KUKA KR6-2 robot built a simulation model of the robot in the SimMechanics environment.Fourthly, research on trajectory planning algorithm for joint space. Use B-splines of seven degree interpolate joint position series and generate joint trajectories with continuous velocity, acceleration and jerk, as well as controllable start-stop kinematic parameters. On this basis, use genetic algorithm plan time-optimal trajectory, the author proposed a kind of planning method to make all joint trajectory arrive position series at the same time.At last, use the software tool named Simulink to analyze robot control algorithm. The author combined the variable structure control and PID control algorithm in which to propose a kind of feed forward algorithm. This algorithm can reduce the error and easy to implement. Simulation results show the feasibility and efficiency of the algorithm. |
PDF Full Text Request