video 2.1a vijay kumar and ani hsieh - edxpennx+robo3x+2t2017+type@asset... · a system of rigidly...
TRANSCRIPT
Robo3x-1.3 1Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Video 2.1aVijay Kumar and Ani Hsieh
Robo3x-1.3 2Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Vijay Kumar and Ani HsiehUniversity of Pennsylvania
Introduction to Lagrangian Mechanics
Robo3x-1.3 3Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Analytical Mechanics
• Aristotle
• Galileo
• Bernoulli
1. Principle of Virtual Work: Static equilibrium of a particle, system of N particles, rigid bodies, system of rigid bodies
2. D’Alembert’s Principle: Incorporate inertial forces for dynamic analysis
3. Lagrange’s Equations of Motion
• Euler
• Lagrange
• D’Alembert
Robo3x-1.3 4Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Generalized Coordinate(s)
A minimal set of coordinates required to describe the configuration of a system
No. of generalized coordinates = no. of degrees of freedom
Robo3x-1.3 5Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Virtual Displacements
Virtual displacements are small displacements consistent with the constraints
A particle of mass m constrained to move vertically
g
generalized coordinate y
y
Robo3x-1.3 6Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Virtual Displacements
Virtual displacements are small displacements consistent with the constraints
x
l
qf
The slider crank mechanism: a single degree of freedom linkage
generalized coordinate x, q, or f
Robo3x-1.3 7Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Virtual Displacements
Virtual displacements are small displacements consistent with the constraints
The pendulum: a single degree of freedom linkage
ql
O
P
generalized coordinate q
Robo3x-1.3 8Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Virtual Work
The work done by applied (external) forces through the virtual displacement,
A particle of mass m constrained to move vertically
mg
Robo3x-1.3 9Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Virtual Work
The work done by applied (external) forces through the virtual displacement,
x
l
qf
The slider crank mechanism: a single degree of freedom linkage
F
Robo3x-1.3 10Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Video 2.1bVijay Kumar and Ani Hsieh
Robo3x-1.3 11Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Virtual Work
The pendulum: a single degree of freedom linkage
ql
O
P
The work done by applied (external) forces through the virtual displacement,
mg
Robo3x-1.3 12Property of Penn Engineering, Vijay Kumar and Ani Hsieh
The Principle of Virtual Work
The virtual work done by all applied (external) forces through any virtual displacement is zero
The system is in equilibrium
Robo3x-1.3 13Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Static Equilibrium
mg
Robo3x-1.3 14Property of Penn Engineering, Vijay Kumar and Ani Hsieh
x
l
qf
F
Static Equilibrium
Robo3x-1.3 15Property of Penn Engineering, Vijay Kumar and Ani Hsieh
ql
O
P
mg
Static Equilibrium
Robo3x-1.3 16Property of Penn Engineering, Vijay Kumar and Ani Hsieh
D’Alembert’s Principle
The virtual work done by all applied (external) forces through any virtual displacement is zero
The system is in static equilibrium
include inertial forces
Equations of motion for the system
principle of virtual work
inertial force = - mass x acceleration
Robo3x-1.3 17Property of Penn Engineering, Vijay Kumar and Ani Hsieh
D’Alembert’s Principle
mge1
e2
acceleration
inertial force
Robo3x-1.3 18Property of Penn Engineering, Vijay Kumar and Ani Hsieh
ql
O
P
mg
D’Alembert’s Principle
er
eq
acceleration
inertial force
equation of motion
Robo3x-1.3 19Property of Penn Engineering, Vijay Kumar and Ani Hsieh
D’Alembert’s principle with generalized coordinates
contribution from inertial
force(s)
contribution from external force(s)
generalized coordinate
Particle in the vertical plane
Simple pendulum
Robo3x-1.3 20Property of Penn Engineering, Vijay Kumar and Ani Hsieh
The Key Idea
The contribution from the inertial forces can be expressed as a function of the
kinetic energy and its derivatives
Kinetic Energy
Robo3x-1.3 21Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Lagrange’s Equation of Motion
Particle in the vertical plane
Simple pendulum
Robo3x-1.3 22Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Lagrange’s Equation of Motion for a Conservative System
Conservative System
Scalar Function
There exists a scalar function such that all applied forces are given by the gradient of the potential function
Gravitational force is conservativeScalar function is the potential energy
Robo3x-1.3 23Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Standard Form of Lagrange’s Equation of Motion
The Lagrangian
Robo3x-1.3 24Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Lagrange’s Equation of Motion
Particle in the vertical plane
Simple pendulum
Robo3x-1.3 25Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Video 2.2Vijay Kumar and Ani Hsieh
Robo3x-1.3 26Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Vijay Kumar and Ani HsiehUniversity of Pennsylvania
Newton Euler Equations
Robo3x-1.3 27Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Analytical Mechanics
1. Principle of Virtual Work: Static equilibrium of a particle, system of N particles, rigid bodies, system of rigid bodies
2. D’Alembert’s Principle: Incorporate inertial forces for dynamic analysis
3. Lagrange’s Equations of Motion
Robo3x-1.3 28Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Newton Euler Equations
Recall Newton’s 2nd law of motion
net external force = inertia x acceleration
m
Robo3x-1.3 29Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Newton Euler Equations
Newton’s equations of motion for a translating rigid body
Euler’s equations of motion for a rotating rigid body
Robo3x-1.3 30Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Motion of Systems of Particles
Ox
rOPi
mi
Pi
Newton’s equations of motion
fjPi
mj
net external force = total mass xacceleration of center of mass
fj
y
z
C
Center of Mass
Robo3x-1.3 31Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Newton’s Second Law for a System of Particles
The center of mass for a system of particles, S, accelerates in an inertial frame, A, as if it were a single particle with mass m (equal to the total mass of the system) acted upon by a force equal to the net external force.
Rate of change of linear momentum in an inertial frame is equal to the net external force acting on the system.
Also true for a
rigid body
Linear momentum
Robo3x-1.3 32Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Equations of Motion for a Rotating Rigid Body
• Rigid body with a point O fixed in an inertial frame
• Rigid body with the center of mass C
Angular momentum
CO
Px
y
moment of inertia
Robo3x-1.3 33Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Equations of Motion for a Rotating Rigid Body
• Rigid body with a point O fixed in an inertial frame
• Rigid body with the center of mass C
The rate of change of angular momentum of a rigid body (or a system of rigidly connected particles) in an inertial frame with O or C as an origin is equal to the net external moment acting (with the same origin) on the body.
Robo3x-1.3 34Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Example
O
P
ql
mge1
e2
equation of motion
Robo3x-1.3 35Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Moment of Inertia of Planar Objects
m m
mm
2a
2be2
e1O
C
67 KB
Robo3x-1.3 36Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Moment of Inertia of Planar Objects
C
x
y
r
dm
Robo3x-1.3 37Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Video 2.3Vijay Kumar and Ani Hsieh
Robo3x-1.3 38Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Vijay Kumar and Ani HsiehUniversity of Pennsylvania
Dynamics and ControlAcceleration Analysis: Revisited
Robo3x-1.3 39Property of Penn Engineering, Vijay Kumar and Ani Hsieh
• Reference frame
• Origin
• Basis vectors
• Position Vectors
• Position vectors for P and Q in A
• Position vector of Q in B
Position Vectors
B
a1
a3
a2
P
Q
O
A
b1
b3
b2
Robo3x-1.3 40Property of Penn Engineering, Vijay Kumar and Ani Hsieh
General Approach to Analyzing Multi-Body System
1. Points common to
adjacent bodies
3. Pair of points on
adjacent bodies
whose relative
motions can be
easily described
2. Pair of points
fixed to the same
body
4. Write equations relating pairs of points either on same or adjacent bodies.
Robo3x-1.3 41Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Position Analysis
B
a1
a3
a2
P
Q
O
A
b1
b3
b2
Robo3x-1.3 42Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Velocity Analysis
B
a1
a3
a2
P
Q
O
A
b1
b3
b2
3x3 skew symmetric matrix
angular velocity of B in A
Robo3x-1.3 43Property of Penn Engineering, Vijay Kumar and Ani Hsieh
• Acceleration of P and Q in A
Acceleration Analysis
B
a1
a3
a2
P
Q
O
A
Robo3x-1.3 44Property of Penn Engineering, Vijay Kumar and Ani Hsieh
The angular acceleration of B in
A, is defined as the derivative of
the angular velocity of B in A:
Angular Acceleration
B
a1
a3
a2
P
Q
O
A
Robo3x-1.3 45Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Acceleration Analysis
B
a1
a3
a2
P
Q
O
A
b1
b3
b2
centripetal (normal)acceleration
tangential acceleration
Robo3x-1.3 46Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Serial Chain of Rigid Bodies
A
B
C
D
OA
OB
OC
OD
Robo3x-1.3 47Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Serial Chain of Rigid Bodies
A
B
C
D
OA
OB
OC
OD
Robo3x-1.3 48Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Video 2.4Vijay Kumar and Ani Hsieh
Robo3x-1.3 49Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Vijay Kumar and Ani HsiehUniversity of Pennsylvania
Newton Euler Equations (continued)
Robo3x-1.3 50Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Newton Euler Equations
Newton’s equations of motion
Euler’s equations of motion
A rigid body B accelerates in an inertial frame A as if it were a single particle with the same mass m (equal to the total mass of the system) acted upon by a force equal to the net external force.
The rate of change of angular momentum of the rigid body B with the center of mass C as the origin in A is equal to the resultant moment of all external forces acting on the body with C as the origin
Robo3x-1.3 51Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Moment of Inertia of 3-D Objects?
C
x
y
r
dm
Robo3x-1.3 52Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Inertia Tensor of 3-D Objects
C
x
y
r
dm
Robo3x-1.3 53Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Inertia Dyadic
Principal Moments of
Inertia
Products of Inertia
Robo3x-1.3 54Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Example: Rectangular Plate Rotating about Axis through Center of Mass
C
B
CB
A
Is the angular momentum parallel to the angular velocity?
Robo3x-1.3 55Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Example: Rectangular Plate Rotating about Axis through Center of Mass
C
B
CB
A
Is the angular momentum parallel to the angular velocity?
Robo3x-1.3 56Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Principal Axes and Principal Moments
Principal axis
• u is a unit vector along a principal axis if I u is parallel to u
• There are 3 independent principal axes!
Principal moment of inertia
• The moment of inertia with respect to a principal axis, uT
I u, is called a principal moment of inertia.
Robo3x-1.3 57Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Examples
b1
b3
b2
b1
b3
b2
Robo3x-1.3 58Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Euler’s Equations of Motion
b1
b3
b2
C
In frame B
Robo3x-1.3 59Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Euler’s Equations of Motion
b1
b3
b2
C
In frame A
need to differentiate in A
Robo3x-1.3 60Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Euler’s Equations of Motion
b1
b3
b2
C
Transform back to frame B
angular velocity in frame B
Robo3x-1.3 61Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Euler’s Equations of Motion
b1
b3
b2
C
1. frame B (bi) along principal axes
angular velocity, moments of inertia, moments in frame B
2. center of mass as origin
3. all components along bi
Robo3x-1.3 62Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Quadrotor
w1
w2
w3
w4
mg
Robo3x-1.3 63Property of Penn Engineering, Vijay Kumar and Ani Hsieh
Static Equilibrium (Hover)
w1
w2
w3
w4
mg
Motor Speeds
Motor Torques
Robo3x-1.3 64Property of Penn Engineering, Vijay Kumar and Ani Hsieh
w3
w1
w2
w4
F4
F3
F2
F1
M2
M3
M4
M1
Resultant Force
Resultant Moment about C
Cr4 r1
r3
r1
mg
Robo3x-1.3 65Property of Penn Engineering, Vijay Kumar and Ani Hsieh
u1
u2
Newton-Euler EquationsB
Rotation of thrust
vector from B to A
Components in the body frame along b1, b2,
and b3, the principal axes
Components in the inertial
frame along a1, a2, and a3
b1
b3
b2