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)

Transcript of Rigid Body Motionchenx/notes/RGB.pdfΒ Β· columns of 𝑄are called principle axes. The rigid body...

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