Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes...
Transcript of Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes...
![Page 1: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/1.jpg)
Rigid body dynamics
![Page 2: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/2.jpg)
Rigid body simulation
Once we consider an object with spatial extent, particle system simulation is no longer sufficient
![Page 3: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/3.jpg)
Rigid body simulation
• Unconstrained system
• no contact
• Constrained system
• collision and contact
![Page 4: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/4.jpg)
Problems
Performance is important!
![Page 5: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/5.jpg)
Problems
Control is difficult!
![Page 6: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/6.jpg)
Particle simulation
Y(t) =
!
x(t)v(t)
"
Position in phase space
Y(t) =
!
v(t)f(t)/m
"
Velocity in phase space
![Page 7: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/7.jpg)
Rigid body concepts
PositionLinear velocity
MassLinear momentum
Force
OrientationAngular velocityInertia tensor
Angular momentumTorque
Translation Rotation
![Page 8: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/8.jpg)
• Position and orientation
• Linear and angular velocity
• Mass and Inertia
• Force and torques
• Simulation
![Page 9: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/9.jpg)
Position and orientationTranslation of the body
x(t) =
!
"
x
y
z
#
$
Rotation of the body
R(t) =
!
"
rxx ryx rzx
rxy ryy rzy
rxz ryz rzz
#
$
and are called spatial variables of a rigid bodyx(t) R(t)
![Page 10: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/10.jpg)
Body spaceBody space
x0
y0
r0i
z0
A fixed and unchanged space where the shape of a rigid body is defined
The geometric center of the rigid body lies at the origin of the body space
![Page 11: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/11.jpg)
x0
y0
z0
r0i
Position and orientationWorld spaceBody space
x
y
z
x0
y0
r0i
z0
x(t)
R(t)
![Page 12: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/12.jpg)
What’s the world coordinate of an arbitrary point r0i on the body?
Position and orientation
Use x(t) and R(t) to transform the body space into world space
ri(t) = x(t) + R(t)r0i
x0
y0
z0
r0i
World space
x
y
z
x(t)
R(t)
![Page 13: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/13.jpg)
Position and orientation
• Assume the rigid body has uniform density, what is the physical meaning of x(t)?
• center of mass over time
• What is the physical meaning of R(t)?
• it’s a bit tricky
![Page 14: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/14.jpg)
Position and orientationConsider the x-axis in body space, (1, 0, 0), what is the direction of this vector in world space at time t?
R(t)
!
"
100
#
$ =
!
"
rxx
rxy
rxz
#
$
which is the first column of R(t)
R(t) represents the directions of x, y, and z axes of the body space in world space at time t
![Page 15: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/15.jpg)
Position and orientation
• So x(t) and R(t) define the position and the orientation of the body at time t
• Next we need to define how the position and orientation change over time
![Page 16: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/16.jpg)
• Position and orientation
• Linear and angular velocity
• Mass and Inertia
• Force and torques
• Simulation
![Page 17: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/17.jpg)
Linear velocity
v(t) = x(t)
Since is the position of the center of mass in world space, is the velocity of the center of mass in world space
x(t)
x(t)
![Page 18: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/18.jpg)
Angular velocity
• If we freeze the position of the COM in space
• then any movement is due to the body spinning about some axis that passes through the COM
• Otherwise, the COM would itself be moving
![Page 19: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/19.jpg)
Angular velocity
Direction of ?!(t)
Magnitude of ? |!(t)|
We describe that spin as a vector !(t)
Linear position and velocity are related by v(t) =d
dtx(t)
How are angular position (orientation) and velocity related?
![Page 20: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/20.jpg)
Angular velocityHow are and related?R(t) !(t)
Hint:
a
b
= |!(t) ! b|
= !(t) ! b + !(t) ! ac
ω(t)
c
Consider a vector at time t specified in world space, how do we represent in terms of !(t)
c(t)
c(t)
|c(t)| = |b||!(t)|
c(t) = !(t) ! b
c(t) = !(t) ! c(t)
![Page 21: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/21.jpg)
Angular velocityGiven the physical meaning of , what does each column of mean?
R(t)
R(t)
At time t, the direction of x-axis of the rigid body in world space is the first column of
!
"
rxx
rxy
rxz
#
$
R(t)
At time t, what is the derivative of the first column of ?R(t) ˙2
4rxx
rxy
rxz
3
5 = !(t)⇥
2
4rxx
rxy
rxz
3
5
![Page 22: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/22.jpg)
Angular velocity
R(t) =
!
" !(t) !
#
$
rxx
rxy
rxz
%
& !(t) !
#
$
ryx
ryy
ryz
%
& !(t) !
#
$
rzx
rzy
rzz
%
&
'
(
This is the relation between angular velocity and the orientation, but it is too cumbersome
We can use a trick to simplify this expression
![Page 23: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/23.jpg)
Angular velocityConsider two 3 by 1 vectors: a and b, the cross product of them is
a ! b =
!
"
aybz " byaz
"axbz + bxaz
axby " bxay
#
$
Given a, let’s define a* to be a skew symmetric matrix !
"
0 !az ay
az 0 !ax
!ay ax 0
#
$
then a!b =
!
"
0 !az ay
az 0 !ax
!ay ax 0
#
$
!
"
bx
by
bz
#
$ = a " b
![Page 24: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/24.jpg)
Angular velocity
R(t) =
!
" !(t)!
#
$
rxx
rxy
rxz
%
& !(t)!
#
$
ryx
ryy
ryz
%
& !(t)!
#
$
rzx
rzy
rzz
%
&
'
(
= !(t)!R(t)
R = !(t)!R(t)Matrix relation:
R(t) =
!
" !(t) !
#
$
rxx
rxy
rxz
%
& !(t) !
#
$
ryx
ryy
ryz
%
& !(t) !
#
$
rzx
rzy
rzz
%
&
'
(
Vector relation: c(t) = !(t) ! c(t)
![Page 25: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/25.jpg)
• Imagine a rigid body is composed of a large number of small particles
• the particles are indexed from 1 to N
• each particle has a constant location r0i in body space
• the location of i-th particle in world space at time t is
Perspective of particles
ri(t) = x(t) + R(t)r0i
![Page 26: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/26.jpg)
angular component linear component
Velocity of a particle
= !!(R(t)r0i + x(t) ! x(t)) + v(t)
r(t) =d
dtr(t) = !
!R(t)r0i + v(t)
= !!(ri(t) ! x(t)) + v(t)
ri(t) = ! ! (ri(t) " x(t)) + v(t)
![Page 27: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/27.jpg)
Velocity of a particle
ri(t) = ! ! (ri(t) " x(t)) + v(t)
!(t) ! (ri(t) " x(t))
v(t)
v(t)
ri(t)
x
y
z
ri (t)
x0
y0
z0
x(t)
!(t)
![Page 28: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/28.jpg)
• Position and orientation
• Linear and angular velocity
• Mass and Inertia
• Force and torques
• Simulation
![Page 29: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/29.jpg)
Mass
Center of mass in world space!
miri(t)
M
M =
N!
i=1
miMass
The mass of the i-th particle is mi
What about center of mass in body space? (0, 0, 0)
![Page 30: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/30.jpg)
Center of massProof that the center of mass at time t in word space is x(t)
!miri(t)
M=
= x(t)
![Page 31: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/31.jpg)
Inertia tensorInertia tensor describes how the mass of a rigid body is distributed relative to the center of mass
I(t) depends on the orientation of a body, but not the translation
For an actual implementation, we replace the finite sum with the integrals over a body’s volume in world space
r!
i = ri(t) ! x(t)
I =X
i
2
64m
i
(r02iy
+ r02iz
) �mi
r0ix
r0iy
�mi
r0ix
r0iz
�mi
r0iy
r0ix
mi
(r02ix
+ r02iz
) �mi
r0iy
r0iz
�mi
r0iz
r0ix
�mi
r0iz
r0iy
mi
(r02ix
+ r02iy
)
3
75
![Page 32: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/32.jpg)
Inertia tensor
• Inertia tensors vary in world space over time
• But are constant in the body space
• Pre-compute the integral part in the body space to save time
![Page 33: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/33.jpg)
Inertia tensor
I(t) = R(t)IbodyR(t)TIbody =
!
i
mi((rT0ir0i)1 ! r0ir
T0i)
Pre-compute Ibody that does not vary over time
I(t) =!
mi(r!T
i r!
i)1 ! r!
ir!T
i )
=!
mi((R(t)r0i)T (R(t)r0i)1 ! (R(t)r0i)(R(t)r0i)
T )
=!
mi(R(t)(rT
0ir0i)R(t)T1 ! R(t)r0ir
T
0iR(t)T )
= R(t)!
"
mi((rT
0ir0i)1 ! r0irT
0i)#
R(t)T
I(t) =X
mi
r0Ti
r0i
2
41 0 00 1 00 0 1
3
5�
2
4m
i
r02ix
mi
r0ix
r0iy
mi
r0ix
r0iz
mi
r0iy
r0ix
mi
r02iy
mi
r0iy
r0iz
mi
r0iz
r0ix
mi
r0iz
r0iy
mi
r02iz
3
5
![Page 34: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/34.jpg)
Inertia tensor
I(t) = R(t)IbodyR(t)TIbody =
!
i
mi((rT0ir0i)1 ! r0ir
T0i)
Pre-compute Ibody that does not vary over time
I(t) =!
mi(r!T
i r!
i)1 ! r!
ir!T
i )
=!
mi((R(t)r0i)T (R(t)r0i)1 ! (R(t)r0i)(R(t)r0i)
T )
=!
mi(R(t)(rT
0ir0i)R(t)T1 ! R(t)r0ir
T
0iR(t)T )
= R(t)!
"
mi((rT
0ir0i)1 ! r0irT
0i)#
R(t)T
I(t) =X
mi
r0Ti
r0i
2
41 0 00 1 00 0 1
3
5�
2
4m
i
r02ix
mi
r0ix
r0iy
mi
r0ix
r0iz
mi
r0iy
r0ix
mi
r02iy
mi
r0iy
r0iz
mi
r0iz
r0ix
mi
r0iz
r0iy
mi
r02iz
3
5
![Page 35: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/35.jpg)
Approximate inertia tensor
• Bounding boxes
• Pros: simple
• Cons: inaccurate
![Page 36: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/36.jpg)
Approximate inertia tensor
• Point sampling
• Pros: simple, fairly accurate
• Cons: expensive, requires volume test
![Page 37: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/37.jpg)
Approximate inertia tensor
• Green’s theorem
• Pros: simple, exact
• Cons: require boundary representation
!!D
F · ds =
! !D
(!" F) · da
![Page 38: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/38.jpg)
• Position and orientation
• Linear and angular velocity
• Mass and Inertia
• Force and torques
• Simulation
![Page 39: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/39.jpg)
Force and torqueFi(t) denotes the total force from external forces acting on the i-th particle at time t
F(t) =!
i
Fi(t) ri (t)
x0
y0
z0
x(t) Fi(t)
x
y
z
!(t) =!
i
(ri(t) ! x(t)) " Fi(t)
!(t) = (ri(t) ! x(t)) " Fi(t)
![Page 40: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/40.jpg)
Force and torque
•F(t) conveys no information about where the various forces acted on the body
•!(t) contains the information about the distribution of the forces over the body
•Which one depends on the location of the particle relative to the center of mass?
![Page 41: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/41.jpg)
Linear momentum
P(t) =!
i
miri(t)
=!
i
miv(t) + !(t) !!
i
mi(ri(t) " x(t))
= Mv(t)
Total linear moment of the rigid body is the same as if the body was simply a particle with mass M and velocity v(t)
![Page 42: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/42.jpg)
Similar to linear momentum, angular momentum is defined as
Angular momentum
L(t) = I(t)!(t)
Does L(t) depend on the translational effect x(t)?Does L(t) depend on the rotational effect R(t)?What about P(t)?
![Page 43: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/43.jpg)
Derivative of momentum
P(t) = M v(t) = F(t)
L(t) = !(t)
Change in linear momentum is equivalent to the total forces acting on the rigid body
The relation between angular momentum and the total torque is analogous to the linear case
![Page 44: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/44.jpg)
Derivative of momentumProof L(t) = !(t) =
!r!
i ! Fi
!
!
"
mir!"
i r!"
i
#
! !
!
"
mir!"
i r!"
i
#
! = "
!r!"
i mi(v ! r!"
i ! ! r!"
i !) !!
r!"
i Fi = 0
miri ! Fi = mi(v ! r!"
i ! ! r!"
i !) ! Fi = 0
!!mir
!"
i r!"
i =!
mi((r!T
i r!
i)1 ! r!
ir!T
i ) = I(t)
!
!
"
mir!"
i r!"
i
#
! + I(t)! = "
I(t) =d
dt
!!mir
!"
i r!"
i =!
!mir!"
i r!"
i ! mir!"
i r!"
i
I(t)! + I(t)! =d
dt(I(t)!) = L(t) = "
![Page 45: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/45.jpg)
• Position and orientation
• Linear and angular velocity
• Mass and Inertia
• Force and torques
• Simulation
![Page 46: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/46.jpg)
Equation of motion
Y(t) =
!
"
"
#
x(t)R(t)P(t)L(t)
$
%
%
&
v(t) =P(t)
M
I(t) = R(t)IbodyR(t)T
!(t) = I(t)!1L(t)
d
dtY(t) =
!
"
"
#
v(t)!(t)!R(t)
F(t)"(t)
$
%
%
&
Constants: M and Ibody
positionorientationlinear momentumangular momentum
![Page 47: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/47.jpg)
Momentum vs. velocity
• Why do we use momentum in the phase space instead of velocity?
• Because the relation of angular momentum and torque is simple
• Because the angular momentum is constant when there is no torques acting on the object
• Use linear momentum P(t) to be consistent with angular velocity and acceleration
![Page 48: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/48.jpg)
Example:1. compute the Ibody in body space
!
x0
2,y0
2,!
z0
2
"
!
!
x0
2,!
y0
2,z0
2
"
x
y
z
Ibody =M
12
!
"
y20 + z2
0 0 0
0 x20 + z2
0 0
0 0 x20 + y2
0
#
$
![Page 49: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/49.jpg)
Example:
x
y
z
1. compute the Ibody in body space
2. rotation free movement
(!3, 0, 2)
F
(3, 0, 2)
F
![Page 50: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/50.jpg)
Example:
x
y
z
1. compute the Ibody in body space
2. rotation free movement
3. translation free movement
(!3, 0, 2)
F
(3, 0, 2)
F
![Page 51: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/51.jpg)
Force vs. torque puzzle
energy = 0
F
10 sec later
energy = 0
F F
energy = 1
2Mv
Tv
Suppose a force F acts on the block at the center of mass for 10 seconds. Since there is no torque acting on the block, the body will only acquire linear velocity v after 10 seconds. The kinetic energy will be 1
2Mv
Tv
Now, consider the same force acting off-center to the body for 10 seconds. Since it is the same force, the velocity of the center of mass after 10 seconds is the same v. However, the block will also pick up some angular velocity ω. The kinetic energy will be 1
2Mv
Tv +
1
2!
TI!
If identical forces push the block in both cases, how can the energy of the block be different?
![Page 52: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/52.jpg)
Notes on implementation
• Using quaternion instead of transformation matrix
• more compact representation
• less numerical drift
![Page 53: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/53.jpg)
Quaternion
q(t) =
2
664
w
x
y
z
3
775 q(t) =12
0
!(t)
�q(t)
quaternion multiplication
![Page 54: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/54.jpg)
Equation of motion
v(t) =P(t)
M
I(t) = R(t)IbodyR(t)T
!(t) = I(t)!1L(t)
Constants: M and Ibody
positionorientationlinear momentumangular momentum
Y(t) =
2
664
x(t)q(t)P(t)L(t)
3
775d
dtY(t) =
2
66664
v(t)12
0
!(t)
�q(t)
F(t)⌧(t)
3
77775
![Page 55: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/55.jpg)
ExerciseConsider a 3D sphere with radius 1m, mass 1kg, and inertia Ibody. The initial linear and angular velocity are both zero. The initial position and the initial orientation are x0 and R0. The forces applied on the sphere include gravity (g) and an initial push F applied at point p. Note that F is only applied for one time step at t0. If we use Explicit Euler method with time step h to integrate , what are the position and the orientation of the sphere at t2? Use the actual numbers defined as below to compute your solution (except for g and h).
![Page 56: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/56.jpg)
What’s next?
![Page 57: Rigid body dynamics - Georgia Institute of Technology · Inertia tensor Inertia tensor describes how the mass of a rigid body is distributed relative to the center of mass I(t) depends](https://reader031.fdocuments.in/reader031/viewer/2022040901/5e72bdde8fc1901d454f8d7d/html5/thumbnails/57.jpg)
• Collision, collision, collision
• Read: Unconstrained rigid body dynamics by Baraff and Witkin