Tracking Control of Position Servo and Stabilization of Rotary Inverted Pendulum Using ISM
Tracking Control of Position Servo and Stabilization of Rotary Inverted Pendulum Using ISM
Tracking Control of Position Servo and Stabilization of Rotary Inverted Pendulum Using ISM
o Robust Control
,
2. Tracking control problem
Tracking control using SM:-
Consider xd as the desired reference such that
Control u is,
Tracking control using ISM:-
Consider a system of the form,
Control u is,
Work done
In this performance of the controller is tested in
simulation.
For this following are the simulation parameters
o CT matrix chosen was
CT = [-2.2900 -1.0000];
o LQR gain matrix K = [2.9580 0.0868];
o δ = 0.05 (sigmoid function was used to alleviate
chattering);
o Closed loop pole for LQR are
-2.2906 + 3.9090i, -2.2906 - 3.9090i;
o Closed loop pole for SMC is -2.2906;
o Sliding surface matrix G is
G = [0 0.0179];
2 2
(rad/sec)
(rad/sec)
1 -reqd 1 -reqd
0 0
0 1 2 3 4 5 6 7 8 9 10 0 1 2 3 4 5 6 7 8 9 10
Time t (sec) Time t (sec)
5 5
d /dt (rad/sec)
d /dt
d /dt (rad/sec)
d /dt
0 d /dt-reqd 0 d /dt-reqd
-5 -5
0 1 2 3 4 5 6 7 8 9 10 0 1 2 3 4 5 6 7 8 9 10
Time t (sec) Time t (sec)
4 4
Control (u)
2
Control (u)
0 0
-2
-2 0 1 2 3 4 5 6 7 8 9 10
0 1 2 3 4 5 6 7 8 9 10
Time t (sec)
Time t (sec)
1.1 Stabilisation control Using LOR 1.2 Stabilisation control Using LOR with
without disturbance. disturbance.
1.5 2 1.5 3
d /dt d /dt
-reqd d /dt-reqd -reqd 2 d /dt-reqd
1 1 1
d /dt (rad/sec)
d /dt (rad/sec)
(rad/sec)
(rad/sec)
1
0.5 0 0.5
0
0 -1 0 -1
0 5 10 0 5 10 0 5 10 0 5 10
Time t (sec) Time t (sec) Time t (sec) Time t (sec)
-0.01
1 1
0
-0.02
Control (u)
Control (u)
Surface s
Surface s
0.5 0.5
-0.03
-0.02
0 0
-0.04
1.3 Stabilisation control Using SM without 1.4 Stabilisation control Using SM with
disturbance. disturbance.
1.5 4 1.5 4
d /dt d /dt
-reqd d /dt-reqd -reqd d /dt-reqd
d /dt (rad/sec)
1 2 1 2
d /dt (rad/sec)
(rad/sec)
(rad/sec)
0.5 0 0.5 0
0 -2 0 -2
0 5 10 0 5 10 0 5 10 0 5 10
Time t (sec) Time t (sec) Time t (sec) Time t (sec)
3 1 3 0.015
2 0.5 2
0.01
Control (u)
Surface s
Control (u)
Surface s
1 0 1
0 -0.5
0.005
0
-1 -1 -1 0
0 5 10 0 5 10 0 5 10 0 5 10
Time t (sec) Time t (sec)
Time t (sec) Time t (sec)
1.5 Stabilisation control Using ISM without 1.6 Stabilisation control Using ISM with
disturbance. disturbance.
2. Tracking control
10 10
(rad/sec)
(rad/sec)
5 -reqd 5 -reqd
0 0
0 1 2 3 4 5 6 7 8 9 10 0 1 2 3 4 5 6 7 8 9 10
Time t (sec) Time t (sec)
2 2
d /dt d /dt
d /dt (rad/sec)
d /dt (rad/sec)
1 d /dt-reqd 1 d /dt-reqd
0 0
0 1 2 3 4 5 6 7 8 9 10 0 1 2 3 4 5 6 7 8 9 10
Time t (sec) Time t (sec)
1 1
Control (u)
Control (u)
0.5 0.5
0 0
0 1 2 3 4 5 6 7 8 9 10 0 1 2 3 4 5 6 7 8 9 10
Time t (sec) Time t (sec)
2.1 Tracking control using LQR without 2.2 Tracking control using LQR with
disturbance disturbance
10 1.5 10 1.5
d /dt d /dt
-reqd d /dt-reqd -reqd d /dt-reqd
1
d /dt (rad/sec)
1
d /dt (rad/sec)
(rad/sec)
(rad/sec)
5 5
0.5 0.5
0 0 0 0
0 5 10 0 5 10 0 5 10 0 5 10
Time t (sec) Time t (sec) Time t (sec) Time t (sec)
Control (u)
Control (u)
Surface s
Surface s
0.55 0 0 0
0 5 10 0 5 10 0 5 10 0 5 10
Time t (sec) Time t (sec) Time t (sec) Time t (sec)
2.3 Tracking control using SM without 2.4 Tracking control using SM with
disturbance. disturbance.
10 1.5 10 1.5
d /dt d /dt
-reqd d /dt-reqd -reqd d /dt-reqd
1 1
d /dt (rad/sec)
d /dt (rad/sec)
(rad/sec)
(rad/sec)
5 5
0.5 0.5
0 0 0 0
0 5 10 0 5 10 0 5 10 0 5 10
Time t (sec) Time t (sec) Time t (sec) Time t (sec)
Control (u)
Surface s
Control (u)
Surface s
0.4 0 0.4
0.005
0.2 -0.5 0.2
0 -1 0 0
0 5 10 0 5 10 0 5 10 0 5 10
Time t (sec) Time t (sec) Time t (sec) Time t (sec)
2.5 Tracking control using ISM without 2.6 Tracking control using ISM with
disturbance. disturbance.
Conclusion
LQR based control gives good results but it required
more control efforts than SM control and SMC is more
robust.