Professional Documents
Culture Documents
8 - Optimal Control of Nonlinear Inverted Pendulum System
8 - Optimal Control of Nonlinear Inverted Pendulum System
DOI: 10.1007/s11633-014-0818-1
Abstract: Linear quadratic regulator (LQR) and proportional-integral-derivative (PID) control methods, which are generally used
for control of linear dynamical systems, are used in this paper to control the nonlinear dynamical system. LQR is one of the optimal
control techniques, which takes into account the states of the dynamical system and control input to make the optimal control decisions.
The nonlinear system states are fed to LQR which is designed using a linear state-space model. This is simple as well as robust. The
inverted pendulum, a highly nonlinear unstable system, is used as a benchmark for implementing the control methods. Here the control
objective is to control the system such that the cart reaches a desired position and the inverted pendulum stabilizes in the upright
position. In this paper, the modeling and simulation for optimal control design of nonlinear inverted pendulum-cart dynamic system
using PID controller and LQR have been presented for both cases of without and with disturbance input. The Matlab-Simulink models
have been developed for simulation and performance analysis of the control schemes. The simulation results justify the comparative
advantage of LQR control method.
Keywords: Inverted pendulum, nonlinear system, proportional-integral-derivative (PID) control, optimal control, linear quadratic
regulator (LQR).
tion 5 presents conclusions. At the end, a brief list of ref- ponents in the x and y directions, respectively.
erences is given. After manipulation, (4) is written as
mẍ cos θ + mlθ̈ = mg sin θ. (5)
2 Mathematical modeling
Equations (3) and (5) are the equations defining this sys-
2.1 Inverted pendulum system equations tem. These two equations are manipulated algebraically to
have only a single second derivative term in each equation.
The free body diagram of an inverted pendulum mounted Finally, we may derive the system equations describing the
on a motor driven cart is shown in Fig. 1[1−4] . The system cart position dynamics and the pendulum angle dynamics,
equations of this nonlinear dynamic system can be derived respectively. Thus we have
as follows. It is assumed here that the pendulum rod is
mass-less, and the hinge is frictionless. In such assumption, u + ml(sin θ)θ̇2 − mg cos θ sin θ
ẍ = (6)
the whole pendulum mass is concentrated in the centre of M + m − m cos2 θ
L. B. Prasad et al. / Optimal Control of Nonlinear Inverted Pendulum System Usingp PID Controller and LQR · · · 663
u cos θ − (M + m)g sin θ + ml(cos θ sin θ)θ̇2 If both the pendulum angle θ and the cart position x are
θ̈ = . (7)
ml cos2 θ − (M + m)l the variables of interest, then the output equation may be
written as
⎡ ⎤
θ
θ ⎢ θ̇ ⎥
1 0 0 0 ⎢ ⎥
x or y =
y = Cx x=
= Cx ⎢ ⎥.
x 0 0 1 0 ⎣ x ⎦
ẋ
(15)
Equations (6) and (7) represent a nonlinear system which 2.3 Linear system state space equations of
is relatively complicated from a mathematical point of view. inverted pendulum
The following subsection presents the standard state space
form of these two nonlinear equations.
Since the goal of this particular system is to keep the in-
2.2 Nonlinear system state space equa- verted pendulum in the upright position around θ = 0, the
tions of inverted pendulum linearization might be considered about this upright equi-
librium point. The linear model for the system around the
For numerical simulation of the nonlinear model for the upright stationary point is derived by simply linearization
inverted pendulum-cart dynamic system, it is required to of the nonlinear system given in (10). Since the usual A and
represent the nonlinear equations (6) and (7) into the stan- B matrices are zero for this case, and so every term is put
dard state space form: into the nonlinear vector function f (x x, u, t), the linearized
form for the system becomes
x
dx
x , u, t).
= f (x (8)
dt
Consider the state variables:
x
dδx
x0 , u0 )δx
= J x (x x + J u (x
x0 , u0 )δu (16)
x1 = θ, x2 = θ̇ = ẋ1 , x3 = x, x4 = ẋ = ẋ3 . (9) dt
by ∂xx1
, ∂xx2
, ∂xx3
, and ∂xx4
, respec-
x 0 ,u0 x 0 ,u0 x 0 ,u0 x 0 ,u0
f1 = x2 (11) tively. Thus, combining all these separate terms gives
that the pendulum stabilizes in the vertically upright po- zero for the case of with continuous disturbance input. The
sition quickly and smoothly after two minor undershoots control input u is bounded for both cases in ranges [−0.1
and a minor overshoot for the case of without disturbance 0.1] and [−1 1], respectively. The simulation results jus-
input, and it also stabilizes in the vertically upright posi- tify the effectiveness and robustness of the cart PID+LQR
tion with minute oscillations for the case of with continuous control.
disturbance input. The angular velocity approaches 0 rad/s
quickly for the case of without disturbance input, and it os-
cillates by approximately +/−0.01 rad/s remaining at most
in the range approximately +/−0.02 rad/s for the case of
with continuous disturbance input. The cart position x
reaches smoothly the desired position of 0.1 m quickly in
approximately 6 s, and the cart velocity reaches zero for
both cases. The control input u is bounded for both cases
in ranges [−0.1 0.1] and [−1 1], respectively. The simu-
lation results justify the effectiveness and robustness of the
2PID+LQR control.
The Simulink models for the optimal control of the non-
linear inverted pendulum-cart system using one PID con-
troller (cart PID) with LQR control method for both cases
of without and with disturbance input are shown in Figs. 11
and 13, respectively. This control method is similar to
2PID+LQR control method in all respects of control tech-
Fig. 8 Responses of pendulum angle θ (solid line), angular ve-
niques but differs only in the number of PID controllers
locity θ̇ (dashed line), cart position x (solid line), cart velocity ẋ
used. Here only cart PID controller is used, and angle PID
(dashed line), and control force u of nonlinear inverted pendulum
controller is not used. Here only cart position x is taken
system with cart PID, angle PID and LQR control
as variable of interest for control. The reference cart po-
sition is set to 0.1 m. The desired angle to be zero is di-
rectly taken care of by state feedback control of LQR which
is designed using the linear state-space model of the sys-
tem with vertically upright position as the reference. The
band limited white noise is added as the disturbance input
to the system. The simulation results for both cases are
shown in Figs. 12 and 14, respectively. The responses of
angle θ, angular velocity θ̇, cart position x, cart velocity ẋ,
and control u are plotted. It is observed that the pendu-
lum stabilizes in the vertically upright position quickly and Fig. 9 Cart PID, Angle PID and LQR control of nonlinear in-
smoothly after two minor undershoots and a minor over- verted pendulum system with disturbance input
shoot for the case of without disturbance input, and it also
stabilizes in the vertically upright position with minute os-
cillations for the case of with continuous disturbance input.
The angular velocity approaches 0 rad/s quickly for the case
of without disturbance input, and it oscillates by approxi-
mately +/−0.01 rad/s remaining at most in the range ap-
proximately +/−0.02 rad/s for the case of with continuous
disturbance input. The cart position x reaches the desired
position of 0.1 m quickly and smoothly in approximately 6 s
for both cases. The cart velocity reaches zero for the case
of without disturbance input, and it oscillates very near to
Control schemes θ θ̇ x ẋ u
PID 0.0046 – 0.0976 – 0.1402
2PID+LQR 0.0029 0.0070 0.1000 0.0330 0.1500
1PID+LQR 0.0029 0.0067 0.1000 0.0331 0.1500
The LQR is designed using the linear state-space model of [8] K. J. Astrom, T. J. McAvoy. Intelligent control. Journal
the system. The optimal control value of LQR is added Process Control, vol. 2, no. 3, pp. 115–127, 1992.
negatively to the PID control value to have a resultant
optimal control. The Matlab-Simulink models have been [9] T. I. Liu, E. J. Ko, J. Lee. Intelligent control of dynamic
systems. Journal of the Franklin Institute, vol. 330, no. 3,
developed for simulation and performance analysis of the pp. 491–503, 1993.
control schemes. The tuning of the PID controllers which
are used here either as PID control method or PID+LQR [10] Y. Becerikli, A. F. Konar, T. Samad. Intelligent optimal
control methods is done by using trial and error method control with dynamic neural networks. Neural Networks,
and observing the responses achieved to be optimal. The vol. 16, no. 2, pp. 251–259, 2003.
simulation results justify the comparative advantage of the
optimal control using LQR method. The pendulum stabi- [11] K. M. Passino, S. Yurkovich. Fuzzy Control, California: Ad-
dison Wesley Longman, Inc., 1998.
lizes in the upright position and the cart reaches the de-
sired position quickly and smoothly even under the con-
[12] V. Kumar, A. P. Mittal. Parallel fuzzy P + fuzzy I + fuzzy
tinuous disturbance input such as wind force justify that D controller: Design and performance evaluation. Interna-
the control schemes are effective and robust. The analy- tional Journal of Automation and Computing, vol. 7, no. 4,
sis of the responses of control schemes gives that the per- pp. 463–471, 2010.
formance of proposed PID+LQR control method is better
than PID control. This comparative performance investi- [13] S. C. Tong, Y. M. Li. Adaptive backstepping output feed-
back control for SISO nonlinear system using fuzzy neural
gation for this benchmark system shows that the proposed
networks. International Journal of Automation and Com-
PID+LQR control approach is a simple, effective and ro- puting, vol. 6, no. 2, pp. 145–153, 2009.
bust control scheme for the optimal control of nonlinear
dynamical systems. The performance investigation of this [14] M. A. Abido. Optimal design of power-system stabilizers
control approach with tuning of PID controller parameters using particle swarm optimization. IEEE Transactions on
using GA and PSO instead of trial and error method may Energy Conversion, vol. 17, no. 3, pp. 406–413, 2002.
be done as a future work.
[15] J. Fisher, R. Bhattacharya. Linear quadratic regulation of
systems with stochastic parameter uncertainties. Automat-
Acknowledgement ica, vol. 45, no. 12, pp. 2831–2841, 2009.
First author is thankful to M. M. M. Engineering Col- [16] M. A. Denai, F. Palis, A. Zeghbib. Modeling and control
lege Gorakhpur; Quality Improvement Programme Centre, of non-linear systems using soft computing techniques. Ap-
Indian Institute of Technology, Roorkee; and AICTE, India plied Soft Computing, vol. 7, no. 3, pp. 728–738, 2007.
for sponsoring him for Ph. D. research work under Quality
Improvement Programme scheme. [17] L. B. Prasad, K. P. Singh, H. L. Javvaji. Simulation of
neuro-fuzzy position controller for induction motor drive
using simulink. In Proceedings of XXXI National Systems
References Conference, Article number P–49, MIT Manipal, India,
2007.
[1] K. Ogata. Modern Control Engineering, 4th ed., New Delhi:
Pearson Education (Singapore) Pvt. Ltd., 2005. [18] G. Ray, S. K. Das, B. Tyagi. Stabilization of inverted pen-
dulum via fuzzy control. Journal of The Institution of En-
[2] A. K. Mandal. Introduction to Control Engineering, New gineers (India)–Electrical Engineering, vol. 88, pp. 58–62,
Delhi: New Age International Pub., 2000. 2007.
[3] L. B. Prasad, B. Tyagi, H. O. Gupta. Optimal control of [19] C. W. Tao, J. S. Taur, C. M. Wang, U. S. Chen. Fuzzy
nonlinear inverted pendulum dynamical system with distur- hierarchical swing-up and sliding position controller for the
bance input using PID controller & LQR. In Proceedings inverted pendulum-cart system. Fuzzy Sets and Systems,
of IEEE International Conference on Control System, Com- vol. 159, no. 20, pp. 2763–2784, 2008.
puting and Engineering, IEEE, Penang, Malaysia, pp. 540–
545, 2011. [20] Y. M. Liu, Z. Chen, D. Y. Xue, X. H. Xu. Real-time con-
trolling of inverted pendulum by fuzzy logic. In Proceedings
[4] L. B. Prasad, B. Tyagi, H. O. Gupta. Modelling and sim- of IEEE International Conference on Automation and Lo-
ulation for optimal control of nonlinear inverted pendulum gistics, IEEE, Shenyang, China, pp. 1180–1183, 2009.
dynamical system using PID controller and LQR. In Pro-
ceedings of the 6th Asia Modelling Symposium, IEEE, Bali, [21] K. J. Astrom, K. Furuta. Swinging up a pendulum by en-
Indonesia, pp. 138–143, 2012. ergy control. Automatica, vol. 36, no. 2, pp. 287–295, 2000.
[5] F. L. Lewis. Optimal Control, New York: John Wiley & [22] D. Chetergee, A. Patra, H. K. Joglekar. Swing-up and
Sons Inc., 1986. stabilization of a cart-pendulum system under restricted
cart track length. Systems & Control Letters, vol. 47, no. 4,
[6] M. N. Bandyopadhyay. Control Engineering: Theory and pp. 355–364, 2002.
Practice, New Delhi: Prentice Hall of India Pvt. Ltd., 2004.
[23] C. A. Ibañez, O. G. Frias, M. S. Castanon. Lyapunov-based
[7] R. S. Burns. Advanced Control Engineering, Oxford: controller for the inverted pendulum cart system. Nonlinear
Elsevier-Butterworth Heinemann, 2001. Dynamics, vol. 40, no. 4, pp. 367–374, 2005.
670 International Journal of Automation and Computing 11(6), December 2014
[24] X. Gong, Z. C. Hu, C. J. Zhao, Y. Bai, Y. T. Tian. Adap- Barjeev Tyagi received his B. Eng. de-
tive backstepping sliding mode trajectory tracking control gree in electrical engineering from Indian
for a quad-rotor. International Journal of Automation and Institute of Technology, Roorkee (IIT Roor-
Computing, vol. 9, no. 5, pp. 555–560, 2012. kee) (formally University of Roorkee), India
in 1987, M. Tech. degree in electrical engi-
neering (control system) from IIT Kharag-
[25] K. S. Grewal, R. Dixon, J. Pearson. LQG controller design
pur in 2000, and Ph. D. degree in electrical
applied to a pneumatic Stewart-Gough platform. Interna-
engineering from IIT Kanpur in 2005. He
tional Journal of Automation and Computing, vol. 9, no. 1,
has been faculty in the Department of Elec-
pp. 45–53, 2012.
trical Engineering, IIT Roorkee since 2007,
and presently serving as associate professor. He has supervised
many M. Tech. dissertations and two Ph. D. theses. He has pub-
Lal Bahadur Prasad obtained his lished many papers in refereed journals and conferences. He is
B. Eng. degree in electrical engineering member of IEEE.
from Madan Mohan Malaviya Engineer- His research interests include power system deregulation,
ing College Gorakhpur, India in 1994, and power system optimization, distributed generation and control.
his M. Tech. degree in electrical engineer- E-mail: btyagfee@iitr.ac.in
ing (control systems) from Indian Institute
of Technology (B.H.U.), Varanasi, India in
1997. He was an officer of Indian Defence
Service of Engineers and served as assis- Hari Om Gupta obtained his B. Eng.
tant executive engineer (electrical) in Mili- degree in electrical engineering from the
tary Engineer Services, Ministry of Defence, Government of India Government Engineering College, Jabalpur
during 1997–1999. In 1999, he switched to engineering teaching securing 1st position in Jabalpur Univer-
career. He is assistant professor (selection grade) in Department sity, India. He received his M. Eng. degree
of Electrical Engineering, Madan Mohan Malaviya Engineering in systems engineering and operations re-
College Gorakhpur, India. Since 2009, he is pursuing his Ph. D. search and Ph. D. degree from the Indian
research work in the Department of Electrical Engineering, In- Institute of Technology, Roorkee (IIT Roor-
dian Institute of Technology Roorkee, India under QIP scheme. kee) in 1975 and 1980, respectively. At
He has supervised 11 M. Tech. dissertations and many present, he is working as director, JIIT
B. Eng./B. Tech. projects. He is life member of Institution of Sector-128, NOIDA, India and professor (on leave) in the De-
Engineers (India), and life member of Institution of Electronics partment of Electrical Engineering, IIT, Roorkee, India.
& Telecommunication Engineers (India). He is member of Au- He has published over 260 research papers, 35 technical re-
tomatic Control and Dynamic Optimization Society (ACDOS), ports, and edited proceedings of four conferences and two books.
India. He is graduate student member of IEEE and IEEE Con- He has supervised 25 Ph. D. and over 45 M. Tech. scholars. He
trol Systems Society, IEEE Computational Intelligence Society, has worked for 6 sponsored and over twenty industrial consul-
IEEE Systems, Man and Cybernetics Society, and IEEE Indus- tancy projects. He is a senior member of IEEE, a fellow IE
trial Applications Society. (India), a life member of NIQR, ISTE, and System Society of
His research interests include control systems and applica- India.
tions, adaptive and optimal control, nonlinear control, intelligent His research interests include computer-aided design, reliabil-
control systems and applications, power and energy systems con- ity engineering, power network optimization, distribution system
trol. automation, power quality, power and distribution transformers
E-mail: erlbprasad@gmail.com, ibpeedee@iitr.ac.in (Corre- and DBMS.
sponding author) E-mail: harifee@iitr.ac.in