Beruflich Dokumente
Kultur Dokumente
A01183339
A01182824
A01361608
Introduction
There has been a great evolution in the robotics field these days, however most of
the research specially in the control of those robots is focused on production and
manufacturing robots, but there are some other types of robots, for example the
underactuated robots, which contain a greater number of DOFs than the strictly
necessary, as they have less actuators they are smaller, lighter and have better
energy consuption than the regular ones, the problem here is that the control of
these systems is much more complex, and it has been less studied.
One of the biggest problems in this kind of systems, and the one that this work will
focus on, is how to control one of the degrees of freedom that does not have an
actuator (Indirect way), the ball and beam is going to be used to explain this
process.
The ball and beam system is one of the most popular and important laboratory
models for teaching control systems in engineering. Throughout this paper we
present the development of this control system, we will be talking about the
theoretical framework, the mathematical background and model, and the different
steps that were developed to achieve it.
The ball and beam system is classified as an underactuated system, because even
though it has two degrees of freedom, it uses only one actuator. The main purpose
of the system is to balance a steel ball on a beam and take it to a desired position.
Fig.1 Example of
ball and beam with
gear arrangement.
The other type of ball and beam that is commonly found on the labs is one that
uses an actuator attached just to the middle of the bar.
Objectives.
Main objetive
The main objective in this work is to model and simulate prototype of the
previously discussed system, ball and beam.
Specific objectives
To design from scracth a mathematical model for the system.
To understand the mathematical processes, required to program the
mathematical models.
To implement control algorithms to the system, so we can achieve a desired
position.
To create a complete virtual model on the system, considering as much
variables as posible.
Problem Statement
As mentioned in the introduction above, it is needed an efficient control system, for
underactuated mechanisms, it is required to find a way to control the position of an
element by controlling a non direct actuator.
Mathematical Model.
The mathematical model of a system, is its representation with some equations,
genarally, diferential equations, obtained through the laws of the physics that
applies to the system, in order to simulate those conditions, and being capable of
studying them and controlling them.
In this paper we are going to be using the Euler-Lagrange method, this method is
used to model dynamic systems by means of the potential and Kinetic energies of
those systems.
The Lagrangian is represented by:
L = K V (1)
Where K is the kinetic energy and V is the potential energy of the system, the
lagrangian is going to be used in the Euler-Lagrange method as follows:
d L L
= (2)
dt q q
Where:
q is the generalized coordinate vector.
L is the lagrangian
is the vector of any momentum applied the system .
The first step in this process is to determine the independent variables in the
system, in this case we will consider two, the first one is the position of the bar with
the x axis, this is given by an angle, we will call this variable q 2, the second variable
is the position of the ball throughout the bar, we will call this variable q 1, this is
shown in the next figure.
Now that we have determined the variables, we will find the kinetic and potential
energies of the system. The Kinetic energy of a system is given by the next
expression:
K=
i =1
1
2
IiV i
2
(3)
K ball =
i=1
1
I b V 2b
2
(4)
= 1 I m V 2m
i=1 2
K
(5)
It is important to mention here, that the ball has angular velocity and lineal velocity,
this happens because the ball moves up and down with bar, and at the same time
it moves through the beam. The new kinetic energy can be expressed as:
1
2 1
2
K ball = I b q 2 + m V b
2
2
(6)
Finally the total kinetic energy can be expressed as the kinetic energy of the ball
and the beam combined.
1
1
1
K ball = I b q 22 + m V 2b + I m q 22
2
2
2
(7)
1
1
( I b + I m ) q 22 + m V 2b
2
2
2
We still need to find the velocity of the ball ( V b ), to do so, we need the position
vector of the ball, this is obtained with some trigonometry as shown below:
Rm =q1
The velocity is the
derivative of the position, therefore, to obtain the vector of the position we find:
d
V b= ( R
) (9)
dt m
q1 q 2 sin ( q 2) + q 1 cos ( q 2 ) ,q 1 q2 cos ( q 2) + q 1 sin ( q2 )
Now that we have obtained the velocity, we just need to square it, the results are
shown below:
2
2
2
2 2
2
2
2
As we know that
V 2b= q 21 +q 21 q2
(11)
1
2 1
2
2
K Total = ( I b+ I m ) q 2+ m ( q 1 +q 1 q2) (12)
2
2
The next step is to find the potential energy, the potential energy goes as follows:
V =mgh
(13)
(14)
(15)
We have found the energies, the next step is to find the lagrangian, however, we
have to consider the inertial forces, so we are going to calculate the inertial forces
first.
The balls moment of inertia is given by the formula:
2
2
I b= m R
5
1
ml 2
12
(16)
Now that we have all of the elements we can calculate the lagrangian, we will find:
d L
L
=0
dt q 1 q 1
( )
d L
L
=
dt q 2 q 2
( )
( )
m q1m q1 q 22 +mgsin ( q2 ) =0
(17)
(18)