Download System Setup
Transcript
Appendix B - 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. −1 0 N 1 Jθ 1 1 0 2N 2 Jθ 2 Jθ = − n3 3 0 Jθ 2N 2 4 0 0 0 Mθ 0 0 Mθ 1 0 Mθ 2 Mθ 3 1 N 4 0 −1 2N 2 − n3 2N 2 0 Equation 3: Arm Motor-to-Joint position transformations N 1 35.87 N 2 28.21 N = N 3 2 n3 1.68 N 17.77 4 Equation 4: Arm transmission ratios 1 Jθ 5 2 N 5 − n6 Jθ 6 = Jθ 2 N 5 7 0 1 2N 5 n6 2N 5 0 0 Mθ 4 0 Mθ 5 − 1 Mθ 6 N 7 Equation 5: Wrist Motor-to-Joint position transformations Barrett Technology, Inc. BA4-310 System User Manual Version 1.1 70