Professional Documents
Culture Documents
10 - All Stabilizing State Feedback Controller For Inverted Pendulum Mechanism
10 - All Stabilizing State Feedback Controller For Inverted Pendulum Mechanism
T
x = [xc α x˙c α̇] (3)
The state space representation:
347
IFAC PID 2018
348 Belgium, May 9-11, 2018
Ghent, Rahman Bitirgen et al. / IFAC PapersOnLine 51-4 (2018) 346–351
00 The desired poles of the closed loop system is given, and by
D= (8) solving Ackermann’s formula, one can calculate the gain
00
K. In this case, K is calculated as:
Here in the equations, Mp = 0.127(kg) is the mass of K = [−42 115 − 46 15] (13)
the pendulum, Jp = 1.19 ∗ 10−3 (kg/m2 ), is the mass
moment of inertia of the pendulum about its center of In this paper, a good set of K value is calculated, then it is
gravity, lp = 0.178(m) is the distance from the center to be found when k1 and k3 (the part of the K that controls
of gravity of the pendulum to the pivot point, g is the the position and velocity of the cart.) are fixed, what are
gravitational acceleration, Beq = 5.4(N s/m) is the friction the possible sets of k2 and k4 (the part of the K that
coefficient between the cart and the track, Bp = 2.4 ∗ controls the angle and angular velocity of the pendulum.).
10−3 (N ms/rad), is the viscous damping coefficient at the Two methods are used to find all possible values of k2 and
pendulum axis, Mc = 0.57(kg) is the mass of the cart, k4 .
ηg = 1 is the planetary gearbox efficiency, Kg = 3.71 is
the planetary gearbox gear ratio, Jm = 3.90 ∗ 10−7 (kgm2 ) 3.1 Gridding Method
rotor inertia, rmp = 6.35 ∗ 10−3 (m) is the motor pinion
radius. The terms Jeq , JT , Jκ and Jξ are related to inertias, In this brute force method, k2 and k4 are gridded between
can be calculated with the given parameters. the values of 0 and 250. k1 and k3 are fixed, for each and
every single point on the grid, it is possible to calculate
The poles of the open loop system: the roots of the characteristic equation. If the point on the
grid does not have any root on the right half plane, then
P = [0 6.38 − 6.38 − 12.47] (9) that K is said to be possible stabilizing controller for the
system. When the gridding is dense enough, this method
There is a pole on the right hand side of the s plane for can give all possible K that stabilizes the system when k1
the open loop system, therefore it is proved that the open and k3 are fixed. However, it should be noted that this is a
loop system is unstable. computationally expensive method, when the gridding is
dense, it takes time to give a solution.
Controllability and observability are checked before de-
signing the controller, in order to inspect if all modes k2 vs. k 4
are controllable and if all the states are observable. The 250
The system has one input and two outputs, and therefore it 100
can be represented with two transfer functions. However,
when PID controller is designed for each of the transfer
function (TF) assuming each TF has a SISO behaviour, 50
the control input for each controller only takes into account
the position or the angle feedback individually. This make
it difficult to find a set of controller that both satisfies the 0
stability of position and angle. It is considered that, with a 0 50 100 150 200 250
full state-feedback controller, all poles of the system can be k2
348
IFAC PID 2018
Ghent, Belgium, May 9-11, 2018 Rahman Bitirgen et al. / IFAC PapersOnLine 51-4 (2018) 346–351 349
Cart Position a4 =1
80
Desired Position a3 = 1.56k3 + 6.78k4 + 12.42
Simulated Position (15)
60 a2 = 1.56k1 + 6.78k2 + 0.72k3 − 40.77
a1 = −66.45k1
40
20
both real and imaginary parts of the Pc (jω) should be
equal to zero.
0
-20
Re {Pc (s)} = a4 ω 4 − a2 ω 2 + a0 = 0
(16)
-40 Im {Pc (s)} = −ω a3 ω 2 − a1 ω = 0
-80
0 1 2 3 4 5 6 7 8 9 10 ω 4 − b1 (k1 , k3 )ω 2 + b2 (k1 )
Time (s) k2 =
b3 ω 2
2
(17)
Fig. 4. Cart Position Time Response for K = −c1 (k3 )ω + c2 (k1 , k3 )
k4 =
[−42 180 − 46 50] c3 ω 2
1 (18)
c1 = 1.56k3 + 12.42
c2 = 0.72k1 − 66.54k3 − 506.64
0 c3 = 6.78
-1
First limit values of k2 and k4 are calculated, when ω = 0
and ω → ∞. In order to calculate k2 and k4 only ω is
gridded between frequencies 0 and 1000.
-2
Table 1. Limit Values for k2 and k4
-3 ω k2 k4
0 1 2 3 4 5 6 7 8 9 10 0 ∞ ∞
Time (s) −c1
∞ ∞ c3
349
IFAC PID 2018
350 Belgium, May 9-11, 2018
Ghent, Rahman Bitirgen et al. / IFAC PapersOnLine 51-4 (2018) 346–351
In Fig. 6, the blue dots are the k2 and k4 pairs that are Pole Spread of the System
calculated with the gridding method. The red curve is the 40
0.55
jω crossing values of k2 and k4 and the orange curve is the
−1 + jω crossing values for k2 and k4 . 30
Imaginary Axis
An arbitrary pair is chosen in this region. 0
10
k vs. k 0
2 4
250
-10
-20
200 -30
-40
30 31 32 33 34 35 36 37 38 39 40
150 Time (s)
k4
350
IFAC PID 2018
Ghent, Belgium, May 9-11, 2018 Rahman Bitirgen et al. / IFAC PapersOnLine 51-4 (2018) 346–351 351
2
2684–2689. IEEE.
Munro, N. and Soylemez, M. (2000). Fast calculation
0
of stabilizing pid controllers for uncertain parameter
-2
systems. IFAC Proceedings Volumes, 33(14), 549–554.
Munro, N., Söylemez, M., and Baki, H. (1999). Compu-
-4 tation of d-stabilizing low-order compensators. Control
Systems Centre Report, 882.
-6 Munro, N. (1999). The systematic design of pid controllers.
Ohta, Y., Li, J., Tagawa, K., and Haneda, H. (1997).
-8 Robust pid controller design. In Proceedings of NOLTA,
30 31 32 33 34 35 36 37 38 39 40
1053–1056.
Time (s)
Saeki, M. and Kimura, J. (1997). Design method of
Fig. 10. Motor Voltage Time Response for K = robust pid controller and cad system. IFAC Proceedings
[−42 145 − 46 25] Volumes, 30(11), 1511–1516.
Shafiei, Z. and Shenton, A. (1994). Tuning of pid-type
studied on the steady state error of the cart position by controllers for stable and unstable systems with time
adding an integral term in K. delay. Automatica, 30(10), 1609–1615.
Shafiei, Z. and Shenton, A. (1997). Frequency-domain
design of pid controllers for stable and unstable systems
ACKNOWLEDGEMENTS with time delay. Automatica, 33(12), 2223–2232.
Yadav, M., Gupta, A.K., Pratap, B., and Saini, S. (2016).
The authors would like to thank to the BAP (Scientific Robust control design for inverted pendulum system
Research Projects) Office of ITU for funding the labora- with uncertain disturbances. In Power Electronics,
tory. Intelligent Control and Energy Systems (ICPEICES),
IEEE International Conference on, 1–6. IEEE.
The authors also would like to thank Prof. M. Turan Yue, M., Wei, X., and Li, Z. (2015). Zero-dynamics-based
Söylemez for providing vision throughout the entire course adaptive sliding mode control for a wheeled inverted
of Control of System with Parametric Uncertainity during pendulum with parametric friction and uncertain dy-
Fall Term of 2017-2018. namics compensation. Transactions of the Institute of
Measurement and Control, 37(1), 91–99.
REFERENCES
Ackermann, J. and Kaesbauer, D. (2001). Design of robust
pid controllers. In Control Conference (ECC), 2001
European, 522–527. IEEE.
351