Segway
Segway
at KMITL
Pittaya Pannil*, Aroosh Klaeoyotha*, Prapart Ukakimaparn*, Thanit Trisuwannawat*, Kitti Tirasesth*
and Noriyuki Kominet
Department of Instrumentation, Faculty of Engineering,
King Mongkut's Institute of Technology Ladkrabang (KMITL), Bangkok, 10520, Thailand
Tel: +66-2-3264203/-4, E-mail: [email protected]
tSchool of Information and Telecommunication Engineering
Tokai University, Hiratsuka, Kanagawa 259-1292 Japan
Tel: +81-463-581211, E-mail: [email protected]
A.
I. INTRODUCTION
Usually, the Inverted Pendulum System (IPS) is used to
verify the control system design for unstable systems [1]. In
recent years, there are some researches on IPS as TwoWheeled Balancing Robot [2]-[3], their work aim to design
the controller for stabilizing the inverted pendulum that pivot
to the standing of balancing robot. Recently, at the
Department of Instrumentation Engineering, KMITL has built
a Two-Wheeled Balancing Mobile Robot by undergraduate
students, the aim is not only to use as a research tool, but also
to utilize as an education tool [4, 5]. In [4], we proposed the
teaching of analog controller design for unstable system with
LQR, LQE and LQG control structure. In addition [5] still.
proposed the analog controller design by using method in [6].
The addition of the quadratic derivatives of state variables
term in the usual standard performance index for LQG
optimal control to dampening the angle of inverted pendulum
is described in this paper. Currently at KMITL, a new
Inverted Pendulum System can be developed as SEGWAY
application.
II.
Controller Unit
. .
A prototype of IPS as a
(a) SolidWorks
Fig. 1.
(b) Actual
The Inverted Pendulum System.
389
The 16-bit
dPCOF00
microcontrolleAr-2km,ke(MPlr-Jp/~ ~MP12)
-42
with 12 bi
2
'
0 { ' J
,_5
_|
IdflvesbyMhe
FT
km,k,(r/83-Mpl)
~~~2A'43
~ ~~~~~42
A3
PM _2-MPlr)
ee
~~~~
a
821
gl/8
A4~2km ([ Rr2a
[Wirless control
2km (MPl-rr,)
Rr
~~~~~~~~~~~~~~~~~~~~~~Rrar
4b1
Rr
and
~~
M~gl2
-23
~~Rr 2 a
8i
+ 2J
C.
IV
a
km
ke
|/
r
NOMENCLATURE
Applied terminal voltage (V)
Torque constant (0.1837 N in/A)
Back EMF constant (0.287304 V sec/rad)
Mass of the robot's chassis (10.5 kg)
Distance between the centers of the wheel and the robot's centre
Controller Design
The problem is to design a controller so that when an
impulse input is given to the system, the Pendulum should be
displaced and eventually return to zero. Fig. 4 shows block
diagram of the closed-loop control system.
B.
Fig. 3.
III.
r(t)(
Sate-Space Modeling
The state-space model of the prototype Inverted Pendulum
System at the Mechatronics Laboratory of the department can
be expressed in (1) and the list of variables and theirs+
magnitudes also [4].
A.
Fx1F
A22 A23
Ox
01A
B 21
11101 0
re
|~~~~~~~~~~l
l
2Is
40 C2
FI
y(t)
FO
0
K] Lo 28.3293
y
0L
xi
1
1.0103
0Hk
8.7872
175.9778 0
F
0
-0.8616
Fo C2D11 D21 1
L
i
1K2K()(s) forforthecontrolledplantis
the cotole pati
iLI-24.1579
!222x
K2i(S) =
10001~~~~~~~~~~~~~~~~~~~~~~~~~
0 1 o0 x x
0]{.
H2X
controller
L2
consrained.matrix
y(t)
C2x(t)
B1w(t) +
D11w(t)
B2u(t),
D12u(t),
D21w(t).
0 0], C= 0jD,
D12~
=01 Di 0j
0
0
441
me
= 10 ,. .
z(t)
y(t)
where
Ax(t)
C1x(t)
C2x(t)
B1w(t)
D21w(t).
Dii
04
0 o0 1 o
B2u(t),
D12u(t),
Cl
0 0 0 0
, D12 =
00 1 , Bi =
LO 0 1 0
0 0 1 0
Lo 0 0 0]
L0i
L0 0 0 0
F1 0 001
L
(3)
1 0 0 0
0 1 0
00 010
~~~~~1
- - 0 l l- l O0 00 0i0 0
L0]
,,
] d3
d x(t)
d11 iS for
0
0 , jD2, = Lo 0 D21].
o
-x(t) = Ax(t) +
dt
z(t) = C1x(t)
0 d22
Di
0
87.872
010 0 001
0i0 0 00
Lo 0 00 0 10 0 1759.788 0 10 0 001
391
__
Ci00
rDiiAj
Cv,
0.08
0 0 0 0
0.04
0.02-
12
0 0
00
lo
0-00
0-0.02
0 0 0 00
D12
H2dtCnrl(oilne
<-0.04
0I0.06
H2 Basic
0
I~~~~~~~~~
L-0.26630 0 0 0
0 0
..
1.21 Fig.
0
a
0 0]
0 0
0000
2.
~~~~~~~~~~~~~~~~~~~~~~~~Time
(secs)
WhenImergedagiveofd33 10 in D to e a z m t t
_~~~~~~~~~~~~~~~~~~~~~~~~~nta
Stat Initalsttrtspnes
Repnea for
IPenuuofPendulum
Angla
VeILoct
angle
we deeoe
0~~~~~~~~
~Ls yerFigew
form~~~~~~~~~~~~a
weghin matricesnt BIt Casstnd
Dimla
and Dthe theeriaBallc
controller
othe6obot
erLeGCotroni (dotevies) uh a
, -9.8736 -6.702 5 -200.2711
K2(s inTDl
(4)A
is0
then2
obtine
einad
by,SGA.Ti
arcthoo
L-o2
663=LO
F. 6. OmInitial rjetwst
State Responses ofpendulum
Angular
Velocity .
B
oo fisbepneiyote
o
K2staing from o0s thnob1.thied
bour
at d.epmenst.at w
i the cerclu veh as
stado te rbo. A1
eto
NeWIPSce
ATc
KMIT
- orzero
themantrix,rbem1
usingrdcdt
tod carryar aeoc- hm as functin Fig. 7(a)(s
Ifden0ce12itial1tate0esponses
11i
then
lal
then
,~~~~~~~~~~~~~Ls
yist
we aote
develpdew
Inve rlted
enduu Syistsngem
J
L Do11B
D
.
a rlear,ul
1
d
sPir
0]
] Tieta a
reduced
without6.ofnderivativeestatesconstraintsluweight.aVaryingimm
hip,
r d
gyrolscopelinc
e ae Eb
f ri ton thisvsintg
e
showsa,
7a
hw
and
Infowhe
392
2008oQGCnto IntbernatIona Sypoium onCmuiain
bord.Dmatonstechinologhies
InvCItedP2008)Sytei
inta3 saerepne for8 Itherangeatinda nglavelocitym
o shmuict
f
owsnd
Inforaig. 7(c). lge (ISI
08
ACKNOWLEDGMENT
The authors would like to thank Mr. Krit Smerpitak for his
assemblies this Inverted Pendulum includes experimental
result so much. Also thank Emeritus Professor Michihiko
lida for his kindly the valuable suggestions.
REFERENCES
Editions,
Englewood1990.Cliffs, New Jersey: Prentice-Hall InteRational
[2] Felix Grasser, Aldo D'Arrigo, Silvio Colombi and Alfred C.
Fig. 7. IPS
Anew narly SEGAY at
V. CONCLUSIONS
Trswnnwt
Tiaesh.
.KoieadY
.. "DerivativeK.State
Ochiai,
Constrained Jia
Optimal
H2 Control for
Oscillatory Systems and Its Application," Transactions ofIEEJ,
Vol. 120-D, No. 6, pp. 775-781, 2000.
[7] Richard Y. Chiang, Michael G. Safonov, Robust Control
Toolbox User's Guide, The MathWorks, Inc., Natick, MA, 1992.
[6
393