Documenti di Didattica
Documenti di Professioni
Documenti di Cultura
e-ISSN: 2455-5703
I. INTRODUCTION
In order to understand the concepts of modern control theory the BBS connected with servo motor is considered as an illustrative
example. The two degrees of freedom of the proposed system are namely, the rolling of the ball back along the beam, and the
beam rotation. The controller design for an unstable system is a difficult task for control engineers and researchers.
The mathematical modelling of the system becomes simpler when the beam deflects a small angle from the horizontal
position which leads to insignificant nonlinear property. Appreciable research work had been done on this laboratory test bench.
A feedback linearization controller is proposed by Hauser et al. A Linear Quadratic Regulator (LQR) for stabilization is designed
by Pang et al. H.Verrelst et al used Neural Network for stabilization of BBS. S.K Oh et al proposed Fuzzy based cascade control
and Chang et al designed a tracking control strategy using fuzzy sliding-mode controllers. Further all the intelligent controllers
are knowledge based and the stability of the system is not guaranteed. In this proposed work controller is designed for
positioning the ball along the beam by manipulating the servomotor voltage. The mathematical modelling of BBS connected
with servo motor is obtained from the force balance equation expressed using Newtons law of motion. The state space
modelling of the plant is obtained so as to design optimal controllers. An implementation of FSFB controller with set point gain
and linear quadratic controller for the modelled system is carried out. The paper is organized as follows. Section II gives details
about the mathematical modelling of BBS and servomotor. In Section III the concepts of full-state feedback controller for a
desired specification is presented. In Section IV the design of Linear Quadratic controller is discussed. The stability analysis of
the closed loop system is presented in section V. The simulated results are given in section VI. Finally conclusion is given in
section VII.
249
Frx
Ftx m
d2x
mx
dt 2
Frx
J
Tr J d b J d (vb / R) J
2x
R R dt
R
dt
R
2
mR 2
5
Frx
2
mx
5
Applying the Newtons second law for forces along the inclination, we have
2
mx mx mg sin
5
Or
5
g sin
7
(1)
5
g
7
(2)
2) The arc distance traversed by the gear at radius r is equated to the arc distance traversed by the beam at radius L , hence
r L or
r
L
x
X ( s)
( s)
K
S2
5 gr
K
7L
(3)
250
B. Modelling of Servomotor
The armature voltage equation is,
Va t La
dia t
dt
Ra ia t K m m
K g K m ia t J L BL
J L BL
K g Km
Ignoring armature inductance the armature voltage equation becomes,
ia t
J BL
Va t Ra L
K g K m
K m Kg
2
K g K mVa S Ra J L S 2 BL S K m Kg S (S )
The transfer function of the servo motor including inertia and friction of load shaft is
Km K g
(s)
Va ( s )
Ra J eq
2 Beq K m2 K g2
S
J
Ra J eq
eq
(4)
Or equivalently,
( s)
Va ( s)
am
S ( S bm )
(5)
Where
am
Km K g
Ra J eq
bm
Beq
J eq
K m2 K g2
Ra J eq
bm amVa
(6)
Parameter
Beam length (L) in meter
Lever arm offset (r) in meter
Acceleration due to Gravity ( g ) in m/S2
Value
0.1675
0.0254
2.6
0.00767
gear ratio ( K g )
70
9.84
Efficiency ( )
0.8
0.0023
4 103
x x and using equation (3) & (6) the state space model is obtained.
x 0
x
0
0
0
0 K
0
0 x 0
0 x 0
V
1 0 a
bm am
251
x
x
y 1 0 0 0
The system parameters given in Table.1 are used for simulation purpose.
The block diagram of FSFB controlled system is shown in Fig.2, which is composed of plant, state feedback gain matrix
and a pre compensator which provides a set point gain factor. The primary need for adding set point gain is to compute new
reference input that increases the speed of system response thus reduces the steady-state error to zero. The controllability
property reveals that the system under consideration is controllable.
n
4
30
ts
It is desired to have overshoot of less than 3% and settling time less than 0.2 seconds, which corresponds to a
30 . The closed loop poles p p p and p are thus chosen as 30 j30, 50, 200 .Now, the state feedback gains are
and d
1, 2, 3
4
obtained by solving the equation given below
det sI A B K ( s p1 )( s p2 )( s p3 )( s p4 ) 0
The closed loop response with FSBF controller results in large steady state error, and in order to compensate for this error, a
reference input compensation is included.
The state space model and output equation of the closed loop system with set point gain is,
x
0
1
0
0 x
0
x
x
0
0
1.1
0
0
Va
0
0
0
1
0
16360000
954500
26800
310
16360000
y = 1
0 0 0 x x
The state space model given above is used to carry out simulation as shown in Fig.2. The state feedback gains for
various pole locations are evaluated and listed in Table 2, which indicates that as the dominant poles are moved farther from
imaginary axis, the speed of response increases.
The state space model given above is used to carry out simulation as shown in Fig.2.
Closed loop pole location
50, 200
& 30 j 30
246070
14350 400 3
VGM
in dB
246070
8.5
252
50, 200
& 10 j10
50, 200
27341
3418 229 3
27341
10.6
J [ xT Qx u T Ru ]dt
0
(7)
Where Q is a nonnegative-definite matrix that penalizes the departure of system states from the equilibrium and R is a
positive-definite matrix that penalizes the control input. The objective is to select the optimal state feedback controller gains.
The selection of matrix Q & R is designers choice. Depending on the choice of these matrices, the closed loop system will
exhibit different set point tracking responses. Selecting Q large, keeps J small so that the states are smaller. Small values of
R make the control effort less, so that the performance index J given in equation (7) becomes small. Larger values of Q and
smaller values of R results in location of closed loop poles far away from the origin which guarantees relative stability.
Consider a system described by the state space equation
X A X B u & y C X d u
The optimal control minimising J is given by the linear feedback law U (t ) K X (t )
1 T
with K R B P ,where P is the unique positive definite solution to the Algebraic Ricattic Equation (ARE) given
by equation
AT P PA Q PBR1BT P 0
T
Let the scalar function be, V ( x) X PX with V ( x) 0
V ( x) is, V ( x) X T PX X T PX
T
T
Now , V ( x) ( AX Bu ) PX X P( AX Bu )
The time derivative of
V ( x) X T ( AT P PA) X uT BT PX X T PBu
T
1 T
From ARE we have, A P PA Q PBR B P
T
T
T
T
1
T
We get, V ( x) ( X QX u Ru ) ( B PX Ru ) R ( B PX Ru )
Integrating
V ( x) we get
T
T
1
T
V ( x)dt J (B PX Ru) R (B PX Ru)dt
253
LQR gains
0.1
7.07
6.2 3 0.071
0.01
22.36
0.001
70.7
Eigen Values
40, 2.35
& 1.17 j 2.03
VGM
in dB
7.07
30.87
22.36
17.59
70.71
6.87
40, 3.45
& 1.71 j 2.98
40, 5.1
& 2.5 j 4.37
V. STABILITY ANALYSIS
According to Franklin et al (2006), vector gain margin (VGM) is a single margin parameter that combines gain and phase
margins into a single measure. This quantity eliminates the ambiguities that exist with the gain margin and phase margin
combination in relation to analyzing stability of a system. The original idea of VGM was proposed by Smith (1958) as cited in
the work by Franklin et al (2006) is adopted in this work. The vector margin or stability margin is the minimum distance from
the Nyquist plot to the point (-1+j0) and the idea is illustrated graphically n Fig.3. Recent advances in computing facility have
made measurement of VGM feasible which was not been used in the past extensively due to difficulties in computing it.
1
1 G ( s )Gc ( s )
1
9.5 dB
3.5 dB max
1 L( j pc )
Where
L( j pc )
1
1 L( j pc )
as given in
(8)
254
of the closed loop system with proposed controllers is presented in Fig.11 & Fig.12. As all the contours corresponding to the
loop transfer function does not encloses the -1+j0 point, stability is assured
Fig. 4: Open loop step response of BBS connected with servo motor
255
256
257
VII.
CONCLUSION
The proposed algorithm is demonstrated for BBS with servomotor. It has been shown that, FSFB controller with pre
compensator tracks the set point with desired settling time. Also it exhibits less overshoot than LQC. The performance summary
given in Table 4 indicates that, the time domain specifications are close to the desired specifications with FSFB controller than
with LQC. The stability of the closed loop system is more for LQC than with FSFB controller.
Parameter
FSFBC
LQC
Settling time
Rise time
0.15 sec
0.07 sec
1.33 sec
0.455 sec
Peak time
% overshoot
0.146 sec
2.04%
1 sec
8.22%
REFERENCES
[1] J. Hauser, S. Sastry, and P. Kokotovic, Nonlinear control via approximate input-output linearization the ball and beam
example, Institute of Electrical and Electronics Engineers, Transactions on Automatic Control, vol. 37, no. 3, pp. 392398,
1992.
[2] Z.H Pang, G. Zheng and C.X. Luo, Augmented State Estimation and LQR Control for a Ball and Beam System, Proc. of
the 6th IEEE Conference on Industrial Electronics and Applications., pp.1328-1332, June 21-23, 2011.
[3] H. Verrelst, K. Van Acker, J. Suykens, B. Motmans, B. De Moor and J. Vandewalle, Neural Control Theory: Case Study
for a Ball and Beam System, Proc. of the European Control Conference Brussels, Belgium, July 4, 1997.
[4] S.K Oh, H.J. Jang and W. Pedrycz, The Design of a Fuzzy Cascade Controller for Ball and Beam System: A Study in
Optimization with the Use of Parallel Genetic Algorithms, Engineering Applications of Artificial Intelligence, Vol. 22, pp.
261271, 2009.
[5] Y.H. Chang, C.W. Chang, C.W. Tao, H.W. Lin and J.S. Taur, Fuzzy Sliding-mode Control for Ball and Beam System with
Fuzzy ant Colony Optimization, Expert Systems with Applications, Vol. 39, No. 3, pp. 3624-3633, 2012.
[6] Ball and Beam Experiment and Solution, Quanser Consulting, 1991.
258