14

advertisement
14 PENDULUM DYNAMICS AND LINEARIZATION
14
35
Pendulum Dynamics and Linearization
Consider a single-link arm, with length l and all the mass m concentrated at the end. A
motor at the fixed pivot point supplies a controllable torque τ . As drawn, a positive torque
drives the arm counter-clockwise, so as to drive the arm angle θ positive. The arm is free to
swing around the full 360 degrees; gravity pulls the arm downward. There is no damping.
m
g
l
W
T
1. Derive and state the equation of motion for this system.
Solution: It is a basic rotary moment of inertia with a gravity effect and input torque.
We will get
ml2 θ¨ = τ − mgl cos θ.
2. For each of the linearization angles [-90,0,90] degrees, answer the following:
(a) What is the static torque needed to support the arm in this configuration?
Solution: For the three angles given, the static torque is the amount needed to
just balance the gravity torque. These values are [0, mgl, 0]; note that the upward
and downward configurations do not take any static torque to maintain.
(b) Assuming that the static torque is continuously applied, but that there is no dy­
namic torque, what is the equation of motion for small deviations from the static
angle? We are looking for a differential equation in the perturbation of θ, say θ̃.
Solution: The key here is to write the angles and the torques as being comprised
¯ tau)
˜ τ̃ ):
¯ and a dynamic part (θ,
of a static (θ,
ml2
�
d �
θ̄ + θ̃ = τ̄ + τ̃ − mgl cos(θ̄ + θ̃) + d
dt
d
ml2 θ̃ = τ̄ − mgl cos θ̄ cos θ̃ − mgl sin θ̄ sin θ̃ + d.
dt
Along with a trigonometric identity, we used the facts that dynamic torque τ̃ is
zero, and that static angle θ̄ has zero second derivative. We can see that cos θ̃ 14 PENDULUM DYNAMICS AND LINEARIZATION
36
linearizes to simply one, and so the first two terms on the right-hand side in the
second line give us precisely the static torques of part (i). The term d represents a
torque perturbation. We are left with the following linear equations for the three
static angles [-90, 0, 90] degrees, respectively:
mgl¨θ̃ = −mglθ̃ + d
mglθ̃¨ = d
¨
mglθ̃ = mglθ̃ + d.
(c) In words and in an annotated graph, show what is the response of the equilibrium
system to a (small) torque impulse. Be sure to take into account the fact that
the system could respond differently to impulses of opposite directions.
Solution: The first differential equation above is that of a second-order, undamped
oscillator. A perturbation to the equilibrium will lead to oscillations of constant
size. The second equation above is a ”double integrator,” like a mass on a slid­
ing contact; an impulsive d will set the arm spinning at constant speed, with no
damping or restoring force. Of course, as the arm travels our linearizing assump­
tions (namely that θ̃ is small) fail, and we see some other interesting behavior.
If the perturbation is upward, the static torque will be larger than the gravity
torque, and the arm will accelerate in the positive direction, up and over the top!
If the perturbation is negative, we can again expect an acceleration in the positive
direction for the same reasons, again going up and over. It doesn’t get stuck at
zero degrees because there is no damping and inertia will carry it through. Fi­
nally, the upward static configuration is just plain unstable because it is as if we
have a negative spring term - any perturbation will cause the arm to fall over.
T
t
T = -90 deg
T = 0 deg
T = +90 deg
MIT OpenCourseWare
http://ocw.mit.edu
2.017J Design of Electromechanical Robotic Systems
Fall 2009
For information about citing these materials or our Terms of Use, visit: http://ocw.mit.edu/terms.
Download