Content MM2 Repetition Euler angels Quarternions

Slides:



Advertisements
Similar presentations
Mechanics of Machines Dr. Mohammad Kilani
Advertisements

ARO309 - Astronautics and Spacecraft Design Winter 2014 Try Lam CalPoly Pomona Aerospace Engineering.
John C. Hart CS 318 Interactive Computer Graphics
Arbitrary Rotations in 3D Lecture 18 Wed, Oct 8, 2003.
P. Axelrad, D. Lawrence ASEN3200 Spring 2006 ATTITUDE REPRESENTATION l Attitude cannot be represented by vector in 3-dimensional space, like position or.
CS B659: Principles of Intelligent Robot Motion Rigid Transformations.
Kinematic Modelling in Robotics
ME751 Advanced Computational Multibody Dynamics Section 9.2 February 9, 2010 © Dan Negrut, 2010 ME751, UW-Madison “In England, if you commit a crime, the.
Chris Hall Aerospace and Ocean Engineering
3D Kinematics Eric Whitman 1/24/2010. Rigid Body State: 2D p.
Computer Graphics Recitation 2. 2 The plan today Learn about rotations in 2D and 3D. Representing rotations by quaternions.
Ch. 7: Dynamics.
Euler Rotation. Angular Momentum  The angular momentum J is defined in terms of the inertia tensor and angular velocity. All rotations included  The.
Ch. 2: Rigid Body Motions and Homogeneous Transforms
Spatial Descriptions and Transformations Introduction to Motion
Ch. 4: Velocity Kinematics
3-D Geometry.
AAE 666 Final Presentation Spacecraft Attitude Control Justin Smith Chieh-Min Ooi April 30, 2005.
CPSC 452: Lecture 1 Introduction, Homogeneous transformations and Coordinate frames.
Rotations. Space and Body  Space coordinates are an inertial system. Fixed in spaceFixed in space  Body coordinates are a non- inertial system. Move.
Screw Rotation and Other Rotational Forms
Euler Angles. Three Angles  A rotation matrix can be described with three free parameters. Select three separate rotations about body axesSelect three.
The linear algebra of Canadarm
CS I400/B659: Intelligent Robotics Rigid Transformations.
ME451 Kinematics and Dynamics of Machine Systems Review of Matrix Algebra – 2.2 Review of Elements of Calculus – 2.5 Vel. and Acc. of a point fixed in.
ME451 Kinematics and Dynamics of Machine Systems Review of Matrix Algebra – 2.2 September 13, 2011 Dan Negrut University of Wisconsin-Madison © Dan Negrut,
Computer Vision Group Prof. Daniel Cremers Autonomous Navigation for Flying Robots Lecture 3.1: 3D Geometry Jürgen Sturm Technische Universität München.
ME/ECE Professor N. J. Ferrier Forward Kinematics Professor Nicola Ferrier ME Room 2246,
1 C01 – Advanced Robotics for Autonomous Manipulation Department of Mechanical EngineeringME 696 – Advanced Topics in Mechanical Engineering.
Game Physics – Part IV Moving to 3D
Theory of Machines Lecture 4 Position Analysis.
Geometric Transformation. So far…. We have been discussing the basic elements of geometric programming. We have discussed points, vectors and their operations.
Rotations and Translations
CSE 681 Review: Transformations. CSE 681 Transformations Modeling transformations build complex models by positioning (transforming) simple components.
Rick Parent - CIS681 ORIENTATION Use Quaternions Interpolating rotations is difficult.
Spatial Descriptions and Transformations Sebastian van Delden USC Upstate
Sect. 4.2: Orthogonal Transformations
Mon 30 July 2007 Overview of the course
MMS I, Lecture 31 Content MM3 Short repetition of mm2 Rigid body Dynamics –Angular Momentum –Inertial Matrixes minus Dyadic(p. 334(down) – 336(top) –Principal.
EEE. Dept of HONG KONG University of Science and Technology Introduction to Robotics Page 1 Lecture 2. Rigid Body Motion Main Concepts: Configuration Space.
Background The Physics Knowledge Expected for this Course: Newton’s Laws of Motion  the “Theme of the Course” –Energy & momentum conservation –Elementary.
Sect. 4.4: Euler Angles Back to PHYSICS! GOAL: Describe rigid body motion (especially rotations) with a Lagrangian formalism. What generalized coordinates.
Rotation and Orientation: Fundamentals Jehee Lee Seoul National University.
ADCS Review – Attitude Determination Prof. Der-Ming Ma, Ph.D. Dept. of Aerospace Engineering Tamkang University.
Kinematics. The function of a robot is to manipulate objects in its workspace. To manipulate objects means to cause them to move in a desired way (as.
Aerospace Modeling Tutorial Lecture 1 – Rigid Body Dynamics Greg and Mario January 21, 2015.
The Spinning Top Chloe Elliott. Rigid Bodies Six degrees of freedom:  3 cartesian coordinates specifying position of centre of mass  3 angles specifying.
Chapter 2: Description of position and orientation Faculty of Engineering - Mechanical Engineering Department ROBOTICS Outline: Introduction. Descriptions:
Comparing Two Motions Jehee Lee Seoul National University.
Chapter 9: Rotational Motion
MMS I, Lecture 11 Course content MM1 Basic geometry and rotations MM2 Rotation parameters and kinematics MM3 Rotational Dynamics MM4 Manipulator Kinematics.
Week 5 - Monday.  What did we talk about last time?  Lines and planes  Trigonometry  Transforms  Affine transforms  Rotation  Scaling  Shearing.
EE 495 Modern Navigation Systems Navigation Mathematics Rotation Matrices – Part II Wednesday, Jan 14 EE 495 Modern Navigation Systems Slide 1 of 21.
INTRODUCTION TO DYNAMICS ANALYSIS OF ROBOTS (Part 1)
Derivation of the 2D Rotation Matrix Changing View from Global to Local X Y X’ Y’  P Y Sin  X Cos  X’ = X Cos  + Y Sin  Y Cos  X Sin  Y’ = Y Cos.
End effector End effector - the last coordinate system of figure Located in joint N. But usually, we want to specify it in base coordinates. 1.
Learning from the Past, Looking to the Future James R. (Jim) Beaty, PhD - NASA Langley Research Center Vehicle Analysis Branch, Systems Analysis & Concepts.
Learning from the Past, Looking to the Future James R. (Jim) Beaty, PhD - NASA Langley Research Center Vehicle Analysis Branch, Systems Analysis & Concepts.
Computer Graphics Lecture 11 2D Transformations I Taqdees A. Siddiqi
Lecture 10 Geometric Transformations In 3D(Three- Dimensional)
Ch. 2: Rigid Body Motions and Homogeneous Transforms
CHAPTER 2 FORWARD KINEMATIC 1.
Rotational Kinematics
Robot Kinematics We know that a set of “joint angles” can be used to locate and orientate the hand in 3-D space We know that the joint angles can be combined.
Derivation of the 2D Rotation Matrix
Chapter 2 Mathematical Analysis for Kinematics
Rotation and Orientation: Fundamentals
Chapter 3. Kinematic analysis
Robotics 1 Copyright Martin P. Aalund, Ph.D.
Screw Rotation and Other Rotational Forms
Presentation transcript:

Content MM2 Repetition Euler angels Quarternions Principal axis and angle (ê, θ ) Quarternions Kinematics expressed in DCM Euler Quaternions MMS I, Lecture 2

DIRECTION COSINE MATRIX (DCM) u3 {A} {A} {A} {U} u2 ^ AX U T AYU T AZU T ^ ^ ^ ^ C UA = [ UXA UYA UZA ] = ^ Three column vectors z z u1 {U} {A} y Three row vectors y X x MMS I, Lecture 2

ELEMENTARY ROTATIONS -90 [0,1,1] RA RB {B} {A} a a a MMS I, Lecture 2 3 [0,1,1] RB RA {B} a {A} 2 a 1 MMS I, Lecture 2

ELEMENTARY ROTATIONS NB MMS I, Lecture 2 {A} {U} θ x θ x z z Black board: U unit vectors in A CAU A U CUA MMS I, Lecture 2

ROTATION ORDER(important) MMS I, Lecture 2

Transportation Theorem Theorem:(Transport Theorem) Let frame A rotate relativ to frame U with angular velocity ωAU and let r be a vector following the A coordinate system. The time derivative of r in the A frame is then related to the derivative of r in the U frame as: â1 û3 â2 ωAU û2 û1 {A} {U} P r r = r1â1+r2â2 + r3â3 = r = CUA ( + ωAU x r A) d r t U · A MMS I, Lecture 2

Example · d r t U d r t A CUA = r = ( ( + ωAU x r A) CUA ) {A} {U} (3) A dt dr ωAU x r A = (-1 1 0) (2) = (1 1 0) (1) rA = (2 2 0) Φ CUA = Cos(θ) Sin(θ) 0 - Sin(θ) Cos(θ) 0 0 0 1 For θ = ( 0, Φ, 90 0 ) MMS I, Lecture 2

Second derivety = CUA + ω x r d dr d dr dt dt dt dt U A d2r d2r dr dr · = CUA + ω x + ω x + ω x r ω x ω x r U A d2r d2r dr dt2 dt2 dt · = CUA + 2ω x + ω x r + ω x ω x r U A Please put on bars and double bars on vectors and matrixes MMS I, Lecture 2

EULER ANGLES (BODY FIXED 3-2-1) MMS I, Lecture 2

EXAMPLE, SHUTTLE (Body Fixed (2-3-1) Flaps Ф2 (Pitch), Ф3 (Yaw). Rudder Ф1 (Roll) gives CUA MMS I, Lecture 2

EULER ANGLES (BODY FIXED 3-1-3) ø φ θ Perihelion Inclination Ascending MMS I, Lecture 2

EULER ANGLE REPRESENTATIONS Further 12 Euler Angle matrices exsist given in fixed axis From now on we expect that the rotation matix exist CUA MMS I, Lecture 2

Euler Principal Axis and angle Theorem: (Euler’s Eigenaxis Rotation) A rigid body or a coordinate frame fixed in a point P can be brought from any arbitrary initial orientetion to an arbitrary final orientation by a single rotation about a principal axis ê through the point P. θ Trick: Move â1 to ê1 â1 â2 â3 {A} ê1 e1 e2 e3 ê2 = R21 R22 R23 ê3 R31 R32 R33 â1 â2 â3 ê1 θ {U} û3 û2 û1 P e1 R21 R31 e2 R22 R32 e3 R23 R33 e1 e2 e3 R21 R22 R23 R31 R32 R33 1 0 0 0 cos θ sin θ 0 – sin θ cos θ Support equations of the type: e12+R212+R312= 1; RTR=I ; e1= R22R33-R23R32 CUA = RTC(θ)R cθ + e1(1- cθ) e1e2(1- cθ) + e3sθ e1e3(1- cθ) – e2sθ = e2e1(1- cθ) - e3sθ cθ + e2(1- cθ) e2e3(1- cθ) + e1sθ e3e1(1- cθ) + e2sθ e3e2(1- cθ) - e1sθ cθ + e3(1- cθ) 2 MMS I, Lecture 2

Euler Principal Axis and angle cont. cθ + e1(1- cθ) e1e2(1- cθ) + e3sθ e1e3(1- cθ) – e2sθ CUA = e2e1(1- cθ) - e3sθ cθ + e2(1- cθ) e2e3(1- cθ) + e1sθ e3e1(1- cθ) + e2sθ e3e2(1- cθ) - e1sθ cθ + e3(1- cθ) 2 2 2 0 -e3 e2 e3 0 -e1 -e2 e1 0 E = CUA(ê, θ) = cos(θ) I + (1- cos(θ) eeT – sin(θ) E From a known DCM determine ê, θ: cos(θ) = ½( Trace CUA - 1) ê = CUA C23 - C32 C31 - C13 C12 - C21 1 2sin(θ) θ ≠ ± n·180 MMS I, Lecture 2

Quarternions Known: ê, θ, CUA Define: q = ( q1,q2,q3,q4 )T = (q4 + î q1+ j q2 + k q3)T = = e1sin(θ/2) e2sin(θ/2) e3sin(θ/2) cos(θ/2) ˆ ˆ q1:3 q4 By using: sin(θ) = 2sin(θ /2)cos(θ /2) cos(θ) = cos2(θ /2) - sin2(θ /2) = 2cos2(θ /2) -1 = 1 - 2sin2(θ /2) In: cθ + e12(1- cθ) e1e2(1- cθ) + e3sθ e1e3(1- cθ) – e2sθ e2e1(1- cθ) - e3sθ cθ + e22(1- cθ) e2e3(1- cθ) + e1sθ e3e1(1- cθ) + e2sθ e3e2(1- cθ) - e1sθ cθ + e32(1- cθ) CUA = MMS I, Lecture 2

Quarternions cont. CUA(ê, θ) = cos(θ) I + (1- cos(θ)) êêT – sin(θ) E ; 0 -e3 e2 e3 0 -e1 -e2 e1 0 CUA(q1:3,q4) = ( q42 - q1:3 T q1:3)I + 2q1:3q1:3T - 2q4Q Q = s(/2) From a known DCM CUA determine q1:3 , q4: e1sin(θ/2) e2sin(θ/2) e3sin(θ/2) q1 q2 q3 C23 - C32 C31 - C13 C12 - C21 q1:3 = = 1 4q4 q4 = ½ ( Trace C + 1)1/2 0 ≤ θ ≤ 180 MMS I, Lecture 2

Quarternions cont. q(t+Δt) q(Δt) q(t) = i2 = j2 = k2 = -1; ij = k = -ji ; q = q”O q’ = (q”1i, q”2j, q”3k, q”4)(q’1i, q’2j, q’3k, q’4) q(t+Δt) = q(Δt) q(t) Compare with C.6 and C.7 in appendix C in literature MMS I, Lecture 2

Kinematics rigid bodies is given ωBA {A} ωBA Direct Cosine Matrix {B} b = CBA(t)â â = CTBA(t)b → = CBAT(t)b + CBAT(t)(ωBAxb) → 0 = CBAT(t)b + CBAT(t)(S(ωBA)b) CBA(t) = - S(ωBA) CBA(t) dâ dt ˆ · 0 - ω 3 ω 2 ω3 0 - ω1 - ω 2 ω 1 0 S(ωBA) = Advantages: Linear No singularities Drawback: 9 differential coupled equations (redundancies) MMS I, Lecture 2

Kinematics cont. ω is given 3 {V} Euler Angles {A} θ3 {U} CUA = CUVCVWCWA = C1(θ1)·C2(θ2)·C3(θ3) · · 1 2 ωWA = θ3â3A = θ3â3W ωVW = θ2â2W = θ2â2V ωVU = θ1â1V = θ1â1U · · 2 θ2 · · θ1 {W} 1 1 · ω1 θ1 0 0 ω2 = 0 + C1(θ1) θ2 + C1(θ1)·C2(θ2) 0 ω3 0 0 θ3 · · ω1 1 0 -sin(θ2) θ1 ω2 = 0 cos(θ1) sin(θ1) cos(θ2) θ2 ω3 0 -sin(θ1) cos(θ1) cos(θ2) θ3 · Euler rates MMS I, Lecture 2

Kinematics cont. Euler Angles cont. · θ1 cos(θ2) sin(θ1)sin(θ2) sin(θ2) cos(θ1) θ2 = 0 cos(θ1)cos(θ2) -sin(θ1) cos(θ2) θ3 0 sin(θ1) cos(θ1) ω1(t) ω2(t) ω3(t) · 1 cos(θ2) · Singularity Known ((C1(θ1)·C2(θ2)·C3(θ3))T = C3(θ3)T C2(θ2)T C1(θ1)T Advantages: Only 3 differential equations Drawback: Unlinear Singularity MMS I, Lecture 2

Kinematics cont. MMS I, Lecture 2

Kinematics cont. Quaternions dq(t) dt q(t+Δt) - q(t) q(Δt) q(t) – q(t) = = limΔt→0 êsin(Δθ/2) cos(Δθ/2) êΔθ/2 1 q(Δt) ~ Not fractions!! = Calculations: See the notes app.C -ωT = (e1, e2, e3)T Δθ/Δt dq(t) dt -S(ω) ω -ωT 0 = 1/2 q(t) Thomas Bak: As seen the same · q13 = ½(q4 ω – ω x q13) q4 = - ½ ωT q13 · MMS I, Lecture 2

Rotation Representations Par. Characteristics Applications Direction Cosine matrix 9 Nonsingular Intuitive Six redundant parameters Analytical studies Euler Angles 3 Minimal set Clear physical representation Trigonometric functions in rotation matrix Singular Quaternions 4 Easy orthogonality Not singular No clear physical representation One redundant parameter Widely used in simulation Preferred for global rotation MMS I, Lecture 2