基于MATLAB的PUMA560机器人运动仿真与轨迹规划5.docx

1、基于MATLAB的PUMA560机器人运动仿真与轨迹规划5The movement simulation and trajectory planning of PUMA560 robot Shibo zhao Abstract: In this essay, we adopt modeling method to study PUMA560 robot in the use of Robotics Toolbox based on MATLAB. We mainly focus on three problems include: the forward kinematics, inverse

2、 kinematics and trajectory planning. At the same time, we simulate each problem above, observe the movement of each joint and explain the reason for the selection of some parameters. Finally, we verify the feasibility of the modeling method.Key words: PUMA560 robot; kinematics; Robotics Toolbox; The

3、 simulation; .IntroductionAs automation becomes more prevalent in peoples life, robot begins more further to change peoples world. Therefore, we are obliged to study the mechanism of robot. How to move, how to determine the position of target and the robot itself, and how to determine the angles of

4、each point needed to obtain the position. In order to study robot more validly, we adopt robot simulation and object-oriented method to simulate the robot kinematic characteristics. We help researchers understand the configuration and limit of the robots working space and reveal the mechanism of rea

5、sonable movement and control algorithm. We can let the user to see the effect of the design, and timely find out the shortcomings and the insufficiency, which help us avoid the accident and unnecessary losses on operating entity. This paper establishes a model for Robot PUMA560 by using Robotics Too

6、lbox, and study the forward kinematics and inverse kinematics of the robot and trajectory planning problem. .The introduction of the parameters for the PUMA560 robotPUMA560 robot is produced by Unimation Company and is defined as 6 degrees of freedom robot. It consists 6 degrees of freedom rotary jo

7、ints (The structure diagram is shown in figure 1). Referring to the human body structure, the first joint（J1） called waist joints. The second joint（J2）called shoulder joint. The third joint （J3）called elbow joints. The joints J4 J5, J6, are called wrist joints. Where, the first three joints determin

8、e the position of wrist reference point. The latter three joints determine the orientation of the wrist. The axis of the joint J1 located vertical direction. The axis direction of joint J2, J3 is horizontal and parallel, a3 meters apart. Joint J1, J2 axis are vertical intersection and joint J3, J4 a

9、xis are vertical crisscross, distance of a4. The latter three joints axes have an intersection point which is also origin point for 4, 5, 6 coordinate. (Each link coordinate system is shown in figure 2)Fig1 the structure of puma560 Fig2 the links coordinate of puma 560 When PUMA560 Robot is in the i

10、nitial state, the corresponding link parameters are showed in table 1. The expression of parameters:Let length of the bar represent the distance between and along.Torsion angle denote the angle revolving from to.The measuring distance between and along is. Joint angle is the angle revolving from to

11、along.Table 1 the parameters of puma560 link Range100900-1601602-90000.1491-22545300.4318-900-452254-90-0.021300.4331-110170590000-1001006-90000-266266 .The movement analysis of Puma560 robot3.1 Forward kinematicDefinition: Forward kinematics problem is to solve the pose of end-effecter coordinate r

12、elative to the base coordinate when given the geometric parameters of link and the translation of joint. Let make things clearly: What you are given: the length of each link and the angle of each jointWhat you can find: the position of any point (i.e. its coordinate)3.2 The solution of forward kinem

13、aticsMethod: Algebraic solution Principal: The kinematic model of a robot can be written like this, where denotes the vector of joint variable, denotes the vector of task variable,is the direct kinematic function that can be derived for any robot structure . The origin of Each joint is assigned a co

14、ordinate frame. Using the Denavit-Hartenberg notation, you need 4 parameters () to describe how a frame () relates to a previous frame (). For two frames positioned in space, the first can be moved into coincidence with the second by a sequence of 4 operations:1. Rotate around the axis by an angle.2

15、. Translate along the axis by a distance.3. Rotate around the new z axis by an angle.4. Translate along the new z axis by a distance. (1.1) (1.2) Therefore, according to the theory above the final homogeneous transform corresponding to the last link of the manipulator: (1.3) 3.3Inverse kinematicDefi

16、nition: Robot inverse kinematics problem is that resolve each joint variables of the robot based on given the position and direction of the end-effecter or of the link (It can show as position matrix T). As for PUMA560 Robot, variable need to be resolved.Let make things clearly: What you are given:

17、The length of each link and the position of some point on the robot.What you can find: The angles of each joint needed to obtain that position. 3.4 The solution of inverse kinematics Method: Algebraic solution Principal: Where is the robot Jacobian. Jacobian can be seen as a mapping from Joint veloc

18、ity space to Operational velocity space. 3.5 The trajectory planning of robot kinematicsThe trajectory planning of robot kinematics mainly studies the movement of robot. Our goal is to let robot moves along given path. We can divide the trajectory of robots into two kinds. One is point to point whil

19、e the other is trajectory tracking. The former is only focus on specific location point. The latter cares the whole path.Trajectory tracking is based on point to point, but the route is not determined. So, trajectory tracking only can ensure the robots arrives the desired pose in the end position, b

20、ut can not ensure in the whole trajectory. In order to let the end-effecter arriving desired path, we try to let the distance between two paths as small as possible when we plan Cartesian space path. In addition, in order to eliminate pose and positions uncertainty between two path points, we usuall

21、y do motivation plan among every joints under gang control. In a word, let each joint has same run duration when we do trajectory planning in joint space.At same time, in order to make the trajectory planning more smoothly, we need to apply the interpolating method. Method: polynomial interpolating

22、1 Given: boundary condition (1.3) (1.4) Output: joint space trajectory between two points = （1.5）Polynomial coefficient can be computed as follows: (1.6). Kinematic simulation based on MATLABHow to use linkIn Robotics Toolbox, function link is used to create a bar. There are two methods. One is to a

23、dopt standard D-H parameters and the other is to adopt modified D-H parameters, which correspond to two coordinate systems. We adopt modified D-H parameters in our paper. The first 4 elements in Function link are , a, , d. The last element is 0 (represent Rotational joint) or 1 (represent translatio

24、n joint). The final parameter of link is mod, which means standard or modified. The default is standard.Therefore, if you want to build your own robot, you may use function link. You can call it like this: L1=link(0 0 pi 0 0,modified); The step of simulation is:Step1: First of all, according to the

25、data from Table 1, we build simulation program of the robot (shown in Appendix rob1.m).Step2: Present 3D figure of the robot (shown in Fig4). This is a three-dimensional figure when the robot located the initial position (). We can adjust the position of the slider in control panel to make the joint

26、 rotation (in Fig 5), just like controlling real robot. Step3:Point A located at initial position. It can de described as . The target point is Point B. The joint rotation angle can be expressed as. We can achieve the solution of forward kinematics and obtain the end-effecter pose relative to the ba

27、se coordinate system is (0.737, 0.149, 0.326) , relative to the three axes of rotation angle is the (0, 0, -1). The robots three-dimensional pose inis shown in Fig 6.Step4: According to the homogeneous transformation matrix, we can obtain each joint variable from the initial position to the specifie

28、d location Step5:Simulate trajectory from point A to point B. The simulation time is 10s. Time interval is 0.1s. Then, we can picture location image, the angular velocity and angular acceleration image (shown as Fig 8) which describe each joint transforms over time from Point A to Point B. In this p

29、aper, we only present the picture of joint 3. By using the function T=fkine(r,q), we obtain T a three-dimensional matrix. The first two dimensional matrix represent the coordinate change while the last dimension is time t. Fig 4 Fig 5Fig 6 Fig 7 Fig8The problem during the simulationThe reason for se

30、lection of some parameter The parameter of link: From kinematic simulation and program, you can see that I set certain value not arbitrary when I call link. That is because I want the simulation can be more close to the real situation .So; I adopt the parameter of puma560 (you can see it from the pr

31、ogram) and there is no difference between my robot and puma560 radically.The parameter of: When I choose the parameter of, I just want to test something.For example, when you denote the parameter of like this , you want to use the function fkine(p560, ) to obtain the homogenous function T, then, you want to use ikine(p560,T) to test whether the is what you have settled before.The result is as follows:=0 -pi/4 -pi/4 0 pi/8 0;T=fkine(p560, );