ROBOTICS: ADVANCED CONCEPTS & ANALYSIS


 Chastity Chambers
 1 years ago
 Views:
Transcription
1 ROBOTICS: ADVANCED CONCEPTS & ANALYSIS MODULE 5  VELOCITY AND STATIC ANALYSIS OF MANIPULATORS Ashitava Ghosal 1 1 Department of Mechanical Engineering & Centre for Product Design and Manufacture Indian Institute of Science Bangalore , India NPTEL, 2010 ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
2 ...1 CONTENTS...2 LECTURE 1 Introduction Linear and Angular Velocity of Links...3 LECTURE 2 Serial Manipulator Jacobian Matrix...4 LECTURE 3 Parallel Manipulator Jacobian Matrix...5 LECTURE 4 Singularities in Serial and Parallel Manipulators...6 LECTURE 5 Statics of Serial and Parallel Manipulators...7 MODULE 5 ADDITIONAL MATERIAL Problems, References and Suggested Reading ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
3 OUTLINE...1 CONTENTS...2 LECTURE 1 Introduction Linear and Angular Velocity of Links...3 LECTURE 2 Serial Manipulator Jacobian Matrix...4 LECTURE 3 Parallel Manipulator Jacobian Matrix...5 LECTURE 4 Singularities in Serial and Parallel Manipulators...6 LECTURE 5 Statics of Serial and Parallel Manipulators...7 MODULE 5 ADDITIONAL MATERIAL Problems, References and Suggested Reading ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
4 INTRODUCTION REVIEW Position kinematics position & orientation of links, workspace, mobility etc. Change of position and orientation with respect to time velocity kinematics Linear velocity as derivative of position vector. Angular velocity in terms of derivative of rotation matrix. Topics in velocity kinematics include Linear and angular velocities of links Manipulator Jacobian(s) Singularities in velocity domain Static equilibrium Relation between external forces & moments and joint torques & forces. Singularities in force domain ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
5 INTRODUCTION REVIEW Position kinematics position & orientation of links, workspace, mobility etc. Change of position and orientation with respect to time velocity kinematics Linear velocity as derivative of position vector. Angular velocity in terms of derivative of rotation matrix. Topics in velocity kinematics include Linear and angular velocities of links Manipulator Jacobian(s) Singularities in velocity domain Static equilibrium Relation between external forces & moments and joint torques & forces. Singularities in force domain ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
6 INTRODUCTION REVIEW Position kinematics position & orientation of links, workspace, mobility etc. Change of position and orientation with respect to time velocity kinematics Linear velocity as derivative of position vector. Angular velocity in terms of derivative of rotation matrix. Topics in velocity kinematics include Linear and angular velocities of links Manipulator Jacobian(s) Singularities in velocity domain Static equilibrium Relation between external forces & moments and joint torques & forces. Singularities in force domain ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
7 INTRODUCTION REVIEW Position kinematics position & orientation of links, workspace, mobility etc. Change of position and orientation with respect to time velocity kinematics Linear velocity as derivative of position vector. Angular velocity in terms of derivative of rotation matrix. Topics in velocity kinematics include Linear and angular velocities of links Manipulator Jacobian(s) Singularities in velocity domain Static equilibrium Relation between external forces & moments and joint torques & forces. Singularities in force domain ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
8 INTRODUCTION REVIEW Position kinematics position & orientation of links, workspace, mobility etc. Change of position and orientation with respect to time velocity kinematics Linear velocity as derivative of position vector. Angular velocity in terms of derivative of rotation matrix. Topics in velocity kinematics include Linear and angular velocities of links Manipulator Jacobian(s) Singularities in velocity domain Static equilibrium Relation between external forces & moments and joint torques & forces. Singularities in force domain ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
9 INTRODUCTION REVIEW Position kinematics position & orientation of links, workspace, mobility etc. Change of position and orientation with respect to time velocity kinematics Linear velocity as derivative of position vector. Angular velocity in terms of derivative of rotation matrix. Topics in velocity kinematics include Linear and angular velocities of links Manipulator Jacobian(s) Singularities in velocity domain Static equilibrium Relation between external forces & moments and joint torques & forces. Singularities in force domain ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
10 OUTLINE...1 CONTENTS...2 LECTURE 1 Introduction Linear and Angular Velocity of Links...3 LECTURE 2 Serial Manipulator Jacobian Matrix...4 LECTURE 3 Parallel Manipulator Jacobian Matrix...5 LECTURE 4 Singularities in Serial and Parallel Manipulators...6 LECTURE 5 Statics of Serial and Parallel Manipulators...7 MODULE 5 ADDITIONAL MATERIAL Problems, References and Suggested Reading ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
11 LINEAR AND ANGULAR VELOCITY OF RIGID BODY LINEAR VELOCITY OF RIGID BODY The linear velocity of O i with respect to {0} is defined as 0 V Oi = d dt 0 0 O i (t + t) 0 O i (t) O i (t) = lim t 0 t (1) {0} 0 O i (t) Ẑ {i}(t) {i}(t + t) O i Rigid body at t + t 0 denote the coordinate system {0} where the limit is taken. The linear velocity vector can be described in {j} as ˆX Figure 1: 0 O i (t + t) Ŷ O i Rigid body at t Linear velocity of a rigid body j (0 V Oi ) = j 0 [R]0 V Oi (2) Two different coordinate system involved: where differentiation done, and where described! ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
12 LINEAR AND ANGULAR VELOCITY OF RIGID BODY ANGULAR VELOCITY OF A RIGID BODY Angular velocity cannot be obtained as a time derivative of 3 quantities representing orientation. Angular velocity can be derived from time derivative of rotation matrix. Recall 0 i [R] 0 i [R] T = [U], Differentiate with respect to time t [U] is a 3 3 identity matrix 0 i [R] 0 i [R] T + 0 i [R] 0 i [R]T = [0] where derivative of a matrix implies derivative of all components of the matrix. Above equation can be written as 0 i [R] 0 i [R] T + ( 0 i [R] 0 i [R] T ) T = [0] Define a 3 3 skew symmetric matrix 0 i [Ω] R = 0 i [R] 0 i [R] T ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
13 LINEAR AND ANGULAR VELOCITY OF RIGID BODY ANGULAR VELOCITY OF A RIGID BODY Angular velocity cannot be obtained as a time derivative of 3 quantities representing orientation. Angular velocity can be derived from time derivative of rotation matrix. Recall 0 i [R] 0 i [R] T = [U], Differentiate with respect to time t [U] is a 3 3 identity matrix 0 i [R] 0 i [R] T + 0 i [R] 0 i [R]T = [0] where derivative of a matrix implies derivative of all components of the matrix. Above equation can be written as 0 i [R] 0 i [R] T + ( 0 i [R] 0 i [R] T ) T = [0] Define a 3 3 skew symmetric matrix 0 i [Ω] R = 0 i [R] 0 i [R] T ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
14 LINEAR AND ANGULAR VELOCITY OF RIGID BODY ANGULAR VELOCITY OF A RIGID BODY Angular velocity cannot be obtained as a time derivative of 3 quantities representing orientation. Angular velocity can be derived from time derivative of rotation matrix. Recall 0 i [R] 0 i [R] T = [U], Differentiate with respect to time t [U] is a 3 3 identity matrix 0 i [R] 0 i [R] T + 0 i [R] 0 i [R]T = [0] where derivative of a matrix implies derivative of all components of the matrix. Above equation can be written as 0 i [R] 0 i [R] T + ( 0 i [R] 0 i [R] T ) T = [0] Define a 3 3 skew symmetric matrix 0 i [Ω] R = 0 i [R] 0 i [R] T ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
15 LINEAR AND ANGULAR VELOCITY OF RIGID BODY ANGULAR VELOCITY OF RIGID BODY SKEW SYMMETRIC MATRIX Skewsymmetric matrix in detail 0 ωz s ω s y 0 i [Ω] R = ωz s 0 ωx s (3) ωy s ωx s 0 The product of O i [Ω] R and a vector (p x,p y,p z ) T R 3 is a crossproduct ω 0 i [Ω] R (p x,p y,p z ) T y s p z ω s z p y = ωz s p x ωx s p z = 0 s ω i 0 p (4) ωx s p y ωy s p x 0 i [Ω] R called angular velocity matrix 0 s ω i called angular velocity vector of {i} with respect to {0}. In contrast to linear velocity, angular velocity vector is not a straightforward differentiation! ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
16 LINEAR AND ANGULAR VELOCITY OF RIGID BODY ANGULAR VELOCITY OF RIGID BODY SKEW SYMMETRIC MATRIX Skewsymmetric matrix in detail 0 ωz s ω s y 0 i [Ω] R = ωz s 0 ωx s (3) ωy s ωx s 0 The product of O i [Ω] R and a vector (p x,p y,p z ) T R 3 is a crossproduct ω 0 i [Ω] R (p x,p y,p z ) T y s p z ω s z p y = ωz s p x ωx s p z = 0 s ω i 0 p (4) ωx s p y ωy s p x 0 i [Ω] R called angular velocity matrix 0 s ω i called angular velocity vector of {i} with respect to {0}. In contrast to linear velocity, angular velocity vector is not a straightforward differentiation! ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
17 LINEAR AND ANGULAR VELOCITY OF RIGID BODY ANGULAR VELOCITY OF RIGID BODY SKEW SYMMETRIC MATRIX Skewsymmetric matrix in detail 0 ωz s ω s y 0 i [Ω] R = ωz s 0 ωx s (3) ωy s ωx s 0 The product of O i [Ω] R and a vector (p x,p y,p z ) T R 3 is a crossproduct ω 0 i [Ω] R (p x,p y,p z ) T y s p z ω s z p y = ωz s p x ωx s p z = 0 s ω i 0 p (4) ωx s p y ωy s p x 0 i [Ω] R called angular velocity matrix 0 s ω i called angular velocity vector of {i} with respect to {0}. In contrast to linear velocity, angular velocity vector is not a straightforward differentiation! ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
18 LINEAR AND ANGULAR VELOCITY OF RIGID BODY ANGULAR VELOCITY OF RIGID BODY SKEW SYMMETRIC MATRIX Skewsymmetric matrix in detail 0 ωz s ω s y 0 i [Ω] R = ωz s 0 ωx s (3) ωy s ωx s 0 The product of O i [Ω] R and a vector (p x,p y,p z ) T R 3 is a crossproduct ω 0 i [Ω] R (p x,p y,p z ) T y s p z ω s z p y = ωz s p x ωx s p z = 0 s ω i 0 p (4) ωx s p y ωy s p x 0 i [Ω] R called angular velocity matrix 0 s ω i called angular velocity vector of {i} with respect to {0}. In contrast to linear velocity, angular velocity vector is not a straightforward differentiation! ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
19 LINEAR AND ANGULAR VELOCITY OF RIGID BODY ANGULAR VELOCITY OF RIGID BODY IN TERMS OF EULER ANGLES Angular velocity in terms of ZYZ Euler angles. Recall for α, β and γ as the ZYZ Euler angles c α c β c γ s α s γ c α c β s γ s α c γ c α s β A B [R] = s α c β c γ + c α s γ s α c β s γ + c α c γ s α s β (5) s β c γ s β s γ c β Obtain A B [R] A B [R]T The X, Y and Z components of the angular velocity vector ω x s ω y s ω z s = γ cosα sinβ β sinα = γ sinα sinβ + β cosα (6) = γ cosβ + α ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
20 LINEAR AND ANGULAR VELOCITY OF RIGID BODY ANGULAR VELOCITY OF RIGID BODY IN TERMS OF EULER ANGLES Angular velocity in terms of ZYZ Euler angles. Recall for α, β and γ as the ZYZ Euler angles c α c β c γ s α s γ c α c β s γ s α c γ c α s β A B [R] = s α c β c γ + c α s γ s α c β s γ + c α c γ s α s β (5) s β c γ s β s γ c β Obtain A B [R] A B [R]T The X, Y and Z components of the angular velocity vector ω x s ω y s ω z s = γ cosα sinβ β sinα = γ sinα sinβ + β cosα (6) = γ cosβ + α ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
21 LINEAR AND ANGULAR VELOCITY OF RIGID BODY ANGULAR VELOCITY OF RIGID BODY IN TERMS OF EULER ANGLES Angular velocity in terms of ZYZ Euler angles. Recall for α, β and γ as the ZYZ Euler angles c α c β c γ s α s γ c α c β s γ s α c γ c α s β A B [R] = s α c β c γ + c α s γ s α c β s γ + c α c γ s α s β (5) s β c γ s β s γ c β Obtain A B [R] A B [R]T The X, Y and Z components of the angular velocity vector ω x s ω y s ω z s = γ cosα sinβ β sinα = γ sinα sinβ + β cosα (6) = γ cosβ + α ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
22 LINEAR AND ANGULAR VELOCITY OF RIGID BODY ANGULAR VELOCITY OF RIGID BODY IN TERMS OF EULER ANGLES Angular velocity in terms of ZYZ Euler angles. Recall for α, β and γ as the ZYZ Euler angles c α c β c γ s α s γ c α c β s γ s α c γ c α s β A B [R] = s α c β c γ + c α s γ s α c β s γ + c α c γ s α s β (5) s β c γ s β s γ c β Obtain A B [R] A B [R]T The X, Y and Z components of the angular velocity vector ω x s ω y s ω z s = γ cosα sinβ β sinα = γ sinα sinβ + β cosα (6) = γ cosβ + α ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
23 LINEAR AND ANGULAR VELOCITY OF RIGID BODY ANGULAR VELOCITY OF RIGID BODY  LEFT AND RIGHT INVARIANT 0 i [Ω] R called rightinvariant derived from right multiplication 0 i [R] 0 i [R]T = [U]. 0 ω i s called the spacefixed angular velocity superscript s. 0 i [R]T 0 i [R] = [U] another skewsymmetric matrix 0 ω 0 i [Ω] L = 0 i [R] T z b ωy b 0 i [R] = ωz b 0 ωx b ωy b ωx b 0 (7) Define an angular velocity vector 0 ω i b from the three components (ω b x,ω b y,ω b z ). ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
24 LINEAR AND ANGULAR VELOCITY OF RIGID BODY ANGULAR VELOCITY OF RIGID BODY  LEFT AND RIGHT INVARIANT 0 i [Ω] R called rightinvariant derived from right multiplication 0 i [R] 0 i [R]T = [U]. 0 ω i s called the spacefixed angular velocity superscript s. 0 i [R]T 0 i [R] = [U] another skewsymmetric matrix 0 ω 0 i [Ω] L = 0 i [R] T z b ωy b 0 i [R] = ωz b 0 ωx b ωy b ωx b 0 (7) Define an angular velocity vector 0 ω i b from the three components (ω b x,ω b y,ω b z ). ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
25 LINEAR AND ANGULAR VELOCITY OF RIGID BODY ANGULAR VELOCITY OF RIGID BODY  LEFT AND RIGHT INVARIANT 0 i [Ω] R called rightinvariant derived from right multiplication 0 i [R] 0 i [R]T = [U]. 0 ω i s called the spacefixed angular velocity superscript s. 0 i [R]T 0 i [R] = [U] another skewsymmetric matrix 0 ω 0 i [Ω] L = 0 i [R] T z b ωy b 0 i [R] = ωz b 0 ωx b ωy b ωx b 0 (7) Define an angular velocity vector 0 ω i b from the three components (ω b x,ω b y,ω b z ). ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
26 LINEAR AND ANGULAR VELOCITY OF RIGID BODY ANGULAR VELOCITY OF RIGID BODY  LEFT AND RIGHT INVARIANT 0 i [Ω] R called rightinvariant derived from right multiplication 0 i [R] 0 i [R]T = [U]. 0 ω i s called the spacefixed angular velocity superscript s. 0 i [R]T 0 i [R] = [U] another skewsymmetric matrix 0 ω 0 i [Ω] L = 0 i [R] T z b ωy b 0 i [R] = ωz b 0 ωx b ωy b ωx b 0 (7) Define an angular velocity vector 0 ω i b from the three components (ω b x,ω b y,ω b z ). ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
27 LINEAR AND ANGULAR VELOCITY OF RIGID BODY ANGULAR VELOCITY OF RIGID BODY LEFT INVARIANT For the ZYZ rotation the three components are ω x b ω y b ω z b = α cosγ sinβ + β sinγ = α sinβ sinγ + β cosγ (8) = α cosβ + γ 0 i [Ω] L called leftinvariant angular velocity matrix. 0 b ω i called bodyfixed angular velocity vector of {i} with respect to {0} superscript b. The two skewsymmetric matrices are related like two tensors The two angular velocities are related as 0 i [Ω] R = 0 i [R] 0 i [Ω] L 0 i [R] T (9) 0 ω i s = 0 i [R] 0 ω i b (10) ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
28 LINEAR AND ANGULAR VELOCITY OF RIGID BODY ANGULAR VELOCITY OF RIGID BODY LEFT INVARIANT For the ZYZ rotation the three components are ω x b ω y b ω z b = α cosγ sinβ + β sinγ = α sinβ sinγ + β cosγ (8) = α cosβ + γ 0 i [Ω] L called leftinvariant angular velocity matrix. 0 b ω i called bodyfixed angular velocity vector of {i} with respect to {0} superscript b. The two skewsymmetric matrices are related like two tensors The two angular velocities are related as 0 i [Ω] R = 0 i [R] 0 i [Ω] L 0 i [R] T (9) 0 ω i s = 0 i [R] 0 ω i b (10) ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
29 LINEAR AND ANGULAR VELOCITY OF RIGID BODY ANGULAR VELOCITY OF RIGID BODY LEFT INVARIANT For the ZYZ rotation the three components are ω x b ω y b ω z b = α cosγ sinβ + β sinγ = α sinβ sinγ + β cosγ (8) = α cosβ + γ 0 i [Ω] L called leftinvariant angular velocity matrix. 0 b ω i called bodyfixed angular velocity vector of {i} with respect to {0} superscript b. The two skewsymmetric matrices are related like two tensors The two angular velocities are related as 0 i [Ω] R = 0 i [R] 0 i [Ω] L 0 i [R] T (9) 0 ω i s = 0 i [R] 0 ω i b (10) ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
30 LINEAR AND ANGULAR VELOCITY OF RIGID BODY ANGULAR VELOCITY OF RIGID BODY LEFT INVARIANT For the ZYZ rotation the three components are ω x b ω y b ω z b = α cosγ sinβ + β sinγ = α sinβ sinγ + β cosγ (8) = α cosβ + γ 0 i [Ω] L called leftinvariant angular velocity matrix. 0 b ω i called bodyfixed angular velocity vector of {i} with respect to {0} superscript b. The two skewsymmetric matrices are related like two tensors The two angular velocities are related as 0 i [Ω] R = 0 i [R] 0 i [Ω] L 0 i [R] T (9) 0 ω i s = 0 i [R] 0 ω i b (10) ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
31 LINEAR AND ANGULAR VELOCITY OF RIGID BODY ANGULAR VELOCITY OF RIGID BODY LEFT INVARIANT For the ZYZ rotation the three components are ω x b ω y b ω z b = α cosγ sinβ + β sinγ = α sinβ sinγ + β cosγ (8) = α cosβ + γ 0 i [Ω] L called leftinvariant angular velocity matrix. 0 b ω i called bodyfixed angular velocity vector of {i} with respect to {0} superscript b. The two skewsymmetric matrices are related like two tensors The two angular velocities are related as 0 i [Ω] R = 0 i [R] 0 i [Ω] L 0 i [R] T (9) 0 ω i s = 0 i [R] 0 ω i b (10) ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
32 LINEAR AND ANGULAR VELOCITY OF RIGID BODY ANGULAR VELOCITY OF RIGID BODY (CONTD.) {0} Ẑ Rigid Body at t i p More on two forms of angular velocity matrix and vectors. Pure rotation 0 O i (t) and 0 O i (t + t) are coincident and {i} t ˆX O i Rigid Body at t + t Ŷ only the elements of the rotation matrix i 0 [R] change with time. Point P located by i p, and fixed in {i} {i} t+ t Figure 2: Angular velocity of a rigid body ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
33 LINEAR AND ANGULAR VELOCITY OF RIGID BODY ANGULAR VELOCITY OF RIGID BODY (CONTD.) Location of P in {0} and since P is fixed in {i} and since 0 i [R] 1 = 0 i [R]T, 0 p = 0 i [R] i p 0 p = 0 V p = 0 i [R] i p 0 V p = 0 i [R] 0 i [R] T 0 p = 0 i [Ω] 0 R p = 0 ω i s 0 p (11) The coordinate system {i} does not appear except in denoting that rigid body {i} is being considered. Spacefixed angular velocity vector is said to be independent of the choice of the body coordinate system. ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
34 LINEAR AND ANGULAR VELOCITY OF RIGID BODY ANGULAR VELOCITY OF RIGID BODY (CONTD.) Location of P in {0} and since P is fixed in {i} and since 0 i [R] 1 = 0 i [R]T, 0 p = 0 i [R] i p 0 p = 0 V p = 0 i [R] i p 0 V p = 0 i [R] 0 i [R] T 0 p = 0 i [Ω] 0 R p = 0 ω i s 0 p (11) The coordinate system {i} does not appear except in denoting that rigid body {i} is being considered. Spacefixed angular velocity vector is said to be independent of the choice of the body coordinate system. ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
35 LINEAR AND ANGULAR VELOCITY OF RIGID BODY ANGULAR VELOCITY OF RIGID BODY (CONTD.) Location of P in {0} and since P is fixed in {i} and since 0 i [R] 1 = 0 i [R]T, 0 p = 0 i [R] i p 0 p = 0 V p = 0 i [R] i p 0 V p = 0 i [R] 0 i [R] T 0 p = 0 i [Ω] 0 R p = 0 ω i s 0 p (11) The coordinate system {i} does not appear except in denoting that rigid body {i} is being considered. Spacefixed angular velocity vector is said to be independent of the choice of the body coordinate system. ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
36 LINEAR AND ANGULAR VELOCITY OF RIGID BODY ANGULAR VELOCITY OF RIGID BODY (CONTD.) Using relation between 0 i [Ω] R and 0 i [Ω] L 0 V p = 0 i [R] 0 0 i [Ω] L i [R] T 0 p = 0 i [R] 0 i [Ω] i L p and get which yields 0 i [R] 1 0 V p = 0 i [Ω] L i p i V p = 0 i [Ω] L i p = 0 ω i b i p (12) Again except for denoting the reference coordinate system, the coordinate system {0} does not appear! Bodyfixed angular velocity vector is said to be independent of the choice of the fixed coordinate system. Unless explicitly stated, spacefixed angular velocity vector derived from 0 i [R] 0 i [R]T is normally used. ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
37 LINEAR AND ANGULAR VELOCITY OF RIGID BODY ANGULAR VELOCITY OF RIGID BODY (CONTD.) Using relation between 0 i [Ω] R and 0 i [Ω] L 0 V p = 0 i [R] 0 0 i [Ω] L i [R] T 0 p = 0 i [R] 0 i [Ω] i L p and get which yields 0 i [R] 1 0 V p = 0 i [Ω] L i p i V p = 0 i [Ω] L i p = 0 ω i b i p (12) Again except for denoting the reference coordinate system, the coordinate system {0} does not appear! Bodyfixed angular velocity vector is said to be independent of the choice of the fixed coordinate system. Unless explicitly stated, spacefixed angular velocity vector derived from 0 i [R] 0 i [R]T is normally used. ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
38 LINEAR AND ANGULAR VELOCITY OF RIGID BODY ANGULAR VELOCITY OF RIGID BODY (CONTD.) Using relation between 0 i [Ω] R and 0 i [Ω] L 0 V p = 0 i [R] 0 0 i [Ω] L i [R] T 0 p = 0 i [R] 0 i [Ω] i L p and get which yields 0 i [R] 1 0 V p = 0 i [Ω] L i p i V p = 0 i [Ω] L i p = 0 ω i b i p (12) Again except for denoting the reference coordinate system, the coordinate system {0} does not appear! Bodyfixed angular velocity vector is said to be independent of the choice of the fixed coordinate system. Unless explicitly stated, spacefixed angular velocity vector derived from 0 i [R] 0 i [R]T is normally used. ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
39 LINEAR AND ANGULAR VELOCITY OF RIGID BODY ANGULAR VELOCITY OF RIGID BODY (CONTD.) Using relation between 0 i [Ω] R and 0 i [Ω] L 0 V p = 0 i [R] 0 0 i [Ω] L i [R] T 0 p = 0 i [R] 0 i [Ω] i L p and get which yields 0 i [R] 1 0 V p = 0 i [Ω] L i p i V p = 0 i [Ω] L i p = 0 ω i b i p (12) Again except for denoting the reference coordinate system, the coordinate system {0} does not appear! Bodyfixed angular velocity vector is said to be independent of the choice of the fixed coordinate system. Unless explicitly stated, spacefixed angular velocity vector derived from 0 i [R] 0 i [R]T is normally used. ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
40 LINEAR AND ANGULAR VELOCITY OF LINKS ANGULAR VELOCITY IN SERIAL MANIPULATOR ROTARY (R) JOINT For two links connected by a rotary (R) joint (see Module 2, Lecture 2) The time derivative operation 0 i [R] = 0 i 1[R] i 1 i [R(ˆk,θ i )] 0 i [R] 0 i [R] T = d dt (0 i 1[R] i 1 i [R(ˆk,θ i )]) ( i 1 i [R(ˆk,θ i )] T 0 i 1[R] T ) Rewrite above equation as 0 i [Ω] R = 0 i 1[Ω] R + 0 i 1[R] ( i 1 [Ṙ(ˆk,θ i )] i 1 i [R(ˆk,θ i )] T ) 0 i 1[R] T To simplify, use the result i 1 i i i 1 i [R(ˆk,θ i )] = e (i 1 i [K ]θ i ) [K ] is the skewsymmetric form of the rotation axis vector ˆk and θ i is the rotation at the rotary joint (see Module 2, Lecture 2). ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
41 LINEAR AND ANGULAR VELOCITY OF LINKS ANGULAR VELOCITY IN SERIAL MANIPULATOR ROTARY (R) JOINT For two links connected by a rotary (R) joint (see Module 2, Lecture 2) The time derivative operation 0 i [R] = 0 i 1[R] i 1 i [R(ˆk,θ i )] 0 i [R] 0 i [R] T = d dt (0 i 1[R] i 1 i [R(ˆk,θ i )]) ( i 1 i [R(ˆk,θ i )] T 0 i 1[R] T ) Rewrite above equation as 0 i [Ω] R = 0 i 1[Ω] R + 0 i 1[R] ( i 1 i [Ṙ(ˆk,θ i )] i 1 i [R(ˆk,θ i )] T ) 0 i 1[R] T To simplify, use the result i 1 i i 1 i [R(ˆk,θ i )] = e (i 1 i [K ]θ i ) [K ] is the skewsymmetric form of the rotation axis vector ˆk and θ i is the rotation at the rotary joint (see Module 2, Lecture 2). ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
42 LINEAR AND ANGULAR VELOCITY OF LINKS ANGULAR VELOCITY IN SERIAL MANIPULATOR ROTARY (R) JOINT For two links connected by a rotary (R) joint (see Module 2, Lecture 2) The time derivative operation 0 i [R] = 0 i 1[R] i 1 i [R(ˆk,θ i )] 0 i [R] 0 i [R] T = d dt (0 i 1[R] i 1 i [R(ˆk,θ i )]) ( i 1 i [R(ˆk,θ i )] T 0 i 1[R] T ) Rewrite above equation as 0 i [Ω] R = 0 i 1[Ω] R + 0 i 1[R] ( i 1 i [Ṙ(ˆk,θ i )] i 1 i [R(ˆk,θ i )] T ) 0 i 1[R] T To simplify, use the result i 1 i i 1 i [R(ˆk,θ i )] = e (i 1 i [K ]θ i ) [K ] is the skewsymmetric form of the rotation axis vector ˆk and θ i is the rotation at the rotary joint (see Module 2, Lecture 2). ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
43 LINEAR AND ANGULAR VELOCITY OF LINKS ANGULAR VELOCITY IN SERIAL MANIPULATOR ROTARY (R) JOINT For two links connected by a rotary (R) joint (see Module 2, Lecture 2) The time derivative operation 0 i [R] = 0 i 1[R] i 1 i [R(ˆk,θ i )] 0 i [R] 0 i [R] T = d dt (0 i 1[R] i 1 i [R(ˆk,θ i )]) ( i 1 i [R(ˆk,θ i )] T 0 i 1[R] T ) Rewrite above equation as 0 i [Ω] R = 0 i 1[Ω] R + 0 i 1[R] ( i 1 i [Ṙ(ˆk,θ i )] i 1 i [R(ˆk,θ i )] T ) 0 i 1[R] T To simplify, use the result i 1 i i 1 i [R(ˆk,θ i )] = e (i 1 i [K ]θ i ) [K ] is the skewsymmetric form of the rotation axis vector ˆk and θ i is the rotation at the rotary joint (see Module 2, Lecture 2). ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
44 LINEAR AND ANGULAR VELOCITY OF LINKS ANGULAR VELOCITY PROPAGATION IN SERIAL MANIPULATORS R JOINT ˆk is fixed in {i 1} and {i} d dt e(i 1 i [K ]θ i ) = i 1 i From above and properties of a rotation matrix, [K ] θ i e (i 1 0 i [Ω] R = 0 i 1[Ω] R + 0 i 1[R] i 1 i [K ] 0 i 1[R] T θ i = 0 i 1[Ω] R + 0 i [K ] θ i and in terms of the spacefixed angular velocity 0 ω ( ) 0 ω i = 0 ω i ˆki θ i i [K ]θ i ) Serial manipulators R joint axis is chosen along the Z axis. Premultiply both sides by i 0 [R] and simplify to get i ω i = i i 1[R] i 1 ω i 1 + θ i (0 0 1) T (13) i ω i denotes i 0 [R]0 ω i i ω i not necessarily 0. Angular velocity propagation in serial manipulators links connected by R joints ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
45 LINEAR AND ANGULAR VELOCITY OF LINKS ANGULAR VELOCITY PROPAGATION IN SERIAL MANIPULATORS R JOINT ˆk is fixed in {i 1} and {i} d dt e(i 1 i [K ]θ i ) = i 1 i From above and properties of a rotation matrix, [K ] θ i e (i 1 0 i [Ω] R = 0 i 1[Ω] R + 0 i 1[R] i 1 i [K ] 0 i 1[R] T θ i = 0 i 1[Ω] R + 0 i [K ] θ i and in terms of the spacefixed angular velocity 0 ω ( ) 0 ω i = 0 ω i ˆki θ i i [K ]θ i ) Serial manipulators R joint axis is chosen along the Z axis. Premultiply both sides by i 0 [R] and simplify to get i ω i = i i 1[R] i 1 ω i 1 + θ i (0 0 1) T (13) i ω i denotes i 0 [R]0 ω i i ω i not necessarily 0. Angular velocity propagation in serial manipulators links connected by R joints ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
46 LINEAR AND ANGULAR VELOCITY OF LINKS ANGULAR VELOCITY PROPAGATION IN SERIAL MANIPULATORS R JOINT ˆk is fixed in {i 1} and {i} d dt e(i 1 i [K ]θ i ) = i 1 i From above and properties of a rotation matrix, [K ] θ i e (i 1 0 i [Ω] R = 0 i 1[Ω] R + 0 i 1[R] i 1 i [K ] 0 i 1[R] T θ i = 0 i 1[Ω] R + 0 i [K ] θ i and in terms of the spacefixed angular velocity 0 ω ( ) 0 ω i = 0 ω i ˆki θ i i [K ]θ i ) Serial manipulators R joint axis is chosen along the Z axis. Premultiply both sides by i 0 [R] and simplify to get i ω i = i i 1[R] i 1 ω i 1 + θ i (0 0 1) T (13) i ω i denotes i 0 [R]0 ω i i ω i not necessarily 0. Angular velocity propagation in serial manipulators links connected by R joints ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
47 LINEAR AND ANGULAR VELOCITY OF LINKS ANGULAR VELOCITY PROPAGATION IN SERIAL MANIPULATORS R JOINT ˆk is fixed in {i 1} and {i} d dt e(i 1 i [K ]θ i ) = i 1 i From above and properties of a rotation matrix, [K ] θ i e (i 1 0 i [Ω] R = 0 i 1[Ω] R + 0 i 1[R] i 1 i [K ] 0 i 1[R] T θ i = 0 i 1[Ω] R + 0 i [K ] θ i and in terms of the spacefixed angular velocity 0 ω ( ) 0 ω i = 0 ω i ˆki θ i i [K ]θ i ) Serial manipulators R joint axis is chosen along the Z axis. Premultiply both sides by i 0 [R] and simplify to get i ω i = i i 1[R] i 1 ω i 1 + θ i (0 0 1) T (13) i ω i denotes i 0 [R]0 ω i i ω i not necessarily 0. Angular velocity propagation in serial manipulators links connected by R joints ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
48 LINEAR AND ANGULAR VELOCITY OF LINKS LINEAR VELOCITY PROPAGATION IN SERIAL MANIPULATOR R JOINT For two consecutive links in a serial manipulator (see Module 2, Lecture 2) 0 O i = 0 O i i 1[R] i 1 O i Taking derivatives on both sides 0 V Oi = 0 V Oi ω i 1 0 i 1[R] i 1 O i Simplify and rewrite above as i V i = i i 1[R]( i 1 V i 1 + i 1 ω i 1 i 1 O i ) (14) Note: i V i and i 1 V i 1 denote i 0 [R]0 V i and i 1 0 [R] 0 V i 1, respectively. They are not necessarily 0! Linear velocity vector propagation in links of a serial manipulator Rotary joint. ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
49 LINEAR AND ANGULAR VELOCITY OF LINKS LINEAR VELOCITY PROPAGATION IN SERIAL MANIPULATOR R JOINT For two consecutive links in a serial manipulator (see Module 2, Lecture 2) 0 O i = 0 O i i 1[R] i 1 O i Taking derivatives on both sides 0 V Oi = 0 V Oi ω i 1 0 i 1[R] i 1 O i Simplify and rewrite above as i V i = i i 1[R]( i 1 V i 1 + i 1 ω i 1 i 1 O i ) (14) Note: i V i and i 1 V i 1 denote i 0 [R]0 V i and i 1 0 [R] 0 V i 1, respectively. They are not necessarily 0! Linear velocity vector propagation in links of a serial manipulator Rotary joint. ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
50 LINEAR AND ANGULAR VELOCITY OF LINKS LINEAR VELOCITY PROPAGATION IN SERIAL MANIPULATOR R JOINT For two consecutive links in a serial manipulator (see Module 2, Lecture 2) 0 O i = 0 O i i 1[R] i 1 O i Taking derivatives on both sides 0 V Oi = 0 V Oi ω i 1 0 i 1[R] i 1 O i Simplify and rewrite above as i V i = i i 1[R]( i 1 V i 1 + i 1 ω i 1 i 1 O i ) (14) Note: i V i and i 1 V i 1 denote i 0 [R]0 V i and i 1 0 [R] 0 V i 1, respectively. They are not necessarily 0! Linear velocity vector propagation in links of a serial manipulator Rotary joint. ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
51 LINEAR AND ANGULAR VELOCITY OF LINKS LINEAR VELOCITY PROPAGATION IN SERIAL MANIPULATOR R JOINT For two consecutive links in a serial manipulator (see Module 2, Lecture 2) 0 O i = 0 O i i 1[R] i 1 O i Taking derivatives on both sides 0 V Oi = 0 V Oi ω i 1 0 i 1[R] i 1 O i Simplify and rewrite above as i V i = i i 1[R]( i 1 V i 1 + i 1 ω i 1 i 1 O i ) (14) Note: i V i and i 1 V i 1 denote i 0 [R]0 V i and i 1 0 [R] 0 V i 1, respectively. They are not necessarily 0! Linear velocity vector propagation in links of a serial manipulator Rotary joint. ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
52 LINEAR AND ANGULAR VELOCITY OF LINKS VELOCITY PROPAGATION PRISMATIC JOINTS Two links connected by a prismatic (P) joint (see Module 2, Lecture 2) Prismatic joint allows relative translation between {1 i} and {i} angular velocity is same Relative translation is along Z axis ḋi(0 0 1) T Velocity propagation for P joint Angular velocity i ω i = i i 1[R] i 1 ω i 1 (15) Linear velocity i V i = i i 1[R]( i 1 V i 1 + i 1 ω i 1 i 1 O i ) + ḋi(0 0 1) T (16) where i i 1 [R]i 1 ω i = i ω i and i i 1 [R]i 1 V i = i V i. ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
53 LINEAR AND ANGULAR VELOCITY OF LINKS VELOCITY PROPAGATION PRISMATIC JOINTS Two links connected by a prismatic (P) joint (see Module 2, Lecture 2) Prismatic joint allows relative translation between {1 i} and {i} angular velocity is same Relative translation is along Z axis ḋi(0 0 1) T Velocity propagation for P joint Angular velocity i ω i = i i 1[R] i 1 ω i 1 (15) Linear velocity i V i = i i 1[R]( i 1 V i 1 + i 1 ω i 1 i 1 O i ) + ḋi(0 0 1) T (16) where i i 1 [R]i 1 ω i = i ω i and i i 1 [R]i 1 V i = i V i. ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
54 LINEAR AND ANGULAR VELOCITY OF LINKS VELOCITY PROPAGATION PRISMATIC JOINTS Two links connected by a prismatic (P) joint (see Module 2, Lecture 2) Prismatic joint allows relative translation between {1 i} and {i} angular velocity is same Relative translation is along Z axis ḋi(0 0 1) T Velocity propagation for P joint Angular velocity i ω i = i i 1[R] i 1 ω i 1 (15) Linear velocity i V i = i i 1[R]( i 1 V i 1 + i 1 ω i 1 i 1 O i ) + ḋi(0 0 1) T (16) where i i 1 [R]i 1 ω i = i ω i and i i 1 [R]i 1 V i = i V i. ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
55 LINEAR AND ANGULAR VELOCITY OF LINKS VELOCITY PROPAGATION PRISMATIC JOINTS Two links connected by a prismatic (P) joint (see Module 2, Lecture 2) Prismatic joint allows relative translation between {1 i} and {i} angular velocity is same Relative translation is along Z axis ḋi(0 0 1) T Velocity propagation for P joint Angular velocity i ω i = i i 1[R] i 1 ω i 1 (15) Linear velocity i V i = i i 1[R]( i 1 V i 1 + i 1 ω i 1 i 1 O i ) + ḋi(0 0 1) T (16) where i i 1 [R]i 1 ω i = i ω i and i i 1 [R]i 1 V i = i V i. ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
56 LINEAR AND ANGULAR VELOCITY OF LINKS VELOCITY PROPAGATION PLANAR 3R MANIPULATOR ˆX 3, ˆX Tool Ŷ 0 {Tool} Ŷ Tool Link 3 l 3 Ŷ 3 {3} θ 3 ˆX 2 O 3 Link 2 All joint axis are parallel and coming out of page. {0} is fixed 0 ω 0 = 0 Ŷ 1 Ŷ 2 {2} l 2 θ 2 ˆX1 0 V 0 = 0 {1} {0} l 1 θ 1 Link 1 O 2 Links connected by rotary (R) joint Equations (13) and (14) give velocities of all links. ˆX 0 O 1 Figure 3: The planar 3R manipulator revisited ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
57 LINEAR AND ANGULAR VELOCITY OF LINKS VELOCITY PROPAGATION PLANAR 3R MANIPULATOR (CONTD.) For i=1 For i=2 For i=3 1 ω 1 = (0 0 θ 1 ) T 1 V 1 = 0 2 ω 2 = (0 0 θ 1 + θ 2 ) T c 2 s V 2 = s 2 c l 1 θ 1 0 = 3 ω 3 = (0 0 θ 1 + θ 2 + θ 3 ) T (l 1 s 23 + l 2 s 3 ) θ 1 + l 2 s 3 θ 2 3 V 3 = (l 1 c 23 + l 2 c 3 ) θ 1 + l 2 c 3 θ 2 0 l 1 s 2 θ 1 l 1 c 2 θ 1 0 ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
58 LINEAR AND ANGULAR VELOCITY OF LINKS VELOCITY PROPAGATION PLANAR 3R MANIPULATOR (CONTD.) For i=1 For i=2 For i=3 1 ω 1 = (0 0 θ 1 ) T 1 V 1 = 0 2 ω 2 = (0 0 θ 1 + θ 2 ) T c 2 s V 2 = s 2 c l 1 θ 1 0 = 3 ω 3 = (0 0 θ 1 + θ 2 + θ 3 ) T (l 1 s 23 + l 2 s 3 ) θ 1 + l 2 s 3 θ 2 3 V 3 = (l 1 c 23 + l 2 c 3 ) θ 1 + l 2 c 3 θ 2 0 l 1 s 2 θ 1 l 1 c 2 θ 1 0 ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
59 LINEAR AND ANGULAR VELOCITY OF LINKS VELOCITY PROPAGATION PLANAR 3R MANIPULATOR (CONTD.) For i=1 For i=2 For i=3 1 ω 1 = (0 0 θ 1 ) T 1 V 1 = 0 2 ω 2 = (0 0 θ 1 + θ 2 ) T c 2 s V 2 = s 2 c l 1 θ 1 0 = 3 ω 3 = (0 0 θ 1 + θ 2 + θ 3 ) T (l 1 s 23 + l 2 s 3 ) θ 1 + l 2 s 3 θ 2 3 V 3 = (l 1 c 23 + l 2 c 3 ) θ 1 + l 2 c 3 θ 2 0 l 1 s 2 θ 1 l 1 c 2 θ 1 0 ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
60 LINEAR AND ANGULAR VELOCITY OF LINKS VELOCITY PROPAGATION PLANAR 3R MANIPULATOR (CONTD.) For i = Tool Tool ω Tool = (0 0 θ 1 + θ 2 + θ 3 ) T (l 1 s 23 + l 2 s 3 ) θ 1 + l 2 s 3 θ 2 Tool V Tool = (l 1 c 23 + l 2 c 3 + l 3 ) θ 1 + (l 2 c 3 + l 3 ) θ 2 + l 3 θ 3 0 Linear and angular velocity in {0} 0 ω Tool = (0 0 θ 1 + θ 2 + θ 3 ) T (17) and 0 V Tool = l 1 s 1 θ 1 l 2 s 12 ( θ 1 + θ 2 ) l 3 s 123 ( θ 1 + θ 2 + θ 3 ) l 1 c 1 θ 1 + l 2 c 12 ( θ 1 + θ 2 ) + l 3 c 123 ( θ 1 + θ 2 + θ 3 ) 0 (18) ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
61 LINEAR AND ANGULAR VELOCITY OF LINKS VELOCITY PROPAGATION PLANAR 3R MANIPULATOR (CONTD.) For i = Tool Tool ω Tool = (0 0 θ 1 + θ 2 + θ 3 ) T (l 1 s 23 + l 2 s 3 ) θ 1 + l 2 s 3 θ 2 Tool V Tool = (l 1 c 23 + l 2 c 3 + l 3 ) θ 1 + (l 2 c 3 + l 3 ) θ 2 + l 3 θ 3 0 Linear and angular velocity in {0} 0 ω Tool = (0 0 θ 1 + θ 2 + θ 3 ) T (17) and 0 V Tool = l 1 s 1 θ 1 l 2 s 12 ( θ 1 + θ 2 ) l 3 s 123 ( θ 1 + θ 2 + θ 3 ) l 1 c 1 θ 1 + l 2 c 12 ( θ 1 + θ 2 ) + l 3 c 123 ( θ 1 + θ 2 + θ 3 ) 0 (18) ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
62 OUTLINE...1 CONTENTS...2 LECTURE 1 Introduction Linear and Angular Velocity of Links...3 LECTURE 2 Serial Manipulator Jacobian Matrix...4 LECTURE 3 Parallel Manipulator Jacobian Matrix...5 LECTURE 4 Singularities in Serial and Parallel Manipulators...6 LECTURE 5 Statics of Serial and Parallel Manipulators...7 MODULE 5 ADDITIONAL MATERIAL Problems, References and Suggested Reading ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
63 SERIAL MANIPULATOR JACOBIAN MATRIX INTRODUCTION Linear and angular velocity of {Tool} (Equations (17) and (18)) can be written in a compact form as 0 V Tool = l 1 s 1 l 2 s 12 l 3 s 123 l 2 s 12 l 3 s 123 l 3 s 123 l 1 c 1 + l 2 c 12 + l 3 c 123 l 2 c 12 + l 3 c 123 l 3 c V Tool is a 6 1 entity 0 V Tool = 0 V Tool 0 ω Tool θ 1 θ 2 θ 3 (19) ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
64 SERIAL MANIPULATOR JACOBIAN MATRIX INTRODUCTION Linear and angular velocity of {Tool} (Equations (17) and (18)) can be written in a compact form as 0 V Tool = l 1 s 1 l 2 s 12 l 3 s 123 l 2 s 12 l 3 s 123 l 3 s 123 l 1 c 1 + l 2 c 12 + l 3 c 123 l 2 c 12 + l 3 c 123 l 3 c V Tool is a 6 1 entity 0 V Tool = 0 V Tool 0 ω Tool θ 1 θ 2 θ 3 (19) ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
65 SERIAL MANIPULATOR JACOBIAN MATRIX INTRODUCTION 0 V Tool is not a 6 1 vector 1 contains linear velocity and the angular velocity which have different units! Use or ; to separate the linear and angular velocities & to remind that 0 V Tool or ( 0 V Tool ; 0 ω Tool ) T is not a vector. Matrix in square brackets, 0 Tool [J(Θ)], is called the Jacobian matrix for the planar 3R manipulator. 0 Tool [J(Θ)] relate the linear and angular velocities of the tool with the joint velocities. Jacobian matrix is for the endeffector or the {Tool} see subscript Tool. Linear and angular velocities are in {0}, leading superscript 0. 1 In theoretical kinematics, ( 0 ω Tool ; 0 V Tool ) is called twist (see Additional Material in Module 2). ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
66 SERIAL MANIPULATOR JACOBIAN MATRIX INTRODUCTION 0 V Tool is not a 6 1 vector 1 contains linear velocity and the angular velocity which have different units! Use or ; to separate the linear and angular velocities & to remind that 0 V Tool or ( 0 V Tool ; 0 ω Tool ) T is not a vector. Matrix in square brackets, 0 Tool [J(Θ)], is called the Jacobian matrix for the planar 3R manipulator. 0 Tool [J(Θ)] relate the linear and angular velocities of the tool with the joint velocities. Jacobian matrix is for the endeffector or the {Tool} see subscript Tool. Linear and angular velocities are in {0}, leading superscript 0. 1 In theoretical kinematics, ( 0 ω Tool ; 0 V Tool ) is called twist (see Additional Material in Module 2). ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
67 SERIAL MANIPULATOR JACOBIAN MATRIX INTRODUCTION 0 V Tool is not a 6 1 vector 1 contains linear velocity and the angular velocity which have different units! Use or ; to separate the linear and angular velocities & to remind that 0 V Tool or ( 0 V Tool ; 0 ω Tool ) T is not a vector. Matrix in square brackets, 0 Tool [J(Θ)], is called the Jacobian matrix for the planar 3R manipulator. 0 Tool [J(Θ)] relate the linear and angular velocities of the tool with the joint velocities. Jacobian matrix is for the endeffector or the {Tool} see subscript Tool. Linear and angular velocities are in {0}, leading superscript 0. 1 In theoretical kinematics, ( 0 ω Tool ; 0 V Tool ) is called twist (see Additional Material in Module 2). ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
68 SERIAL MANIPULATOR JACOBIAN MATRIX PROPERTIES OF JACOBIAN MATRIX 0 Tool [J(Θ)] is not a proper matrix. The first and the last three rows represent linear and angular velocity, Elements of the first three rows have units of length, Elements of last three rows have no units. Similar to 0 V Tool, top and bottom halves of a Jacobian matrix are separated by. Many matrix operations makes no sense the condition number 2 of this matrix changes with the choice of length units. 0 Tool [J(Θ)] is best thought of as a map 0 Tool [J(Θ)] : Θ 0 V Tool 2 The condition number of a matrix is the ratio of the absolute value of the largest to the smallest eigenvalues. ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
69 SERIAL MANIPULATOR JACOBIAN MATRIX PROPERTIES OF JACOBIAN MATRIX 0 Tool [J(Θ)] is not a proper matrix. The first and the last three rows represent linear and angular velocity, Elements of the first three rows have units of length, Elements of last three rows have no units. Similar to 0 V Tool, top and bottom halves of a Jacobian matrix are separated by. Many matrix operations makes no sense the condition number 2 of this matrix changes with the choice of length units. 0 Tool [J(Θ)] is best thought of as a map 0 Tool [J(Θ)] : Θ 0 V Tool 2 The condition number of a matrix is the ratio of the absolute value of the largest to the smallest eigenvalues. ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
70 SERIAL MANIPULATOR JACOBIAN MATRIX PROPERTIES OF JACOBIAN MATRIX 0 Tool [J(Θ)] is not a proper matrix. The first and the last three rows represent linear and angular velocity, Elements of the first three rows have units of length, Elements of last three rows have no units. Similar to 0 V Tool, top and bottom halves of a Jacobian matrix are separated by. Many matrix operations makes no sense the condition number 2 of this matrix changes with the choice of length units. 0 Tool [J(Θ)] is best thought of as a map 0 Tool [J(Θ)] : Θ 0 V Tool 2 The condition number of a matrix is the ratio of the absolute value of the largest to the smallest eigenvalues. ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
71 SERIAL MANIPULATOR JACOBIAN MATRIX PROPERTIES OF JACOBIAN MATRIX 0 Tool [J(Θ)] is not a proper matrix. The first and the last three rows represent linear and angular velocity, Elements of the first three rows have units of length, Elements of last three rows have no units. Similar to 0 V Tool, top and bottom halves of a Jacobian matrix are separated by. Many matrix operations makes no sense the condition number 2 of this matrix changes with the choice of length units. 0 Tool [J(Θ)] is best thought of as a map 0 Tool [J(Θ)] : Θ 0 V Tool 2 The condition number of a matrix is the ratio of the absolute value of the largest to the smallest eigenvalues. ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
72 SERIAL MANIPULATOR JACOBIAN MATRIX PROPERTIES OF JACOBIAN MATRIX (CONTD.) The Jacobian matrix can be derived for any serial manipulator with rotary and prismatic joints. Compute the linear and angular velocities using propagation equations Rearrange in a matrix equation as done for the planar 3R manipulator. Jacobian can be defined for any differentiable vector function. Direct kinematics equations differentiable vector function X = Ψ(Θ) Θ = (θ 1,θ 2,...,θ n ) denotes the n joint variables Position and orientation of endeffector are denoted by X 3. [J(Θ)] is the matrix of first partial derivatives of Ψ with respect to θ i i th column of [J(Θ)] is the partial derivatives of Ψ with respect to θ i. [ ] Ψ Ψ Ψ [J(Θ)] =... θ 1 θ 2 θ n 3 For example, X denotes the three Cartesian position variables (x, y, z) and the three Euler angles (α, β,γ). ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
73 SERIAL MANIPULATOR JACOBIAN MATRIX PROPERTIES OF JACOBIAN MATRIX (CONTD.) The Jacobian matrix can be derived for any serial manipulator with rotary and prismatic joints. Compute the linear and angular velocities using propagation equations Rearrange in a matrix equation as done for the planar 3R manipulator. Jacobian can be defined for any differentiable vector function. Direct kinematics equations differentiable vector function X = Ψ(Θ) Θ = (θ 1,θ 2,...,θ n ) denotes the n joint variables Position and orientation of endeffector are denoted by X 3. [J(Θ)] is the matrix of first partial derivatives of Ψ with respect to θ i i th column of [J(Θ)] is the partial derivatives of Ψ with respect to θ i. [ ] Ψ Ψ Ψ [J(Θ)] =... θ 1 θ 2 θ n 3 For example, X denotes the three Cartesian position variables (x, y, z) and the three Euler angles (α, β,γ). ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
74 SERIAL MANIPULATOR JACOBIAN MATRIX PROPERTIES OF JACOBIAN MATRIX (CONTD.) The Jacobian matrix can be derived for any serial manipulator with rotary and prismatic joints. Compute the linear and angular velocities using propagation equations Rearrange in a matrix equation as done for the planar 3R manipulator. Jacobian can be defined for any differentiable vector function. Direct kinematics equations differentiable vector function X = Ψ(Θ) Θ = (θ 1,θ 2,...,θ n ) denotes the n joint variables Position and orientation of endeffector are denoted by X 3. [J(Θ)] is the matrix of first partial derivatives of Ψ with respect to θ i i th column of [J(Θ)] is the partial derivatives of Ψ with respect to θ i. [ ] Ψ Ψ Ψ [J(Θ)] =... θ 1 θ 2 θ n 3 For example, X denotes the three Cartesian position variables (x, y, z) and the three Euler angles (α, β,γ). ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
75 SERIAL MANIPULATOR JACOBIAN MATRIX PROPERTIES OF JACOBIAN MATRIX (CONTD.) The Jacobian matrix can be derived for any serial manipulator with rotary and prismatic joints. Compute the linear and angular velocities using propagation equations Rearrange in a matrix equation as done for the planar 3R manipulator. Jacobian can be defined for any differentiable vector function. Direct kinematics equations differentiable vector function X = Ψ(Θ) Θ = (θ 1,θ 2,...,θ n ) denotes the n joint variables Position and orientation of endeffector are denoted by X 3. [J(Θ)] is the matrix of first partial derivatives of Ψ with respect to θ i i th column of [J(Θ)] is the partial derivatives of Ψ with respect to θ i. [ ] Ψ Ψ Ψ [J(Θ)] =... θ 1 θ 2 θ n 3 For example, X denotes the three Cartesian position variables (x, y, z) and the three Euler angles (α, β,γ). ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
76 SERIAL MANIPULATOR JACOBIAN MATRIX PROPERTIES OF JACOBIAN MATRIX (CONTD.) 0 Tool [J(Θ)] very important in velocity kinematics of serial manipulators. The elements of the Jacobian matrix are nonlinear functions of the joint variables Θ. Manipulator in motion 0 Tool [J(Θ)] is time varying. At instant with Θ known, 0 Tool [J(Θ)] relates linear and angular velocities to joint rates. The relationship is linear! The Jacobian matrix can be obtained for any link most often for endeffector. The Jacobian matrix is always with respect to a coordinate system where the linear and angular velocities are obtained. Most often Jacobian matrix is with respect to fixed {0}. Jacobian matrix can be written in any coordinate system using rotation matrices. ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
77 SERIAL MANIPULATOR JACOBIAN MATRIX PROPERTIES OF JACOBIAN MATRIX (CONTD.) 0 Tool [J(Θ)] very important in velocity kinematics of serial manipulators. The elements of the Jacobian matrix are nonlinear functions of the joint variables Θ. Manipulator in motion 0 Tool [J(Θ)] is time varying. At instant with Θ known, 0 Tool [J(Θ)] relates linear and angular velocities to joint rates. The relationship is linear! The Jacobian matrix can be obtained for any link most often for endeffector. The Jacobian matrix is always with respect to a coordinate system where the linear and angular velocities are obtained. Most often Jacobian matrix is with respect to fixed {0}. Jacobian matrix can be written in any coordinate system using rotation matrices. ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
78 SERIAL MANIPULATOR JACOBIAN MATRIX PROPERTIES OF JACOBIAN MATRIX (CONTD.) 0 Tool [J(Θ)] very important in velocity kinematics of serial manipulators. The elements of the Jacobian matrix are nonlinear functions of the joint variables Θ. Manipulator in motion 0 Tool [J(Θ)] is time varying. At instant with Θ known, 0 Tool [J(Θ)] relates linear and angular velocities to joint rates. The relationship is linear! The Jacobian matrix can be obtained for any link most often for endeffector. The Jacobian matrix is always with respect to a coordinate system where the linear and angular velocities are obtained. Most often Jacobian matrix is with respect to fixed {0}. Jacobian matrix can be written in any coordinate system using rotation matrices. ASHITAVA GHOSAL (IISC) ROBOTICS: ADVANCED CONCEPTS & ANALYSIS NPTEL, / 98
ME 115(b): Solution to Homework #1
ME 115(b): Solution to Homework #1 Solution to Problem #1: To construct the hybrid Jacobian for a manipulator, you could either construct the body Jacobian, JST b, and then use the bodytohybrid velocity
More informationMechanics lecture 7 Moment of a force, torque, equilibrium of a body
G.1 EE1.el3 (EEE1023): Electronics III Mechanics lecture 7 Moment of a force, torque, equilibrium of a body Dr Philip Jackson http://www.ee.surrey.ac.uk/teaching/courses/ee1.el3/ G.2 Moments, torque and
More informationBead moving along a thin, rigid, wire.
Bead moving along a thin, rigid, wire. odolfo. osales, Department of Mathematics, Massachusetts Inst. of Technology, Cambridge, Massachusetts, MA 02139 October 17, 2004 Abstract An equation describing
More informationELEMENTS OF VECTOR ALGEBRA
ELEMENTS OF VECTOR ALGEBRA A.1. VECTORS AND SCALAR QUANTITIES We have now proposed sets of basic dimensions and secondary dimensions to describe certain aspects of nature, but more than just dimensions
More informationRobot Dynamics and Control
Chapter 4 Robot Dynamics and Control This chapter presents an introduction to the dynamics and control of robot manipulators. We derive the equations of motion for a general openchain manipulator and,
More informationLecture 7. Matthew T. Mason. Mechanics of Manipulation. Lecture 7. Representing Rotation. Kinematic representation: goals, overview
Matthew T. Mason Mechanics of Manipulation Today s outline Readings, etc. We are starting chapter 3 of the text Lots of stuff online on representing rotations Murray, Li, and Sastry for matrix exponential
More information3D Tranformations. CS 4620 Lecture 6. Cornell CS4620 Fall 2013 Lecture 6. 2013 Steve Marschner (with previous instructors James/Bala)
3D Tranformations CS 4620 Lecture 6 1 Translation 2 Translation 2 Translation 2 Translation 2 Scaling 3 Scaling 3 Scaling 3 Scaling 3 Rotation about z axis 4 Rotation about z axis 4 Rotation about x axis
More informationLecture L18  Exploring the Neighborhood: the Restricted ThreeBody Problem
S. Widnall 16.07 Dynamics Fall 008 Version 1.0 Lecture L18  Exploring the Neighborhood: the Restricted ThreeBody Problem The ThreeBody Problem In Lecture 1517, we presented the solution to the twobody
More informationDesignSimulationOptimization Package for a Generic 6DOF Manipulator with a Spherical Wrist
DesignSimulationOptimization Package for a Generic 6DOF Manipulator with a Spherical Wrist MHER GRIGORIAN, TAREK SOBH Department of Computer Science and Engineering, U. of Bridgeport, USA ABSTRACT Robot
More informationChapter 24 Physical Pendulum
Chapter 4 Physical Pendulum 4.1 Introduction... 1 4.1.1 Simple Pendulum: Torque Approach... 1 4. Physical Pendulum... 4.3 Worked Examples... 4 Example 4.1 Oscillating Rod... 4 Example 4.3 Torsional Oscillator...
More informationMetrics on SO(3) and Inverse Kinematics
Mathematical Foundations of Computer Graphics and Vision Metrics on SO(3) and Inverse Kinematics Luca Ballan Institute of Visual Computing Optimization on Manifolds Descent approach d is a ascent direction
More information3.8 Finding Antiderivatives; Divergence and Curl of a Vector Field
3.8 Finding Antiderivatives; Divergence and Curl of a Vector Field 77 3.8 Finding Antiderivatives; Divergence and Curl of a Vector Field Overview: The antiderivative in one variable calculus is an important
More informationAffine Transformations. University of Texas at Austin CS384G  Computer Graphics Fall 2010 Don Fussell
Affine Transformations University of Texas at Austin CS384G  Computer Graphics Fall 2010 Don Fussell Logistics Required reading: Watt, Section 1.1. Further reading: Foley, et al, Chapter 5.15.5. David
More informationSixDegreeofFreedom Kinematics and Dynamics of a Rigid Body
SixDegreeofFreedom Kinematics and Dynamics of a Rigid Body I. Kinematics Consider an inertial frame X i Y i Z i with origin O i and a bodyfixed frame X b Y b Z b with origin O b. The rotation matrix
More informationSimulation of Trajectories and Comparison of Joint Variables for Robotic Manipulator Using Multibody Dynamics (MBD)
Simulation of Trajectories and Comparison of Joint Variables for Robotic Manipulator Using Multibody Dynamics (MBD) Jatin Dave Assistant Professor Nirma University Mechanical Engineering Department, Institute
More information1 Scalars, Vectors and Tensors
DEPARTMENT OF PHYSICS INDIAN INSTITUTE OF TECHNOLOGY, MADRAS PH350 Classical Physics Handout 1 8.8.2009 1 Scalars, Vectors and Tensors In physics, we are interested in obtaining laws (in the form of mathematical
More information1 KINEMATICS OF MOVING FRAMES
1 1 KINEMATICS OF MOVING FRAMES 1.1 Rotation of Reference Frames We denote through a subscript the specific reference system of a vector. Let a vector expressed in the inertial frame be denoted as γx,
More informationState of Stress at Point
State of Stress at Point Einstein Notation The basic idea of Einstein notation is that a covector and a vector can form a scalar: This is typically written as an explicit sum: According to this convention,
More informationLet s first see how precession works in quantitative detail. The system is illustrated below: ...
lecture 20 Topics: Precession of tops Nutation Vectors in the body frame The free symmetric top in the body frame Euler s equations The free symmetric top ala Euler s The tennis racket theorem As you know,
More informationLecture L3  Vectors, Matrices and Coordinate Transformations
S. Widnall 16.07 Dynamics Fall 2009 Lecture notes based on J. Peraire Version 2.0 Lecture L3  Vectors, Matrices and Coordinate Transformations By using vectors and defining appropriate operations between
More informationDynamics. Basilio Bona. DAUINPolitecnico di Torino. Basilio Bona (DAUINPolitecnico di Torino) Dynamics 2009 1 / 30
Dynamics Basilio Bona DAUINPolitecnico di Torino 2009 Basilio Bona (DAUINPolitecnico di Torino) Dynamics 2009 1 / 30 Dynamics  Introduction In order to determine the dynamics of a manipulator, it is
More informationElasticity Theory Basics
G22.3033002: Topics in Computer Graphics: Lecture #7 Geometric Modeling New York University Elasticity Theory Basics Lecture #7: 20 October 2003 Lecturer: Denis Zorin Scribe: Adrian Secord, Yotam Gingold
More informationVectors VECTOR PRODUCT. Graham S McDonald. A Tutorial Module for learning about the vector product of two vectors. Table of contents Begin Tutorial
Vectors VECTOR PRODUCT Graham S McDonald A Tutorial Module for learning about the vector product of two vectors Table of contents Begin Tutorial c 2004 g.s.mcdonald@salford.ac.uk 1. Theory 2. Exercises
More informationOperational Space Control for A Scara Robot
Operational Space Control for A Scara Robot Francisco Franco Obando D., Pablo Eduardo Caicedo R., Oscar Andrés Vivas A. Universidad del Cauca, {fobando, pacaicedo, avivas }@unicauca.edu.co Abstract This
More informationLecture L19  Vibration, Normal Modes, Natural Frequencies, Instability
S. Widnall 16.07 Dynamics Fall 2009 Version 1.0 Lecture L19  Vibration, Normal Modes, Natural Frequencies, Instability Vibration, Instability An important class of problems in dynamics concerns the free
More informationDynamics of Rotational Motion
Chapter 10 Dynamics of Rotational Motion PowerPoint Lectures for University Physics, Twelfth Edition Hugh D. Young and Roger A. Freedman Lectures by James Pazun Modified by P. Lam 5_31_2012 Goals for Chapter
More informationRotation Matrices and Homogeneous Transformations
Rotation Matrices and Homogeneous Transformations A coordinate frame in an ndimensional space is defined by n mutually orthogonal unit vectors. In particular, for a twodimensional (2D) space, i.e., n
More informationINSTRUCTOR WORKBOOK Quanser Robotics Package for Education for MATLAB /Simulink Users
INSTRUCTOR WORKBOOK for MATLAB /Simulink Users Developed by: Amir Haddadi, Ph.D., Quanser Peter Martin, M.A.SC., Quanser Quanser educational solutions are powered by: CAPTIVATE. MOTIVATE. GRADUATE. PREFACE
More informationThe Phase Plane. Phase portraits; type and stability classifications of equilibrium solutions of systems of differential equations
The Phase Plane Phase portraits; type and stability classifications of equilibrium solutions of systems of differential equations Phase Portraits of Linear Systems Consider a systems of linear differential
More informationConstraint satisfaction and global optimization in robotics
Constraint satisfaction and global optimization in robotics Arnold Neumaier Universität Wien and JeanPierre Merlet INRIA Sophia Antipolis 1 The design, validation, and use of robots poses a number of
More informationKinematics of Robots. Alba Perez Gracia
Kinematics of Robots Alba Perez Gracia c Draft date August 31, 2007 Contents Contents i 1 Motion: An Introduction 3 1.1 Overview.......................................... 3 1.2 Introduction.........................................
More informationRepresenting Attitude: Euler Angles, Unit Quaternions, and Rotation Vectors
Representing Attitude: Euler Angles, Unit Quaternions, and Rotation Vectors James Diebel Stanford University Stanford, California 94301 9010 Email: diebel@stanford.edu 0 October 006 Abstract We present
More informationA PAIR OF MEASURES OF ROTATIONAL ERROR FOR AXISYMMETRIC ROBOT ENDEFFECTORS
A PAIR OF MEASURES OF ROTATIONAL ERROR FOR AXISYMMETRIC ROBOT ENDEFFECTORS Sébastien Briot, Ilian A. Bonev Department of Automated Manufacturing Engineering École de technologie supérieure (ÉTS), Montreal,
More informationby the matrix A results in a vector which is a reflection of the given
Eigenvalues & Eigenvectors Example Suppose Then So, geometrically, multiplying a vector in by the matrix A results in a vector which is a reflection of the given vector about the yaxis We observe that
More informationOrbital Mechanics. Angular Momentum
Orbital Mechanics The objects that orbit earth have only a few forces acting on them, the largest being the gravitational pull from the earth. The trajectories that satellites or rockets follow are largely
More informationEngineering Mechanics I. Phongsaen PITAKWATCHARA
2103213 Engineering Mechanics I Phongsaen.P@chula.ac.th May 13, 2011 Contents Preface xiv 1 Introduction to Statics 1 1.1 Basic Concepts............................ 2 1.2 Scalars and Vectors..........................
More informationModule 4. Analysis of Statically Indeterminate Structures by the Direct Stiffness Method. Version 2 CE IIT, Kharagpur
Module Analysis of Statically Indeterminate Structures by the Direct Stiffness Method Version CE IIT, haragpur esson 7 The Direct Stiffness Method: Beams Version CE IIT, haragpur Instructional Objectives
More information5.2 Rotational Kinematics, Moment of Inertia
5 ANGULAR MOTION 5.2 Rotational Kinematics, Moment of Inertia Name: 5.2 Rotational Kinematics, Moment of Inertia 5.2.1 Rotational Kinematics In (translational) kinematics, we started out with the position
More informationMatrix Normalization for Optimal Robot Design
IEEE International Conference on Robotics and Automation Leuven, Belgium, May 1621, 1998. Matrix Normalization for Optimal Robot Design L. Stocco, S. E. Salcudean and F. Sassani * Department of Electrical
More informationCross product and determinants (Sect. 12.4) Two main ways to introduce the cross product
Cross product and determinants (Sect. 12.4) Two main ways to introduce the cross product Geometrical definition Properties Expression in components. Definition in components Properties Geometrical expression.
More informationIsaac Newton s (16421727) Laws of Motion
Big Picture 1 2.003J/1.053J Dynamics and Control I, Spring 2007 Professor Thomas Peacock 2/7/2007 Lecture 1 Newton s Laws, Cartesian and Polar Coordinates, Dynamics of a Single Particle Big Picture First
More informationRobot Modeling and Control
Robot Modeling and Control First Edition Mark W. Spong, Seth Hutchinson, and M. Vidyasagar JOHN WILEY & SONS, INC. New York / Chichester / Weinheim / Brisbane / Singapore / Toronto Preface TO APPEAR i
More informationThe dynamic equation for the angular motion of the wheel is R w F t R w F w ]/ J w
Chapter 4 Vehicle Dynamics 4.. Introduction In order to design a controller, a good representative model of the system is needed. A vehicle mathematical model, which is appropriate for both acceleration
More informationComputer Graphics Prof. Sukhendu Das Dept. of Computer Science and Engineering Indian Institute of Technology, Madras Lecture 7 Transformations in 2D
Computer Graphics Prof. Sukhendu Das Dept. of Computer Science and Engineering Indian Institute of Technology, Madras Lecture 7 Transformations in 2D Welcome everybody. We continue the discussion on 2D
More information3 Orthogonal Vectors and Matrices
3 Orthogonal Vectors and Matrices The linear algebra portion of this course focuses on three matrix factorizations: QR factorization, singular valued decomposition (SVD), and LU factorization The first
More informationI. The BornOppenheimer Separation of Electronic and Nuclear Motions
Chapter 3 The Application of the Schrödinger Equation to the Motions of Electrons and Nuclei in a Molecule Lead to the Chemists' Picture of Electronic Energy Surfaces on Which Vibration and Rotation Occurs
More informationMath 497C Sep 9, Curves and Surfaces Fall 2004, PSU
Math 497C Sep 9, 2004 1 Curves and Surfaces Fall 2004, PSU Lecture Notes 2 15 sometries of the Euclidean Space Let M 1 and M 2 be a pair of metric space and d 1 and d 2 be their respective metrics We say
More informationTHREE DIMENSIONAL GEOMETRY
Chapter 11 THREE DIMENSIONAL GEOMETRY 111 Overview 1111 Direction cosines of a line are the cosines of the angles made by the line with positive directions of the coordinate axes 111 If l, m, n are the
More informationRecall the basic property of the transpose (for any A): v A t Aw = v w, v, w R n.
ORTHOGONAL MATRICES Informally, an orthogonal n n matrix is the ndimensional analogue of the rotation matrices R θ in R 2. When does a linear transformation of R 3 (or R n ) deserve to be called a rotation?
More informationLecture L222D Rigid Body Dynamics: Work and Energy
J. Peraire, S. Widnall 6.07 Dynamics Fall 008 Version.0 Lecture L  D Rigid Body Dynamics: Work and Energy In this lecture, we will revisit the principle of work and energy introduced in lecture L3 for
More informationPrerequisites 20122013
Prerequisites 20122013 Engineering Computation The student should be familiar with basic tools in Mathematics and Physics as learned at the High School level and in the first year of Engineering Schools.
More informationStability Of Structures: Basic Concepts
23 Stability Of Structures: Basic Concepts ASEN 3112 Lecture 23 Slide 1 Objective This Lecture (1) presents basic concepts & terminology on structural stability (2) describes conceptual procedures for
More informationSection 1.1. Introduction to R n
The Calculus of Functions of Several Variables Section. Introduction to R n Calculus is the study of functional relationships and how related quantities change with each other. In your first exposure to
More informationACTUATOR DESIGN FOR ARC WELDING ROBOT
ACTUATOR DESIGN FOR ARC WELDING ROBOT 1 Anurag Verma, 2 M. M. Gor* 1 G.H Patel College of Engineering & Technology, V.V.Nagar388120, Gujarat, India 2 Parul Institute of Engineering & Technology, Limda391760,
More informationA Python Project for Lagrangian Mechanics
The 3rd International Symposium on Engineering, Energy and Environments 1720 November 2013, Pullman King Power Hotel, Bangkok A Python Project for Lagrangian Mechanics Peter Slaets 1, Pauwel Goethals
More informationIntroduction to Robotics Analysis, Systems, Applications
Introduction to Robotics Analysis, Systems, Applications Saeed B. Niku Mechanical Engineering Department California Polytechnic State University San Luis Obispo Technische Urw/carsMt Darmstadt FACHBEREfCH
More informationRotational inertia (moment of inertia)
Rotational inertia (moment of inertia) Define rotational inertia (moment of inertia) to be I = Σ m i r i 2 or r i : the perpendicular distance between m i and the given rotation axis m 1 m 2 x 1 x 2 Moment
More informationGroup Theory and Chemistry
Group Theory and Chemistry Outline: Raman and infrared spectroscopy Symmetry operations Point Groups and Schoenflies symbols Function space and matrix representation Reducible and irreducible representation
More informationThe Basics of FEA Procedure
CHAPTER 2 The Basics of FEA Procedure 2.1 Introduction This chapter discusses the spring element, especially for the purpose of introducing various concepts involved in use of the FEA technique. A spring
More informationGeometry for Computer Graphics
Computer Graphics and Visualisation Geometry for Computer Graphics Student Notes Developed by F Lin K Wyrwas J Irwin C Lilley W T Hewitt T L J Howard Computer Graphics Unit Manchester Computing Centre
More informationMatrix Norms. Tom Lyche. September 28, Centre of Mathematics for Applications, Department of Informatics, University of Oslo
Matrix Norms Tom Lyche Centre of Mathematics for Applications, Department of Informatics, University of Oslo September 28, 2009 Matrix Norms We consider matrix norms on (C m,n, C). All results holds for
More informationSolving Simultaneous Equations and Matrices
Solving Simultaneous Equations and Matrices The following represents a systematic investigation for the steps used to solve two simultaneous linear equations in two unknowns. The motivation for considering
More informationMatrix Differentiation
1 Introduction Matrix Differentiation ( and some other stuff ) Randal J. Barnes Department of Civil Engineering, University of Minnesota Minneapolis, Minnesota, USA Throughout this presentation I have
More informationMath 313 Lecture #10 2.2: The Inverse of a Matrix
Math 1 Lecture #10 2.2: The Inverse of a Matrix Matrix algebra provides tools for creating many useful formulas just like real number algebra does. For example, a real number a is invertible if there is
More informationIntroduction to Matrix Algebra
Psychology 7291: Multivariate Statistics (Carey) 8/27/98 Matrix Algebra  1 Introduction to Matrix Algebra Definitions: A matrix is a collection of numbers ordered by rows and columns. It is customary
More informationSection V.4: Cross Product
Section V.4: Cross Product Definition The cross product of vectors A and B is written as A B. The result of the cross product A B is a third vector which is perpendicular to both A and B. (Because the
More informationCATIA V5 Tutorials. Mechanism Design & Animation. Release 18. Nader G. Zamani. University of Windsor. Jonathan M. Weaver. University of Detroit Mercy
CATIA V5 Tutorials Mechanism Design & Animation Release 18 Nader G. Zamani University of Windsor Jonathan M. Weaver University of Detroit Mercy SDC PUBLICATIONS Schroff Development Corporation www.schroff.com
More information2D Geometric Transformations. COMP 770 Fall 2011
2D Geometric Transformations COMP 770 Fall 2011 1 A little quick math background Notation for sets, functions, mappings Linear transformations Matrices Matrixvector multiplication Matrixmatrix multiplication
More informationThe Physical Significance of div and curl
The Physical Significance of div and curl Consider a (possibly compressible fluid with velocity field v(x,t. Pick any time t 0 and a really tiny piece of the fluid, which at time t 0 a cube with corners
More informationOUTCOME 2 KINEMATICS AND DYNAMICS TUTORIAL 2 PLANE MECHANISMS. You should judge your progress by completing the self assessment exercises.
Unit 60: Dynamics of Machines Unit code: H/601/1411 QCF Level:4 Credit value:15 OUTCOME 2 KINEMATICS AND DYNAMICS TUTORIAL 2 PLANE MECHANISMS 2 Be able to determine the kinetic and dynamic parameters of
More informationMotion Control of 3 DegreeofFreedom DirectDrive Robot. Rutchanee Gullayanon
Motion Control of 3 DegreeofFreedom DirectDrive Robot A Thesis Presented to The Academic Faculty by Rutchanee Gullayanon In Partial Fulfillment of the Requirements for the Degree Master of Engineering
More informationForce on Moving Charges in a Magnetic Field
[ Assignment View ] [ Eðlisfræði 2, vor 2007 27. Magnetic Field and Magnetic Forces Assignment is due at 2:00am on Wednesday, February 28, 2007 Credit for problems submitted late will decrease to 0% after
More informationHomework 4. problems: 5.61, 5.67, 6.63, 13.21
Homework 4 problems: 5.6, 5.67, 6.6,. Problem 5.6 An object of mass M is held in place by an applied force F. and a pulley system as shown in the figure. he pulleys are massless and frictionless. Find
More informationGraphical Linkage Synthesis
Graphical Linkage Synthesis Lecture 5 Time ratio The timing of the crankrocker can be assessed using the two stationary positions. Time ratio = OR Time ratio = Time it takes to complete forward motion/
More informationAutomatic Synthesis of a Planar Linkage Mechanism
Automatic Synthesis of a Planar Linkage Mechanism Yoon Young Kim Seoul National University 2 Our Goal: Automatic Mechanism Synthesis?? 3 Research Motivation Arrow Model at Brandeis Univ. Space Robot at
More informationASEN 3112  Structures. MDOF Dynamic Systems. ASEN 3112 Lecture 1 Slide 1
19 MDOF Dynamic Systems ASEN 3112 Lecture 1 Slide 1 A TwoDOF MassSpringDashpot Dynamic System Consider the lumpedparameter, massspringdashpot dynamic system shown in the Figure. It has two point
More informationDynamic Analysis. Mass Matrices and External Forces
4 Dynamic Analysis. Mass Matrices and External Forces The formulation of the inertia and external forces appearing at any of the elements of a multibody system, in terms of the dependent coordinates that
More informationINTRODUCTION. Robotics is a relatively young field of modern technology that crosses traditional
1 INTRODUCTION Robotics is a relatively young field of modern technology that crosses traditional engineering boundaries. Understanding the complexity of robots and their applications requires knowledge
More informationDATA ANALYSIS II. Matrix Algorithms
DATA ANALYSIS II Matrix Algorithms Similarity Matrix Given a dataset D = {x i }, i=1,..,n consisting of n points in R d, let A denote the n n symmetric similarity matrix between the points, given as where
More information13 MATH FACTS 101. 2 a = 1. 7. The elements of a vector have a graphical interpretation, which is particularly easy to see in two or three dimensions.
3 MATH FACTS 0 3 MATH FACTS 3. Vectors 3.. Definition We use the overhead arrow to denote a column vector, i.e., a linear segment with a direction. For example, in threespace, we write a vector in terms
More informationTHE problem of visual servoing guiding a robot using
582 IEEE TRANSACTIONS ON ROBOTICS AND AUTOMATION, VOL. 13, NO. 4, AUGUST 1997 A Modular System for Robust Positioning Using Feedback from Stereo Vision Gregory D. Hager, Member, IEEE Abstract This paper
More informationRobust Design of Inertial Measurement Units Based on Accelerometers
Robust Design of Inertial Measurement Units Based on Accelerometers Zhongkai Qin, Luc Baron and Lionel Birglen {zhongkai.qin, luc.baron, lionel.birglen}@polymtl.ca Department of Mechanical Engineering,
More informationMatrix Calculations: Applications of Eigenvalues and Eigenvectors; Inner Products
Matrix Calculations: Applications of Eigenvalues and Eigenvectors; Inner Products H. Geuvers Institute for Computing and Information Sciences Intelligent Systems Version: spring 2015 H. Geuvers Version:
More informationCNC Machine Control Unit
NC Hardware a NC Hardware CNC Machine Control Unit Servo Drive Control Hydraulic Servo Drive Hydraulic power supply unit Servo valve Servo amplifiers Hydraulic motor Hydraulic Servo Valve Hydraulic Servo
More informationUnit 3 (Review of) Language of Stress/Strain Analysis
Unit 3 (Review of) Language of Stress/Strain Analysis Readings: B, M, P A.2, A.3, A.6 Rivello 2.1, 2.2 T & G Ch. 1 (especially 1.7) Paul A. Lagace, Ph.D. Professor of Aeronautics & Astronautics and Engineering
More informationDifferential Relations for Fluid Flow. Acceleration field of a fluid. The differential equation of mass conservation
Differential Relations for Fluid Flow In this approach, we apply our four basic conservation laws to an infinitesimally small control volume. The differential approach provides point by point details of
More informationUnified Lecture # 4 Vectors
Fall 2005 Unified Lecture # 4 Vectors These notes were written by J. Peraire as a review of vectors for Dynamics 16.07. They have been adapted for Unified Engineering by R. Radovitzky. References [1] Feynmann,
More informationOn Motion of Robot EndEffector using the Curvature Theory of Timelike Ruled Surfaces with Timelike Directrix
Malaysian Journal of Mathematical Sciences 8(2): 89204 (204) MALAYSIAN JOURNAL OF MATHEMATICAL SCIENCES Journal homepage: http://einspem.upm.edu.my/journal On Motion of Robot EndEffector using the Curvature
More information[1] Diagonal factorization
8.03 LA.6: Diagonalization and Orthogonal Matrices [ Diagonal factorization [2 Solving systems of first order differential equations [3 Symmetric and Orthonormal Matrices [ Diagonal factorization Recall:
More informationKINEMATICS OF PARTICLES RELATIVE MOTION WITH RESPECT TO TRANSLATING AXES
KINEMTICS OF PRTICLES RELTIVE MOTION WITH RESPECT TO TRNSLTING XES In the previous articles, we have described particle motion using coordinates with respect to fixed reference axes. The displacements,
More informationLab 7: Rotational Motion
Lab 7: Rotational Motion Equipment: DataStudio, rotary motion sensor mounted on 80 cm rod and heavy duty bench clamp (PASCO ME9472), string with loop at one end and small white bead at the other end (125
More informationThe basic unit in matrix algebra is a matrix, generally expressed as: a 11 a 12. a 13 A = a 21 a 22 a 23
(copyright by Scott M Lynch, February 2003) Brief Matrix Algebra Review (Soc 504) Matrix algebra is a form of mathematics that allows compact notation for, and mathematical manipulation of, highdimensional
More informationThe Matrix Elements of a 3 3 Orthogonal Matrix Revisited
Physics 116A Winter 2011 The Matrix Elements of a 3 3 Orthogonal Matrix Revisited 1. Introduction In a class handout entitled, ThreeDimensional Proper and Improper Rotation Matrices, I provided a derivation
More informationMath 504, Fall 2013 HW 3
Math 504, Fall 013 HW 3 1. Let F = F (x) be the field of rational functions over the field of order. Show that the extension K = F(x 1/6 ) of F is equal to F( x, x 1/3 ). Show that F(x 1/3 ) is separable
More informationLeastSquares Intersection of Lines
LeastSquares Intersection of Lines Johannes Traa  UIUC 2013 This writeup derives the leastsquares solution for the intersection of lines. In the general case, a set of lines will not intersect at a
More informationMATH10212 Linear Algebra. Systems of Linear Equations. Definition. An ndimensional vector is a row or a column of n numbers (or letters): a 1.
MATH10212 Linear Algebra Textbook: D. Poole, Linear Algebra: A Modern Introduction. Thompson, 2006. ISBN 0534405967. Systems of Linear Equations Definition. An ndimensional vector is a row or a column
More informationKinematical Animation. lionel.reveret@inria.fr 201314
Kinematical Animation 201314 3D animation in CG Goal : capture visual attention Motion of characters Believable Expressive Realism? Controllability Limits of purely physical simulation :  little interactivity
More informationPhysics 9e/Cutnell. correlated to the. College Board AP Physics 1 Course Objectives
Physics 9e/Cutnell correlated to the College Board AP Physics 1 Course Objectives Big Idea 1: Objects and systems have properties such as mass and charge. Systems may have internal structure. Enduring
More information1 2 3 1 1 2 x = + x 2 + x 4 1 0 1
(d) If the vector b is the sum of the four columns of A, write down the complete solution to Ax = b. 1 2 3 1 1 2 x = + x 2 + x 4 1 0 0 1 0 1 2. (11 points) This problem finds the curve y = C + D 2 t which
More informationRotation: Moment of Inertia and Torque
Rotation: Moment of Inertia and Torque Every time we push a door open or tighten a bolt using a wrench, we apply a force that results in a rotational motion about a fixed axis. Through experience we learn
More information