Version 3 (modified by bz, 7 years ago) (diff) |
---|
Kinematics, Transmission Ratios, and Joint Ranges
4 DOF and 7 DOF
A good introduction to coordinate frames, transformations and kinematics is beyond the scope of this document. There are several good introductory robotics books available. We recommend Spong, M.; Hutchinson, S.; Vidyasagar, M. Robot Modeling and Control; 2006 John Wiley & Sons as we use the variant of the Denavit-Hartenberg (D-H) method that is from this book to establish the coordinate frames.
Figure 35 shows the 4-DOF WAM system in the zero position. A positive joint motion is based on the right hand rule for each axis. Figure 37 through Figure 40 show explicitly each of the four joint kinematic parameters and joint limits.
Figure 36 shows the entire 7-DOF WAM system in the zero position. A positive joint motion is based on the right hand rule for each axis. Figure 37 through Figure 43 show explicitly each of the seven joint kinematic parameters and joint limits.
Figure 37: WAM Arm Joint 1 Frames and Limits
Figure 38: WAM Arm Joint 2 Frames and Limits
Figure 39: WAM Arm Joint 3 Frames and Limits
Figure 40: WAM Arm Joint 4 Frames and Limits
Figure 41: WAM Arm Joint 5 Frames and Limits
Figure 42: WAM Arm Joint 6 Frames and Limits
Figure 43: WAM Arm Joint 7 Frames and Limits
Equation 1 below gives the transform between two adjacent D-H coordinate frames. The D-H parameters that were derived from this equation are located in Table 4 below. Note that c and s stand for cos and sin respectively.
Equation 1: D-H generalized transform matrix
Table 4: 4-DOF WAM frame parameters (with blank outer link installed) and 7-DOF WAM frame parameters
i | a_{i} | α_{i} | d_{i} | θ_{i} | i | a_{i} | α_{i} | d_{i} | θ_{i} | ||
1 | 0 | −π/2 | 0 | θ_{1} | 1 | 0 | −π/2 | 0 | θ_{1} | ||
2 | 0 | π/2 | 0 | θ_{2} | 2 | 0 | π/2 | 0 | θ_{2} | ||
3 | 0.045 | −π/2 | 0.55 | θ_{3} | 3 | 0.045 | −π/2 | 0.55 | θ_{3} | ||
4 | −0.045 | π/2 | 0 | θ_{4} | 4 | −0.045 | π/2 | 0 | θ_{4} | ||
Τ | 0 | 0 | 0.35 | 5 | 0 | −π/2 | 0.3 | θ_{5} | |||
6 | 0 | π/2 | 0 | θ_{6} | |||||||
7 | 0 | 0 | 0.06 | θ_{7} | |||||||
Τ | 0 | 0 | 0 |
For example, to generate the transform from coordinate Frame 2 to coordinate Frame 1 (i.e. the position and orientation of Frame 2 described in terms of Frame 1 which is also a rotation about joint 2), use the parameters in the second row of Table 4 as follows:
Equation 2: D-H Matrix Example
Each of the joints has a mechanical stop that limits the motion. Refer to Table 6 below for a complete listing of the joint limits for each axis.
Table 6: Joint Limits
Joint | Positive Joint Limit Rad (deg) | Negative Joint Limit Rad (deg) |
1 | 2.6 (150) | -2.6 (-150) |
2 | 2.0 (113) | -2.0 (-113) |
3 | 2.8 (157) | -2.8 (-157) |
4 | 3.1 (180) | -0.9 (-50) |
5 | 1.24 (71) | -4.76 (-273) |
6 | 1.6 (90) | -1.6 (-90) |
7 | 3.0 (172) | -3.0 (-172) |
Forward Kinematics for the 4-DOF WAM
The forward kinematics of the 4-DOF WAM system is used to determine the end tip location and orientation. These transformations are generated using the parameters in Table 4 and the matrix in Equation 1.
Equation 3: Tool frame matrix
You define the frame for your specific end-effector. The forward kinematics are determined for any frame on the robot by mulitplying all of the transforms up to and including the final frame. To determine the tool end tip location and orientation use the following equation:
Equation 4: Tool end tip position and orientation equation for the 4-DOF WAM
Forward Kinematics for the 7-DOF WAM
As with the previous example, you define the frame for your specific end-effector. The forward kinematics are determined for any frame on the robot by mulitplying all of the transforms up to and including the final frame. To determine the end tip location and orientation use the following equation:
Equation 5: Tool end tip position and orientation equation for the 7-DOF WAM
4 DOF with Gimbals
A 4-DOF WAM Arm can be outfitted with optional 3-axis non-motorized gimbals that give precise angular feedback. The kinematics of the first 4 joints is identical to a 4-DOF WAM Arm. The kinematics for the additional 3 axes is shown in Figure 44.
Figure 44 shows the WAM Gimbals in the zero position. A positive joint motion is based on the right hand rule for each axis. The D-H parameters that were derived from Figure 44 are located in Table 7 below.
Table 7: 4-DOF WAM + Gimbals DH Parameters
i | a_{i} | α_{i} | d_{i} | θ_{i} |
1 | 0 | -π/2 | 0 | θ_{1} |
2 | 0 | π/2 | 0 | θ_{2} |
3 | 0.045 | -π/2 | 0.55 | θ_{3} |
4 | 0.4 | -π/2 | 0 | θ_{4} |
5 | 0 | π/2 | 0 | θ_{5}-π/2 |
6 | 0 | -π/2 | 0.155 | θ_{6}-π/2 |
7 | 0 | 0 | 0 | θ_{7} |
Motor-to-Joint Transformations
Motor-to-Joint Position Transformations
The following transformations show the change in joint positions as a function of motor positions. The input transmission ratios and the differential transmission ratios are calculated from known pulley, pinion, and cable diameters.
Table 8: Arm Transmission Ratios
Parameter | Value |
N_{1} | 42.0 |
N_{2} | 28.25 |
N_{3} | 28.25 |
n_{3} | 1.68 |
N_{4} | 18.0 |
N_{5} | 9.48 |
N_{6} | 9.48 |
N_{7} | 14.93 |
n_{6} | 1 |
Equation 6: WAM Motor-to-Joint position transformations
Equation 7: Wrist Motor-to-Joint position transformations
The motor position can also be derived from joint space by taking the inverse of the multiplying matrix. For convenience, they are as follows:
Equation 8: Arm Joint-to-Motor position transformations
Equation 9: Wrist Joint-to-Motor position transformation
Motor-to-Joint Torque Transformations
Similar to the position transformations the following equations determine the joint torque from the motor torque:
Equation 10: Arm Motor-to-Joint torque transformation
Equation 11: Wrist Motor-to-Joint transformations
The following equations determine motor torque from the joint torque:
Equation 12: Arm Joint-to-Motor torque transformations
Equation 13: Wrist Joint-to-Motor torque transformations
Joint Resolution
Table 9: Joint resolution
Motor Encoder (ME) Cts/Rev | Motor/Joint Ratio | ME Cts/ Joint Rev | Joint Encoder (JE) Cts/Rev | Meters/ Joint Rev | ME Position Resolution (m) | ME Orientation Resolution (rad) | JE Position Resolution (m) | JE Orientation Resolution (rad) | |
J1 | 4096 | 42 | 172,032 | 1,578,399 | 6.28 | 36.5E-6 | 36.5E-6 | 4.0E-6 | 4.0E-6 |
J2 | 4096 | 28.25 | 115,712 | 655,360 | 6.28 | 54E-6 | 54E-6 | 9.6E-6 | 9.6E-6 |
J3 | 4096 | 16.8 | 68,812 | 655,360 | 3.14 | 45E-6 | 91E-6 | 4.8E-6 | 9.6E-6 |
J4 | 4096 | 18 | 73,728 | 327,680 | 3.14 | 42.6E-6 | 85.2E-6 | 9.6E-6 | 19.2E-6 |
J5 | 4096 | 9.48 | 38,830 | N/A | 376.8E-3 | 9.7E-6 | 161.7E-6 | N/A | N/A |
J6 | 4096 | 9.48 | 38,830 | N/A | 376.8E-3 | 9.7E-6 | 161.7E-6 | N/A | N/A |
J7 | 4096 | 14.93 | 61,153 | N/A | 0 | N/A | (backlash) 17.5E-3 | N/A | N/A |