xviii Contents
2.8.3 Closed Chain . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 65
2.9 Kinematics of Typical Manipulator Structures . . . . . . . . . . . . . 68
2.9.1 Three-link Planar Arm . . . . . . . . . . . . . . . . . . . . . . . . . . . . 69
2.9.2 Parallelogram Arm . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 70
2.9.3 Spherical Arm . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 72
2.9.4 Anthropomorphic Arm . . . . . . . . . . . . . . . . . . . . . . . . . . . . 73
2.9.5 Spherical Wrist . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 75
2.9.6 Stanford Manipulator . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 76
2.9.7 Anthropomorphic Arm with Spherical Wrist . . . . . . . . . 77
2.9.8 DLR Manipulator . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 79
2.9.9 Humanoid Manipulator . . . . . . . . . . . . . . . . . . . . . . . . . . . 81
2.10 Joint Space and Operational Space . . . . . . . . . . . . . . . . . . . . . . . 83
2.10.1 Workspace . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 85
2.10.2 Kinematic Redundancy . . . . . . . . . . . . . . . . . . . . . . . . . . . 87
2.11 Kinematic Calibration . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 88
2.12 Inverse Kinematics Problem . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 90
2.12.1 Solution of Three-link Planar Arm . . . . . . . . . . . . . . . . . 91
2.12.2 Solution of Manipulators with Spherical Wrist . . . . . . . 94
2.12.3 Solution of Spherical Arm . . . . . . . . . . . . . . . . . . . . . . . . . 95
2.12.4 Solution of Anthropomorphic Arm . . . . . . . . . . . . . . . . . 96
2.12.5 Solution of Spherical Wrist . . . . . . . . . . . . . . . . . . . . . . . . 99
Bibliography . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 100
Problems..............................................100
3 Differential Kinematics and Statics ........................105
3.1 GeometricJacobian ....................................105
3.1.1 Derivative of a Rotation Matrix . . . . . . . . . . . . . . . . . . . . 106
3.1.2 Link Velocities . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 108
3.1.3 Jacobian Computation . . . . . . . . . . . . . . . . . . . . . . . . . . . . 111
3.2 Jacobian of Typical Manipulator Structures . . . . . . . . . . . . . . . 113
3.2.1 Three-link Planar Arm . . . . . . . . . . . . . . . . . . . . . . . . . . . . 113
3.2.2 Anthropomorphic Arm . . . . . . . . . . . . . . . . . . . . . . . . . . . . 114
3.2.3 Stanford Manipulator . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 115
3.3 Kinematic Singularities . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 116
3.3.1 Singularity Decoupling . . . . . . . . . . . . . . . . . . . . . . . . . . . . 117
3.3.2 Wrist Singularities . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 119
3.3.3 Arm Singularities . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 119
3.4 Analysis of Redundancy . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 121
3.5 Inverse Differential Kinematics . . . . . . . . . . . . . . . . . . . . . . . . . . . 123
3.5.1 Redundant Manipulators . . . . . . . . . . . . . . . . . . . . . . . . . . 124
3.5.2 Kinematic Singularities . . . . . . . . . . . . . . . . . . . . . . . . . . . 127
3.6 AnalyticalJacobian ....................................128
3.7 Inverse Kinematics Algorithms . . . . . . . . . . . . . . . . . . . . . . . . . . . 132
3.7.1 Jacobian (Pseudo-)inverse . . . . . . . . . . . . . . . . . . . . . . . . . 133
3.7.2 Jacobian Transpose . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 134