[Download] Rev-Chapter-2
-
Upload
atc-ece-hong-kong-university-of-science-and-technology -
Category
Education
-
view
605 -
download
0
description
Transcript of [Download] Rev-Chapter-2
![Page 1: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/1.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
Chapter 2 Rigid Body Motion
1
Lecture Notes for
A Geometrical Introduction to
Robotics and Manipulation
Richard Murray and Zexiang Li and Shankar S. SastryCRC Press
Zexiang Li1 and Yuanqing Wu1
1ECE, Hong Kong University of Science & Technology
May 23, 2010
![Page 2: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/2.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
Chapter 2 Rigid Body Motion
2
Chapter 2 Rigid Body Motion
1 Rigid Body Transformations
2 Rotational motion in ℝ3
3 Rigid Motion in ℝ3
4 Velocity of a Rigid Body
5 Wrenches and Reciprocal Screws
6 Reference
z
yabx
xaby
zab
q
![Page 3: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/3.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.1 Rigid Body TransformationsChapter 2 Rigid Body Motion
3
§ Notations:
x
y
z p
p = [ pxpypz] or p = [ p1
p2p3]
For p ∈ ℝn, n = 2, 3(2 for planar, 3 for spatial)Point: p =
⎡⎢⎢⎢⎢⎣p1p2⋮pn
⎤⎥⎥⎥⎥⎦, ∥p∥ =√p21 +⋯+ p2n
![Page 4: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/4.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.1 Rigid Body TransformationsChapter 2 Rigid Body Motion
3
§ Notations:
x
y
z p
p = [ pxpypz] or p = [ p1
p2p3]
For p ∈ ℝn, n = 2, 3(2 for planar, 3 for spatial)Point: p =
⎡⎢⎢⎢⎢⎣p1p2⋮pn
⎤⎥⎥⎥⎥⎦, ∥p∥ =√p21 +⋯+ p2n
Vector: v = p − q = ⎡⎢⎢⎢⎢⎣p1 − q1p2 − q2⋮pn − qn
⎤⎥⎥⎥⎥⎦ = [v1v2⋮vn], ∥v∥ =√v21 +⋯+ v2n
![Page 5: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/5.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.1 Rigid Body TransformationsChapter 2 Rigid Body Motion
3
§ Notations:
x
y
z p
p = [ pxpypz] or p = [ p1
p2p3]
For p ∈ ℝn, n = 2, 3(2 for planar, 3 for spatial)Point: p =
⎡⎢⎢⎢⎢⎣p1p2⋮pn
⎤⎥⎥⎥⎥⎦, ∥p∥ =√p21 +⋯+ p2n
Vector: v = p − q = ⎡⎢⎢⎢⎢⎣p1 − q1p2 − q2⋮pn − qn
⎤⎥⎥⎥⎥⎦ = [v1v2⋮vn], ∥v∥ =√v21 +⋯+ v2n
Matrix: A ∈ ℝn×m ,A = [ a11 a12 ⋯ a1m⋮ ⋮an1 an2 ⋯ anm
]
![Page 6: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/6.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.1 Rigid Body TransformationsChapter 2 Rigid Body Motion
4
◻ Description of point-mass motion:
p(0) = ⎡⎢⎢⎢⎢⎣x(0)y(0)z(0)
⎤⎥⎥⎥⎥⎦: initial position
x y
z
p(0)Figure 2.1
![Page 7: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/7.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.1 Rigid Body TransformationsChapter 2 Rigid Body Motion
4
◻ Description of point-mass motion:
p(0) = ⎡⎢⎢⎢⎢⎣x(0)y(0)z(0)
⎤⎥⎥⎥⎥⎦: initial position
x y
z
p(0)Figure 2.1
p(t) = ⎡⎢⎢⎢⎢⎣x(t)y(t)z(t)
⎤⎥⎥⎥⎥⎦ , t ∈ (−ε, ε)p(t)
![Page 8: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/8.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.1 Rigid Body TransformationsChapter 2 Rigid Body Motion
4
◻ Description of point-mass motion:
p(0) = ⎡⎢⎢⎢⎢⎣x(0)y(0)z(0)
⎤⎥⎥⎥⎥⎦: initial position
x y
z
p(0)Figure 2.1
p(t) = ⎡⎢⎢⎢⎢⎣x(t)y(t)z(t)
⎤⎥⎥⎥⎥⎦ , t ∈ (−ε, ε)p(t)
Definition: Trajectory
A trajectory is a curve p ∶ (−ε, ε) ↦ ℝ3, p(t) = ⎡⎢⎢⎢⎢⎣
x(t)y(t)z(t)
⎤⎥⎥⎥⎥⎦
![Page 9: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/9.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.1 Rigid Body TransformationsChapter 2 Rigid Body Motion
5
◻ Rigid Body Motion:
x y
z
p(0)
q(0)
Figure 2.2
![Page 10: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/10.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.1 Rigid Body TransformationsChapter 2 Rigid Body Motion
5
◻ Rigid Body Motion:
x y
z
p(0)
q(0)
Figure 2.2
p(t)
q(t)
∥p(t) − q(t)∥ = ∥p(0) − q(0)∥ = constant
![Page 11: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/11.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.1 Rigid Body TransformationsChapter 2 Rigid Body Motion
5
◻ Rigid Body Motion:
x y
z
p(0)
q(0)
Figure 2.2
p(t)
q(t)
∥p(t) − q(t)∥ = ∥p(0) − q(0)∥ = constantDefinition: Rigid body transformation
g ∶ ℝ3 ↦ ℝ3
s.t.
1 Length preserving: ∥g(p) − g(q)∥ = ∥p − q∥2 Orientation preserving: g∗(v × ω) = g∗(v) × g∗(ω)
† End of Section †
![Page 12: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/12.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
6
◻ Rotational Motion:
z
x
yo
A: o − xyz
Figure 2.3
1 Choose a reference frame A(spatial frame)
![Page 13: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/13.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
6
◻ Rotational Motion:
z
x
yo
A: o − xyz
Figure 2.3
1 Choose a reference frame A(spatial frame)2 Attach a frame B to the body(spatial frame)
yab
xab
zab
q
o
B: o − xabyabzab
xab ∈ ℝ3: coordinates of xb in frame ARab = [xab yab zab] ∈ ℝ3×3: Rotation (or orientation) matrix of B
w.r.t. A
![Page 14: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/14.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
7
◻ Property of a Rotation Matrix:Let R = [r1 r2 r3] be a rotation matrix
![Page 15: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/15.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
7
◻ Property of a Rotation Matrix:Let R = [r1 r2 r3] be a rotation matrix
⇒ rTi ⋅ rj = {0 i ≠ j
1 i = j
or RT ⋅ R =⎡⎢⎢⎢⎢⎣rT1rT2rT3
⎤⎥⎥⎥⎥⎦[r1 r2 r3] = I or R ⋅ RT = I
![Page 16: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/16.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
7
◻ Property of a Rotation Matrix:Let R = [r1 r2 r3] be a rotation matrix
⇒ rTi ⋅ rj = {0 i ≠ j
1 i = j
or RT ⋅ R =⎡⎢⎢⎢⎢⎣rT1rT2rT3
⎤⎥⎥⎥⎥⎦[r1 r2 r3] = I or R ⋅ RT = I
det(RTR) = detRT ⋅ detR = (detR)2 = 1, detR = ±1As detR = rT1 (r2 × r3) = 1⇒ detR = 1
![Page 17: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/17.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
8
Definition:SO(3) = {R ∈ ℝ3×3 ∣RTR = I, detR = 1}
andSO(n) = {R ∈ ℝn×n ∣RTR = I, detR = 1}
![Page 18: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/18.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
8
Definition:SO(3) = {R ∈ ℝ3×3 ∣RTR = I, detR = 1}
andSO(n) = {R ∈ ℝn×n ∣RTR = I, detR = 1}
♢ Review: Group
(G, ⋅) is a group if:
1 g1, g2 ∈ G⇒ g1 ⋅ g2 ∈ G
![Page 19: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/19.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
8
Definition:SO(3) = {R ∈ ℝ3×3 ∣RTR = I, detR = 1}
andSO(n) = {R ∈ ℝn×n ∣RTR = I, detR = 1}
♢ Review: Group
(G, ⋅) is a group if:
1 g1, g2 ∈ G⇒ g1 ⋅ g2 ∈ G2 ∃! e ∈ G, s.t. g ⋅ e = e ⋅ g = g ,∀g ∈ G
![Page 20: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/20.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
8
Definition:SO(3) = {R ∈ ℝ3×3 ∣RTR = I, detR = 1}
andSO(n) = {R ∈ ℝn×n ∣RTR = I, detR = 1}
♢ Review: Group
(G, ⋅) is a group if:
1 g1, g2 ∈ G⇒ g1 ⋅ g2 ∈ G2 ∃! e ∈ G, s.t. g ⋅ e = e ⋅ g = g ,∀g ∈ G3 ∀g ∈ G, ∃! g−1 ∈ G, s.t. g ⋅ g−1 = g−1 ⋅ g = e
![Page 21: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/21.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
8
Definition:SO(3) = {R ∈ ℝ3×3 ∣RTR = I, detR = 1}
andSO(n) = {R ∈ ℝn×n ∣RTR = I, detR = 1}
♢ Review: Group
(G, ⋅) is a group if:
1 g1, g2 ∈ G⇒ g1 ⋅ g2 ∈ G2 ∃! e ∈ G, s.t. g ⋅ e = e ⋅ g = g ,∀g ∈ G3 ∀g ∈ G, ∃! g−1 ∈ G, s.t. g ⋅ g−1 = g−1 ⋅ g = e4 g1 ⋅ (g2 ⋅ g3) = (g1 ⋅ g2) ⋅ g3
![Page 22: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/22.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
9
♢ Review: Examples of group
1 (ℝ3 ,+)
![Page 23: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/23.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
9
♢ Review: Examples of group
1 (ℝ3 ,+)2 ({0, 1},+ mod 2)
![Page 24: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/24.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
9
♢ Review: Examples of group
1 (ℝ3 ,+)2 ({0, 1},+ mod 2)3 (ℝ,×) Not a group (Why?)
![Page 25: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/25.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
9
♢ Review: Examples of group
1 (ℝ3 ,+)2 ({0, 1},+ mod 2)3 (ℝ,×) Not a group (Why?)
4 (ℝ∗ ∶ ℝ − {0},×)
![Page 26: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/26.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
9
♢ Review: Examples of group
1 (ℝ3 ,+)2 ({0, 1},+ mod 2)3 (ℝ,×) Not a group (Why?)
4 (ℝ∗ ∶ ℝ − {0},×)5 S1 ≜ {z ∈ ℂ∣∣z∣ = 1}
Property 1: SO(3) is a group under matrix multiplication.
![Page 27: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/27.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
9
♢ Review: Examples of group
1 (ℝ3 ,+)2 ({0, 1},+ mod 2)3 (ℝ,×) Not a group (Why?)
4 (ℝ∗ ∶ ℝ − {0},×)5 S1 ≜ {z ∈ ℂ∣∣z∣ = 1}
Property 1: SO(3) is a group under matrix multiplication.
Proof :
1 If R1 ,R2 ∈ SO(3), then R1 ⋅ R2 ∈ SO(3), because● (R1R2)T(R1R2) = RT2 (RT
1 R1)R2 = RT2 R2 = I● det(R1 ⋅ R2) = det(R1) ⋅ det(R2) = 1
![Page 28: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/28.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
9
♢ Review: Examples of group
1 (ℝ3 ,+)2 ({0, 1},+ mod 2)3 (ℝ,×) Not a group (Why?)
4 (ℝ∗ ∶ ℝ − {0},×)5 S1 ≜ {z ∈ ℂ∣∣z∣ = 1}
Property 1: SO(3) is a group under matrix multiplication.
Proof :
1 If R1 ,R2 ∈ SO(3), then R1 ⋅ R2 ∈ SO(3), because● (R1R2)T(R1R2) = RT2 (RT
1 R1)R2 = RT2 R2 = I● det(R1 ⋅ R2) = det(R1) ⋅ det(R2) = 1
2 e = I3×3
![Page 29: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/29.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
9
♢ Review: Examples of group
1 (ℝ3 ,+)2 ({0, 1},+ mod 2)3 (ℝ,×) Not a group (Why?)
4 (ℝ∗ ∶ ℝ − {0},×)5 S1 ≜ {z ∈ ℂ∣∣z∣ = 1}
Property 1: SO(3) is a group under matrix multiplication.
Proof :
1 If R1 ,R2 ∈ SO(3), then R1 ⋅ R2 ∈ SO(3), because● (R1R2)T(R1R2) = RT2 (RT
1 R1)R2 = RT2 R2 = I● det(R1 ⋅ R2) = det(R1) ⋅ det(R2) = 1
2 e = I3×33 RT ⋅ R = I ⇒ R−1 = RT
![Page 30: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/30.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
10
◻ Configuration and rigid transformation:
Rab = [xab yab zab] ∈ SO(3)Configuration Space
z
yabx
xaby
zab
q
o
A: o − xyzB: o − xabyabzab
Figure 2.3
![Page 31: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/31.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
10
◻ Configuration and rigid transformation:
Rab = [xab yab zab] ∈ SO(3)Configuration Space
z
yabx
xaby
zab
q
o
A: o − xyzB: o − xabyabzab
Figure 2.3
Let qb = [ xbybzb] ∈ ℝ3: coordinates of q in B.
qa = xab ⋅ xb + yab ⋅ yb + zab ⋅ zb= [xab yab zab][ xbyb
zb] = Rab ⋅ qb
![Page 32: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/32.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
10
◻ Configuration and rigid transformation:
Rab = [xab yab zab] ∈ SO(3)Configuration Space
z
yabx
xaby
zab
q
o
A: o − xyzB: o − xabyabzab
Figure 2.3
Let qb = [ xbybzb] ∈ ℝ3: coordinates of q in B.
qa = xab ⋅ xb + yab ⋅ yb + zab ⋅ zb= [xab yab zab][ xbyb
zb] = Rab ⋅ qb
A configuration Rab ∈ SO(3) is also a transformation:Rab ∶ ℝ3 → ℝ
3,Rab(qb) = Rab ⋅ qb = qaA config. ⇔ A transformation in SO(3)
![Page 33: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/33.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
11
Property 2: Rab preserves distance between points andorientation.
1 ∥Rab ⋅ (pb − qb)∥ = ∥pa − qa∥2 R(v × ω) = (Rv) × Rω
![Page 34: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/34.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
11
Property 2: Rab preserves distance between points andorientation.
1 ∥Rab ⋅ (pb − qb)∥ = ∥pa − qa∥2 R(v × ω) = (Rv) × Rω
Proof :
For a ∈ ℝ3, let a = [ 0 −a3 a2a3 0 −a1−a2 a1 0
]Note that a ⋅ b = a × b1 follows from ∥Rab(pb − pa)∥2 = (Rab(pb − pa))TRab(pb − pa)
= (pb − pa)TRTabRab(pb − pa)
= ∥pb − pa∥22 follows from RωRT = (Rω)∧
![Page 35: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/35.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
12
◻ Parametrization of SO(3) (theexponential coordinate):
♢ Review: S1 = {z ∈ ℂ∣∣z∣ = 1}
Figure 2.4
Re
Im
φ
1
i
cos φ
sin φ
eiφ = cos φ + i sin φEuler’s Formula
“One of the most remarkable, al-most astounding, formulas in allof mathematics.”
R. Feynman
![Page 36: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/36.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
12
◻ Parametrization of SO(3) (theexponential coordinate):
♢ Review: S1 = {z ∈ ℂ∣∣z∣ = 1}
Figure 2.4
Re
Im
φ
1
i
cos φ
sin φ
eiφ = cos φ + i sin φEuler’s Formula
“One of the most remarkable, al-most astounding, formulas in allof mathematics.”
R. Feynman
♢ Review:
{ x(t) = ax(t)x(0) = x0 ⇒ x(t) = eatx0
(Continues next slide)
![Page 37: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/37.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
13
R ∈ SO(3),R = [ r11 r12 r13r21 r22 r23r31 r32 r33]
ri ⋅ rj = ⎧⎪⎪⎨⎪⎪⎩0, i ≠ j1, i = j ← 6 constraints
⇒ 3 independent parameters!
![Page 38: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/38.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
13
R ∈ SO(3),R = [ r11 r12 r13r21 r22 r23r31 r32 r33]
ri ⋅ rj = ⎧⎪⎪⎨⎪⎪⎩0, i ≠ j1, i = j ← 6 constraints
⇒ 3 independent parameters!
Consider motion of a point q on a rotating link
ωq(t)
q(0)
Figure 2.5{ q(t) = ω × q(t) = ωq(t)q(0): Initial coordinates
![Page 39: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/39.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
13
R ∈ SO(3),R = [ r11 r12 r13r21 r22 r23r31 r32 r33]
ri ⋅ rj = ⎧⎪⎪⎨⎪⎪⎩0, i ≠ j1, i = j ← 6 constraints
⇒ 3 independent parameters!
Consider motion of a point q on a rotating link
ωq(t)
q(0)
Figure 2.5{ q(t) = ω × q(t) = ωq(t)q(0): Initial coordinates⇒ q(t) = eωtq0 where eωt = I + ωt + (ωt)2
2!+ (ωt)3
3!+⋯
![Page 40: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/40.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
13
R ∈ SO(3),R = [ r11 r12 r13r21 r22 r23r31 r32 r33]
ri ⋅ rj = ⎧⎪⎪⎨⎪⎪⎩0, i ≠ j1, i = j ← 6 constraints
⇒ 3 independent parameters!
Consider motion of a point q on a rotating link
ωq(t)
q(0)
Figure 2.5{ q(t) = ω × q(t) = ωq(t)q(0): Initial coordinates⇒ q(t) = eωtq0 where eωt = I + ωt + (ωt)2
2!+ (ωt)3
3!+⋯
By the definition of rigid transformation, R(ω, θ) = eωθ . Letso(3) = {ω∣ω ∈ ℝ3} or so(n) = {S ∈ ℝn×n∣ST = −S} where ∧ ∶ℝ3 ↦ so(3) ∶ ω ↦ ω, we have:
Property 3: exp ∶ so(3)↦ SO(3), ωθ ↦ eωθ
![Page 41: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/41.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
14
Rodrigues’ formula (∥ω∥ = 1):eωθ = I + ω sin θ + ω2(1 − cos θ)
![Page 42: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/42.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
14
Rodrigues’ formula (∥ω∥ = 1):eωθ = I + ω sin θ + ω2(1 − cos θ)
Proof :Let a ∈ ℝ3, write
a = ωθ ,ω = a
∥a∥(or ∥ω∥ = 1), and θ = ∥a∥eωθ = I + ωθ + (ωθ)2
2!+ (ωθ)3
3!+⋯
As a2 = aaT − ∥a∥2I, a3 = −∥a∥2awe have:
eωθ = I + (θ − θ3
3!+ θ3
5!−⋯)ω + (θ2
2!− θ4
4!+⋯)ω2
= I + ω sin θ + ω2(1 − cos θ)
![Page 43: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/43.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
15
Rodrigue’s formula for ∥ω∥ ≠ 1:eωθ = I + ω
∥ω∥ sin ∥ω∥θ + ω2
∥ω∥2 (1 − cos ∥ω∥θ)
![Page 44: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/44.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
15
Rodrigue’s formula for ∥ω∥ ≠ 1:eωθ = I + ω
∥ω∥ sin ∥ω∥θ + ω2
∥ω∥2 (1 − cos ∥ω∥θ)Proof for Property 3:Let R ≜ eωθ , then:
(eωθ)−1 = e−ωθ = eωTθ = (eωθ)T⇒ R−1 = RT ⇒ RTR = I ⇒ detR = ±1
From det exp(0) = 1, and the continuity of det function w.r.t. θ,we have det eωθ = 1,∀θ ∈ ℝ
![Page 45: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/45.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
16
Property 4: The exponential map is onto.
![Page 46: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/46.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
16
Property 4: The exponential map is onto.
Proof :Given R ∈ SO(3), to show ∃ω ∈ ℝ3, ∥ω∥ = 1 and θ s.t. R = eωθLet
R = [ r11 r12 r13r21 r22 r23r31 r32 r33]
andvθ = 1 − cos θ , cθ = cos θ , sθ = sin θ
By Rodrigue’s formula
eωθ =⎡⎢⎢⎢⎢⎣
ω21 vθ + cθ ω1ω2vθ − ω3sθ ω1ω3vθ + ω2sθ
ω1ω2vθ + ω3sθ ω22vθ + cθ ω2ω3vθ − ω1sθ
ω1ω3vθ − ω2sθ ω2ω3vθ + ω1sθ ω23vθ + cθ
⎤⎥⎥⎥⎥⎦(continues next slide)
![Page 47: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/47.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
17
Taking the trace of both sides,
tr(R) = r11 + r22 + r33 = 1 + 2 cos θ = 3∑i=1
λi
where λi is the eigenvalue of R, i = 1, 2, 3Case 1: tr(R) = 3 or R = I, θ = 0⇒ ωθ = 0
![Page 48: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/48.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
17
Taking the trace of both sides,
tr(R) = r11 + r22 + r33 = 1 + 2 cos θ = 3∑i=1
λi
where λi is the eigenvalue of R, i = 1, 2, 3Case 1: tr(R) = 3 or R = I, θ = 0⇒ ωθ = 0Case 2: −1 < tr(R) < 3,
θ = arccos tr(R) − 12
⇒ ω = 1
2sθ[ r32 − r23r13 − r31r21 − r12 ]
![Page 49: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/49.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
17
Taking the trace of both sides,
tr(R) = r11 + r22 + r33 = 1 + 2 cos θ = 3∑i=1
λi
where λi is the eigenvalue of R, i = 1, 2, 3Case 1: tr(R) = 3 or R = I, θ = 0⇒ ωθ = 0Case 2: −1 < tr(R) < 3,
θ = arccos tr(R) − 12
⇒ ω = 1
2sθ[ r32 − r23r13 − r31r21 − r12 ]
Case 3: tr(R) = −1 ⇒ cos θ = −1⇒ θ = ±π(continues next slide)
![Page 50: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/50.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
18
Following are 3 possibilities:
R = [ 1 0 00 −1 00 0 −1 ]⇒ ω = [ 1
00],
R = [ −1 0 00 1 00 0 −1 ]⇒ ω = [ 0
10],
R = [ −1 0 00 −1 00 0 1
]⇒ ω = [ 001]
Note that if ωθ is a solution, then ω(θ ± nπ), n = 0,±1,±2, ... isalso a solution.
![Page 51: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/51.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
19
Definition: Exponential coordinateωθ ∈ ℝ3, with eωθ = R is called the exponential coordinates of R
Exp ∶
I
so(3) ≅ ℝ30
SO(3)exp log
Figure 2.6
![Page 52: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/52.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
19
Definition: Exponential coordinateωθ ∈ ℝ3, with eωθ = R is called the exponential coordinates of R
Exp ∶
I
so(3) ≅ ℝ30
SO(3)exp log
Figure 2.6
Property 5: exp is 1-1 when restricted to an open ball in ℝ3
of radius π.
![Page 53: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/53.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
20
1707–1783
Theorem 1 (Euler):Any orientation is equivalent to a rotation about afixed axis ω ∈ ℝ3 through an angle θ ∈ [−π , π].
A
Bω
Figure 2.7
SO(3) can be visualized as a solid ball of radius π.
![Page 54: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/54.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
21
◻ Other Parametrizations of SO(3):XYZ fixed angles (or Roll-Pitch-Yaw angle)
x
y
z
ψ-Yaw
Roll-φ
θ-Pitch
Figure 2.8
(continues next slide)
![Page 55: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/55.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
22
XYZ fixed angles (or Roll-Pitch-Yaw angle) Continued
Rx(φ) ∶= exφ = [ 1 0 00 cosφ − sin φ0 sin φ cosφ
]Ry(θ) ∶= eyθ = [ cos θ 0 sin θ
0 1 0− sin θ 0 cos θ]
Rz(ψ) ∶= ezψ = [ cosψ − sinψ 0sinψ cosψ 00 0 1
]Rab = Rx(φ)Ry(θ)Rz(ψ)= [ cθcψ −cθsψ sθ
sφsθcψ + cφsψ −sφsθsψ + cφcψ −sφcθ−cφsθcψ + sφsψ cφsθsψ + sφcψ cφcθ]
![Page 56: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/56.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
23
ZYX Euler angle
Figure 2.9
AA′
A′′B
x y
z
![Page 57: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/57.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
23
ZYX Euler angle
Figure 2.9
AA′
A′′B
x y
z
x′y′
(z′)
α
Raa′ = Rz(α)
x′y′
z′
![Page 58: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/58.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
23
ZYX Euler angle
Figure 2.9
AA′
A′′B
x y
z
x′y′
(z′)
α
Raa′ = Rz(α)
x′y′
z′
x′′
(y′′)
z′′
β
Ra′a′′ = Ry(β)x′′
y′′
z′′
![Page 59: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/59.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
23
ZYX Euler angle
Figure 2.9
AA′
A′′B
x y
z
x′y′
(z′)
α
Raa′ = Rz(α)
x′y′
z′
x′′
(y′′)
z′′
β
Ra′a′′ = Ry(β)x′′
y′′
z′′
(x′′′)
y′′′
z′′′
γ
Ra′′b = Rx(γ)Rab = Rz(α)Ry(β)Rx(γ)
(continues next slide)
![Page 60: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/60.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
24
ZYX Euler angle (continued)
Rab(α , β, γ) = [ cαcβ −sαcγ + cαsβsγ sαsγ + cαsβcγsαcβ cαcγ + sαsβsγ −cαsγ + sαsβcγ−sβ cβsγ cβcγ
]Note: When β = 0, sin β = 0, α + γ = const⇒ singularity!
β = atan2(−r31 ,√r232 + r233)α = atan2(r21/cβ , r11/cβ)γ = atan2(r32/cβ , r33/cβ) x
y
atan2(y, x)
Figure 2.10
![Page 61: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/61.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
25
§ Quaternions:
Q = q0 + q1i + q2j + q3kwhere i2 = j2 = k2 = −1, i ⋅ j = k, j ⋅ k = i, k ⋅ i = j
![Page 62: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/62.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
25
§ Quaternions:
Q = q0 + q1i + q2j + q3kwhere i2 = j2 = k2 = −1, i ⋅ j = k, j ⋅ k = i, k ⋅ i = j
Property 1: Define Q∗ = (q0 , q)∗ = (q0 ,−q), q0 ∈ ℝ, q ∈ ℝ3
∥Q∥2 = QQ∗ = q02 + q12 + q22 + q32
![Page 63: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/63.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
25
§ Quaternions:
Q = q0 + q1i + q2j + q3kwhere i2 = j2 = k2 = −1, i ⋅ j = k, j ⋅ k = i, k ⋅ i = j
Property 1: Define Q∗ = (q0 , q)∗ = (q0 ,−q), q0 ∈ ℝ, q ∈ ℝ3
∥Q∥2 = QQ∗ = q02 + q12 + q22 + q32Property 2: Q = (q0 , q), P = (p0 , p)
QP = (q0p0 − q ⋅ p, q0p + p0q + q × p)
![Page 64: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/64.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
25
§ Quaternions:
Q = q0 + q1i + q2j + q3kwhere i2 = j2 = k2 = −1, i ⋅ j = k, j ⋅ k = i, k ⋅ i = j
Property 1: Define Q∗ = (q0 , q)∗ = (q0 ,−q), q0 ∈ ℝ, q ∈ ℝ3
∥Q∥2 = QQ∗ = q02 + q12 + q22 + q32Property 2: Q = (q0 , q), P = (p0 , p)
QP = (q0p0 − q ⋅ p, q0p + p0q + q × p)Property 3: (a) The set of unit quaternions forms a group
(b) If R = eωθ , then Q = (cos θ2,ω sin
θ
2)
(c) Q acts on x ∈ ℝ3 by QXQ∗, where X = (0, x)
![Page 65: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/65.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
26
◻ Unit Quaternions:Given Q = (q0 , q), q0 ∈ ℝ, q ∈ ℝ3, the vector part of QXQ∗ isgiven by R(Q)x,R(Q) = I + 2q0q + 2q2
=
⎡⎢⎢⎢⎢⎣1 − 2(q22 + q23) −2q0q3 + 2q1q2 2q0q2 + 2q1q32q0q3 + 2q1q2 1 − 2(q21 + q23) −2q0q1 + 2q2q3−2q0q2 + 2q1q3 2q0q1 + 2q2q3 1 − 2(q21 + q22)
⎤⎥⎥⎥⎥⎦where ∥Q∥ ≜ q20 + q21 + q22 + q23 = 1
(continues next slide)
![Page 66: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/66.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.2 Rotational Motion in ℝ3Chapter 2 Rigid Body Motion
27
◻ Quaternions (continued):Conversion from Roll-Pitch-Yaw angle to unit quaternions:
Q = (cos φ2, x sin
φ
2)(cos
θ
2, y sin
θ
2)(cos
ψ
2, z sin
ψ
2) ⇒
q0 = cos φ2cos
θ
2cos
ψ
2− sin φ
2sin
θ
2sin
ψ
2
q =⎡⎢⎢⎢⎢⎢⎢⎢⎢⎢⎢⎣
cosφ
2sin
θ
2sin
ψ
2+ sin φ
2cos
θ
2cos
ψ
2
cosφ
2sin
θ
2cos
ψ
2− sin φ
2cos
θ
2sin
ψ
2
cosφ
2cos
θ
2sin
ψ
2+ sin φ
2sin
θ
2cos
ψ
2
⎤⎥⎥⎥⎥⎥⎥⎥⎥⎥⎥⎦
Conversion from unit quaternions to roll-pitch-yaw angles (?)
† End of Section †
![Page 67: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/67.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.3 Rigid motion in ℝ3Chapter 2 Rigid Body Motion
28
A
x y
z
B
q
qb
pab
qa
Figure 2.11
pab ∈ ℝ3 ∶ Coordinates of the origin of B
Rab ∈ SO(3) ∶ Orientation of B relative to A
SE(3) ∶ {(p,R)∣p ∈ ℝ3,R ∈ SO(3)} ∶ Configuration Space
![Page 68: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/68.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.3 Rigid motion in ℝ3Chapter 2 Rigid Body Motion
28
A
x y
z
B
q
qb
pab
qa
Figure 2.11
pab ∈ ℝ3 ∶ Coordinates of the origin of B
Rab ∈ SO(3) ∶ Orientation of B relative to A
SE(3) ∶ {(p,R)∣p ∈ ℝ3,R ∈ SO(3)} ∶ Configuration Space
Or...as a transformation:gab = (pab,Rab) ∶ ℝ3 ↦ ℝ
3
qb ↦ qa = pab + Rab ⋅ qb
![Page 69: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/69.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.3 Rigid motion in ℝ3Chapter 2 Rigid Body Motion
29
◻ Homogeneous Representation:Points:
q = [ q1q2q3] ∈ ℝ3 q =
⎡⎢⎢⎢⎢⎣q1q2q31
⎤⎥⎥⎥⎥⎦∈ ℝ4
![Page 70: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/70.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.3 Rigid motion in ℝ3Chapter 2 Rigid Body Motion
29
◻ Homogeneous Representation:Points:
q = [ q1q2q3] ∈ ℝ3 q =
⎡⎢⎢⎢⎢⎣q1q2q31
⎤⎥⎥⎥⎥⎦∈ ℝ4
Vectors:
v = p − q = [ p1 − q1p2 − q2p3 − q3 ] = [
v1v2v3] v = p−q =
⎡⎢⎢⎢⎢⎣p1p2p31
⎤⎥⎥⎥⎥⎦−⎡⎢⎢⎢⎢⎣
q1q2q31
⎤⎥⎥⎥⎥⎦= [ v1v2v3
0]
![Page 71: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/71.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.3 Rigid motion in ℝ3Chapter 2 Rigid Body Motion
29
◻ Homogeneous Representation:Points:
q = [ q1q2q3] ∈ ℝ3 q =
⎡⎢⎢⎢⎢⎣q1q2q31
⎤⎥⎥⎥⎥⎦∈ ℝ4
Vectors:
v = p − q = [ p1 − q1p2 − q2p3 − q3 ] = [
v1v2v3] v = p−q =
⎡⎢⎢⎢⎢⎣p1p2p31
⎤⎥⎥⎥⎥⎦−⎡⎢⎢⎢⎢⎣
q1q2q31
⎤⎥⎥⎥⎥⎦= [ v1v2v3
0]
1 Point-Point = Vector
2 Vector+Point = Point
3 Vector+Vector = Vector
4 Point+Point: Meaningless
(continues next slide)
![Page 72: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/72.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.3 Rigid motion in ℝ3Chapter 2 Rigid Body Motion
30qa = pab + Rab ⋅ qb
[ qa1 ] = [ Rab pab
0 1 ]´¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¸¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¶gab
[ qab1 ]
qa = gab ⋅ qb
gab = (pab,Rab)
gab = [ Rab pab0 1 ]
![Page 73: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/73.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.3 Rigid motion in ℝ3Chapter 2 Rigid Body Motion
30qa = pab + Rab ⋅ qb
[ qa1 ] = [ Rab pab
0 1 ]´¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¸¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¶gab
[ qab1 ]
qa = gab ⋅ qb
gab = (pab,Rab)
gab = [ Rab pab0 1 ]
◻ Composition Rule:
gab gbc
A
B
C
Figure 2.12
qb = gbc ⋅ qcqa = gab ⋅ qb
![Page 74: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/74.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.3 Rigid motion in ℝ3Chapter 2 Rigid Body Motion
30qa = pab + Rab ⋅ qb
[ qa1 ] = [ Rab pab
0 1 ]´¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¸¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¶gab
[ qab1 ]
qa = gab ⋅ qb
gab = (pab,Rab)
gab = [ Rab pab0 1 ]
◻ Composition Rule:
gab gbc
A
B
C
Figure 2.12
qb = gbc ⋅ qcqa = gab ⋅ qb = gab ⋅ gbc´¹¹¹¹¹¹¹¸¹¹¹¹¹¹¹¹¶
gac
⋅qcgac = gab ⋅ gbc = [ RabRbc Rabpbc + pab
0 1 ]
gac
![Page 75: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/75.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.3 Rigid motion in ℝ3Chapter 2 Rigid Body Motion
31
◻ Special Euclidean Group:
SE(3) = {[ R p0 1 ] ∈ ℝ4×4∣ p ∈ ℝ3,R ∈ SO(3)}
![Page 76: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/76.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.3 Rigid motion in ℝ3Chapter 2 Rigid Body Motion
31
◻ Special Euclidean Group:
SE(3) = {[ R p0 1 ] ∈ ℝ4×4∣ p ∈ ℝ3,R ∈ SO(3)}
Property 4: SE(3) forms a group.
![Page 77: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/77.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.3 Rigid motion in ℝ3Chapter 2 Rigid Body Motion
31
◻ Special Euclidean Group:
SE(3) = {[ R p0 1 ] ∈ ℝ4×4∣ p ∈ ℝ3,R ∈ SO(3)}
Property 4: SE(3) forms a group.
Proof :
1 g1 ⋅ g2 ∈ SE(3)2 e = I43 (g)−1 = [ RT −RTp
0 1]
4 Associativity: Follows from property of matrix
multiplication
![Page 78: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/78.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.3 Rigid motion in ℝ3Chapter 2 Rigid Body Motion
32
§ Induced transformation on vectors:
v = s − r = [ v1v2v30] , g∗v = gs − gr = [ R p
0 1 ] [v1v2v30] = [ Rv
0 ]The bar will be dropped to simplify notations
Property 5: An element of SE(3) is a rigid transformation.
![Page 79: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/79.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.3 Rigid motion in ℝ3Chapter 2 Rigid Body Motion
33
Exponential coordinates of SE(3):For rotational motion:
p(t)=ω × (p(t) − q)[ p0]=[ ω −ω × q
0 0] [ p
1]
or p=ξ ⋅ p⇒ p(t) = eξtp(0)where eξt=I + ξt + (ξt)2
2!+⋯
Figure 2.13
ω
p(0) p(t)
p(t)
q
A
![Page 80: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/80.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.3 Rigid motion in ℝ3Chapter 2 Rigid Body Motion
33
Exponential coordinates of SE(3):For rotational motion:
p(t)=ω × (p(t) − q)[ p0]=[ ω −ω × q
0 0] [ p
1]
or p=ξ ⋅ p⇒ p(t) = eξtp(0)where eξt=I + ξt + (ξt)2
2!+⋯
Figure 2.13
ω
p(0) p(t)
p(t)
q
A
For translational motion:p(t)=v
[ p(t)0]=[ 0 v
0 0] [ p
1]
p(t)=ξ ⋅ p(t)⇒ p(t) = eξtp(0)ξ=[ 0 v
0 0]
p(0)p(t)
p(t)v
A
![Page 81: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/81.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.3 Rigid motion in ℝ3Chapter 2 Rigid Body Motion
34
Definition:se(3) = {[ ω v
0 0 ] ∈ ℝ4×4∣ v,ω ∈ ℝ3}is called the twist space. There exists a 1-1 correspondencebetween se(3) and ℝ
6, defined by ∧ ∶ ℝ6 ↦ se(3)ξ ∶= [ v
ω ]↦ ξ = [ ω v0 0 ]
![Page 82: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/82.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.3 Rigid motion in ℝ3Chapter 2 Rigid Body Motion
34
Definition:se(3) = {[ ω v
0 0 ] ∈ ℝ4×4∣ v,ω ∈ ℝ3}is called the twist space. There exists a 1-1 correspondencebetween se(3) and ℝ
6, defined by ∧ ∶ ℝ6 ↦ se(3)ξ ∶= [ v
ω ]↦ ξ = [ ω v0 0 ]
Property 6: exp ∶ se(3)↦ SE(3), ξθ ↦ eξθ
![Page 83: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/83.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.3 Rigid motion in ℝ3Chapter 2 Rigid Body Motion
34
Definition:se(3) = {[ ω v
0 0 ] ∈ ℝ4×4∣ v,ω ∈ ℝ3}is called the twist space. There exists a 1-1 correspondencebetween se(3) and ℝ
6, defined by ∧ ∶ ℝ6 ↦ se(3)ξ ∶= [ v
ω ]↦ ξ = [ ω v0 0 ]
Property 6: exp ∶ se(3)↦ SE(3), ξθ ↦ eξθ
Proof :Let ξ = [ ω v
0 0 ]If ω = 0, then ξ2 = ξ3 = ⋯ = 0, eξθ = [ I vθ
0 1 ] ∈ SE(3)(continues next slide)
![Page 84: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/84.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.3 Rigid motion in ℝ3Chapter 2 Rigid Body Motion
35
If ω is not 0, assume ∥ω∥ = 1.Define:
g0 = [ I ω × v0 1 ] , ξ′ = g−10 ⋅ ξ ⋅ g0 = [ ω hω
0 0 ]where h = ωT ⋅ v.
eξθ = eg−10 ⋅ξ′⋅g0 = g−10 ⋅ eξ′θ ⋅ g0and as
ξ′2 = [ ω2 00 0 ] , ξ′3 = [ ω3 0
0 0 ]we have
eξ′θ = [ eωθ hωθ
0 1]⇒ eξθ = [ eωθ (I − eωθ)ωv + ωωTvθ
0 1]
![Page 85: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/85.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.3 Rigid motion in ℝ3Chapter 2 Rigid Body Motion
36
p(θ) = eξθ ⋅ p(0)⇒ gab(θ) = eξθIf there is offset,
gab(θ) = eξθgab(0)(Why?)ω
θ
B
B′
Agab(0)
e ξθ
Figure 2.14
![Page 86: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/86.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.3 Rigid motion in ℝ3Chapter 2 Rigid Body Motion
37
Property 7: exp ∶ se(3) ↦ SE(3) is onto.
![Page 87: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/87.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.3 Rigid motion in ℝ3Chapter 2 Rigid Body Motion
37
Property 7: exp ∶ se(3) ↦ SE(3) is onto.Proof :
Let g = (p,R),R ∈ SO(3), p ∈ ℝ3
Case 1: (R = I) Letξ = [ 0
p∥p∥0 0
] , θ = ∥p∥⇒ eξθ = g = [ I p0 1 ]
![Page 88: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/88.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.3 Rigid motion in ℝ3Chapter 2 Rigid Body Motion
37
Property 7: exp ∶ se(3) ↦ SE(3) is onto.Proof :
Let g = (p,R),R ∈ SO(3), p ∈ ℝ3
Case 1: (R = I) Letξ = [ 0
p∥p∥0 0
] , θ = ∥p∥⇒ eξθ = g = [ I p0 1 ]
Case 2: (R ≠ I)eξθ = [ eωθ (I − eωθ)(ω × v) + ωωTvθ
0 1] = [ R p
0 1 ]⇒ { eωθ = R(I − eωθ)(ω × v) + ωωTvθ = p
Solve for ωθ from previous section. Let A = (I − eωθ)ω + wwTθ,Av = p. Claim:
A = (I − eωθ)ω +wwTθ ∶= A1 + A2
kerA1 ∩ kerA2 = ϕ⇒ v = A−1pξθ ∈ ℝ6: Exponential coordinates of g ∈ SE(3)
![Page 89: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/89.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.3 Rigid motion in ℝ3Chapter 2 Rigid Body Motion
38
◻ Screws, twists and screw motion:
Figure 2.15
x y
z
θ
ωq
p
d
Screw attributes Pitch: h = dθ (θ = 0, h =∞), d = h ⋅ θ
Axis: l = {q + λω∣λ ∈ ℝ}Magnitude: M = θ
![Page 90: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/90.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.3 Rigid motion in ℝ3Chapter 2 Rigid Body Motion
38
◻ Screws, twists and screw motion:
Figure 2.15
x y
z
θ
ωq
p
d
Screw attributes Pitch: h = dθ (θ = 0, h =∞), d = h ⋅ θ
Axis: l = {q + λω∣λ ∈ ℝ}Magnitude: M = θ
Definition:A screw S consists of an axis l, pitch h, and magnitude M. Ascrew motion is a rotation by θ =M about l, followed bytranslation by hθ, parallel to l. If h =∞, then, translationabout v by θ =M
![Page 91: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/91.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.3 Rigid motion in ℝ3Chapter 2 Rigid Body Motion
39
Corresponding g ∈ SE(3):g ⋅ p = q + eωθ(p − q) + hθωg ⋅ [ p
1 ] = [ eωθ (I − eωθ)q + hθω0 1
] [ p1 ]⇒
g = [ eωθ (I − eωθ)q + hθω0 1
]
![Page 92: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/92.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.3 Rigid motion in ℝ3Chapter 2 Rigid Body Motion
39
Corresponding g ∈ SE(3):g ⋅ p = q + eωθ(p − q) + hθωg ⋅ [ p
1 ] = [ eωθ (I − eωθ)q + hθω0 1
] [ p1 ]⇒
g = [ eωθ (I − eωθ)q + hθω0 1
]On the other hand...
eξθ = [ eωθ (I − eωθ)ω × v + ωωTvθ0 1
]If we let v = −ω × q + hω, then(I − eωθ)(−ω2q) = (I − eωθ)(−ωωTq + q) = (I − eωθ)qThus, eξθ = g
![Page 93: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/93.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.3 Rigid motion in ℝ3Chapter 2 Rigid Body Motion
39
Corresponding g ∈ SE(3):g ⋅ p = q + eωθ(p − q) + hθωg ⋅ [ p
1 ] = [ eωθ (I − eωθ)q + hθω0 1
] [ p1 ]⇒
g = [ eωθ (I − eωθ)q + hθω0 1
]On the other hand...
eξθ = [ eωθ (I − eωθ)ω × v + ωωTvθ0 1
]If we let v = −ω × q + hω, then(I − eωθ)(−ω2q) = (I − eωθ)(−ωωTq + q) = (I − eωθ)qThus, eξθ = g
For pure rotation (h = 0): ξ = (−ω × q,ω)For pure translation: g = [ I vθ
0 1 ], ⇒ ξ = (v, 0), and eξθ = g
![Page 94: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/94.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.3 Rigid motion in ℝ3Chapter 2 Rigid Body Motion
40
◻ Screw associated with a twist:ξ = (v,ω) ∈ ℝ6
1 Pitch: h =⎧⎪⎪⎪⎨⎪⎪⎪⎩
ωTv
∥ω∥2 , if ω ≠ 0∞, if ω = 0
2 Axis: l = ⎧⎪⎪⎨⎪⎪⎩ω × v∥ω∥2 + λω, λ ∈ ℝ, if ω ≠ 00 + λv λ ∈ ℝ, if ω = 0
3 Magnitude: M =⎧⎪⎪⎨⎪⎪⎩∥ω∥, if ω ≠ 0∥v∥, if ω = 0
![Page 95: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/95.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.3 Rigid motion in ℝ3Chapter 2 Rigid Body Motion
40
◻ Screw associated with a twist:ξ = (v,ω) ∈ ℝ6
1 Pitch: h =⎧⎪⎪⎪⎨⎪⎪⎪⎩
ωTv
∥ω∥2 , if ω ≠ 0∞, if ω = 0
2 Axis: l = ⎧⎪⎪⎨⎪⎪⎩ω × v∥ω∥2 + λω, λ ∈ ℝ, if ω ≠ 00 + λv λ ∈ ℝ, if ω = 0
3 Magnitude: M =⎧⎪⎪⎨⎪⎪⎩∥ω∥, if ω ≠ 0∥v∥, if ω = 0
Special cases:
1 h =∞, Pure translation (prismatic joint)
2 h = 0, Pure rotation (revolute joint)
![Page 96: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/96.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.3 Rigid motion in ℝ3Chapter 2 Rigid Body Motion
41
Screw Twist: ξθCase 1:Pitch: h =∞Axis: l = {q + λv∣∥v∥ = 1, λ ∈ ℝ}Magnitude:M
θ =M,
ξ = [ 0 v0 0 ]
Case 2:Pitch: h ≠∞Axis: l = {q + λω∣∥ω∥ = 1, λ ∈ ℝ}Magnitude:M
θ =M,
ξ = [ ω −ωq + hω0 0 ]
![Page 97: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/97.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.3 Rigid motion in ℝ3Chapter 2 Rigid Body Motion
41
Screw Twist: ξθCase 1:Pitch: h =∞Axis: l = {q + λv∣∥v∥ = 1, λ ∈ ℝ}Magnitude:M
θ =M,
ξ = [ 0 v0 0 ]
Case 2:Pitch: h ≠∞Axis: l = {q + λω∣∥ω∥ = 1, λ ∈ ℝ}Magnitude:M
θ =M,
ξ = [ ω −ωq + hω0 0 ]
Definition: Screw MotionRotation about an axis by θ =M, followed by translationabout the same axis by hθ
![Page 98: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/98.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.3 Rigid motion in ℝ3Chapter 2 Rigid Body Motion
42
1793–1880
Theorem 2 (Chasles):Every rigid body motion can be realized by a ro-tation about an axis combined with a translationparallel to that axis.
![Page 99: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/99.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.3 Rigid motion in ℝ3Chapter 2 Rigid Body Motion
42
1793–1880
Theorem 2 (Chasles):Every rigid body motion can be realized by a ro-tation about an axis combined with a translationparallel to that axis.
Proof :For ξ ∈ se(3):
ξ = ξ1 + ξ2 = [ ω −ω × q0 0 ] + [ 0 hω
0 0 ][ξ1 , ξ2] = 0⇒ eξθ = eξ1θeξ2θ
† End of Section †
![Page 100: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/100.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.4 Velocity of a Rigid BodyChapter 2 Rigid Body Motion
43
♢ Review: Point-mass velocity
q(t) ∈ ℝ3, t ∈ (−ε, ε), v = d
dtq(t) ∈ ℝ3, a = d2
dt2q(t) = d
dtv(t) ∈ ℝ3
![Page 101: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/101.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.4 Velocity of a Rigid BodyChapter 2 Rigid Body Motion
43
♢ Review: Point-mass velocity
q(t) ∈ ℝ3, t ∈ (−ε, ε), v = d
dtq(t) ∈ ℝ3, a = d2
dt2q(t) = d
dtv(t) ∈ ℝ3
◻ Velocity of Rotational Motion:Rab(t) ∈ SO(3), t ∈ (−ε, ε), qa(t) = Rab(t)qbVa = d
dtqa(t) = Rab(t)qb = Rab(t)RT
ab(t)Rab(t)qb = RabRTabqa
Rab(t)RTab(t) = I ⇒ RabR
Tab + RabR
Tab = 0, RabR
Tab = −(RabR
Tab)T
x y
z
p(t)
p(0) Figure 2.1
z
yabx
xaby
zab
q
o A:o − xyzB:o − xabyabzab Figure 2.3
![Page 102: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/102.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.4 Velocity of a Rigid BodyChapter 2 Rigid Body Motion
44
Denote spatial angular velocity by:
ωsab = RabR
Tab,ωab ∈ ℝ
3
ThenVa= ωs
ab ⋅ qa = ωsab × qa
Body angular velocity:
ωbab = R
Tab ⋅ Rab, v
b≜ RT
ab ⋅ va = ωbab × qb
Relation between body and spatial angular velocity:
ωbab = R
Tab ⋅ ωs
ab or ωbab = R
Tabω
sabRab
![Page 103: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/103.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.4 Velocity of a Rigid BodyChapter 2 Rigid Body Motion
45
◻ Generalized Velocity:
gab = [ Rab(t) pab(t)0 1 ] , qa(t) = gab(t)qb
d
dtqa(t) = gab(t)qb = gab ⋅ g−1ab ⋅ gab ⋅ qb = V s
ab ⋅ qa
![Page 104: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/104.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.4 Velocity of a Rigid BodyChapter 2 Rigid Body Motion
45
◻ Generalized Velocity:
gab = [ Rab(t) pab(t)0 1 ] , qa(t) = gab(t)qb
d
dtqa(t) = gab(t)qb = gab ⋅ g−1ab ⋅ gab ⋅ qb = V s
ab ⋅ qa
V sab = gab ⋅ g−1ab = [ Rab pab
0 0] [ RT
ab −RTabpab
0 1]
= [ RabRTab −RabRT
abpab + pab0 0
]= [ ωs
ab −ωsab × pab + pab
0 0] ≜ [ ωs
ab vsab0 0 ]
![Page 105: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/105.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.4 Velocity of a Rigid BodyChapter 2 Rigid Body Motion
46
◻ (Generalized) Spatial Velocity:
Vsab = [ vsab
wsab] = [ −ωs
ab × pab + pab(RabRTab)∨ ]
vqa = ωsab × qa + vsab
Note: vqb = g−1ab ⋅ vqa = g−1ab ⋅ gab ⋅ qb = Vbab ⋅ qb
![Page 106: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/106.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.4 Velocity of a Rigid BodyChapter 2 Rigid Body Motion
46
◻ (Generalized) Spatial Velocity:
Vsab = [ vsab
wsab] = [ −ωs
ab × pab + pab(RabRTab)∨ ]
vqa = ωsab × qa + vsab
Note: vqb = g−1ab ⋅ vqa = g−1ab ⋅ gab ⋅ qb = Vbab ⋅ qb
◻ (Generalized) Body Velocity:
Vbab = g−1ab gab = [ RT
abRab RTabpab
0 0] ≜ [ ωb
ab vbab0 0
]Vbab = [ vbab
ωbab
] = [ RTabpab(RTabRab)∨ ]
![Page 107: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/107.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.4 Velocity of a Rigid BodyChapter 2 Rigid Body Motion
47
◻ Relation between body and spatialvelocity:
Vsab = gab ⋅ g−1ab = gab ⋅ g−1ab ⋅ gab ⋅ g−1ab = gab ⋅ Vb
ab ⋅ g−1ab= [ Rab pab
0 1 ] [ ωbab vbab0 0
] [ RTab −RT
abpab0 1
]= [ Rab pab
0 1 ] [ ωbabR
Tab −ωb
abRTabpab + vbab
0 0]
= [ RabωbabR
Tab −Rabω
babR
Tabpab + Rabv
bab
0 0]
![Page 108: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/108.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.4 Velocity of a Rigid BodyChapter 2 Rigid Body Motion
47
◻ Relation between body and spatialvelocity:
Vsab = gab ⋅ g−1ab = gab ⋅ g−1ab ⋅ gab ⋅ g−1ab = gab ⋅ Vb
ab ⋅ g−1ab= [ Rab pab
0 1 ] [ ωbab vbab0 0
] [ RTab −RT
abpab0 1
]= [ Rab pab
0 1 ] [ ωbabR
Tab −ωb
abRTabpab + vbab
0 0]
= [ RabωbabR
Tab −Rabω
babR
Tabpab + Rabv
bab
0 0]
Vsab = [ vsab
ωsab] = [ Rab pabRab
0 Rab]
´¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¸¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¹¶Adg
Vbab
Adg = [ R pR0 R ] ∈ ℝ6×6, for g = (p,R)
![Page 109: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/109.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.4 Velocity of a Rigid BodyChapter 2 Rigid Body Motion
48
◻ Properties of Adjoint mapping:
g−1 = [ RT −RTp0 1
]⇒Adg−1 = [ RT (−RTp)∧RT
0 RT ]= [ RT −RT p
0 RT ] = (Adg)−1and Adg1 ⋅g2 = Adg1 ⋅ Adg2
![Page 110: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/110.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.4 Velocity of a Rigid BodyChapter 2 Rigid Body Motion
48
◻ Properties of Adjoint mapping:
g−1 = [ RT −RTp0 1
]⇒Adg−1 = [ RT (−RTp)∧RT
0 RT ]= [ RT −RT p
0 RT ] = (Adg)−1and Adg1 ⋅g2 = Adg1 ⋅ Adg2
The map Ad ∶ SE(3)↦ GL(ℝ6), Ad(g) = Adg is a grouphomomorphism
Matrix Rep Vector Repξ ∈ se(3) ξ ∈ ℝ6
g ⋅ ξ ⋅ g−1 ∈ se(3) Adg ξ ∈ ℝ6
![Page 111: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/111.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.4 Velocity of a Rigid BodyChapter 2 Rigid Body Motion
49
◇ Example: Velocity of Screw Motion
gab(θ) = eξθ(t)gab(0), ddteξθ(t) = ξθ(t)eξθ(t) = θ(t)eξθ(t) ξ
Vsab = gab ⋅ g−1ab = (ξθeξθ(t)gab(0)) ⋅ (g−1ab(0)e−ξθ(t))= ξθ ⇒ Vs
ab = ξθVbab = g−1ab ⋅ gab = g−1ab(0)e−ξθ ⋅ eξθ ξθgab(0)= g−1ab(0)ξθgab(0) = (Adg−1ab (0)ξ)∧θ ⇒ Vb
ab = Adg−1ab (0)ξθ
![Page 112: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/112.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.4 Velocity of a Rigid BodyChapter 2 Rigid Body Motion
50
◻ Metric Property of se(3):Let gi(t) ∈ SE(3), i = 1, 2, be representations of the same motion,obtained using coordinate frame A and B. Then,
g2(t) = g−10 ⋅ g1(t) ⋅ g0 ⇒ Vs2 = Adg−10
⋅Vs1
A B
g0
g1(t)
g2(t)
g0
Figure 2.2
(Continues next slide)
![Page 113: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/113.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.4 Velocity of a Rigid BodyChapter 2 Rigid Body Motion
51
∥V s2∥2 = (Adg0 ⋅V s
1)T(Adg0 ⋅V s1) = (V s
1)TAdTg0 ⋅Adg0 ⋅V s1
AdTg0 ⋅Adg0 = [ RT0 0
−RT0 p0 RT
0] [ R0 p0R0
0 R0]
= [ I RT0 p0R0−RT
0 p0R0 I − RT0 p
20R0]
In general, ∥V s2∥ ≠ ∥V s
1∥, or there exists no bi-invariantmetric on se(3).
![Page 114: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/114.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.4 Velocity of a Rigid BodyChapter 2 Rigid Body Motion
52
◻ Coordinate Transformation:
gac(t) = gab(t) ⋅ gbc(t) gab gbc
gacA
B
C
Figure 2.12Vsac = gac ⋅ g−1ac= (gab ⋅ gbc + gab ⋅ gbc)(g−1bc ⋅ g−1ab)= gab ⋅ g−1ab + gab ⋅ gbc ⋅ g−1bc ⋅ g−1ab = Vs
ab + gabVsbcg−1ab
⇒ Vsac = Vs
ab + AdgabVsbc
![Page 115: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/115.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.4 Velocity of a Rigid BodyChapter 2 Rigid Body Motion
52
◻ Coordinate Transformation:
gac(t) = gab(t) ⋅ gbc(t) gab gbc
gacA
B
C
Figure 2.12Vsac = gac ⋅ g−1ac= (gab ⋅ gbc + gab ⋅ gbc)(g−1bc ⋅ g−1ab)= gab ⋅ g−1ab + gab ⋅ gbc ⋅ g−1bc ⋅ g−1ab = Vs
ab + gabVsbcg−1ab
⇒ Vsac = Vs
ab + AdgabVsbc
Similarly: Vbac = Adg−1bc
Vbab +Vb
bc
Note: Vsbc = 0⇒ Vs
ac = Vsab, V
bab = 0⇒ Vb
ac = Vbbc
![Page 116: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/116.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.4 Velocity of a Rigid BodyChapter 2 Rigid Body Motion
53
◇ Example:
gab(θ1) =⎡⎢⎢⎢⎢⎢⎣cθ1 −sθ1 0 0sθ1 cθ1 0 00 0 1 l00 0 0 1
⎤⎥⎥⎥⎥⎥⎦B
A
l0
l1
C
θ2
θ1
l2
Figure 2.17
gbc(θ2) =⎡⎢⎢⎢⎢⎢⎣
cθ2 −sθ2 0 0sθ2 cθ2 0 l10 0 1 l20 0 0 1
⎤⎥⎥⎥⎥⎥⎦
, Vsab =⎡⎢⎢⎢⎢⎢⎢⎢⎣
000001
⎤⎥⎥⎥⎥⎥⎥⎥⎦
θ1, Vsbc =⎡⎢⎢⎢⎢⎢⎢⎢⎣
l100001
⎤⎥⎥⎥⎥⎥⎥⎥⎦
θ2
Vsac = Vs
ab + Adgab ⋅Vsbc =⎡⎢⎢⎢⎢⎢⎢⎢⎣
000001
⎤⎥⎥⎥⎥⎥⎥⎥⎦
θ1 +⎡⎢⎢⎢⎢⎢⎢⎢⎢⎣
l1cθ1l1sθ10001
⎤⎥⎥⎥⎥⎥⎥⎥⎥⎦
θ2
† End of Section †
![Page 117: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/117.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.5 Wrenches & Reciprocal ScrewsChapter 2 Rigid Body Motion
54
◻ Wrenches:Let Fc = [ fc
τc] ∈ ℝ
6,
fc, τc ∈ ℝ3 be force or mo-ment applied at the originof C
A
BC
Fc
Figure 2.18
![Page 118: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/118.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.5 Wrenches & Reciprocal ScrewsChapter 2 Rigid Body Motion
54
◻ Wrenches:Let Fc = [ fc
τc] ∈ ℝ
6,
fc, τc ∈ ℝ3 be force or mo-ment applied at the originof C
A
BC
Fc
Figure 2.18
Generalized power: δW = Fc ⋅Vbac = ⟨fc, vbac⟩ + ⟨τc ,ωb
ac⟩
![Page 119: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/119.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.5 Wrenches & Reciprocal ScrewsChapter 2 Rigid Body Motion
54
◻ Wrenches:Let Fc = [ fc
τc] ∈ ℝ
6,
fc, τc ∈ ℝ3 be force or mo-ment applied at the originof C
A
BC
Fc
Figure 2.18
Generalized power: δW = Fc ⋅Vbac = ⟨fc, vbac⟩ + ⟨τc ,ωb
ac⟩Work: W = ∫ t2
t1Vbac ⋅ Fcdt
Vbab ⋅ Fb = (Adgbc ⋅Vb
ac)T ⋅ Fb= (Vb
ac)TAdTgbc ⋅ Fb = (Vbac)T ⋅ Fc ,∀Vb
ac
⇒ Fc = AdTgbc ⋅ Fb(Continues next slide)
![Page 120: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/120.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.5 Wrenches & Reciprocal ScrewsChapter 2 Rigid Body Motion
55
AB
g0
Vb1 F1
Vb2 F2
Adg0
Ad∗g−10
Figure 2.19
V s2 = Adg−10 ⋅V s
1
(Vb2 = Adg−10 ⋅Vb
1 )⇒ Vb
1 = Adg0 ⋅Vb2
F2 = Ad∗g0F1
![Page 121: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/121.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.5 Wrenches & Reciprocal ScrewsChapter 2 Rigid Body Motion
56
◻ Screw coordinates for a wrench:
S: l: {q + λω∣λ ∈ ℝ}h: pitchM: Magnitude∥f ∥ =M, ∥τ∥ = hMIf h =∞, Pure τ, ∥τ∥ =M
A
qω
f
τ
Figure 2.20Associate with S a wrench:
F =⎧⎪⎪⎪⎪⎪⎪⎪⎪⎨⎪⎪⎪⎪⎪⎪⎪⎪⎩
M
⎡⎢⎢⎢⎢⎣ω−ω × q + hω
⎤⎥⎥⎥⎥⎦ h ≠∞M
⎡⎢⎢⎢⎢⎣
0
ω
⎤⎥⎥⎥⎥⎦
h =∞
![Page 122: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/122.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.5 Wrenches & Reciprocal ScrewsChapter 2 Rigid Body Motion
57
Also, given F = [ fτ ] (What a force/torque sensor at A
measures), construct S as follows:
⎧⎪⎪⎪⎪⎪⎪⎪⎨⎪⎪⎪⎪⎪⎪⎪⎩
Case 1: (f = 0, pure torque)M = ∥τ∥,ω = τ
M , h =∞Case 2: (f ≠ 0)
M = ∥f ∥,ω = fM
![Page 123: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/123.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.5 Wrenches & Reciprocal ScrewsChapter 2 Rigid Body Motion
57
Also, given F = [ fτ ] (What a force/torque sensor at A
measures), construct S as follows:
⎧⎪⎪⎪⎪⎪⎪⎪⎨⎪⎪⎪⎪⎪⎪⎪⎩
Case 1: (f = 0, pure torque)M = ∥τ∥,ω = τ
M , h =∞Case 2: (f ≠ 0)
M = ∥f ∥,ω = fM
Solve for q, h from M(q × ω + hω) = τ⇒ h = f Tτ
∥f ∥2 , q =f × τ∥f ∥2
F = [ fτ ]⇔ Apply a force f of mag. M along l,
and a torque τ of mag. hM about l
![Page 124: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/124.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.5 Wrenches & Reciprocal ScrewsChapter 2 Rigid Body Motion
58
1777-1859
Theorem 3 (Poinsot):Every collection of wrenches applied to a rigid bodyis equivalent to a force applied along a fixed axisplus a torque about the axis.
![Page 125: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/125.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.5 Wrenches & Reciprocal ScrewsChapter 2 Rigid Body Motion
58
1777-1859
Theorem 3 (Poinsot):Every collection of wrenches applied to a rigid bodyis equivalent to a force applied along a fixed axisplus a torque about the axis.
◻ Multi-fingered grasp:
Fo = k∑i=1
AdTg−1oci⋅ Fci Ci CjO
Si SjP
Figure 2.21
![Page 126: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/126.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.5 Wrenches & Reciprocal ScrewsChapter 2 Rigid Body Motion
59
◻ Reciprocal screws:
V = [ vω ] , F = [ f
τ ]F ⋅V = f T ⋅ v + τT ⋅ ω↓ ↓
S2 S1
ω2
S1
q1
d
q2
S2
ω1
α
Figure 2.22α = atan2((ω1 × ω2) ⋅ n,ω1 ⋅ ω2)
S1 ⊙ S2 =M1M2((h1 + h2) cos α − d sin α)= 0 if reciprocal
(continues next slide)
![Page 127: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/127.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.5 Wrenches & Reciprocal ScrewsChapter 2 Rigid Body Motion
60
Given V =M1 [ q1 × ω1 + h1ω1ω1
] , F =M2 [ ω2q2 × ω2 + h2ω2
] ,Let q2 = q1 + dn, thenV ⋅ F =M1M2(ω2 ⋅ (q1 × ω1 + h1ω1) + ω1 ⋅ (q2 × ω2 + h2ω2))
=M1M2(ω2 ⋅ (q1 × ω1) + h1ω1 ⋅ ω2
+ ω1 ⋅ ((q1 + dn) × ω2) + h2ω1 ⋅ ω2)=M1M2((h1 + h2) cos α − d sinα)
![Page 128: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/128.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.5 Wrenches & Reciprocal ScrewsChapter 2 Rigid Body Motion
61
◇ Example: Basic joints
Revolute
ω1(v1) ω2(v2)
ω(ω3)
q
Figure 2.23
● Revolute joint: ξ = [ −ω × qω ]ξ⊥ = span{[ ωiq × ωi
] , [ 0vj ]∣ ωi ∈ S2, i = 1, 2, 3
vj ⋅ ω = 0, j = 1, 2 }: 5-system
![Page 129: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/129.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.5 Wrenches & Reciprocal ScrewsChapter 2 Rigid Body Motion
61
◇ Example: Basic joints
Revolute
ω1(v1) ω2(v2)
ω(ω3)
q
Figure 2.23
● Revolute joint: ξ = [ −ω × qω ]ξ⊥ = span{[ ωiq × ωi
] , [ 0vj ]∣ ωi ∈ S2, i = 1, 2, 3
vj ⋅ ω = 0, j = 1, 2 }: 5-system
● Prismatic joint: ξ = [ v0 ]ξ⊥ = span{[ ωiq × ωi
] , [ 0vj ]∣ ωi ⋅ v = 0, i = 1, 2
vj ∈ S2, j = 1, 2, 3 }: 5-systemPrismatic
ω1(v1) ω2(v2)
v(v3)
q
Figure 2.24
![Page 130: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/130.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.5 Wrenches & Reciprocal ScrewsChapter 2 Rigid Body Motion
62
◇ Example: Basic joints (continued)
Spherical
ω1 ω2
ω3
q
Figure 2.25
● Spherical joint: ξ = span{[ −ωi × qωi
]∣ωi ∈ S2, i = 1, 2, 3}ξ⊥ = span{[ ωiq × ωi
]∣ωi ∈ S2, i = 1, 2, 3}: 3-system
![Page 131: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/131.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.5 Wrenches & Reciprocal ScrewsChapter 2 Rigid Body Motion
62
◇ Example: Basic joints (continued)
Spherical
ω1 ω2
ω3
q
Figure 2.25
● Spherical joint: ξ = span{[ −ωi × qωi
]∣ωi ∈ S2, i = 1, 2, 3}ξ⊥ = span{[ ωiq × ωi
]∣ωi ∈ S2, i = 1, 2, 3}: 3-system
● Universal joint: ξ = span{[ q × xx ] , [ q × yy ]}ξ⊥ = span{[ ωiq × ωi
] , [ 0z ]∣ωi ∈ S2, i = 1, 2, 3}: 4-systemUniversal
x(ω1) y(ω2)
z(ω3)
q
Figure 2.26
![Page 132: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/132.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.5 Wrenches & Reciprocal ScrewsChapter 2 Rigid Body Motion
63◇ Example: Kinematic chains
x(ω1) y(ω2)
v(ω3)
q1
q2
Figure 2.27
● Universal-Spherical Dyad:ξ = span {[ q1 × x
x ] , [ q1 × yy ] [ q2 × ωi
ωi]∣ωi ∈ S2 , i = 1, 2, 3}
ξ⊥ = span{[ vq1 × v ]∣ v = q2−q1∥q2−q1∥}
![Page 133: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/133.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.5 Wrenches & Reciprocal ScrewsChapter 2 Rigid Body Motion
63◇ Example: Kinematic chains
x(ω1) y(ω2)
v(ω3)
q1
q2
Figure 2.27
● Universal-Spherical Dyad:ξ = span {[ q1 × x
x ] , [ q1 × yy ] [ q2 × ωi
ωi]∣ωi ∈ S2 , i = 1, 2, 3}
ξ⊥ = span{[ vq1 × v ]∣ v = q2−q1∥q2−q1∥}● Revolute-Spherical Dyad:
zero pitch screws passing through the center of the sphere, lieon a plane containing the axis of the revolute joint: 2-system
Figure 2.28† End of Section †
![Page 134: [Download] Rev-Chapter-2](https://reader034.fdocuments.net/reader034/viewer/2022052412/558136ccd8b42a68488b5229/html5/thumbnails/134.jpg)
Chapter2 Rigid BodyMotion
Rigid BodyTransforma-tions
Rotationalmotion in ℝ
3
Rigid Motion
in ℝ3
Velocity of aRigid Body
Wrenches andReciprocalScrews
Reference
2.6 ReferencesChapter 2 Rigid Body Motion
64
◻ Reference:[1] Murray, R.M. and Li, Z.X. and Sastry, S.S., A mathematical introduction to robotic manipu-lation. CRC Press, 1994.[2] Ball, R.S., A treatise on the theory of screws. University Press, 1900.[3] Bottema, O. and Roth, B. , Theoretical kinematics. Dover Publications, 1990.[4] Craig, J.J., Introduction to robotics : mechanics and control, 3rd ed. Prentice Hall, 2004.[5] Fu, K.S. and Gonzalez, R.C. and Lee, C.S.G., Robotics : control, sensing, vision, and intelli-gence. CAD/CAM, robotics, and computer vision. McGraw-Hill, 1987.[6] Hunt, K.H., Kinematic geometry of mechanisms. 1978, Oxford, New York: Clarendon Press,1978.[7] Paul, R.P., Robot manipulators : mathematics, programming, and control. The MIT Pressseries in artificial intelligence. MIT Press, 1981.[8] Park, F. C., A first course in robot mechanics. Available online:http://robotics.snu.ac.kr/files/_pdf_files_publications/a_first_coruse_in_robot_mechanics.pdf ,2006.[9] Tsai, L.-W., Robot analysis : the mechanics of serial and parallel manipulators. Wiley, 1999.[10] Spong, M.W. and Hutchinson, S. and Vidyasagar, M. , Robot modeling and control. JohnWiley & Sons, 2006.