amr hutter s02 kinbasic
TRANSCRIPT
ASL Autonomous Systems Lab
1
Kinematics | Basics of Rigid Body Kinematics
Autonomous Mobile Robots
Marco Hutter
Margarita Chli, Paul Furgale, Martin Rufli, Davide Scaramuzza, Roland Siegwart
ASL Autonomous Systems Lab
Definition of kinematics
“Description of the motion of points, bodies, or systems of bodies”
… without consideration of the causes of motion (=> dynamics)
Required for kinematic simulation and control
Types of motion of single bodies
Translation
Rotation
Combined motion
2
Introduction
ASL Autonomous Systems Lab
Reference frames
Coordinate system I (inertial, not moving)
Coordinate system B (body-fixed, moving)
Translation
Vector from O to P, expressed in I:
Rotation
Matrix from frame B to frame I:
Homogeneous transformation
Combination of translation and rotation
3
Vectors and coordinate transformation
I OP I OB I BP r r r1 0 1 1
I OP IB I OB B BP
r R r rI OB IB B BP r R r
3 1
I OP
r
3 3
IB
R
ASL Autonomous Systems Lab
Rotation from frame B to I such that
Inversion
Composition of rotations
4
Rotation
, C CI I CI CB BI r R r R R R
, , T
I IB B B BI I BI IB r R r r R r R ROrientation in 3D
Euler angles (z-x-z)
Tait-Bryan/Cardan angles (z-y-x)
cos sin 0
sin cos 0
0 0 1
IB
R
I IB Br R r
ASL Autonomous Systems Lab
Reference frames
Coordinate system I (inertial, not moving)
Coordinate system B (body-fixed, moving)
Translation
vector from O to P, expressed in I:
Rotation
matrix from frame B to frame I:
Homogeneous transformation
Combination of translation and rotation
5
Vectors and coordinate transformation
3 1
I P I OP
v r
3 1
I IB
ω
I P I OP I OB I IB I BP v r r ω r
3 1
I OP
r
3 3
IB
R
ASL Autonomous Systems Lab
Angular velocity of frame B with respect to I expressed in I
Relation to rotation matrix
Transformation
Consecutive rotations
6
Angular velocity
I IC I IB I BC ω ω ω
0
0I IB
ω
I IB IB B IBω R ω
0
ˆ ˆ, 0 ,
0
z y x
IB IB IB
T z x y
I IB IB IB IB IB IB IB IB
y x z
IB IB IB
ω R R ω ω
ASL Autonomous Systems Lab
Position and velocity in different frames
Inertial frame
Moving frame
Example: single pendulum,
7
Vector differentiation
II I
d
dt
rr r
BB B IB BB
d
dt
rr r ω r
sin
cos
0
I OP
l
l
r
0 0 0
0 0 0
0 0 0
B OP
B P B IB B OP
ld
ldt
rv ω r
?B P v
cos
sin
0
I OP
I P
ld
ldt
rv
cos sin 0 cos
sin cos 0 sin 0
0 0 1 0 0
B P BI I P
l l
l
v R v
0
0
B OP l
r
ASL Autonomous Systems Lab
We learned the basics for describing the motion
Translations
Rotations
Homogeneous transformation
Anglar velocities
Differentiation of (position) vectors
8
Recapitulation
1 1I OP I OB I BP r r r
1 1B OP BI I BPr R r
1 1
0 11 1
I OP B BPIB I OB
r rR r
BB B IB BB
d
dt
rr r ω r
I IC I IB I BC ω ω ω