Version 1 (modified by edison, 11 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 – WAM 4-DOF dimensions and D-H 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 on the following pages show explicitly each of the four joint kinematic parameters and joint limits.

Figure 36 – WAM 7-DOF dimensions and D-H frames

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 on the following pages 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 ai αi di θi i ai αi di θ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 on page 64 and the matrix in Equation 1 on page 64.

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: Denavit-Hartenberg Frames – 4-DOF + Gimbals

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 ai αi di θ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 N1 42.0 N2 28.25 N3 28.25 n3 1.68 N4 18.0 N5 9.48 N6 9.48 N7 14.93 n6 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