Académique Documents
Professionnel Documents
Culture Documents
Nico Hasoloan
Departemen Teknik Mesin, Fakultas Teknologi Industri, Institut Teknologi Sepuluh Nopember (ITS)
Jl. Arief Rahman Hakim, Surabaya 60111 Indonesia
email : nicohasoloan07@gmail.com
Abstract – Control System currently used and develop widely in II. MODELLING WHEELED INVERTED
this world. Its because by using Control System, human will no
longer have to do most of his work manually. One of the problem
PENDULUM
in using Control System is the stability of the system. Because, if Wheeled Inverted Pendulum system is consist of two wheel
the system unstable, it will be resulting high number of error. To
overcome this problem, there are several method to make the
with radius (r) and mass (Mw) that connected by a connecting
system become stable.This paper introduces a method to design a rod. The wheel placed at both end of the connecting rod. At
Full State Feedback controller for a Wheeled Inverted Pendulum the centre of the connecting rod placed a pendulum that has
using Pole Placement Method. The WIM will be modelled mass (Mp) and length (L) and can rotate along alpha (α). The
mathematically using Euler-Lagrange approach. The model later
will be simulated in simulink with several condition to find out wheel itself can translate and rotate along theta (θ). System of
what are the parameters to make the optimum pole position. Wheeled Inverted Pendulum is shown in Figure (1) below :
I. INTRODUCTION
owdays Wheeled Inverted Pendulum is one of the mostly
N use mechanic system. One of the vehicle that use
Wheeled Inverted Pendulum system is Segway. The control in
Wheeled Inverted Pendulum system, keeps the Wheeled
Inverted Pendulum stands still. The control system will
stabilize the system by moving the pendulum and the wheel.
Wheeled Inverted Pendulum itself has nonlinear characteristic.
Because of the nonlinearities of the system, Wheeled Inverted
Pendulum is hard to develop and many people prefer to
Figure 1. Wheeled Inverted Pendulum
develop another mechanism. But this system can be solved
using linear approach. This paper will discuss on how to make To analyze the system further, the Wheeled Inverted
control system of Wheeled Inverted Pendulum mechanism. To Pendulum system has to be modelled into mathematical form.
make the control design, first the Wheeled Inverted Pendulum From Figure (1), The Wheeled Inverted Pendulum system can
mechanism has to be mathematically modelled. In this paper, be broke down into two sub-systems. By assuming the center
the system will mathematically modelled using Euler- mass of the pendulum is at the middle of the pendulum, F is
Lagrange’s equation approach. From mathematical model, a force applied to the wheel, g is gravity acceleration and N is
state space model of the system can be found by linearize the normal force, Free-Body Diagram of the system can be made
mathematical model. The state space form of the system than as shown in Figure 2.
simulated and tested in matlab. Pole Placement Method is
used to design the controller of Wheeled Inverted Pendulum.
By place several poles in the system, the system expected to
operates stable.
2
Where
JT = Iwheel + Mwheel rw2 + Mpendulum rw2 (12)
̇
( ( ) )
(2)
[ ]
The total kinetic energy of the system can be form as :
( ( ) )
=
(3)
[ ]
Potential energy of the pendulum can be form as :
* +
( ) (4)
* +
Since potential energy of the wheel is zero due to the wheel
has no altitude, the mathematical model of the system can be Where,
formed using Lagrangian equation below :
(15)
( ( ) ) By entering value from table 1, the matrix system become :
( ) (5)
3
̇ (16)
[ ] By using MATLAB, the system can be modelled as block
diagram as show in figure 4 and figure 5.
[ ]
* +
* +
P= [ ]
matrix A become negative, Pole Placement Method will be From the simulation done in simulink for condition one, the
applied to this system. This method used by putting several system response vs time can be found as shown in figure 6. In
pole into the system. By putting several pole, the value of figure 6, response of state space 1 represent as yellow line and
matrix K (gain) will be changed. By assuming there is repsones of state space 3 represent as red line.
disturbance in the system, the close loop equation with
feedback of the system become :
4
Figure 6. System Response Vs Time for condition 2 [2] Bitirgen, Rahman, Muhsin Hanser, and Ismael Bayezit.
(2018, March). All Stabilizing Feedback Controler for
Based on the result from figure six, the maximum amplitude Inverted Pendulum Mechanism. IFAC [Online].
of state space 1 is 0.26, and the rise time of state space 1 is http://www.sciencedirect.com/
27.250 ms. For state space 3, the maximum amplitude is 1.45 [3] Yamakawa,Satoko. (2011). Tracking Control of Wheeled
and the rise time value is 8.427 ms. From the simulation done Inverted Pendulum Based on Time State Control Form.
in simulink for condition four, the system response vs time can IFAC [Online]. http://www.sciencedirect.com
be found as shown in figure 8. In figure 8, response of state [4] Brisillia, R. M. and V. Sankaranarayanan(2015).
space 1 represent as yellow line and repsones of state space 3 Nonlinear Control of Mobile Inverted Pendulum. Elsevier
represent as red line. Based on the result from figure seven, [Online]. http://www.sciencedirect.com
the maximum amplitude of state space 1 is 0.26, and the rise [5] Dai, Fuquan, Gao Xueshan, Shigong Jiang, Wenzeng
time of state space 1 is 29.680 ms. For state space 3, the Guo, and Yubai Liu. (2015, July). A Two-Wheeled
maximum amplitude is 1.78 and the rise time value is 3.920 Inverted Pendulum Robot With Friction Compesation.
ms. By take a look at those result, the maximum amplitude of Elsevier [Online]. http://www.sciencedirect.com
state one is came from condition two. The maximum
amplitude of state space three is came from condition two. The
biggest rise time of state space one came from condition 1.
And for state space 3, the biggest rise time is came from
condition 2.