rigid body motionchenx/notes/rgb.pdf · columns of 𝑄are called principle axes. the rigid body...

35
Rigid Body Rotation Speaker: Xiaolei Chen Advisor: Prof. Xiaolin Li Department of Applied Mathematics and Statistics Stony Brook University (SUNY)

Upload: others

Post on 09-Aug-2020

12 views

Category:

Documents


0 download

TRANSCRIPT

Page 1: Rigid Body Motionchenx/notes/RGB.pdf · columns of 𝑄are called principle axes. The rigid body rotates in angular velocity ( , , )with respect to the principle axes. Specially,

Rigid Body Rotation

Speaker: Xiaolei Chen Advisor: Prof. Xiaolin Li

Department of Applied Mathematics and Statistics

Stony Brook University (SUNY)

Page 2: Rigid Body Motionchenx/notes/RGB.pdf · columns of 𝑄are called principle axes. The rigid body rotates in angular velocity ( , , )with respect to the principle axes. Specially,

Content

Introduction

Angular Velocity

Angular Momentum and Inertia Tensor

Euler’s Equations of Motion

Euler Angles and Euler Parameters

Numerical Simulation

Future work

Page 3: Rigid Body Motionchenx/notes/RGB.pdf · columns of 𝑄are called principle axes. The rigid body rotates in angular velocity ( , , )with respect to the principle axes. Specially,

Introduction

Question: How many degrees of freedom in the rigid

body motion?

Answer: In total, there are 6 degrees of freedom.

1) 3 for the translational motion

2) 3 for the rotational motion

Translational Motion: center of mass velocity

Rotational Motion: angular velocity, euler angles, euler

parameters

Page 4: Rigid Body Motionchenx/notes/RGB.pdf · columns of 𝑄are called principle axes. The rigid body rotates in angular velocity ( , , )with respect to the principle axes. Specially,

Angular Velocity

In physics, the angular velocity is defined as the rate of

change of angular displacement.

In 2D cases, the angular velocity is a scalar.

Equation: 𝑑𝜃

𝑑𝑡= 𝑤

Linear velocity: 𝑣 = 𝑤 × 𝑟

Page 5: Rigid Body Motionchenx/notes/RGB.pdf · columns of 𝑄are called principle axes. The rigid body rotates in angular velocity ( , , )with respect to the principle axes. Specially,

Angular Velocity

In the 3D rigid body rotation, the angular velocity is a

vector, and use 𝑤 = (𝑤1, 𝑤2, 𝑤3) to denote it.

Page 6: Rigid Body Motionchenx/notes/RGB.pdf · columns of 𝑄are called principle axes. The rigid body rotates in angular velocity ( , , )with respect to the principle axes. Specially,

Angular Momentum

In physics, the angular momentum (𝐿) is a measure of the

amount of rotation an object has, taking into account its

mass, shape and speed.

The 𝐿 of a particle about a given origin in the body axes is

given by

𝐿 = 𝑟 × 𝑝 = 𝑟 × (𝑚𝑣)

where 𝑝 is the linear momentum, and 𝑣 is the linear velocity.

Linear velocity: 𝑣 = 𝑤 × 𝑟𝐿 = 𝑚𝑟 × 𝑤 × 𝑟 = 𝑚(𝑤𝑟2 − 𝑟(𝑟 ∙ 𝑤))

Page 7: Rigid Body Motionchenx/notes/RGB.pdf · columns of 𝑄are called principle axes. The rigid body rotates in angular velocity ( , , )with respect to the principle axes. Specially,

Angular Momentum

Each component of the angular Momentum is

𝐿1 = 𝑚(𝑟2 − 𝑥2)𝑤1 −𝑚𝑥𝑦𝑤2 −𝑚𝑥𝑧𝑤3

𝐿2 = −𝑚𝑦𝑥𝑤1 +𝑚(𝑟2 − 𝑦2)𝑤2 −𝑚𝑦𝑧𝑤3

𝐿3 = −𝑚𝑧𝑥𝑤1 −𝑚𝑧𝑦𝑤2 +𝑚(𝑟2 − 𝑧2)𝑤3

It can be written in the tensor formula.𝐿 = 𝐼𝑤

𝐼 =

𝐼𝑥𝑥 𝐼𝑥𝑦 𝐼𝑥𝑧𝐼𝑦𝑥 𝐼𝑦𝑦 𝐼𝑦𝑧𝐼𝑧𝑥 𝐼𝑧𝑦 𝐼𝑧𝑧

, 𝐼𝑎𝑏 = 𝑚(𝑟2𝛿𝑎𝑏 − 𝑎𝑏)

Page 8: Rigid Body Motionchenx/notes/RGB.pdf · columns of 𝑄are called principle axes. The rigid body rotates in angular velocity ( , , )with respect to the principle axes. Specially,

Inertia Tensor

Moment of inertia is the mass property of a rigid body

that determines the torque needed for a desired

angular acceleration about an axis of rotation. It can be

defined by the Inertia Tensor (𝐼), which consists of nine

components (3 × 3 matrix).

In continuous cases,

𝐼𝑎𝑏 = 𝑉

𝜌 𝑉 𝑟2𝛿𝑎𝑏 − 𝑎𝑏 𝑑𝑉

The inertia tensor is constant in the body axes.

Page 9: Rigid Body Motionchenx/notes/RGB.pdf · columns of 𝑄are called principle axes. The rigid body rotates in angular velocity ( , , )with respect to the principle axes. Specially,

Inertia Tensor

Page 10: Rigid Body Motionchenx/notes/RGB.pdf · columns of 𝑄are called principle axes. The rigid body rotates in angular velocity ( , , )with respect to the principle axes. Specially,

Euler’s Equations of Motion

Apply the eigen-decomposition to the inertial tensor and

obtain

𝐼 = 𝑄Λ𝑄𝑇 , Λ = 𝑑𝑖𝑎𝑔 𝐼1, 𝐼2, 𝐼3

where 𝐼𝑖 are called principle moments of inertia, and the

columns of 𝑄 are called principle axes. The rigid body rotates in angular velocity (𝑤𝑥, 𝑤𝑦, 𝑤𝑧) with respect to the

principle axes.

Specially, consider the cases where 𝐼 is diagonal.

𝐼 = 𝑑𝑖𝑎𝑔 𝐼1, 𝐼2, 𝐼3 , 𝐿𝑖 = 𝐼𝑖𝑤𝑖 , 𝑖 = 1,2,3

The principle axes are the same as the 𝑥, 𝑦, 𝑧 axes in the

body axes.

Page 11: Rigid Body Motionchenx/notes/RGB.pdf · columns of 𝑄are called principle axes. The rigid body rotates in angular velocity ( , , )with respect to the principle axes. Specially,

Euler’s Equations of Motion

The time rate of change of a vector 𝐺 in the space axes

can be written as𝑑𝐺

𝑑𝑡𝑠

=𝑑𝐺

𝑑𝑡𝑏

+𝑤 × 𝐺

where 𝑑𝐺

𝑑𝑡 𝑏is the time rate of change of the vector 𝐺 in

the body axes.

Apply the formula to the angular momentum 𝐿𝑑𝐿

𝑑𝑡𝑠

=𝑑𝐿

𝑑𝑡𝑏

+𝑤 × 𝐺

Page 12: Rigid Body Motionchenx/notes/RGB.pdf · columns of 𝑄are called principle axes. The rigid body rotates in angular velocity ( , , )with respect to the principle axes. Specially,

Euler’s Equations of Motion

Use the relationship 𝐿 = 𝐼𝑤 to obtain𝑑(𝐼𝑤)

𝑑𝑡+ 𝑤 × 𝐿 =

𝑑𝐿

𝑑𝑡𝑠

= 𝜏

The second equality is based on the definition of torque.𝑑𝐿

𝑑𝑡=𝑑(𝑟 × 𝑝)

𝑑𝑡= 𝑟 ×

𝑑𝑝

𝑑𝑡= 𝑟 × 𝐹 = 𝜏

Euler’s equation of motion

𝐼1 𝑤1 −𝑤2𝑤3 𝐼2 − 𝐼3 = 𝜏1𝐼2 𝑤2 −𝑤3𝑤1 𝐼3 − 𝐼1 = 𝜏2𝐼3 𝑤3 −𝑤1𝑤2 𝐼1 − 𝐼2 = 𝜏3

Page 13: Rigid Body Motionchenx/notes/RGB.pdf · columns of 𝑄are called principle axes. The rigid body rotates in angular velocity ( , , )with respect to the principle axes. Specially,

Euler Angles

The Euler angles are three angles introduced to describe

the orientation of a rigid body.

Usually, use ϕ, 𝜃, 𝜓 to denote them.

Page 14: Rigid Body Motionchenx/notes/RGB.pdf · columns of 𝑄are called principle axes. The rigid body rotates in angular velocity ( , , )with respect to the principle axes. Specially,

The order of the rotation steps matters.

Euler Angles

Page 15: Rigid Body Motionchenx/notes/RGB.pdf · columns of 𝑄are called principle axes. The rigid body rotates in angular velocity ( , , )with respect to the principle axes. Specially,

Euler Angles

Three rotation matrices are

𝐷 =𝑐𝑜𝑠𝜙 𝑠𝑖𝑛𝜙 0−𝑠𝑖𝑛𝜙 𝑐𝑜𝑠𝜙 0

0 0 1

𝐶 =1 0 00 𝑐𝑜𝑠𝜃 𝑠𝑖𝑛𝜃0 −𝑠𝑖𝑛𝜃 𝑐𝑜𝑠𝜃

𝐵 =𝑐𝑜𝑠𝜓 𝑠𝑖𝑛𝜓 0−𝑠𝑖𝑛𝜓 𝑐𝑜𝑠𝜓 0

0 0 1

Page 16: Rigid Body Motionchenx/notes/RGB.pdf · columns of 𝑄are called principle axes. The rigid body rotates in angular velocity ( , , )with respect to the principle axes. Specially,

Then, the rotation matrix is

𝐴 = 𝐵𝐶𝐷 =

𝑐𝑜𝑠𝜓𝑐𝑜𝑠𝜙 − 𝑐𝑜𝑠𝜃𝑠𝑖𝑛𝜙𝑠𝑖𝑛𝜓 𝑐𝑜𝑠𝜓𝑠𝑖𝑛𝜙 + 𝑐𝑜𝑠𝜃𝑐𝑜𝑠𝜙𝑠𝑖𝑛𝜓 𝑠𝑖𝑛𝜓𝑠𝑖𝑛𝜃−𝑠𝑖𝑛𝜓𝑐𝑜𝑠𝜙 − 𝑐𝑜𝑠𝜃𝑠𝑖𝑛𝜙𝑐𝑜𝑠𝜓 −𝑠𝑖𝑛𝜓𝑠𝑖𝑛𝜙 + 𝑐𝑜𝑠𝜃𝑐𝑜𝑠𝜙𝑐𝑜𝑠𝜓 𝑐𝑜𝑠𝜓𝑠𝑖𝑛𝜃

𝑠𝑖𝑛𝜃𝑠𝑖𝑛𝜙 −𝑠𝑖𝑛𝜃𝑐𝑜𝑠𝜙 𝑐𝑜𝑠𝜃

This matrix can be used to convert the coordinates in the

space axes to the coordinates in the body axes.

The inverse is 𝐴−1 = 𝐴𝑇.

Assume 𝑥 is the coordinates in the space axes, and 𝑥′ is the

coordinates in the body axes.

𝑥′ = 𝐴𝑥𝑥 = 𝐴𝑇𝑥′

Euler Angles

Page 17: Rigid Body Motionchenx/notes/RGB.pdf · columns of 𝑄are called principle axes. The rigid body rotates in angular velocity ( , , )with respect to the principle axes. Specially,

Euler Angles

The relationship between the angular velocity and the

euler angles is𝑤1

𝑤2

𝑤3

=00 𝜙+ 𝐷𝑇

𝜃00

+ 𝐷𝑇𝐶𝑇00 𝜓= 𝐽−1

𝜙 𝜃 𝜓

𝐽−1 =0 𝑐𝑜𝑠𝜙 𝑠𝑖𝑛𝜃𝑠𝑖𝑛𝜙0 𝑠𝑖𝑛𝜙 −𝑠𝑖𝑛𝜃𝑐𝑜𝑠𝜙1 0 𝑐𝑜𝑠𝜃

𝜙 𝜃 𝜓

=

−𝑠𝑖𝑛𝜙𝑐𝑜𝑡𝜃 𝑐𝑜𝑠𝜙𝑐𝑜𝑡𝜃 1𝑐𝑜𝑠𝜙 𝑠𝑖𝑛𝜙 0

𝑠𝑖𝑛𝜙𝑐𝑠𝑐𝜃 −𝑐𝑜𝑠𝜙𝑐𝑠𝑐𝜃 0

𝑤1

𝑤2

𝑤3

Page 18: Rigid Body Motionchenx/notes/RGB.pdf · columns of 𝑄are called principle axes. The rigid body rotates in angular velocity ( , , )with respect to the principle axes. Specially,

Euler Parameters

The four parameters 𝑒0, 𝑒1, 𝑒2, 𝑒3 describe a finite about an arbitrary axis. The parameters are defined as

Def: 𝑒0 = 𝑐𝑜𝑠𝜑

2

And 𝑒1, 𝑒2, 𝑒3 = 𝑛sin(𝜑

2)

Page 19: Rigid Body Motionchenx/notes/RGB.pdf · columns of 𝑄are called principle axes. The rigid body rotates in angular velocity ( , , )with respect to the principle axes. Specially,

Euler Parameters

In this representation, 𝑛 is the unit normal vector, and 𝜑 is the rotation angle.

Constraint: 𝑒02 + 𝑒1

2 + 𝑒22 + 𝑒3

2 = 1

𝐴 =

𝑒02 + 𝑒1

2 − 𝑒22 − 𝑒3

2 2(𝑒1𝑒2 + 𝑒0𝑒3) 2(𝑒1𝑒3 − 𝑒0𝑒2)

2(𝑒1𝑒2 − 𝑒0𝑒3) 𝑒02 − 𝑒1

2 + 𝑒22 − 𝑒3

2 2(𝑒2𝑒3 + 𝑒0𝑒1)

2(𝑒1𝑒3 + 𝑒0𝑒2) 2(𝑒2𝑒3 − 𝑒0𝑒1) 𝑒02 − 𝑒1

2 + 𝑒22 − 𝑒3

2

Page 20: Rigid Body Motionchenx/notes/RGB.pdf · columns of 𝑄are called principle axes. The rigid body rotates in angular velocity ( , , )with respect to the principle axes. Specially,

Euler Parameters

The relationship between the angular velocity and the

euler parameters is 𝑒0 𝑒1 𝑒2 𝑒3

=1

2

−𝑒1 −𝑒2 −𝑒3𝑒0 𝑒3 −𝑒2−𝑒3 𝑒0 𝑒1𝑒2 −𝑒1 𝑒0

𝑤1

𝑤2

𝑤3

The relationship between the euler angles and the euler

parameters is

𝑒0 = cos𝜙 + 𝜓

2cos

𝜃

2, 𝑒1 = cos

𝜙 − 𝜓

2sin

𝜃

2

𝑒2 = sin𝜙 − 𝜓

2sin

𝜃

2, 𝑒3 = sin

𝜙 + 𝜓

2cos

𝜃

2

Page 21: Rigid Body Motionchenx/notes/RGB.pdf · columns of 𝑄are called principle axes. The rigid body rotates in angular velocity ( , , )with respect to the principle axes. Specially,

Numerical Simulations

Question: How to propagate the rigid body?

Answer: There are three ways. But not all of them work

good in numerical simulation.

1) Linear velocity

2) Euler Angles

3) Euler Parameters

Page 22: Rigid Body Motionchenx/notes/RGB.pdf · columns of 𝑄are called principle axes. The rigid body rotates in angular velocity ( , , )with respect to the principle axes. Specially,

Numerical Simulations

Propagate by linear velocity𝑑𝑟

𝑑𝑡= 𝑣 = 𝑤 × 𝑟

𝑟𝑛 → 𝑟𝑛+1

Directly use the last step location information.

Propagate by euler angles or euler parameter

1) Implemented by rotation matrix.

2) The order of propagate matters.

3) e.g. Δ𝐴 ∙ 𝐴 = Δ𝐵Δ𝐶Δ𝐷 ∙ 𝐵𝐶𝐷 ≠ Δ𝐵 ∙ 𝐵 Δ𝐶 ∙ 𝐶 Δ𝐷 ∙ 𝐷

Inverse back to the initial location by the old parameters

and propagate by the new parameters.

Page 23: Rigid Body Motionchenx/notes/RGB.pdf · columns of 𝑄are called principle axes. The rigid body rotates in angular velocity ( , , )with respect to the principle axes. Specially,

Numerical Simulations

Update angular velocity by the Euler’s equation of

motion with 4-th order Runge-Kutta method.

Initial angular velocity: 𝑤1 = 1,𝑤2 = 0,𝑤3 = 1

Principle Moment of Inertia:

𝐼1 = 𝐼2 = 0.6375, 𝐼3 = 0.075

Analytic Solution

𝑤1 = cos(𝐼3 − 𝐼1𝐼1

𝑤3𝑡)

𝑤2 = sin(𝐼3 − 𝐼1𝐼1

𝑤3𝑡)

Page 24: Rigid Body Motionchenx/notes/RGB.pdf · columns of 𝑄are called principle axes. The rigid body rotates in angular velocity ( , , )with respect to the principle axes. Specially,

Numerical Simulations

Page 25: Rigid Body Motionchenx/notes/RGB.pdf · columns of 𝑄are called principle axes. The rigid body rotates in angular velocity ( , , )with respect to the principle axes. Specially,

Numerical Simulationspropagate by linear velocity

If the rigid body is propagated in the tangent direction,

numerical simulations showed the fact that the rigid

body will become larger and larger.

Solution: propagate in the secant direction.

Page 26: Rigid Body Motionchenx/notes/RGB.pdf · columns of 𝑄are called principle axes. The rigid body rotates in angular velocity ( , , )with respect to the principle axes. Specially,

Numerical Simulationspropagate by linear velocity

Page 27: Rigid Body Motionchenx/notes/RGB.pdf · columns of 𝑄are called principle axes. The rigid body rotates in angular velocity ( , , )with respect to the principle axes. Specially,

Numerical Simulationspropagate by linear velocity

Page 28: Rigid Body Motionchenx/notes/RGB.pdf · columns of 𝑄are called principle axes. The rigid body rotates in angular velocity ( , , )with respect to the principle axes. Specially,

Numerical Simulationspropagate by euler angles

Use the relationship between the euler angles and the

angular velocity to update the euler angles in each time

step.

This keeps the shape of the rigid body. However, the

matrix has a big probability to be singular when 𝜃 = 𝑛𝜋.

Example: if we consider the initial position is where the

three euler angles are all zero, then 𝜃 = 0 and this leads

to a singular matrix.

Solution: no solution.

Page 29: Rigid Body Motionchenx/notes/RGB.pdf · columns of 𝑄are called principle axes. The rigid body rotates in angular velocity ( , , )with respect to the principle axes. Specially,

Numerical Simulationspropagate by euler parameters

Use the relationship between the euler parameters and the angular velocity to update the euler parameters in each step.

This keeps the shape of the rigid body. Also, it is shown in numerical simulation that the matrix can never be singular.

Based on the initial euler angles 𝜙 = 𝜃 = 𝜑 = 0 and the relationship between euler parameters and euler angles, the initial values of the four euler parameters are

𝑒0 = 1, 𝑒1 = 𝑒2 = 𝑒3 = 0

Page 30: Rigid Body Motionchenx/notes/RGB.pdf · columns of 𝑄are called principle axes. The rigid body rotates in angular velocity ( , , )with respect to the principle axes. Specially,

Numerical Simulationspropagate by euler parameters

Page 31: Rigid Body Motionchenx/notes/RGB.pdf · columns of 𝑄are called principle axes. The rigid body rotates in angular velocity ( , , )with respect to the principle axes. Specially,

Numerical Simulationspropagate by euler parameters

Page 32: Rigid Body Motionchenx/notes/RGB.pdf · columns of 𝑄are called principle axes. The rigid body rotates in angular velocity ( , , )with respect to the principle axes. Specially,

Numerical Simulationspropagate by euler parameters

Page 33: Rigid Body Motionchenx/notes/RGB.pdf · columns of 𝑄are called principle axes. The rigid body rotates in angular velocity ( , , )with respect to the principle axes. Specially,

Numerical Simulationspropagate by euler parameters

Page 34: Rigid Body Motionchenx/notes/RGB.pdf · columns of 𝑄are called principle axes. The rigid body rotates in angular velocity ( , , )with respect to the principle axes. Specially,

Future Work

different shapes of rigid body

outside force to the rigid body

fluid field in the simulation

parachutists motion in the parachute inflation

Page 35: Rigid Body Motionchenx/notes/RGB.pdf · columns of 𝑄are called principle axes. The rigid body rotates in angular velocity ( , , )with respect to the principle axes. Specially,

References

Classical Mechanics, Herbert Goldstein, Charles Poole anb John Safko

http://www.mathworks.com/help/aeroblks/6dofeuleran

gles.html

http://mathworld.wolfram.com/EulerParameters.html

http://www.u.arizona.edu/~pen/ame553/Notes/Lesson%

2010.pdf

Wikipedia