QUBE-Servo Inverted Pendulum Modeling

MODELING DOCUMENTATION
QUBE-SERVO INVERTED PENDULUM MODELING
v 1.0
QUBE-Servo Rotary Inverted

Pendulum Modeling
1.1 Model Convention

The rotary inverted pendulum model is shown in Figure 1.1. The rotary arm pivot is attached to the QUBE-Servo
base and is actuated. The arm has a length of Lr , a moment of inertia of Jr , and its angle, , increases positively
when it rotates counter-clockwise (CCW). The servo (and thus the arm) should turn in the CCW direction when the
control voltage is positive, i.e., Vm > 0.
L
The pendulum link is connected to the end of the rotary arm. It has a total length of Lp and it center of mass is 2p .
The moment of inertia about its center of mass is Jp . The inverted pendulum angle, , is zero when it is perfectly
upright in the vertical position and increases positively when rotated CCW.
Figure 1.1: Rotary inverted pendulum conventions
1.2 Nonlinear Equations of Motion

Instead of using classical mechanics, the Lagrange method is used to find the equations of motion of the system.
This systematic method is often used for more complicated systems such as robot manipulators with multiple joints.
More specifically, the equations that describe the motions of the rotary arm and the pendulum with respect to the
servo motor voltage, i.e. the dynamics, will be obtained using the Euler-Lagrange equation:
2L
L
= Qi
t qi
qi
The variables qi are called generalized coordinates. For this system let
q(t) = [(t) (t)]
(1.1)
where, as shown in Figure 1.1, (t) is the rotary arm angle and (t) is the inverted pendulum angle. The corresponding velocities are
[
]
(t) (t)
q(t)
=
t
t
Note: The dot convention for the time derivative will be used throughout this document, i.e., =
variable t will also be dropped from and , i.e., = (t) and = (t).
d
dt .
The time
With the generalized coordinates defined, the Euler-Lagrange equations for the rotary pendulum system are
L
2L
t
L
2L
= Q1
= Q2
The Lagrangian of the system is described

L=T V
where T is the total kinetic energy of the system and V is the total potential energy of the system. Thus the Lagrangian
is the difference between a system's kinetic and potential energies.
The generalized forces Qi are used to describe the non-conservative forces (e.g., friction) applied to a system with
respect to the generalized coordinates. In this case, the generalized force acting on the rotary arm is
Q1 = Br
and acting on the pendulum is
Q2 = Bp .
See the QUBE-Servo User Manual for a description of the corresponding QUBE parameters (e.g. such as the backemf constant, km ). Our control variable is the input servo motor voltage, Vm . Opposing the applied torque is the
viscous friction torque, or viscous damping, corresponding to the term Br . Since the pendulum is not actuated, the
only force acting on the link is the damping. The viscous damping coefficient of the pendulum is denoted by Bp .
The Euler-Lagrange equations is a systematic method of finding the equations of motion, i.e., EOMs, of a system.
Once the kinetic and potential energy are obtained and the Lagrangian is found, then the task is to compute various
derivatives to get the EOMs. After going through this process, the nonlinear equations of motion for the QUBE-Servo
rotary inverted pendulum are:
(
)
(
)
1
1
1
2
2
2
2
mp Lr + mp Lp mp Lp cos() + Jr
mp Lp Lr cos()
4
4
2
)
(
)
(
1
1
mp L2p sin() cos() +
mp Lp Lr sin() 2 = Br
(1.2)
+
2
2
(
)
1
1
1
mp L2p cos() sin()2
mp Lp Lr cos() + Jp + mp L2p
2
4
4
1
mp Lp g sin() = Bp .
(1.3)
2
The torque applied at the base of the rotary arm (i.e., at the load gear) is generated by the servo motor as described
by the equation
g Kg m kt (Vm Kg km )
=
.
(1.4)
Rm
v 1.0
Both the equations match the typical form of an EOM for a single body:
Jx
+ bx + g(x) = 1
where x is an angular position, J is the moment of inertia, b is the damping, g(x) is the gravitational function, and 1
is the applied torque (scalar value).
For a generalized coordinate vector q, this can be generalized into the matrix form
(1.5)
D(q)
q + C(q, q)
q + g(q) =
where D is the inertial matrix, C is the damping matrix, g(q) is the gravitational vector, and is the applied torque
vector.
The nonlinear equations of motion given in 1.2 and 1.3 can be placed into this matrix format.
1.3 Linearizing
Here is an example of how to linearize a two-variable nonlinear function called f (z). Variable z is defined
z = [z1 z2 ]
and f (z) is to be linearized about the operating point
z0 = [a b]
The linearized function is
(
flin = f (z0 ) +
f (z)
z1
(
(z1 a) +
z=z0
f (z)
z2
(z2 b)
z=z0
1.4 Linear State-Space Model

The linear state-space equations are
x = Ax + Bu
(1.6)
y = Cx + Du
(1.7)
and
where x is the state, u is the control input, A, B, C, and D are state-space matrices. For the rotary pendulum system,
the state and output are defined
x = [ ]
(1.8)
and
y = [x1 x2 ].
(1.9)
In the output equation, only the position of the servo and link angles are being measured. Based on this, the C and
D matrices in the output equation are
[
]
1 0 0 0
C=
(1.10)
0 1 0 0
and
[ ]
0
D=
.
0
(1.11)
The velocities of the servo and pendulum angles can be computed in the digital controller, e.g., by taking the derivative and filtering the result though a high-pass filter.

QUBE-Servo Inverted Pendulum Modeling

Uploaded by

Copyright:

Available Formats

QUBE-Servo Inverted Pendulum Modeling

Uploaded by

Document Information

Original Description:

Original Title

Copyright

Available Formats

Share this document

Share or Embed Document

Sharing Options

Did you find this document useful?

Is this content inappropriate?

Copyright:

Available Formats

QUBE-Servo Inverted Pendulum Modeling

Uploaded by

Copyright:

Available Formats

MODELING DOCUMENTATION

QUBE-SERVO INVERTED PENDULUM MODELING

QUBE-Servo Rotary Inverted

1.1 Model Convention

Figure 1.1: Rotary inverted pendulum conventions

1.2 Nonlinear Equations of Motion

QUBE-SERVO INVERTED PENDULUM MODELING

The Lagrangian of the system is described

1.4 Linear State-Space Model

You might also like