SlideShare uma empresa Scribd logo
1 de 20
Baixar para ler offline
International Journal of Control Theory and Computer Modeling (IJCTCM) Vol.3, No.6, November 2013

DYNAMIC MODELLING AND OPTIMAL CONTROL
SCHEME OF WHEEL INVERTED PENDULUM FOR
MOBILE ROBOT APPLICATION
Mohamad Amir Shamsudin*1, Rosbi Mamat*2, and Sophan Wahyudi Nawawi*3
*

Department of Control and Mechatronics, Faculty of Electrical,
Universiti Teknologi Malaysia, Johor, Malaysia

Abstract
Unstable wheel inverted pendulum is modelled and controlled deploying Kane’s method and optimal
partial-state PID control scheme. A correct derivation of nonlinear mathematical model of a wheel inverted
pendulum is obtained using a proper definition of the geometric context of active and inertia forces. Then
the model is decoupled to two linear subsystems namely balancing and heading subsystems. Afterward
partial-state PID controller is proposed and formulated to quadratic optimal regulation tuning method. It
enables partial-state PID to be optimally tuned and guarantees a satisfactory level of states error and a
realistic utilization of torque energy. Simulation and numerical analyses are carried out to analyse
system’s stability and to determine the performance of the proposed controller for mobile wheel inverted
pendulum application.

KEYWORDS
Wheel inverted pendulum, Kane’s method, partial-state PID, quadratic optimal regulation tuning

1. INTRODUCTION
The application of wheel inverted pendulum (WIP) robot gains high attention from industry and
research communities. Recently, many WIP-based products are available in industry such as
human transporter by Karmen and service robot by Hitachi’s Mechanical Engineering Research
laboratory. They believe this high manoeuvrability wheel system will be the future urban robot
and transporter and even in rural places with rough terrain. Meanwhile in research community,
WIP system has been extensively studied because this simple structure robot serve complex
dynamic [1]. Thus many comprehensive research materials can be found and mainly for
modelling and control aspects.
Over a decade, various types of WIP have been developed along with their mathematical model
[2-5]. The modelling focuses either on kinematic [6, 7] or dynamic issues. In dynamic aspect,
Lagrange [8, 9], Lagrage-Eular [10], and Newton-Eular [11] used to develop nonlinear WIP
mathematical model. However Newton method involved the calculation of unwanted forces and
Lagrange method used Lagrange multiplier in their derivation. Consequently those methods
required tedious and complicated formulation of a large multibody system, hence led to
inefficient computation. Thus, Kane method is the alternative because of its simpler and efficient
mathematical analysis where it is based on partial velocity in multibody dynamic modelling [12].
However, less attention on torque context in term of differential drive nonholonomic and mobile
system led to an unaccurate dynamic equation [13]. Thus this paper defines a proper torque
DOI : 10.5121/ijctcm.2013.3601

1
International Journal of Control Theory and Computer Modeling (IJCTCM) Vol.3, No.6, November 2013

geometric context of WIP system, eventually this definition leads to a correct solution of the
nonlinear WIP mathematical model.
In control aspect, advanced and robust control schemes designed to control WIP system. It were
sliding mode control (SMC) [14], backsteping control [15], fuzzy logic control (FLC) [16], and
neural network control (NN) [17]. However, most of those control schemes need high
computationally effort even for single state control [18]. This prevented it to be programmed as a
low level controller in an embedded WIP system. Thus linear controller such as LQR and PID
controllers are more favourable for this fast system [19-21]. Many researches preferred and
showed that the LQR as a modern controller gave better performance compared to conventional
PID controller [22-24]. However the research overlooked the applicability of LQR controller in
input trajectory tracking where the significant state trajectory errors occur [25]. Thus this paper
proposes partial-state PID (PSPID) controller to eliminate the aforementioned problem. Besides,
the controller is formulated to quadratic optimal regulation (QOR) tuning scheme where it
guarantees system stability and satisfactory level of WIP performance.
This paper is organized as follows: development of nonlinear WIP mathematical model is
presented in section 2; section 3 provides a formulation of proposed PSPID controller for the
QOR tuning method; the analysis of the model and the proposed controller is demonstrated by
simulation in section 4; and the conclusion of this paper is in the last section.

2. WHEEL INVERTED PENDULUM ROBOT
Generally, the outline of Kane’s method can be found in following literatures [12, 13]. Thus this
paper will only concentrate on the development of a WIP mathematical model of Kane’s method.
Notation: Throughout this section, C i and S i indicate cos and sin functions with i = 2 = φ and
i = 3 = θ . Body Bi and point Pi refer to bodies B , W1 , W2 and points G , WC1 , and WC2 .

2.1. Kinematic of WIP
As shown in Fig. 1, WIP consists of three bodies: the pendulum, B, as the main body and the two
wheels, W1 and W2 . The important points where the gravitational force, g is detected are the
centre of right wheel, WC1 , the centre of left wheel, WC2 , and the centre of gravity of the main
body G ; point C , the point where the torque exerted from wheels to pendulum in the form of
force. Other vital points on the right and left wheel’s surfaces are WP1 and WP2 . W~1 and W~2
P
P
are any point on the right and left wheels. WIP mechanical parameters tabulate in Table 1. The
WIP has 5 degrees of freedoms, hence the independent generalized coordinates are
qn = (q1, q2 ,  , qn ) = (x, φ, θ, ϕW 1, ϕW 2 ); n = 5,

(1)

The following assumptions have been made to model the WIP:
1) The linear motor model considered, motor inductance and friction on the armature are
neglected.
2) No slip and wheels always in contact with the ground
3) At every instant, WIP experiences forward and steering forces.
4) Cornering force is neglected

2
International Journal of Control Theory and Computer Modeling (IJCTCM) Vol.3, No.6, November 2013

Based on the 2nd and 3rd assumptions, the constraints m = 2 and the nonholonomic constraints are
F
F

ˆW
ˆ
ˆ
ω P 1 − F ω WP1 x − F ω
~

ˆ
ω

~
WP 2

ˆ
− ω
F

WP 2 x


ˆ
− ω
F

= 0,

WP 1
WP 2 

(2)

= 0,

Table 1.WIP mechanical parameters.

Symbol
mb
mw
L
R
Ib2
Ib3
g
d

Parameter
Mass of body
Mass of wheel
Half of lateral body
Radius of wheel
Inertia of main body in n2 directional
Inertia of main body in n3 directional
Gravitational constant
A distance between point C and COG of main body

Value
15kg
0.42kg
0.2m
0.106m
0.63kgm2
1.12kgm2
9.81ms-2
0.212m

(b)

(a)

Figure 1. (a) Available WIP in UTM laboratory, and (b) free body diagram of WIP in newton Frame
F.
F

~
WP i

ˆ
ω

is an angular velocity of point W~i on the right and left wheels with respect to reference
P
W 

ˆ
ˆ
frame F. F ωWP1x and F ω P1φ are angular velocities of points WP1s on the right and left wheels
with respect to frame F that due to forward motion and steering motion. Based on (1) and (2), the
generalized speeds, ur , are

(

)

  
ur = (u1, u2 ,  , ur ) = x, φ, θ ;

r = n − m,

(3)

The velocity, angular velocity and angular acceleration of point C with respect to reference
frame F are

3
International Journal of Control Theory and Computer Modeling (IJCTCM) Vol.3, No.6, November 2013

ˆ
v = u1n1 ,

F C
F

ˆ
ωC = u 2f 2 = u 2n 2 ,

F

ˆ


α = u 2f 2 = u 2n 2 ,

(4)

C

From (2), angular velocity of points W~1 and W~2 with respect to reference frame F are
P
P
~
ˆW
ω P1 = −u 2 L (− S 2n1 + C2n 3 ) − u1 1 n 3 ,
R
R
~
F WP 2
L (− S n + C n ) − u 1 n ,
ˆ
ω = u2
2 1
2 3
1
3
R
R

F

(5)

The angular velocity of robot main body and two wheels with respect to reference frame F are
F

ˆ
ˆ
ˆ
ω B = F ωC + C ωG = u 2n 2 − u3n 3 ,



~
LC 2
LS
ˆ
ˆ
ˆW
ωW1 = F ωC + F ω P1 = −u1 1 n 3 + u 2  n 2 −
n 3 + 2 n1 ,




R
R
R


~
LC 2
LS
F W2 F C F WP 2
ˆ
ˆ
ˆ
ω = ω + ω
= −u1 1 n 3 + u 2  n 2 +
n 3 − 2 n1 ,




R
R
R
F

C

(6)

ˆ
ωG

is an angular velocity of point G with respect to robot point C . Based on a rigid body
motion solution in 3D space, the velocity of the COG of the main body and the centre of two
wheels with respect to reference frame F can be formulated as

(Pi = G,WC1,WC 2 ),

ˆ ˆ
ˆ
ˆ
ˆ
v = F v C + F ωC ×r Pi + C v Pi ;

F Pi

ˆ
r Pi

(7)

ˆ
and C v Pi are the displacement and velocity of point Pi with respect to point C . The

centre of wheels are fixed with respect to point C , i.e

C WCi

ˆ
v

= 0 , Thus

ˆ
ˆ
ˆ
ˆ
ˆ
ˆ
v = F v C + F ωC ×C d G + C ωG ×C d G = u1n1 − u 2 dS 3n 3 + u3 (dC3n1 − dS 3n 2 ),
F WC1 F C F C C ˆWC1
ˆ
ˆ
ˆ
v = v + ω × L = u n + u Ln ,
F G

1 1

F WC 2 F C
ˆ
ˆ
v = v

ˆ
+ ω
F

C

ˆ
×C LWC 2

2

1

(8)

= u1n1 − u 2 Ln1 ,

C ˆG

ˆ
and C LWCi are displacements of the COG of main body and the centre of wheels with
respect to point C . The angular acceleration of the main body and the wheels are

d

F

F B
ˆ
ˆ


α B = d ω = u 2n 2 − u3n 3 ,
dt

F W1
 u LS −u u 

 
~
u + u 2 LC 2
ˆ
ˆ
ˆ
ˆW

αW1 = d ω + F ωC × F ω P1 =  2 2 1 2 n1 + u 2n 2 − 1
n3,




dt
R
R
F W2
 − u LS −u u 

 
~
u − u 2 LC 2
ˆ
F W2
ˆ
ˆ
ˆW

α = d ω + F ωC × F ω P 2 =  2 2 1 2 n1 + u 2n 2 − 1
n3,




dt
R
R
F

(9)

4
International Journal of Control Theory and Computer Modeling (IJCTCM) Vol.3, No.6, November 2013

From (7) the acceleration of the COG of main body and centre of two wheels with respect to
reference frame F can be formulated as
F

ˆ
ˆ
ˆ
ˆ
ˆ
a Pi = F a C + F α C × r Pi + F ωC ×

ˆ
ˆ
ˆ
(F ωC × rˆ Pi )+ F ωC ×C vˆ Pi + C a Pi ; (Pi = G,WC1,WC 2 ),

(10)

ˆ
ˆ
is an acceleration of point C with respect to frame F and C a Pi = d Cv Pi dt is an
C WCi
ˆ
acceleration of point Pi with respect to point C . Based on aforementioned fact, a = 0 , thus
F C

ˆ
a

(

)

F C
ˆ
ˆ
ˆ
ˆ
ˆ
ˆ
ˆ
ˆ
ˆ
ˆ
a = d v + F α C ×C d G + F ωC × F ωC ×C d G + F ωC ×C v G + C a G ,
dt
2
2
2
 


= u1 + u3 dC3 − u 2 dS 3 − u 3 dS 3 n1 − u3 dS 3 + u 3 dC3 n 2 − (u 2 dS 3 + u 2u3 dC3 )n 3,

F G

(

)

(

)

(

)

(11)

F C
ˆ
2
ˆ
ˆ
ˆ
ˆ
ˆ
 
= d v + F α C ×C LWC1 + F ωC × F ωC ×C LWC1 = (u1 + u 2 L )n1 − u 2 Ln 3 ,
dt
F C
ˆ
F WC 2
2
ˆ
ˆ
ˆ
ˆ
ˆ
ˆ
 
a
= d v + F α C ×C LWC 2 + F ωC × F ωC ×C LWC 2 = (u1 − u 2 L )n1 + u 2 Ln 3 ,
dt
F WC1

ˆ
a

(

)

Partial velocity and partial angular velocity of the main body and the wheels can be obtained by
differentiating (4), (6) and (8) with u r as shown below.
F ~ Pi
vr

F

F Pi
ˆ
=∂ v ;
∂u r

(r = 1,2,3), (Pi = G, C , WC1, WC 2 ),

F Bi
ˆ
~ Bi
ωr = ∂ ω ; (r = 1,2,3), (Bi = B, A, W1, W2 ),
∂u r

(12)

2.2. Dynamic of WIP
WIP lies under differential drive type of mobile robot. Thus generated torque, τ C, from the motors
to the robot can be represented as
τC = τ pitch + τ yaw ,

(13)

The yaw torque, τ yaw , and pitch torque, τ pitch , are the torques that cause WIP steers by , ϕ, in f 2
directional and move with velocity vC in n1 directional as shown in Fig. 1(b). However, pitch
torque exerts to robot main body in the form of force. Therefore at every instant, this robot
experiences both forward force and steering torque. Based on Fig. 1(b) and the assumptions, the
active forces are
ˆ
RC = γ1n1 + γ 2n 2 + γ 3n 3 ,
ˆ
T =δ n +δ n +δ n ,
C

1 1

2 2

ˆ
Rw1 = −mW gn 2 ,

3 3

(14)

ˆ
Rw2 = −mW gn 2 ,
ˆ
R B = − m B gn 2 ,

5
International Journal of Control Theory and Computer Modeling (IJCTCM) Vol.3, No.6, November 2013

Where
τ + τ wl

;
i = 1,
F + Fwl = wr
γ i =  wr
R

0
otherwise,


(15)

(F − F )LC = (τ − τ ) L C ;
i = 2,
 wr
wl
2
wr
wl
2
δi = 
R

0
otherwise,


ˆ
ˆ
ˆ
ˆ
ˆ
RC and TC are the force and torque exerted on the main body by wheel, Rw1 , Rw2 and RB are

forces exerted on the wheel and body by the gravity. Fwr and Fwl are translated forces from
the wheels torque. The inertia force and inertia torque of the main body and the wheels are
ˆ*
ˆ
RPi = −mPi ⋅ F a Pi ; (Pi = G, WC1, WC 2 ),
ˆ
ˆ
*
ˆ
ˆ
ˆ
ˆ
ˆ
ˆ
TBi =− F α Bi ⋅ I Bi − F ω Bi × I Bi ⋅ F ω Bi ; (Bi = B, W1, W2 ),

(16)

ˆ
ˆ
Where mG = mB , mWCi = mW , IˆBi = I b2n 2n 2 + I b3n 3n 3 and IˆWi = IW2 n 2n 2 + IW3 n 3n 3 . The inertia of

the wheels is considered as IW2 = mW R 2 4 + mW L2 and IW3 = mW R 2 4 . The generalized active
force and inertia force are given as
j

k

i =1
j

i =1

~ Bi ˆ
~
ˆ
Fr = ∑ F vrPi ⋅ RPi + ∑ F ωr ⋅ TBi ; (r = 1,2,3), (Pi = G, C , WC1, WC 2 ), (Bi = C ),

(17)

k

~ Bi ˆ
~
ˆ*
Fr * = ∑ F vrPi ⋅ RPi + ∑ F ωr ⋅ TBi * ; (r = 1,2,3), (Pi = G, WC1, WC 2 ), (Bi = B, W1, W2 ),
i =1

i =1

Where j is the number of points subjected to applied forces and k is the number of rigid bodies
subjected to applied torques. Three motion equations of WIP (19) are obtained by equating the
dynamic equation of motion (18),
Fr + Fr* = 0,

(18)

(

)


I 
τ + τ wl


 mb + 2mw + 2 w3  + mb dC3 = wr
x
θ
+ φ 2 + θ 2 mb dS3 ,

2 

R 
R
2



 mb (dS 3 )2 + 2mw L2 + I b2 + 2I w2 + 2 (LC 2 ) I w3  = (τ wr − τ wl ) LC 2 − θφmb d 2 S3C3 ,

φ
2
R
R



mb dC3  + mb d 2 + I b3  = mb dgS 3 + φ 2 mb d 2 S3C3 ,
x
θ

(

(19)

)

6
International Journal of Control Theory and Computer Modeling (IJCTCM) Vol.3, No.6, November 2013

Then state space representation of the WIP (20) is solved using Cramer rule. The matrix variables
are listed as in the appendix.

x(t ) = A(x, t )x(t ) + B(x, t )u(t ) + f (x, t )

 x 0 1 0 0 0 0   x  0
  
  0 0 0 A
x
24 0 A26   x   B21
  

θ 0 0 0 1 0 0  θ  0
   + 
 = 
θ 0 0 0 A44 0 A46  θ  B41

φ 0 0 0 0 0 1  φ  0
   
 
  
  
φ 0 0 0 0 0 A66  φ  B61

0 
0

F 
B22

 2
0  τ wr   0 
+  ,

B42   τ wl   F4 
 
0
0 

 
B62 
0
 


(20)

3. PARTIAL STATE-PID CONTROLLER
Notation: Throughout this section, i index indicates the balancing and heading subsystems by
equalized it to θ and φ .

3.1. Linear WIP model
To design a linear controller, the nonlinear WIP model is linearized by setting tilt angle, θ ≈ 0 ,
and heading angle,  ≈ 0 . The linear WIP system can be represented into two subsystems, first is
“balancing” subsystem which is regarding the rotation and motion about n 3 and n1 directional
and second is “heading” subsystem which is describing the rotation about n 2 directional. These
subsystems can be formulated as

x i (t ) = A i x i (t ) + B i u i (t );

(i = θ, φ),

y i (t ) = Ci x i (t )

(21)

Here Ai , Bi and Ci are state constant system matrix, system input matrix and system output
matrix with appropriate dimension. x i ∈ R ni and ui ∈ R are defined as state variable and control
input with ni number of state variables. The state vector of balancing and heading subsystems are

(

)

( )


 
x θ = x, x, θ, θ and x φ = φ, φ . The characteristic polynomial of both subsystems given as

det(sI − A i ) = ai0 s ni + ai1s ni −1 +  + ai(ni −1)s + aini ,

(22)

Where a i = [ai0 ai1  aini ] is a characteristic vector with coefficients ai0 = 1 , aini = det(−A i )
and ai1 = −trace(−A i ) . Both balancing and heading subsystems are

 x 0
 0
x
 =

θ 0
 
θ 0

φ 0
 = 
φ 0

0  x  0 

0  x  B21L 
  + 
u θ ,
0
0
1 θ  0 
   

0 A43L 0 θ  B41L 
1 φ  0 
uφ ,
 +
0 φ  B61L 
  

1
0

0
A23L

(23)

7
International Journal of Control Theory and Computer Modeling (IJCTCM) Vol.3, No.6, November 2013

Equation (23) showed nθ = 4 for balancing subsystem and nφ = 2 for heading subsystem.
The matrix variables are listed as in the appendix. Using decoupling technique, the relationship of
control input and uφ to the wheel torques are
τ wr = 0.5uθ + 0.5uφ ,

(24)

τ wl = 0.5uθ − 0.5uφ ,

3.2. Augment subsystem with PSPID
Fig. 2 shows closed loop WIP system. In such ni order system, input matrix, ri , and proposed
PSPID controller are
ri T = [ri1 0  ri(n −1) 0];
K PIDi

(i = θ, φ),

K Pi   K Pi1 0 K Pi3  K Pi(n −1)

=  K Ii  =  K Ii1 0 K Ii3  K Ii(n −1)


K Di   K Di1 0 K Di3  K Di(n −1)

 

0

0,
0


(25)

ri1 ,  , ri(ni −1) are the input variables, K Pi , K Ii , and K Di are proportional, integral and derivative

gain vector of PSPID controller. Based on (23) and (25), the PID controllers for the balancing and
heading subsystems are K PIDθ1 = [K Pθ1 K Iθ1 K Dθ1 ]T , K PIDθ3 = [K Pθ3 K Iθ3 K Dθ3 ]T and
K PIDφ1 = [K Pφ1

K Iφ1

K Dφ1 ]T . The control input ui is

ui = K P i (ri − y i ) + K Ii ∫ (ri − y i )dt + K Di d (ri − y i ) ,
dt

(26)

The output matrix is y i (t ) = Ci x i (t ) = x ino (t ) where x ino = [ xi1 0  xi(ni −1) 0]T . For simplicity,
set all input variable to zero ( ri = 0 ni ), hence the control input is
ui = −K PDin xi − K Iin ∫ y i dt ,

(27)

ṡ=y is defined, hence (27) will be
ui = −K pin x i − K Iin s i ,

(28)

Figure 2. Closed loop WIP structure with PSPID.

The second term in (28) can be simplified to a scalar by a following formula

8
International Journal of Control Theory and Computer Modeling (IJCTCM) Vol.3, No.6, November 2013

′ i
′
K Ii s′ = K Ii (βi1s i1 + βi3s i3 +  + βi(ni −1)s i(ni −1) ),
= K Ii1ς i1 + K Ii3ς i3 +  + K Ii(ni −1 )ς i(ni −1) ,

βini

(29)

is a coefficient with arbitrary selected value. Thus input signal ui is
ui = −K i xi ;

[ K D 1  K D (n −1)
= [xi1 (t ), x n (t ), s′ (t )],
i

K i = K Pi1
xi

T

i

i

i

]

′
K Ii ,

(30)

i i

It is obvious in (29) si’=βisi, thus


si = β i s i = β i Ci x i = Cβi x i ;

[

Cβi = βi1 0  βi (n −1)
i

]

(31)

0,

Based on above formulation, equivalent ni + 1 order subsystem dynamic can be formulated from
the combination of the original state (23) and (31). The ni + 1 state vector is written as

x i = A i x i + Bi ui ,

x i (t )  A i
 s (t )  = C
 i   βi

0 x i (t ) B i 
+
u (t ),
0  si (t )   0  i
  


(32)

Here βini is set to one. The output matrix Ci is set to
C
Ci =  i
0

0
;
1


(33)

The rank of controllability matrix [Bi A i Bi A 2 Bi  A ni Bi ] of system (32) is ni + 1 . This
i
i
means the linear system (32) is completely controllable.

3.3. Optimal PSPID
To apply QOR tuning method, Frobenius Canonical form of system (32) is considered by
following transformation.
z i = Ti xi ,

(34)

Where z i (mi × 1) and Ti (mi × mi ) are transformation state variable vector and transformation
matrix. Index mi = ni + 1 , and Ti matrix define as
 qi1 
 q A 
i i 
Ti =  1
; q i 1 = eT Wc−1,
ini
i




ni −1 
q i 1 Ai 

q i 1 is 1 × mi vector, Wci = [Bi

(35)

A i Bi  A mi Bi ] and unit vector eini = [0 0  1] , the
i

Frobenius canonical form of WIP subsystems can be express as
9
International Journal of Control Theory and Computer Modeling (IJCTCM) Vol.3, No.6, November 2013


z i = A Ci z i + B Ci ui ,

(36)

Where
 0
 0

−1
A ci = Ti A i Ti =  

 0
− α im

i
0
0
B ci = Ti Bi =  ,

 
1

1
0


0
1


0
− α i(mi −1)

0
− α i(mi − 2)




,


1 
 − α i1 





0
0


(37)

The input signal is
ui = −K Ci z i ;

[
K Ci 2  K Ci (m −1)
z i T = [zi1 (t ), zi 2 (t )  zim (t )],

K i = K Ci1

i

]

(38)

K Cimi ,

i

And also feedback gain
K Ci = K i Ti −1 ,

(39)

The desired m order characteristic equation of matrix A Ci − B Ci K Ci is
det(sI − Ai ) = s mi + (α i1 + K cimi )s mi −1 +  + (α i(mi −1) + K ci 2 )s + (α imi + K ci1 ),

(40)

As shown, system (32) is completely controllable, then K Ci can be tuned by QOR method. The
QOR problem is a quadratic performance index function for the integral function. The index is in
the form of quadratic performance of continuous-time linear time-varying function.
I = 1 z i T (t f ) Pfi z i (t f ) + 1
2
2

Where the final time,

tf

tf

∫0

(z

T
i

, is fix.

)

( t ) Q i z i ( t ) + u iT ( t ) R i u i ( t ) dt

(41)

Pfi , Q i ,

R i to

are chosen to be symmetry positive semidefinite, and

be symmetry positive definite. The QOR optimal control problem is to drive the state vector
z i (t ) to the origin from any nonzero initial values of states. The problem objective is to find u i (t ) ;
0 ≤ t ≤ t f , such that the objective function (41) is minimized. Choosing the appropriate weighting
matrix Q i , R i , and therefore get the optimal control rate with optimal control theory. For an
infinite time t f , P f i must satisfy following reduced Riccati equation.
A Ti P f i + P f A c i − P f i B c i R i − 1 B Ti P f i + Q i = 0
c
c

(42)

10
International Journal of Control Theory and Computer Modeling (IJCTCM) Vol.3, No.6, November 2013

With predetermined weighted matrix, optimal control is
u i ( t ) = − R i − 1 B Ti P f i z i ( t f ) = − K C i z i ( t f )
c

(43)

The control law makes the linear feedback system stable, then by adopting Lyapunov second law,
the nonlinear feedback system is stable. Weighting matrix Q i and R i are
u


e = Ae + B u e

x

−K
Figure 3. Equivalent ni + 1 order error vector of system (2) with PID controller

 q 11
 0
Q = 
 

 0


0



q 22







0

0 
 
 ; R = [r ]
11
0 

q mimi 


(44)

Finally, based on (39) and (30), PSPID controller is directly tuned for subsystems (23). The
formulation makes the proposed controller has both of PID controller and QOR advantages.
Following steps can be applied to tune PID controller using QOR technique:
Step 1. Construct mi order system (32) from the combination of the original system (23) and (31).
Step 2. Transform this mi order system to a Frobenius Canonical form based on transformation
formula (34).
Step 3. Tune K ci gain by appropriately tuning Qi and R i (44) matrices.
Step 4. Compute K i in (30) from K ci by transformation formulation (14).
Step 5. Lastly Based on (30), set PID gains (25) accordingly.

4. RESULT AND DISCUSSION
4.1. Model analysis
tuning scheme,
and
Qθ = diag(83.112, 2.583, 5.2287,3.4656) ,
Q φ = diag(0.01,1)
R θ = R φ = 1 × 10 were set for LQR controllers. For PSPID controller, the matrices Qs are
Q θ = diag(83.112, 2.583, 5.2287, 3.4656, 0.01) , Q φ = diag(0.01,1, 0.01) and
R θ = R φ = 1 × 10-3 . Thus the
following LQR and PSPID controller are obtained:
In

QOR

-3

11
International Journal of Control Theory and Computer Modeling (IJCTCM) Vol.3, No.6, November 2013

K θ = −[91.2,106.8, 493.4,129]; K φ = −[493.4,12],
− 27.1
− 106.0
K PIDθ1 =  − 18.3; K PIDθ3 =  − 18.3 ,






 − 21.5 
− 18.9


11.8
K PIDφ1 =  1.1 ,


 3 .1 



4.1.1. Open loop stability
The stability of WIP depends on the balancing of its main body. To investigate this behaviour, the
pole analysis of the balancing submatrix, A θ′ , from constant matrix A θ was conducted. The
poles are obtained by solving following equation
 s
det[ sI nθ − A θ′ ] = det 
− A43L

− 1
= 0,
s


(45)

Thus the poles are

(mB + 3mW )mb dg
,
(mB + 3mW )(mb d 2 + I B3 ) − (mB d )2
(mB + 3mW )mb dg
sθ 2 = −
,
(mB + 3mW )(mb d 2 + I B3 ) − (mB d )2
sθ1 =

(46)

This showed one of its pole was positive. The fact shows, if the WIP not accelerates (ie. u θ = 0 ),
the robot body will fall. Another fact is the mass of robot body, the mass of the wheel and the
COG of the main body will determine the magnitude of this pole.
4.1.1.1. Effect of main body COG on tilt angle, θ, control
Firstly, robot body was assumed as a point of mass, I b3 = mb d 2 . Therefore the unstable pole was
sθ1 =

(mb + 3m w )g
,
(mb + 6m w )d

(47)

The value of the pole is tabulated in table 2 as d change, d ∈ [o.1,2] .
Table 2.Variation of unstable pole over d.

d(m)
Sθ1

0.1
9.542

0.3
5.509

0.5
4.267

0.7
3.606

0.9
3.181

1.1
2.877

From the table 1, pole became larger when d was shorter. This matches the fact that the robot will
be harder to balance when COG of the main body is lower as shown in Fig. 3. However for higher
d, larger torque will be required.

12
International Journal of Control Theory and Computer Modeling (IJCTCM) Vol.3, No.6, November 2013

Proof: To hold the pendulum at vertical, defines the displacement of point C , xC must be equal to
circumference, Cd , that had been made by θ at point d .
xC ≡ Cd = θd ,

(48)

Thus
FC = mb aC =

mb xC
t

2

=

mb θd
t2

(49)

,

It is proven by newton's law, larger force is required if d becomes larger.

4.1.1.2. Effect of mass of body on tilt angle, θ, control
Table 3 below shows that when the mass of the body increase to 20kg the unstable pole only
increase about 1 from its initial value. Thus the effect is less significant on the tilt angle balancing
control. This is true as shown in Fig. 4(a).
Table 3. Variation of unstable pole over mb.

mb(kg)
Sθ1

1
5.451

2
5.777

4
6.110

6
6.279

10
6.451

20
6.609

4.1.1.3. Effect of mass of wheel on tilt angle, θ, control
Table 4 shows that when the mass of wheel increase to 2kg the unstable pole only decreases about
0.6 from its initial value. Thus the effect is less significant on the tilt angle balancing control as
shown in Fig. 4(b).
Table 4. Variation of unstable pole over mw.

mw(kg)
Sθ1

0.2
6.675

0.4
6.564

0.6
6.465

0.8
6.377

1
6.298

2
5.999

4.1.1.3. Inertia forces over initial condition
From the model, the motors need to generate enough amount of torque to compensate inertia
forces, F*1, F*2, and F*3 while balancing and moving in the Cartesian plane. Thus these inertia
forces were analysed over three initial conditions of position, x, tilt angle, θ, and heading angle,
ϕ. Three initial conditions are considered, (x,θ,ϕ)=(0.01745m,0,0), (x,θ,ϕ)=(0,0.01745rad,0),
and (x,θ,ϕ)=(0,0,0.01745rad).

13
International Journal of Control Theory and Computer Modeling (IJCTCM) Vol.3, No.6, November 2013

(b)

(a)

Figure 3. Responses of (a) tilt angle and (b) input torque over various COG of robot main body

(b)

(a)

Figure 4. Response of (a) tilt angle of over various mass of body and (b) tilt angle of over
various mass of wheel

(a)

(b)

(c)

Figure 5. Responses of (a) Inertia force F 1, (b) Inertia force F 2, and (c) Inertia force F
x, θ, and ϕ initial conditions.

3

due to

Fig. 5 shows the effect of these three initial conditions. In this work, WIP’s motors have
maximum torque τ wr (max) = 4 Nm . Thus it is important to determine the radius of the wheels. Based
on force and torque relationship, the wheels radius R must be less than the ratio of maximum
wheels torque and maximum heading inertia force, 2τ wr (max) F1*
(max) . It was shown in Fig. 5(a),
maximum heading inertia force F1*
(max) is about 81.22N when robot needs to compensate tilt angle
initial error. Thus, based on this fact, R should less than 0.098m
.

4.2. Controller analysis
4.2.1. Basic input test
A WIP system with LQR controller tested on three types of input, unit step, ramp function, and
exponential function. The test showed the suitability of input to the mobile WIP system
application. Fig. 6 shows, LQR controller was the best on unit step input. However its
14
International Journal of Control Theory and Computer Modeling (IJCTCM) Vol.3, No.6, November 2013

performance deteriorated when operates on others input function as shown in Fig. 7 and Fig. 8.
Fig. 7 shows, WIP with LQR had position and heading states error on ramp input. Fig. 8 shows,
WIP with LQR had position, velocity, heading angle, heading angular velocity state errors occur
in exponential input. For mobile WIP application, unit step input was not suitable where it
required tremendous large amount of torque as maximum as 45Nm as showed in Fig. 6(c). In
contrast, ramp and exponential type input functions are suitable input for the WIP system; these
inputs do not only have velocity information, it also enables the WIP system to be driven in
optimum velocity using permissible torque energy as shown in Fig. 7(c) and Fig. 8(c).
4.2.2. Cartesian motion
WIP was tested on two types of motion, rectilinear and curvilinear motions. WIP needed to be
held in a vertical while moving to a specify distance either in a straight line or in a curve. Below
are the equations of position input and heading angle input for both rectilinear and curvilinear
motions.
xin (t ) =

Pos
,
1 + e −T (t −Tc )
φin (t ) = − Hea ,
1 + e −T (t −Tc )

(50)

The constants T=0. 3, Tc=20 for both types of motions. The constants Pos=5, Hea=0 and
Pos=1.25π, Hea=π/4 were respectively for rectilinear and curvilinear motions. Both inputs have
s-shape trajectory and its slope is maximum time t=Tc.
From both Fig. 9 and 10, system with PSPID controller had better dynamic performance over the
system with LQR controller. Comparatively, WIP with PSPID controller took only 40s to reach at
specified position and orientation compare to WIP with LQR controller which took twice time
longer (about 80s) as shown in Fig. 10(e). It verified that the trajectory error can be reduced to
zero by adding an additional pole at zero to the system; and this process was achievable by
implementing PSPID controller to the WIP system. Moreover on QOR tuning formulation,
required torque of the WIP system with PSPID can be guaranteed within permissible torque
limitation.

(a)

(b)

(c)

Figure 6. Responses of (a) state x, (b) state ϕ and (a) torques τwr, τwl on unit step input.

15
International Journal of Control Theory and Computer Modeling (IJCTCM) Vol.3, No.6, November 2013

(c)

(b)

(a)

Figure 7. Responses of (a) state x, (b) state ϕ and (c) torques τwr, τwl on ramp input.

(c)

(b)

(a)



φ
Figure 8. Responses of (a) states x, x , (b) states ϕ, and (c) torques τwr, τwl on exponential
input.

(c)

(b)

(a)

(d)

(e)



Figure 9. Responses of (a) state x, (b) state x , (c) state θ, (d) state θ and (e) torques τwr, τwl on
rectilinear motion.

16
International Journal of Control Theory and Computer Modeling (IJCTCM) Vol.3, No.6, November 2013

(a)

(b)

(c)

(d)

(e)

(f)

(g)



x
θ
φ
Figure 10. Responses of (a) state x, (b) state , (c) state θ, (d) state , (e) state ϕ, (f) state
and (g) torques τwr, τwl on curvilinear motion.

5. CONCLUSION
Nonlinear dynamic mathematical model of a WIP system successfully derived. Applying right
geometric context of the active force and inertia force led to a correct derivation of the WIP
system using Kane’s method. Furthermore, an optimal PSPID controller had been proposed to
control the system for better dynamic performance. The controller had both advantages of PID
and QOR tuning method.
Theoretical design, simulation and numerical results depicted that: 1) the nonlinear dynamic
model correctly derived, 2) WIP system with proposed controller had a satisfactory dynamic
performance where the trajectory error was very small, 3) QOR tuning scheme used and this
guarantee stability of WIP system, and 4) WIP required low magnitude of torque and this permit
practical implementation.
Further research should concern on: 1) variable type of WIP model since it is closer to human
transporter and WIP service robot application and 2) design and implementation of the proposed
controller in a microcontroller based system as a standalone and low level controller since of its
simple and easy realization.

17
International Journal of Control Theory and Computer Modeling (IJCTCM) Vol.3, No.6, November 2013

APPENDIX
Nonlinear and linear WIP state variables

(

)

DIP1 = (mb + 3mw ) mb d 2 + I B3 − (mb d cos θ)2 ,
2


DIP 2 = mb (d sin θ)2 + I b 2 +  4 L2 + R + (L cos φ)2 mw ,




2
2
2


m d 1 − cos 2 θ + I b3 mb d sin θφ
m d + I b3 mb d sin θθ
A24 = b
, A26 = b
,
DIP1
DIP1



3mw mb d 2 sin θ cos θφ
− mb d 2 sin θ cos θθ
− (mb d )2 sin θ cos θθ
A44 =
, A46 =
, A66 =
,
DIP1
DIP1
DIP 2

(

B21 = B22 =
F2 =

(

)

(mb d 2 + I b3 ) , B

41

DIP1R

− (mb d )2 g sin θ cos θ
DIP

= B42 =

, F4 =

(

(

)

−mb d cos θ
DIP1 R

)

, B61 = − B61 =

mb dg sin θ(mb + 3mw )

L cos φ

,

DIP 2 R

,

DIP

)

D IPL 1 = ( m B + 3 m w ) m b d 2 + I b 3 − ( m b d ) 2 ,
2

D IPL 2 = I b 2 +  5 L 2 + R


2

A 23 L =

− (m b d )2 g
D IPL 1

B 21 L = B 22 L =


m w ,



, A 43 L =

(m b d 2 + I B 3 ) ,
D IPL 1 R

( m b + 3 m w )m b dg

,

D IPL 1

B 41 L = B 42 L =

−mbd
D IPL 1 R

, B 61 L = − B 62 L =

L
,
D IPL 2 R

REFERENCES
[1]

[2]
[3]
[4]

[5]

[6]

[7]

[8]

Z. Kausar, K. Stol, and N. Patel, "The Effect of Terrain Inclination on Performance and the Stability
Region of Two-Wheeled Mobile Robots," International Journal of Advanced Robotic Systems, vol. 9,
no. 218, pp. 1-11, 2012.
S. H. Miao, "Modeling of self-tilt-up motion for a two-wheeled inverted pendulum," Industrial Robotan International Journal, vol. 38, no. 1, pp. 76-85, 2011.
F. Grasser, A. D’Arrigo, S. Colombi, and A. C. Rufer, "JOE: a mobile, inverted pendulum," IEEE
Transactions on Industrial Electronics, vol. 49, no. 1, pp. 107-114, 2002.
L. Jingtao, X. Gao, H. Qiang, D. Qinjun, and D. Xingguang, "Mechanical Design and Dynamic
Modeling of a Two-Wheeled Inverted Pendulum Mobile Robot," Automation and Logistics, 2007
IEEE International Conference on, Jinan, China, pp. 1614-1619, 2007.
M. Baloh and M. Parent, "Modeling and Model Verification of an Intelligent Self-Balancing TwoWheeled Vehicle for an Autonomous Urban Transportation System," Conference on Computational
Intelligence, Robotics, and Autonomous Systems, Singapore, pp. 1-7, 2003.
J. S. Noh, G. H. Lee, and S. Jung, "Position control of a mobile inverted pendulum system using
radial basis function network," International Journal of Control, Automation and Systems, vol. 8, no.
1, pp. 157-162, 2010.
H. Ozaki, T. Ohgushi, T. Shimogawa, and C.-J. Lin, "Position and orientation control of a wheeled
inverted pendulum," JSME International Journal, Series C: Mechanical Systems, Machine Elements
and Manufacturing, vol. 44, no. 1, pp. 188-195, 2001.
K. Teeyapan, J. Wang, T. Kunz, and M. Stilman, "Robot Limbo: Optimized Planning and Control for
Dynamically Stable Robots Under Vertical Obstacles," 2010 IEEE International Conference on
Robotics and Automation, Anchorage, Alaska, USA, pp. 4519-45 S. H. Jeong and T. Takahashi,
18
International Journal of Control Theory and Computer Modeling (IJCTCM) Vol.3, No.6, November 2013

[10]

[11]

[12]

[13]
[14]

[15]
[16]

[17]
[18]

[19]
[20]

[21]
[22]

[23]
[24]

[25]

"Wheeled inverted pendulum type assistant robot: inverted mobile, standing, and sitting motions,"
IEEE/RSJ International Conference on Intelligent Robots and Systems 2007, San Diego, CA, USA.,
pp. 1932-1937, 2007.
M. L. Chen, "Analysis and design of robust feedback control systems for a nonlinear two-wheel
inverted pendulum system," 2012 International Symposium on Computer, Consumer and Control,
Taichung City, Taiwan, pp. 949-953, 2012.
K. M. Goher, M. O. Tokhi, and N. H. Siddique, "Dynamic modelling and control of a two wheeled
robotic vehicle with a virtual payload," Journal of Engineering and Applied Sciences, vol. 6, no. 3, pp.
7-41, 2011.
A. Bajodah, D. Hodges, and Y.-H. Chen, "Nonminimal Kane's Equations of Motion for Multibody
Dynamical Systems Subject to Nonlinear Nonholonomic Constraints," Multibody System Dynamics,
vol. 14, no. 2, pp. 155-187, 2005.
Y. Kim, S. Kim, and Y. Kwak, "Dynamic analysis of a nonholonomic two-wheeled inverted
pendulum robot," Journal of Intelligent and Robotic Systems, vol. 44, no. 1, pp. 25-46, 2005.
H. Jian, G. Zhi-Hong, T. Matsuno, T. Fukuda, and K. Sekiyama, "Sliding-Mode Velocity Control of
Mobile-Wheeled Inverted-Pendulum Systems," Robotics, IEEE Transactions on, vol. 26, no. 4, pp.
750-758, 2010.
C. H. Chiu and C. H. Lin, "A WIP control based on an intelligent controller," World Academy Of
Science Engineering and Technology vol. 54, no. 126, pp. 656-661, 2011.
C. H. Huang, W. J. Wang, and C. H. Chiu, "Design and implementation of fuzzy control on a twowheel inverted pendulum," IEEE Transactions on Industrial Electronics, vol. 58, no. 7, pp. 29883001, 2011.
C. C. Tsai, H. C. Huang, and S. C. Lin, "Adaptive Neural Network Control of a Self-Balancing TwoWheeled Scooter," Industrial Electronics, IEEE Transactions on, vol. 57, no. 4, pp. 1420-1428, 2010.
E. Minnaert, B. Hemmelman, and D. Dolan, "Inverted pendulum design with hardware fuzzy logic
controller," 11th World Multi-Conference on Systemics, Cybernetics and Informatics, (Wmsci 2007),
Orlando, pp. 76-81, 2007.
T. Ren, T. C. Chen, and C. J. Chen, "Motion control for a two-wheeled vehicle using a self-tuning
PID controller," Control Engineering Practice, vol. 16, no. 3, pp. 365-375, 2008.
M. Fallahi and S. Azadi, "Adaptive Control of an inverted pendulum using adaptive PID neural
network," Proceedings of the 2009 International Conference on Signal Processing Systems, Los
Alamitos, CA, USA, pp. 589-593, 2009.
S. Liang and G. Jiafei, "Researching of Two-Wheeled Self-Balancing Robot Base on LQR Combined
with PID," 2nd International Workshop on Intelligent Systems and Applications (ISA), pp. 1-5, 2010.
A. N. K. Nasir, M. A. Ahmad, and R. M. T. R. Ismail, "The control of a highly nonlinear two-wheels
balancing robot: A comparative assessment between LQR and PID-PID control schemes," World
Academy Of Science Engineering and Technology, vol. 46, no. 44, pp. 227-232, 2010.
S. Ahmad and M. O. Tokhi, "Linear Quadratic Regulator (LQR) approach for lifting and stabilizing of
two-wheeled wheelchair," 4th International Conference On Mechatronics (ICOM), pp. 1-6, 2011.
S. Y. Seo, S. H. Kim, S.-H. Lee, S. H. Han, and H. S. Kim, "Simulation of attitude control of a
wheeled inverted pendulum," International Conference on Control, Automation and Systems, (ICCAS
'07), pp. 2264-2269, 2007.
T. Takei, R. Imamura, and S. Yuta, "Baggage Transportation and Navigation by a Wheeled Inverted
Pendulum Mobile Robot," IEEE Transactions on Industrial Electronics, vol. 56, no. 10, pp. 39853994, 2009.

19
International Journal of Control Theory and Computer Modeling (IJCTCM) Vol.3, No.6, November 2013

Authors
Mohamad Amir Shamsudin was born in Johor, Malaysia, in 1983. He received the B.S
and M.S degrees in mechatronics engineering from Universiti Teknologi Malaysia
(UTM) respectively in 2007 and 2009. He is currently a PhD student in the Faculty of
Electrical Engineering, UTM. His research is on Modelling and Control of Wheel
Inverted Pendulum system.
Rosbi Mamat is Associate Professor at Department of Control and Mechatronic UTM,
Malaysia. His research interests include control and intelligent systems, mechatronic
system, and embedded system.
Sophan Wahyudi Nawawi received his PhD from UTM, Malaysia in 2006. His PhD
research was in Control area. His research interests include nonlinear system and
control, robust control and robotic system.

20

Mais conteúdo relacionado

Mais procurados

Adaptive Fuzzy Integral Sliding-Mode Regulator for Induction Motor Using Nonl...
Adaptive Fuzzy Integral Sliding-Mode Regulator for Induction Motor Using Nonl...Adaptive Fuzzy Integral Sliding-Mode Regulator for Induction Motor Using Nonl...
Adaptive Fuzzy Integral Sliding-Mode Regulator for Induction Motor Using Nonl...IJPEDS-IAES
 
Improvement of vehicle ride comfort using geneticalgorithm optimization and p...
Improvement of vehicle ride comfort using geneticalgorithm optimization and p...Improvement of vehicle ride comfort using geneticalgorithm optimization and p...
Improvement of vehicle ride comfort using geneticalgorithm optimization and p...ahmedgeweda
 
An improved swarm intelligence algorithms-based nonlinear fractional order-PI...
An improved swarm intelligence algorithms-based nonlinear fractional order-PI...An improved swarm intelligence algorithms-based nonlinear fractional order-PI...
An improved swarm intelligence algorithms-based nonlinear fractional order-PI...TELKOMNIKA JOURNAL
 
SLAM of Multi-Robot System Considering Its Network Topology
SLAM of Multi-Robot System Considering Its Network TopologySLAM of Multi-Robot System Considering Its Network Topology
SLAM of Multi-Robot System Considering Its Network Topologytoukaigi
 
Design and Simulation of Different Controllers for Stabilizing Inverted Pendu...
Design and Simulation of Different Controllers for Stabilizing Inverted Pendu...Design and Simulation of Different Controllers for Stabilizing Inverted Pendu...
Design and Simulation of Different Controllers for Stabilizing Inverted Pendu...IJERA Editor
 
PSO and SMC based Closed Loop V/F Control of AC Drive using SVPWM
PSO and SMC based Closed Loop V/F Control of AC Drive using SVPWMPSO and SMC based Closed Loop V/F Control of AC Drive using SVPWM
PSO and SMC based Closed Loop V/F Control of AC Drive using SVPWMIRJET Journal
 
E043036045
E043036045E043036045
E043036045inventy
 
Analysis & Control of Inverted Pendulum System Using PID Controller
Analysis & Control of Inverted Pendulum System Using PID ControllerAnalysis & Control of Inverted Pendulum System Using PID Controller
Analysis & Control of Inverted Pendulum System Using PID ControllerIJERA Editor
 
Robust Control of Rotor/AMB Systems
Robust Control of Rotor/AMB SystemsRobust Control of Rotor/AMB Systems
Robust Control of Rotor/AMB SystemsSina Kuseyri
 
shehabi - A Classical and Fuzzy Logic Control Design and Simulation of a Long...
shehabi - A Classical and Fuzzy Logic Control Design and Simulation of a Long...shehabi - A Classical and Fuzzy Logic Control Design and Simulation of a Long...
shehabi - A Classical and Fuzzy Logic Control Design and Simulation of a Long...Abdul Ghafoor Al Shehabi
 
IRJET- Four Propellers Submarine Drone Modelling
IRJET- Four Propellers Submarine Drone ModellingIRJET- Four Propellers Submarine Drone Modelling
IRJET- Four Propellers Submarine Drone ModellingIRJET Journal
 
ADAPTIVE TREADMILL CONTROL BY HUMAN WILL
ADAPTIVE TREADMILL CONTROL BY HUMAN WILLADAPTIVE TREADMILL CONTROL BY HUMAN WILL
ADAPTIVE TREADMILL CONTROL BY HUMAN WILLtoukaigi
 
Robust Control of Rotor/AMB Systems
Robust Control of Rotor/AMB SystemsRobust Control of Rotor/AMB Systems
Robust Control of Rotor/AMB SystemsSina Kuseyri
 
Unmanned Airplane Autopilot Tuning
Unmanned Airplane Autopilot TuningUnmanned Airplane Autopilot Tuning
Unmanned Airplane Autopilot TuningIJERA Editor
 
Paper_Flutter
Paper_FlutterPaper_Flutter
Paper_FlutterRam Mohan
 

Mais procurados (18)

Adaptive Fuzzy Integral Sliding-Mode Regulator for Induction Motor Using Nonl...
Adaptive Fuzzy Integral Sliding-Mode Regulator for Induction Motor Using Nonl...Adaptive Fuzzy Integral Sliding-Mode Regulator for Induction Motor Using Nonl...
Adaptive Fuzzy Integral Sliding-Mode Regulator for Induction Motor Using Nonl...
 
Improvement of vehicle ride comfort using geneticalgorithm optimization and p...
Improvement of vehicle ride comfort using geneticalgorithm optimization and p...Improvement of vehicle ride comfort using geneticalgorithm optimization and p...
Improvement of vehicle ride comfort using geneticalgorithm optimization and p...
 
An improved swarm intelligence algorithms-based nonlinear fractional order-PI...
An improved swarm intelligence algorithms-based nonlinear fractional order-PI...An improved swarm intelligence algorithms-based nonlinear fractional order-PI...
An improved swarm intelligence algorithms-based nonlinear fractional order-PI...
 
SLAM of Multi-Robot System Considering Its Network Topology
SLAM of Multi-Robot System Considering Its Network TopologySLAM of Multi-Robot System Considering Its Network Topology
SLAM of Multi-Robot System Considering Its Network Topology
 
Design and Simulation of Different Controllers for Stabilizing Inverted Pendu...
Design and Simulation of Different Controllers for Stabilizing Inverted Pendu...Design and Simulation of Different Controllers for Stabilizing Inverted Pendu...
Design and Simulation of Different Controllers for Stabilizing Inverted Pendu...
 
PSO and SMC based Closed Loop V/F Control of AC Drive using SVPWM
PSO and SMC based Closed Loop V/F Control of AC Drive using SVPWMPSO and SMC based Closed Loop V/F Control of AC Drive using SVPWM
PSO and SMC based Closed Loop V/F Control of AC Drive using SVPWM
 
E043036045
E043036045E043036045
E043036045
 
Analysis & Control of Inverted Pendulum System Using PID Controller
Analysis & Control of Inverted Pendulum System Using PID ControllerAnalysis & Control of Inverted Pendulum System Using PID Controller
Analysis & Control of Inverted Pendulum System Using PID Controller
 
Robust Control of Rotor/AMB Systems
Robust Control of Rotor/AMB SystemsRobust Control of Rotor/AMB Systems
Robust Control of Rotor/AMB Systems
 
shehabi - A Classical and Fuzzy Logic Control Design and Simulation of a Long...
shehabi - A Classical and Fuzzy Logic Control Design and Simulation of a Long...shehabi - A Classical and Fuzzy Logic Control Design and Simulation of a Long...
shehabi - A Classical and Fuzzy Logic Control Design and Simulation of a Long...
 
IRJET- Four Propellers Submarine Drone Modelling
IRJET- Four Propellers Submarine Drone ModellingIRJET- Four Propellers Submarine Drone Modelling
IRJET- Four Propellers Submarine Drone Modelling
 
ADAPTIVE TREADMILL CONTROL BY HUMAN WILL
ADAPTIVE TREADMILL CONTROL BY HUMAN WILLADAPTIVE TREADMILL CONTROL BY HUMAN WILL
ADAPTIVE TREADMILL CONTROL BY HUMAN WILL
 
Robust Control of Rotor/AMB Systems
Robust Control of Rotor/AMB SystemsRobust Control of Rotor/AMB Systems
Robust Control of Rotor/AMB Systems
 
Unmanned Airplane Autopilot Tuning
Unmanned Airplane Autopilot TuningUnmanned Airplane Autopilot Tuning
Unmanned Airplane Autopilot Tuning
 
paper
paperpaper
paper
 
Paper_Flutter
Paper_FlutterPaper_Flutter
Paper_Flutter
 
A Suitable Structure to Control the System of Quad-rotor Miniature Aerial Veh...
A Suitable Structure to Control the System of Quad-rotor Miniature Aerial Veh...A Suitable Structure to Control the System of Quad-rotor Miniature Aerial Veh...
A Suitable Structure to Control the System of Quad-rotor Miniature Aerial Veh...
 
D05532531
D05532531D05532531
D05532531
 

Destaque

การวิเคราะห์โครงการแหล่งน้ำขนาดเล็กโดยวิธี integrated mental model and projec...
การวิเคราะห์โครงการแหล่งน้ำขนาดเล็กโดยวิธี integrated mental model and projec...การวิเคราะห์โครงการแหล่งน้ำขนาดเล็กโดยวิธี integrated mental model and projec...
การวิเคราะห์โครงการแหล่งน้ำขนาดเล็กโดยวิธี integrated mental model and projec...Piriya Uraiwong
 
การบริหารจัดการความเสี่ยงโครงการแหล่งน้ำขนาดเล็กโดยกลุ่มผู้มีส่วนได้ส่วนเสีย
การบริหารจัดการความเสี่ยงโครงการแหล่งน้ำขนาดเล็กโดยกลุ่มผู้มีส่วนได้ส่วนเสียการบริหารจัดการความเสี่ยงโครงการแหล่งน้ำขนาดเล็กโดยกลุ่มผู้มีส่วนได้ส่วนเสีย
การบริหารจัดการความเสี่ยงโครงการแหล่งน้ำขนาดเล็กโดยกลุ่มผู้มีส่วนได้ส่วนเสียPiriya Uraiwong
 
2014 inverted pendulum_presentation
2014 inverted pendulum_presentation2014 inverted pendulum_presentation
2014 inverted pendulum_presentationSteven Hefner
 
Controller design of inverted pendulum using pole placement and lqr
Controller design of inverted pendulum using pole placement and lqrController design of inverted pendulum using pole placement and lqr
Controller design of inverted pendulum using pole placement and lqreSAT Publishing House
 
eCommerce Case Studies - A Little Book of Success
eCommerce Case Studies - A Little Book of SuccesseCommerce Case Studies - A Little Book of Success
eCommerce Case Studies - A Little Book of SuccessDivante
 
1 mrac for inverted pendulum
1 mrac for inverted pendulum1 mrac for inverted pendulum
1 mrac for inverted pendulumnazir1988
 
Inverted Pendulum Control: A Brief Overview
Inverted Pendulum Control: A Brief OverviewInverted Pendulum Control: A Brief Overview
Inverted Pendulum Control: A Brief OverviewIJMER
 
Thesis presentation on inverted pendulum
Thesis presentation on inverted pendulum Thesis presentation on inverted pendulum
Thesis presentation on inverted pendulum Nowab Md. Aminul Haq
 
SlideShare's New App for Android
SlideShare's New App for AndroidSlideShare's New App for Android
SlideShare's New App for AndroidSlideShare
 

Destaque (15)

การวิเคราะห์โครงการแหล่งน้ำขนาดเล็กโดยวิธี integrated mental model and projec...
การวิเคราะห์โครงการแหล่งน้ำขนาดเล็กโดยวิธี integrated mental model and projec...การวิเคราะห์โครงการแหล่งน้ำขนาดเล็กโดยวิธี integrated mental model and projec...
การวิเคราะห์โครงการแหล่งน้ำขนาดเล็กโดยวิธี integrated mental model and projec...
 
การบริหารจัดการความเสี่ยงโครงการแหล่งน้ำขนาดเล็กโดยกลุ่มผู้มีส่วนได้ส่วนเสีย
การบริหารจัดการความเสี่ยงโครงการแหล่งน้ำขนาดเล็กโดยกลุ่มผู้มีส่วนได้ส่วนเสียการบริหารจัดการความเสี่ยงโครงการแหล่งน้ำขนาดเล็กโดยกลุ่มผู้มีส่วนได้ส่วนเสีย
การบริหารจัดการความเสี่ยงโครงการแหล่งน้ำขนาดเล็กโดยกลุ่มผู้มีส่วนได้ส่วนเสีย
 
2014 inverted pendulum_presentation
2014 inverted pendulum_presentation2014 inverted pendulum_presentation
2014 inverted pendulum_presentation
 
invertedpendulum
invertedpenduluminvertedpendulum
invertedpendulum
 
Controller design of inverted pendulum using pole placement and lqr
Controller design of inverted pendulum using pole placement and lqrController design of inverted pendulum using pole placement and lqr
Controller design of inverted pendulum using pole placement and lqr
 
eCommerce Case Studies - A Little Book of Success
eCommerce Case Studies - A Little Book of SuccesseCommerce Case Studies - A Little Book of Success
eCommerce Case Studies - A Little Book of Success
 
Blog de tecno mochi
Blog de tecno mochiBlog de tecno mochi
Blog de tecno mochi
 
1 mrac for inverted pendulum
1 mrac for inverted pendulum1 mrac for inverted pendulum
1 mrac for inverted pendulum
 
Inverted Pendulum Control: A Brief Overview
Inverted Pendulum Control: A Brief OverviewInverted Pendulum Control: A Brief Overview
Inverted Pendulum Control: A Brief Overview
 
final project
final projectfinal project
final project
 
Segway
SegwaySegway
Segway
 
Thesis presentation on inverted pendulum
Thesis presentation on inverted pendulum Thesis presentation on inverted pendulum
Thesis presentation on inverted pendulum
 
Pcmat em slide
Pcmat em slidePcmat em slide
Pcmat em slide
 
SlideShare's New App for Android
SlideShare's New App for AndroidSlideShare's New App for Android
SlideShare's New App for Android
 
Slideshare ppt
Slideshare pptSlideshare ppt
Slideshare ppt
 

Semelhante a Dynamic modelling and optimal controlscheme of wheel inverted pendulum for mobile robot application

ENHANCED DATA DRIVEN MODE-FREE ADAPTIVE YAW CONTROL OF UAV HELICOPTER
ENHANCED DATA DRIVEN MODE-FREE ADAPTIVE YAW CONTROL OF UAV HELICOPTERENHANCED DATA DRIVEN MODE-FREE ADAPTIVE YAW CONTROL OF UAV HELICOPTER
ENHANCED DATA DRIVEN MODE-FREE ADAPTIVE YAW CONTROL OF UAV HELICOPTERijcisjournal
 
Optimal FOPI-FOPD controller design for rotary inverted pendulum system using...
Optimal FOPI-FOPD controller design for rotary inverted pendulum system using...Optimal FOPI-FOPD controller design for rotary inverted pendulum system using...
Optimal FOPI-FOPD controller design for rotary inverted pendulum system using...TELKOMNIKA JOURNAL
 
Neural Network Control Based on Adaptive Observer for Quadrotor Helicopter
Neural Network Control Based on Adaptive Observer for Quadrotor HelicopterNeural Network Control Based on Adaptive Observer for Quadrotor Helicopter
Neural Network Control Based on Adaptive Observer for Quadrotor HelicopterIJITCA Journal
 
STABILIZATION AT UPRIGHT EQUILIBRIUM POSITION OF A DOUBLE INVERTED PENDULUM W...
STABILIZATION AT UPRIGHT EQUILIBRIUM POSITION OF A DOUBLE INVERTED PENDULUM W...STABILIZATION AT UPRIGHT EQUILIBRIUM POSITION OF A DOUBLE INVERTED PENDULUM W...
STABILIZATION AT UPRIGHT EQUILIBRIUM POSITION OF A DOUBLE INVERTED PENDULUM W...ijcsa
 
PID vs LQR controller for tilt rotor airplane
PID vs LQR controller for tilt rotor airplane PID vs LQR controller for tilt rotor airplane
PID vs LQR controller for tilt rotor airplane IJECEIAES
 
Robust Control of a Spherical Mobile Robot
Robust Control of a Spherical Mobile RobotRobust Control of a Spherical Mobile Robot
Robust Control of a Spherical Mobile RobotIRJET Journal
 
Iaetsd modelling of one link flexible arm manipulator using
Iaetsd modelling of one link flexible arm manipulator usingIaetsd modelling of one link flexible arm manipulator using
Iaetsd modelling of one link flexible arm manipulator usingIaetsd Iaetsd
 
Velocity control of a two-wheeled inverted pendulum mobile robot: a fuzzy mod...
Velocity control of a two-wheeled inverted pendulum mobile robot: a fuzzy mod...Velocity control of a two-wheeled inverted pendulum mobile robot: a fuzzy mod...
Velocity control of a two-wheeled inverted pendulum mobile robot: a fuzzy mod...journalBEEI
 
Simulation of Robot Manipulator Trajectory Optimization Design
Simulation of Robot Manipulator Trajectory Optimization DesignSimulation of Robot Manipulator Trajectory Optimization Design
Simulation of Robot Manipulator Trajectory Optimization DesignIJRESJOURNAL
 
Single Pendulum Gantry (SPG) 2013.4.17
Single Pendulum Gantry (SPG) 2013.4.17Single Pendulum Gantry (SPG) 2013.4.17
Single Pendulum Gantry (SPG) 2013.4.17WEI WEI
 
DEVELOPMENT AND IMPLEMENTATION OF A ADAPTIVE FUZZY CONTROL SYSTEM FOR A VTOL ...
DEVELOPMENT AND IMPLEMENTATION OF A ADAPTIVE FUZZY CONTROL SYSTEM FOR A VTOL ...DEVELOPMENT AND IMPLEMENTATION OF A ADAPTIVE FUZZY CONTROL SYSTEM FOR A VTOL ...
DEVELOPMENT AND IMPLEMENTATION OF A ADAPTIVE FUZZY CONTROL SYSTEM FOR A VTOL ...ijctcm
 
DEVELOPMENT AND IMPLEMENTATION OF A ADAPTIVE FUZZY CONTROL SYSTEM FOR A VTOL ...
DEVELOPMENT AND IMPLEMENTATION OF A ADAPTIVE FUZZY CONTROL SYSTEM FOR A VTOL ...DEVELOPMENT AND IMPLEMENTATION OF A ADAPTIVE FUZZY CONTROL SYSTEM FOR A VTOL ...
DEVELOPMENT AND IMPLEMENTATION OF A ADAPTIVE FUZZY CONTROL SYSTEM FOR A VTOL ...ijctcm
 
Navigation of Mobile Inverted Pendulum via Wireless control using LQR Technique
Navigation of Mobile Inverted Pendulum via Wireless control using LQR TechniqueNavigation of Mobile Inverted Pendulum via Wireless control using LQR Technique
Navigation of Mobile Inverted Pendulum via Wireless control using LQR TechniqueIJMTST Journal
 
Experiment based comparative analysis of stator current controllers using pre...
Experiment based comparative analysis of stator current controllers using pre...Experiment based comparative analysis of stator current controllers using pre...
Experiment based comparative analysis of stator current controllers using pre...journalBEEI
 
Mathematical Modeling and Fuzzy Adaptive PID Control of Erection Mechanism
Mathematical Modeling and Fuzzy Adaptive PID Control of Erection MechanismMathematical Modeling and Fuzzy Adaptive PID Control of Erection Mechanism
Mathematical Modeling and Fuzzy Adaptive PID Control of Erection MechanismTELKOMNIKA JOURNAL
 
[8] implementation of pmsm servo drive using digital signal processing
[8] implementation of pmsm servo drive using digital signal processing[8] implementation of pmsm servo drive using digital signal processing
[8] implementation of pmsm servo drive using digital signal processingNgoc Dinh
 
The Neural Network-Combined Optimal Control System of Induction Motor
The Neural Network-Combined Optimal Control System of Induction MotorThe Neural Network-Combined Optimal Control System of Induction Motor
The Neural Network-Combined Optimal Control System of Induction MotorIJECEIAES
 
A Lyapunov Based Approach to Enchance Wind Turbine Stability
A Lyapunov Based Approach to Enchance Wind Turbine StabilityA Lyapunov Based Approach to Enchance Wind Turbine Stability
A Lyapunov Based Approach to Enchance Wind Turbine Stabilityijeei-iaes
 

Semelhante a Dynamic modelling and optimal controlscheme of wheel inverted pendulum for mobile robot application (20)

ENHANCED DATA DRIVEN MODE-FREE ADAPTIVE YAW CONTROL OF UAV HELICOPTER
ENHANCED DATA DRIVEN MODE-FREE ADAPTIVE YAW CONTROL OF UAV HELICOPTERENHANCED DATA DRIVEN MODE-FREE ADAPTIVE YAW CONTROL OF UAV HELICOPTER
ENHANCED DATA DRIVEN MODE-FREE ADAPTIVE YAW CONTROL OF UAV HELICOPTER
 
Optimal FOPI-FOPD controller design for rotary inverted pendulum system using...
Optimal FOPI-FOPD controller design for rotary inverted pendulum system using...Optimal FOPI-FOPD controller design for rotary inverted pendulum system using...
Optimal FOPI-FOPD controller design for rotary inverted pendulum system using...
 
Neural Network Control Based on Adaptive Observer for Quadrotor Helicopter
Neural Network Control Based on Adaptive Observer for Quadrotor HelicopterNeural Network Control Based on Adaptive Observer for Quadrotor Helicopter
Neural Network Control Based on Adaptive Observer for Quadrotor Helicopter
 
STABILIZATION AT UPRIGHT EQUILIBRIUM POSITION OF A DOUBLE INVERTED PENDULUM W...
STABILIZATION AT UPRIGHT EQUILIBRIUM POSITION OF A DOUBLE INVERTED PENDULUM W...STABILIZATION AT UPRIGHT EQUILIBRIUM POSITION OF A DOUBLE INVERTED PENDULUM W...
STABILIZATION AT UPRIGHT EQUILIBRIUM POSITION OF A DOUBLE INVERTED PENDULUM W...
 
PID vs LQR controller for tilt rotor airplane
PID vs LQR controller for tilt rotor airplane PID vs LQR controller for tilt rotor airplane
PID vs LQR controller for tilt rotor airplane
 
Robust Control of a Spherical Mobile Robot
Robust Control of a Spherical Mobile RobotRobust Control of a Spherical Mobile Robot
Robust Control of a Spherical Mobile Robot
 
Iaetsd modelling of one link flexible arm manipulator using
Iaetsd modelling of one link flexible arm manipulator usingIaetsd modelling of one link flexible arm manipulator using
Iaetsd modelling of one link flexible arm manipulator using
 
Velocity control of a two-wheeled inverted pendulum mobile robot: a fuzzy mod...
Velocity control of a two-wheeled inverted pendulum mobile robot: a fuzzy mod...Velocity control of a two-wheeled inverted pendulum mobile robot: a fuzzy mod...
Velocity control of a two-wheeled inverted pendulum mobile robot: a fuzzy mod...
 
Simulation of Robot Manipulator Trajectory Optimization Design
Simulation of Robot Manipulator Trajectory Optimization DesignSimulation of Robot Manipulator Trajectory Optimization Design
Simulation of Robot Manipulator Trajectory Optimization Design
 
Single Pendulum Gantry (SPG) 2013.4.17
Single Pendulum Gantry (SPG) 2013.4.17Single Pendulum Gantry (SPG) 2013.4.17
Single Pendulum Gantry (SPG) 2013.4.17
 
DEVELOPMENT AND IMPLEMENTATION OF A ADAPTIVE FUZZY CONTROL SYSTEM FOR A VTOL ...
DEVELOPMENT AND IMPLEMENTATION OF A ADAPTIVE FUZZY CONTROL SYSTEM FOR A VTOL ...DEVELOPMENT AND IMPLEMENTATION OF A ADAPTIVE FUZZY CONTROL SYSTEM FOR A VTOL ...
DEVELOPMENT AND IMPLEMENTATION OF A ADAPTIVE FUZZY CONTROL SYSTEM FOR A VTOL ...
 
DEVELOPMENT AND IMPLEMENTATION OF A ADAPTIVE FUZZY CONTROL SYSTEM FOR A VTOL ...
DEVELOPMENT AND IMPLEMENTATION OF A ADAPTIVE FUZZY CONTROL SYSTEM FOR A VTOL ...DEVELOPMENT AND IMPLEMENTATION OF A ADAPTIVE FUZZY CONTROL SYSTEM FOR A VTOL ...
DEVELOPMENT AND IMPLEMENTATION OF A ADAPTIVE FUZZY CONTROL SYSTEM FOR A VTOL ...
 
Discrete Time Optimal Tracking Control of BLDC Motor
Discrete Time Optimal Tracking Control of BLDC MotorDiscrete Time Optimal Tracking Control of BLDC Motor
Discrete Time Optimal Tracking Control of BLDC Motor
 
Navigation of Mobile Inverted Pendulum via Wireless control using LQR Technique
Navigation of Mobile Inverted Pendulum via Wireless control using LQR TechniqueNavigation of Mobile Inverted Pendulum via Wireless control using LQR Technique
Navigation of Mobile Inverted Pendulum via Wireless control using LQR Technique
 
Experiment based comparative analysis of stator current controllers using pre...
Experiment based comparative analysis of stator current controllers using pre...Experiment based comparative analysis of stator current controllers using pre...
Experiment based comparative analysis of stator current controllers using pre...
 
Mathematical Modeling and Fuzzy Adaptive PID Control of Erection Mechanism
Mathematical Modeling and Fuzzy Adaptive PID Control of Erection MechanismMathematical Modeling and Fuzzy Adaptive PID Control of Erection Mechanism
Mathematical Modeling and Fuzzy Adaptive PID Control of Erection Mechanism
 
[8] implementation of pmsm servo drive using digital signal processing
[8] implementation of pmsm servo drive using digital signal processing[8] implementation of pmsm servo drive using digital signal processing
[8] implementation of pmsm servo drive using digital signal processing
 
Hh3312761282
Hh3312761282Hh3312761282
Hh3312761282
 
The Neural Network-Combined Optimal Control System of Induction Motor
The Neural Network-Combined Optimal Control System of Induction MotorThe Neural Network-Combined Optimal Control System of Induction Motor
The Neural Network-Combined Optimal Control System of Induction Motor
 
A Lyapunov Based Approach to Enchance Wind Turbine Stability
A Lyapunov Based Approach to Enchance Wind Turbine StabilityA Lyapunov Based Approach to Enchance Wind Turbine Stability
A Lyapunov Based Approach to Enchance Wind Turbine Stability
 

Último

Igniting Next Level Productivity with AI-Infused Data Integration Workflows
Igniting Next Level Productivity with AI-Infused Data Integration WorkflowsIgniting Next Level Productivity with AI-Infused Data Integration Workflows
Igniting Next Level Productivity with AI-Infused Data Integration WorkflowsSafe Software
 
Anypoint Code Builder , Google Pub sub connector and MuleSoft RPA
Anypoint Code Builder , Google Pub sub connector and MuleSoft RPAAnypoint Code Builder , Google Pub sub connector and MuleSoft RPA
Anypoint Code Builder , Google Pub sub connector and MuleSoft RPAshyamraj55
 
Using IESVE for Loads, Sizing and Heat Pump Modeling to Achieve Decarbonization
Using IESVE for Loads, Sizing and Heat Pump Modeling to Achieve DecarbonizationUsing IESVE for Loads, Sizing and Heat Pump Modeling to Achieve Decarbonization
Using IESVE for Loads, Sizing and Heat Pump Modeling to Achieve DecarbonizationIES VE
 
AI Fame Rush Review – Virtual Influencer Creation In Just Minutes
AI Fame Rush Review – Virtual Influencer Creation In Just MinutesAI Fame Rush Review – Virtual Influencer Creation In Just Minutes
AI Fame Rush Review – Virtual Influencer Creation In Just MinutesMd Hossain Ali
 
activity_diagram_combine_v4_20190827.pdfactivity_diagram_combine_v4_20190827.pdf
activity_diagram_combine_v4_20190827.pdfactivity_diagram_combine_v4_20190827.pdfactivity_diagram_combine_v4_20190827.pdfactivity_diagram_combine_v4_20190827.pdf
activity_diagram_combine_v4_20190827.pdfactivity_diagram_combine_v4_20190827.pdfJamie (Taka) Wang
 
UiPath Studio Web workshop series - Day 6
UiPath Studio Web workshop series - Day 6UiPath Studio Web workshop series - Day 6
UiPath Studio Web workshop series - Day 6DianaGray10
 
Crea il tuo assistente AI con lo Stregatto (open source python framework)
Crea il tuo assistente AI con lo Stregatto (open source python framework)Crea il tuo assistente AI con lo Stregatto (open source python framework)
Crea il tuo assistente AI con lo Stregatto (open source python framework)Commit University
 
Basic Building Blocks of Internet of Things.
Basic Building Blocks of Internet of Things.Basic Building Blocks of Internet of Things.
Basic Building Blocks of Internet of Things.YounusS2
 
Videogame localization & technology_ how to enhance the power of translation.pdf
Videogame localization & technology_ how to enhance the power of translation.pdfVideogame localization & technology_ how to enhance the power of translation.pdf
Videogame localization & technology_ how to enhance the power of translation.pdfinfogdgmi
 
Introduction to Matsuo Laboratory (ENG).pptx
Introduction to Matsuo Laboratory (ENG).pptxIntroduction to Matsuo Laboratory (ENG).pptx
Introduction to Matsuo Laboratory (ENG).pptxMatsuo Lab
 
Computer 10: Lesson 10 - Online Crimes and Hazards
Computer 10: Lesson 10 - Online Crimes and HazardsComputer 10: Lesson 10 - Online Crimes and Hazards
Computer 10: Lesson 10 - Online Crimes and HazardsSeth Reyes
 
UiPath Solutions Management Preview - Northern CA Chapter - March 22.pdf
UiPath Solutions Management Preview - Northern CA Chapter - March 22.pdfUiPath Solutions Management Preview - Northern CA Chapter - March 22.pdf
UiPath Solutions Management Preview - Northern CA Chapter - March 22.pdfDianaGray10
 
Secure your environment with UiPath and CyberArk technologies - Session 1
Secure your environment with UiPath and CyberArk technologies - Session 1Secure your environment with UiPath and CyberArk technologies - Session 1
Secure your environment with UiPath and CyberArk technologies - Session 1DianaGray10
 
Comparing Sidecar-less Service Mesh from Cilium and Istio
Comparing Sidecar-less Service Mesh from Cilium and IstioComparing Sidecar-less Service Mesh from Cilium and Istio
Comparing Sidecar-less Service Mesh from Cilium and IstioChristian Posta
 
Salesforce Miami User Group Event - 1st Quarter 2024
Salesforce Miami User Group Event - 1st Quarter 2024Salesforce Miami User Group Event - 1st Quarter 2024
Salesforce Miami User Group Event - 1st Quarter 2024SkyPlanner
 
IESVE Software for Florida Code Compliance Using ASHRAE 90.1-2019
IESVE Software for Florida Code Compliance Using ASHRAE 90.1-2019IESVE Software for Florida Code Compliance Using ASHRAE 90.1-2019
IESVE Software for Florida Code Compliance Using ASHRAE 90.1-2019IES VE
 
UWB Technology for Enhanced Indoor and Outdoor Positioning in Physiological M...
UWB Technology for Enhanced Indoor and Outdoor Positioning in Physiological M...UWB Technology for Enhanced Indoor and Outdoor Positioning in Physiological M...
UWB Technology for Enhanced Indoor and Outdoor Positioning in Physiological M...UbiTrack UK
 
9 Steps For Building Winning Founding Team
9 Steps For Building Winning Founding Team9 Steps For Building Winning Founding Team
9 Steps For Building Winning Founding TeamAdam Moalla
 
20230202 - Introduction to tis-py
20230202 - Introduction to tis-py20230202 - Introduction to tis-py
20230202 - Introduction to tis-pyJamie (Taka) Wang
 

Último (20)

Igniting Next Level Productivity with AI-Infused Data Integration Workflows
Igniting Next Level Productivity with AI-Infused Data Integration WorkflowsIgniting Next Level Productivity with AI-Infused Data Integration Workflows
Igniting Next Level Productivity with AI-Infused Data Integration Workflows
 
Anypoint Code Builder , Google Pub sub connector and MuleSoft RPA
Anypoint Code Builder , Google Pub sub connector and MuleSoft RPAAnypoint Code Builder , Google Pub sub connector and MuleSoft RPA
Anypoint Code Builder , Google Pub sub connector and MuleSoft RPA
 
Using IESVE for Loads, Sizing and Heat Pump Modeling to Achieve Decarbonization
Using IESVE for Loads, Sizing and Heat Pump Modeling to Achieve DecarbonizationUsing IESVE for Loads, Sizing and Heat Pump Modeling to Achieve Decarbonization
Using IESVE for Loads, Sizing and Heat Pump Modeling to Achieve Decarbonization
 
AI Fame Rush Review – Virtual Influencer Creation In Just Minutes
AI Fame Rush Review – Virtual Influencer Creation In Just MinutesAI Fame Rush Review – Virtual Influencer Creation In Just Minutes
AI Fame Rush Review – Virtual Influencer Creation In Just Minutes
 
20150722 - AGV
20150722 - AGV20150722 - AGV
20150722 - AGV
 
activity_diagram_combine_v4_20190827.pdfactivity_diagram_combine_v4_20190827.pdf
activity_diagram_combine_v4_20190827.pdfactivity_diagram_combine_v4_20190827.pdfactivity_diagram_combine_v4_20190827.pdfactivity_diagram_combine_v4_20190827.pdf
activity_diagram_combine_v4_20190827.pdfactivity_diagram_combine_v4_20190827.pdf
 
UiPath Studio Web workshop series - Day 6
UiPath Studio Web workshop series - Day 6UiPath Studio Web workshop series - Day 6
UiPath Studio Web workshop series - Day 6
 
Crea il tuo assistente AI con lo Stregatto (open source python framework)
Crea il tuo assistente AI con lo Stregatto (open source python framework)Crea il tuo assistente AI con lo Stregatto (open source python framework)
Crea il tuo assistente AI con lo Stregatto (open source python framework)
 
Basic Building Blocks of Internet of Things.
Basic Building Blocks of Internet of Things.Basic Building Blocks of Internet of Things.
Basic Building Blocks of Internet of Things.
 
Videogame localization & technology_ how to enhance the power of translation.pdf
Videogame localization & technology_ how to enhance the power of translation.pdfVideogame localization & technology_ how to enhance the power of translation.pdf
Videogame localization & technology_ how to enhance the power of translation.pdf
 
Introduction to Matsuo Laboratory (ENG).pptx
Introduction to Matsuo Laboratory (ENG).pptxIntroduction to Matsuo Laboratory (ENG).pptx
Introduction to Matsuo Laboratory (ENG).pptx
 
Computer 10: Lesson 10 - Online Crimes and Hazards
Computer 10: Lesson 10 - Online Crimes and HazardsComputer 10: Lesson 10 - Online Crimes and Hazards
Computer 10: Lesson 10 - Online Crimes and Hazards
 
UiPath Solutions Management Preview - Northern CA Chapter - March 22.pdf
UiPath Solutions Management Preview - Northern CA Chapter - March 22.pdfUiPath Solutions Management Preview - Northern CA Chapter - March 22.pdf
UiPath Solutions Management Preview - Northern CA Chapter - March 22.pdf
 
Secure your environment with UiPath and CyberArk technologies - Session 1
Secure your environment with UiPath and CyberArk technologies - Session 1Secure your environment with UiPath and CyberArk technologies - Session 1
Secure your environment with UiPath and CyberArk technologies - Session 1
 
Comparing Sidecar-less Service Mesh from Cilium and Istio
Comparing Sidecar-less Service Mesh from Cilium and IstioComparing Sidecar-less Service Mesh from Cilium and Istio
Comparing Sidecar-less Service Mesh from Cilium and Istio
 
Salesforce Miami User Group Event - 1st Quarter 2024
Salesforce Miami User Group Event - 1st Quarter 2024Salesforce Miami User Group Event - 1st Quarter 2024
Salesforce Miami User Group Event - 1st Quarter 2024
 
IESVE Software for Florida Code Compliance Using ASHRAE 90.1-2019
IESVE Software for Florida Code Compliance Using ASHRAE 90.1-2019IESVE Software for Florida Code Compliance Using ASHRAE 90.1-2019
IESVE Software for Florida Code Compliance Using ASHRAE 90.1-2019
 
UWB Technology for Enhanced Indoor and Outdoor Positioning in Physiological M...
UWB Technology for Enhanced Indoor and Outdoor Positioning in Physiological M...UWB Technology for Enhanced Indoor and Outdoor Positioning in Physiological M...
UWB Technology for Enhanced Indoor and Outdoor Positioning in Physiological M...
 
9 Steps For Building Winning Founding Team
9 Steps For Building Winning Founding Team9 Steps For Building Winning Founding Team
9 Steps For Building Winning Founding Team
 
20230202 - Introduction to tis-py
20230202 - Introduction to tis-py20230202 - Introduction to tis-py
20230202 - Introduction to tis-py
 

Dynamic modelling and optimal controlscheme of wheel inverted pendulum for mobile robot application

  • 1. International Journal of Control Theory and Computer Modeling (IJCTCM) Vol.3, No.6, November 2013 DYNAMIC MODELLING AND OPTIMAL CONTROL SCHEME OF WHEEL INVERTED PENDULUM FOR MOBILE ROBOT APPLICATION Mohamad Amir Shamsudin*1, Rosbi Mamat*2, and Sophan Wahyudi Nawawi*3 * Department of Control and Mechatronics, Faculty of Electrical, Universiti Teknologi Malaysia, Johor, Malaysia Abstract Unstable wheel inverted pendulum is modelled and controlled deploying Kane’s method and optimal partial-state PID control scheme. A correct derivation of nonlinear mathematical model of a wheel inverted pendulum is obtained using a proper definition of the geometric context of active and inertia forces. Then the model is decoupled to two linear subsystems namely balancing and heading subsystems. Afterward partial-state PID controller is proposed and formulated to quadratic optimal regulation tuning method. It enables partial-state PID to be optimally tuned and guarantees a satisfactory level of states error and a realistic utilization of torque energy. Simulation and numerical analyses are carried out to analyse system’s stability and to determine the performance of the proposed controller for mobile wheel inverted pendulum application. KEYWORDS Wheel inverted pendulum, Kane’s method, partial-state PID, quadratic optimal regulation tuning 1. INTRODUCTION The application of wheel inverted pendulum (WIP) robot gains high attention from industry and research communities. Recently, many WIP-based products are available in industry such as human transporter by Karmen and service robot by Hitachi’s Mechanical Engineering Research laboratory. They believe this high manoeuvrability wheel system will be the future urban robot and transporter and even in rural places with rough terrain. Meanwhile in research community, WIP system has been extensively studied because this simple structure robot serve complex dynamic [1]. Thus many comprehensive research materials can be found and mainly for modelling and control aspects. Over a decade, various types of WIP have been developed along with their mathematical model [2-5]. The modelling focuses either on kinematic [6, 7] or dynamic issues. In dynamic aspect, Lagrange [8, 9], Lagrage-Eular [10], and Newton-Eular [11] used to develop nonlinear WIP mathematical model. However Newton method involved the calculation of unwanted forces and Lagrange method used Lagrange multiplier in their derivation. Consequently those methods required tedious and complicated formulation of a large multibody system, hence led to inefficient computation. Thus, Kane method is the alternative because of its simpler and efficient mathematical analysis where it is based on partial velocity in multibody dynamic modelling [12]. However, less attention on torque context in term of differential drive nonholonomic and mobile system led to an unaccurate dynamic equation [13]. Thus this paper defines a proper torque DOI : 10.5121/ijctcm.2013.3601 1
  • 2. International Journal of Control Theory and Computer Modeling (IJCTCM) Vol.3, No.6, November 2013 geometric context of WIP system, eventually this definition leads to a correct solution of the nonlinear WIP mathematical model. In control aspect, advanced and robust control schemes designed to control WIP system. It were sliding mode control (SMC) [14], backsteping control [15], fuzzy logic control (FLC) [16], and neural network control (NN) [17]. However, most of those control schemes need high computationally effort even for single state control [18]. This prevented it to be programmed as a low level controller in an embedded WIP system. Thus linear controller such as LQR and PID controllers are more favourable for this fast system [19-21]. Many researches preferred and showed that the LQR as a modern controller gave better performance compared to conventional PID controller [22-24]. However the research overlooked the applicability of LQR controller in input trajectory tracking where the significant state trajectory errors occur [25]. Thus this paper proposes partial-state PID (PSPID) controller to eliminate the aforementioned problem. Besides, the controller is formulated to quadratic optimal regulation (QOR) tuning scheme where it guarantees system stability and satisfactory level of WIP performance. This paper is organized as follows: development of nonlinear WIP mathematical model is presented in section 2; section 3 provides a formulation of proposed PSPID controller for the QOR tuning method; the analysis of the model and the proposed controller is demonstrated by simulation in section 4; and the conclusion of this paper is in the last section. 2. WHEEL INVERTED PENDULUM ROBOT Generally, the outline of Kane’s method can be found in following literatures [12, 13]. Thus this paper will only concentrate on the development of a WIP mathematical model of Kane’s method. Notation: Throughout this section, C i and S i indicate cos and sin functions with i = 2 = φ and i = 3 = θ . Body Bi and point Pi refer to bodies B , W1 , W2 and points G , WC1 , and WC2 . 2.1. Kinematic of WIP As shown in Fig. 1, WIP consists of three bodies: the pendulum, B, as the main body and the two wheels, W1 and W2 . The important points where the gravitational force, g is detected are the centre of right wheel, WC1 , the centre of left wheel, WC2 , and the centre of gravity of the main body G ; point C , the point where the torque exerted from wheels to pendulum in the form of force. Other vital points on the right and left wheel’s surfaces are WP1 and WP2 . W~1 and W~2 P P are any point on the right and left wheels. WIP mechanical parameters tabulate in Table 1. The WIP has 5 degrees of freedoms, hence the independent generalized coordinates are qn = (q1, q2 ,  , qn ) = (x, φ, θ, ϕW 1, ϕW 2 ); n = 5, (1) The following assumptions have been made to model the WIP: 1) The linear motor model considered, motor inductance and friction on the armature are neglected. 2) No slip and wheels always in contact with the ground 3) At every instant, WIP experiences forward and steering forces. 4) Cornering force is neglected 2
  • 3. International Journal of Control Theory and Computer Modeling (IJCTCM) Vol.3, No.6, November 2013 Based on the 2nd and 3rd assumptions, the constraints m = 2 and the nonholonomic constraints are F F ˆW ˆ ˆ ω P 1 − F ω WP1 x − F ω ~ ˆ ω ~ WP 2 ˆ − ω F WP 2 x  ˆ − ω F = 0, WP 1 WP 2  (2) = 0, Table 1.WIP mechanical parameters. Symbol mb mw L R Ib2 Ib3 g d Parameter Mass of body Mass of wheel Half of lateral body Radius of wheel Inertia of main body in n2 directional Inertia of main body in n3 directional Gravitational constant A distance between point C and COG of main body Value 15kg 0.42kg 0.2m 0.106m 0.63kgm2 1.12kgm2 9.81ms-2 0.212m (b) (a) Figure 1. (a) Available WIP in UTM laboratory, and (b) free body diagram of WIP in newton Frame F. F ~ WP i ˆ ω is an angular velocity of point W~i on the right and left wheels with respect to reference P W  ˆ ˆ frame F. F ωWP1x and F ω P1φ are angular velocities of points WP1s on the right and left wheels with respect to frame F that due to forward motion and steering motion. Based on (1) and (2), the generalized speeds, ur , are ( )    ur = (u1, u2 ,  , ur ) = x, φ, θ ; r = n − m, (3) The velocity, angular velocity and angular acceleration of point C with respect to reference frame F are 3
  • 4. International Journal of Control Theory and Computer Modeling (IJCTCM) Vol.3, No.6, November 2013 ˆ v = u1n1 , F C F ˆ ωC = u 2f 2 = u 2n 2 , F ˆ   α = u 2f 2 = u 2n 2 , (4) C From (2), angular velocity of points W~1 and W~2 with respect to reference frame F are P P ~ ˆW ω P1 = −u 2 L (− S 2n1 + C2n 3 ) − u1 1 n 3 , R R ~ F WP 2 L (− S n + C n ) − u 1 n , ˆ ω = u2 2 1 2 3 1 3 R R F (5) The angular velocity of robot main body and two wheels with respect to reference frame F are F ˆ ˆ ˆ ω B = F ωC + C ωG = u 2n 2 − u3n 3 ,   ~ LC 2 LS ˆ ˆ ˆW ωW1 = F ωC + F ω P1 = −u1 1 n 3 + u 2  n 2 − n 3 + 2 n1 ,     R R R   ~ LC 2 LS F W2 F C F WP 2 ˆ ˆ ˆ ω = ω + ω = −u1 1 n 3 + u 2  n 2 + n 3 − 2 n1 ,     R R R F C (6) ˆ ωG is an angular velocity of point G with respect to robot point C . Based on a rigid body motion solution in 3D space, the velocity of the COG of the main body and the centre of two wheels with respect to reference frame F can be formulated as (Pi = G,WC1,WC 2 ), ˆ ˆ ˆ ˆ ˆ v = F v C + F ωC ×r Pi + C v Pi ; F Pi ˆ r Pi (7) ˆ and C v Pi are the displacement and velocity of point Pi with respect to point C . The centre of wheels are fixed with respect to point C , i.e C WCi ˆ v = 0 , Thus ˆ ˆ ˆ ˆ ˆ ˆ v = F v C + F ωC ×C d G + C ωG ×C d G = u1n1 − u 2 dS 3n 3 + u3 (dC3n1 − dS 3n 2 ), F WC1 F C F C C ˆWC1 ˆ ˆ ˆ v = v + ω × L = u n + u Ln , F G 1 1 F WC 2 F C ˆ ˆ v = v ˆ + ω F C ˆ ×C LWC 2 2 1 (8) = u1n1 − u 2 Ln1 , C ˆG ˆ and C LWCi are displacements of the COG of main body and the centre of wheels with respect to point C . The angular acceleration of the main body and the wheels are d F F B ˆ ˆ   α B = d ω = u 2n 2 − u3n 3 , dt F W1  u LS −u u     ~ u + u 2 LC 2 ˆ ˆ ˆ ˆW  αW1 = d ω + F ωC × F ω P1 =  2 2 1 2 n1 + u 2n 2 − 1 n3,     dt R R F W2  − u LS −u u     ~ u − u 2 LC 2 ˆ F W2 ˆ ˆ ˆW  α = d ω + F ωC × F ω P 2 =  2 2 1 2 n1 + u 2n 2 − 1 n3,     dt R R F (9) 4
  • 5. International Journal of Control Theory and Computer Modeling (IJCTCM) Vol.3, No.6, November 2013 From (7) the acceleration of the COG of main body and centre of two wheels with respect to reference frame F can be formulated as F ˆ ˆ ˆ ˆ ˆ a Pi = F a C + F α C × r Pi + F ωC × ˆ ˆ ˆ (F ωC × rˆ Pi )+ F ωC ×C vˆ Pi + C a Pi ; (Pi = G,WC1,WC 2 ), (10) ˆ ˆ is an acceleration of point C with respect to frame F and C a Pi = d Cv Pi dt is an C WCi ˆ acceleration of point Pi with respect to point C . Based on aforementioned fact, a = 0 , thus F C ˆ a ( ) F C ˆ ˆ ˆ ˆ ˆ ˆ ˆ ˆ ˆ ˆ a = d v + F α C ×C d G + F ωC × F ωC ×C d G + F ωC ×C v G + C a G , dt 2 2 2     = u1 + u3 dC3 − u 2 dS 3 − u 3 dS 3 n1 − u3 dS 3 + u 3 dC3 n 2 − (u 2 dS 3 + u 2u3 dC3 )n 3, F G ( ) ( ) ( ) (11) F C ˆ 2 ˆ ˆ ˆ ˆ ˆ   = d v + F α C ×C LWC1 + F ωC × F ωC ×C LWC1 = (u1 + u 2 L )n1 − u 2 Ln 3 , dt F C ˆ F WC 2 2 ˆ ˆ ˆ ˆ ˆ ˆ   a = d v + F α C ×C LWC 2 + F ωC × F ωC ×C LWC 2 = (u1 − u 2 L )n1 + u 2 Ln 3 , dt F WC1 ˆ a ( ) Partial velocity and partial angular velocity of the main body and the wheels can be obtained by differentiating (4), (6) and (8) with u r as shown below. F ~ Pi vr F F Pi ˆ =∂ v ; ∂u r (r = 1,2,3), (Pi = G, C , WC1, WC 2 ), F Bi ˆ ~ Bi ωr = ∂ ω ; (r = 1,2,3), (Bi = B, A, W1, W2 ), ∂u r (12) 2.2. Dynamic of WIP WIP lies under differential drive type of mobile robot. Thus generated torque, τ C, from the motors to the robot can be represented as τC = τ pitch + τ yaw , (13) The yaw torque, τ yaw , and pitch torque, τ pitch , are the torques that cause WIP steers by , ϕ, in f 2 directional and move with velocity vC in n1 directional as shown in Fig. 1(b). However, pitch torque exerts to robot main body in the form of force. Therefore at every instant, this robot experiences both forward force and steering torque. Based on Fig. 1(b) and the assumptions, the active forces are ˆ RC = γ1n1 + γ 2n 2 + γ 3n 3 , ˆ T =δ n +δ n +δ n , C 1 1 2 2 ˆ Rw1 = −mW gn 2 , 3 3 (14) ˆ Rw2 = −mW gn 2 , ˆ R B = − m B gn 2 , 5
  • 6. International Journal of Control Theory and Computer Modeling (IJCTCM) Vol.3, No.6, November 2013 Where τ + τ wl  ; i = 1, F + Fwl = wr γ i =  wr R  0 otherwise,  (15) (F − F )LC = (τ − τ ) L C ; i = 2,  wr wl 2 wr wl 2 δi =  R  0 otherwise,  ˆ ˆ ˆ ˆ ˆ RC and TC are the force and torque exerted on the main body by wheel, Rw1 , Rw2 and RB are forces exerted on the wheel and body by the gravity. Fwr and Fwl are translated forces from the wheels torque. The inertia force and inertia torque of the main body and the wheels are ˆ* ˆ RPi = −mPi ⋅ F a Pi ; (Pi = G, WC1, WC 2 ), ˆ ˆ * ˆ ˆ ˆ ˆ ˆ ˆ TBi =− F α Bi ⋅ I Bi − F ω Bi × I Bi ⋅ F ω Bi ; (Bi = B, W1, W2 ), (16) ˆ ˆ Where mG = mB , mWCi = mW , IˆBi = I b2n 2n 2 + I b3n 3n 3 and IˆWi = IW2 n 2n 2 + IW3 n 3n 3 . The inertia of the wheels is considered as IW2 = mW R 2 4 + mW L2 and IW3 = mW R 2 4 . The generalized active force and inertia force are given as j k i =1 j i =1 ~ Bi ˆ ~ ˆ Fr = ∑ F vrPi ⋅ RPi + ∑ F ωr ⋅ TBi ; (r = 1,2,3), (Pi = G, C , WC1, WC 2 ), (Bi = C ), (17) k ~ Bi ˆ ~ ˆ* Fr * = ∑ F vrPi ⋅ RPi + ∑ F ωr ⋅ TBi * ; (r = 1,2,3), (Pi = G, WC1, WC 2 ), (Bi = B, W1, W2 ), i =1 i =1 Where j is the number of points subjected to applied forces and k is the number of rigid bodies subjected to applied torques. Three motion equations of WIP (19) are obtained by equating the dynamic equation of motion (18), Fr + Fr* = 0, (18) ( )  I  τ + τ wl    mb + 2mw + 2 w3  + mb dC3 = wr x θ + φ 2 + θ 2 mb dS3 ,  2   R  R 2     mb (dS 3 )2 + 2mw L2 + I b2 + 2I w2 + 2 (LC 2 ) I w3  = (τ wr − τ wl ) LC 2 − θφmb d 2 S3C3 ,  φ 2 R R    mb dC3  + mb d 2 + I b3  = mb dgS 3 + φ 2 mb d 2 S3C3 , x θ ( (19) ) 6
  • 7. International Journal of Control Theory and Computer Modeling (IJCTCM) Vol.3, No.6, November 2013 Then state space representation of the WIP (20) is solved using Cramer rule. The matrix variables are listed as in the appendix.  x(t ) = A(x, t )x(t ) + B(x, t )u(t ) + f (x, t )   x 0 1 0 0 0 0   x  0      0 0 0 A x 24 0 A26   x   B21     θ 0 0 0 1 0 0  θ  0    +   =  θ 0 0 0 A44 0 A46  θ  B41  φ 0 0 0 0 0 1  φ  0             φ 0 0 0 0 0 A66  φ  B61 0  0  F  B22   2 0  τ wr   0  +  ,  B42   τ wl   F4    0 0     B62  0    (20) 3. PARTIAL STATE-PID CONTROLLER Notation: Throughout this section, i index indicates the balancing and heading subsystems by equalized it to θ and φ . 3.1. Linear WIP model To design a linear controller, the nonlinear WIP model is linearized by setting tilt angle, θ ≈ 0 , and heading angle,  ≈ 0 . The linear WIP system can be represented into two subsystems, first is “balancing” subsystem which is regarding the rotation and motion about n 3 and n1 directional and second is “heading” subsystem which is describing the rotation about n 2 directional. These subsystems can be formulated as  x i (t ) = A i x i (t ) + B i u i (t ); (i = θ, φ), y i (t ) = Ci x i (t ) (21) Here Ai , Bi and Ci are state constant system matrix, system input matrix and system output matrix with appropriate dimension. x i ∈ R ni and ui ∈ R are defined as state variable and control input with ni number of state variables. The state vector of balancing and heading subsystems are ( ) ( )    x θ = x, x, θ, θ and x φ = φ, φ . The characteristic polynomial of both subsystems given as det(sI − A i ) = ai0 s ni + ai1s ni −1 +  + ai(ni −1)s + aini , (22) Where a i = [ai0 ai1  aini ] is a characteristic vector with coefficients ai0 = 1 , aini = det(−A i ) and ai1 = −trace(−A i ) . Both balancing and heading subsystems are   x 0  0 x  =  θ 0   θ 0  φ 0  =  φ 0 0  x  0   0  x  B21L    +  u θ , 0 0 1 θ  0       0 A43L 0 θ  B41L  1 φ  0  uφ ,  + 0 φ  B61L      1 0 0 A23L (23) 7
  • 8. International Journal of Control Theory and Computer Modeling (IJCTCM) Vol.3, No.6, November 2013 Equation (23) showed nθ = 4 for balancing subsystem and nφ = 2 for heading subsystem. The matrix variables are listed as in the appendix. Using decoupling technique, the relationship of control input and uφ to the wheel torques are τ wr = 0.5uθ + 0.5uφ , (24) τ wl = 0.5uθ − 0.5uφ , 3.2. Augment subsystem with PSPID Fig. 2 shows closed loop WIP system. In such ni order system, input matrix, ri , and proposed PSPID controller are ri T = [ri1 0  ri(n −1) 0]; K PIDi (i = θ, φ), K Pi   K Pi1 0 K Pi3  K Pi(n −1)  =  K Ii  =  K Ii1 0 K Ii3  K Ii(n −1)   K Di   K Di1 0 K Di3  K Di(n −1)    0  0, 0  (25) ri1 ,  , ri(ni −1) are the input variables, K Pi , K Ii , and K Di are proportional, integral and derivative gain vector of PSPID controller. Based on (23) and (25), the PID controllers for the balancing and heading subsystems are K PIDθ1 = [K Pθ1 K Iθ1 K Dθ1 ]T , K PIDθ3 = [K Pθ3 K Iθ3 K Dθ3 ]T and K PIDφ1 = [K Pφ1 K Iφ1 K Dφ1 ]T . The control input ui is ui = K P i (ri − y i ) + K Ii ∫ (ri − y i )dt + K Di d (ri − y i ) , dt (26) The output matrix is y i (t ) = Ci x i (t ) = x ino (t ) where x ino = [ xi1 0  xi(ni −1) 0]T . For simplicity, set all input variable to zero ( ri = 0 ni ), hence the control input is ui = −K PDin xi − K Iin ∫ y i dt , (27) ṡ=y is defined, hence (27) will be ui = −K pin x i − K Iin s i , (28) Figure 2. Closed loop WIP structure with PSPID. The second term in (28) can be simplified to a scalar by a following formula 8
  • 9. International Journal of Control Theory and Computer Modeling (IJCTCM) Vol.3, No.6, November 2013 ′ i ′ K Ii s′ = K Ii (βi1s i1 + βi3s i3 +  + βi(ni −1)s i(ni −1) ), = K Ii1ς i1 + K Ii3ς i3 +  + K Ii(ni −1 )ς i(ni −1) , βini (29) is a coefficient with arbitrary selected value. Thus input signal ui is ui = −K i xi ; [ K D 1  K D (n −1) = [xi1 (t ), x n (t ), s′ (t )], i K i = K Pi1 xi T i i i ] ′ K Ii , (30) i i It is obvious in (29) si’=βisi, thus   si = β i s i = β i Ci x i = Cβi x i ; [ Cβi = βi1 0  βi (n −1) i ] (31) 0, Based on above formulation, equivalent ni + 1 order subsystem dynamic can be formulated from the combination of the original state (23) and (31). The ni + 1 state vector is written as  x i = A i x i + Bi ui ,  x i (t )  A i  s (t )  = C  i   βi 0 x i (t ) B i  + u (t ), 0  si (t )   0  i     (32) Here βini is set to one. The output matrix Ci is set to C Ci =  i 0 0 ; 1  (33) The rank of controllability matrix [Bi A i Bi A 2 Bi  A ni Bi ] of system (32) is ni + 1 . This i i means the linear system (32) is completely controllable. 3.3. Optimal PSPID To apply QOR tuning method, Frobenius Canonical form of system (32) is considered by following transformation. z i = Ti xi , (34) Where z i (mi × 1) and Ti (mi × mi ) are transformation state variable vector and transformation matrix. Index mi = ni + 1 , and Ti matrix define as  qi1   q A  i i  Ti =  1 ; q i 1 = eT Wc−1, ini i     ni −1  q i 1 Ai  q i 1 is 1 × mi vector, Wci = [Bi (35) A i Bi  A mi Bi ] and unit vector eini = [0 0  1] , the i Frobenius canonical form of WIP subsystems can be express as 9
  • 10. International Journal of Control Theory and Computer Modeling (IJCTCM) Vol.3, No.6, November 2013  z i = A Ci z i + B Ci ui , (36) Where  0  0  −1 A ci = Ti A i Ti =     0 − α im  i 0 0 B ci = Ti Bi =  ,    1 1 0  0 1  0 − α i(mi −1) 0 − α i(mi − 2)    ,   1   − α i1      0 0  (37) The input signal is ui = −K Ci z i ; [ K Ci 2  K Ci (m −1) z i T = [zi1 (t ), zi 2 (t )  zim (t )], K i = K Ci1 i ] (38) K Cimi , i And also feedback gain K Ci = K i Ti −1 , (39) The desired m order characteristic equation of matrix A Ci − B Ci K Ci is det(sI − Ai ) = s mi + (α i1 + K cimi )s mi −1 +  + (α i(mi −1) + K ci 2 )s + (α imi + K ci1 ), (40) As shown, system (32) is completely controllable, then K Ci can be tuned by QOR method. The QOR problem is a quadratic performance index function for the integral function. The index is in the form of quadratic performance of continuous-time linear time-varying function. I = 1 z i T (t f ) Pfi z i (t f ) + 1 2 2 Where the final time, tf tf ∫0 (z T i , is fix. ) ( t ) Q i z i ( t ) + u iT ( t ) R i u i ( t ) dt (41) Pfi , Q i , R i to are chosen to be symmetry positive semidefinite, and be symmetry positive definite. The QOR optimal control problem is to drive the state vector z i (t ) to the origin from any nonzero initial values of states. The problem objective is to find u i (t ) ; 0 ≤ t ≤ t f , such that the objective function (41) is minimized. Choosing the appropriate weighting matrix Q i , R i , and therefore get the optimal control rate with optimal control theory. For an infinite time t f , P f i must satisfy following reduced Riccati equation. A Ti P f i + P f A c i − P f i B c i R i − 1 B Ti P f i + Q i = 0 c c (42) 10
  • 11. International Journal of Control Theory and Computer Modeling (IJCTCM) Vol.3, No.6, November 2013 With predetermined weighted matrix, optimal control is u i ( t ) = − R i − 1 B Ti P f i z i ( t f ) = − K C i z i ( t f ) c (43) The control law makes the linear feedback system stable, then by adopting Lyapunov second law, the nonlinear feedback system is stable. Weighting matrix Q i and R i are u  e = Ae + B u e x −K Figure 3. Equivalent ni + 1 order error vector of system (2) with PID controller  q 11  0 Q =      0  0  q 22     0 0     ; R = [r ] 11 0   q mimi   (44) Finally, based on (39) and (30), PSPID controller is directly tuned for subsystems (23). The formulation makes the proposed controller has both of PID controller and QOR advantages. Following steps can be applied to tune PID controller using QOR technique: Step 1. Construct mi order system (32) from the combination of the original system (23) and (31). Step 2. Transform this mi order system to a Frobenius Canonical form based on transformation formula (34). Step 3. Tune K ci gain by appropriately tuning Qi and R i (44) matrices. Step 4. Compute K i in (30) from K ci by transformation formulation (14). Step 5. Lastly Based on (30), set PID gains (25) accordingly. 4. RESULT AND DISCUSSION 4.1. Model analysis tuning scheme, and Qθ = diag(83.112, 2.583, 5.2287,3.4656) , Q φ = diag(0.01,1) R θ = R φ = 1 × 10 were set for LQR controllers. For PSPID controller, the matrices Qs are Q θ = diag(83.112, 2.583, 5.2287, 3.4656, 0.01) , Q φ = diag(0.01,1, 0.01) and R θ = R φ = 1 × 10-3 . Thus the following LQR and PSPID controller are obtained: In QOR -3 11
  • 12. International Journal of Control Theory and Computer Modeling (IJCTCM) Vol.3, No.6, November 2013 K θ = −[91.2,106.8, 493.4,129]; K φ = −[493.4,12], − 27.1 − 106.0 K PIDθ1 =  − 18.3; K PIDθ3 =  − 18.3 ,        − 21.5  − 18.9   11.8 K PIDφ1 =  1.1 ,    3 .1    4.1.1. Open loop stability The stability of WIP depends on the balancing of its main body. To investigate this behaviour, the pole analysis of the balancing submatrix, A θ′ , from constant matrix A θ was conducted. The poles are obtained by solving following equation  s det[ sI nθ − A θ′ ] = det  − A43L − 1 = 0, s  (45) Thus the poles are (mB + 3mW )mb dg , (mB + 3mW )(mb d 2 + I B3 ) − (mB d )2 (mB + 3mW )mb dg sθ 2 = − , (mB + 3mW )(mb d 2 + I B3 ) − (mB d )2 sθ1 = (46) This showed one of its pole was positive. The fact shows, if the WIP not accelerates (ie. u θ = 0 ), the robot body will fall. Another fact is the mass of robot body, the mass of the wheel and the COG of the main body will determine the magnitude of this pole. 4.1.1.1. Effect of main body COG on tilt angle, θ, control Firstly, robot body was assumed as a point of mass, I b3 = mb d 2 . Therefore the unstable pole was sθ1 = (mb + 3m w )g , (mb + 6m w )d (47) The value of the pole is tabulated in table 2 as d change, d ∈ [o.1,2] . Table 2.Variation of unstable pole over d. d(m) Sθ1 0.1 9.542 0.3 5.509 0.5 4.267 0.7 3.606 0.9 3.181 1.1 2.877 From the table 1, pole became larger when d was shorter. This matches the fact that the robot will be harder to balance when COG of the main body is lower as shown in Fig. 3. However for higher d, larger torque will be required. 12
  • 13. International Journal of Control Theory and Computer Modeling (IJCTCM) Vol.3, No.6, November 2013 Proof: To hold the pendulum at vertical, defines the displacement of point C , xC must be equal to circumference, Cd , that had been made by θ at point d . xC ≡ Cd = θd , (48) Thus FC = mb aC = mb xC t 2 = mb θd t2 (49) , It is proven by newton's law, larger force is required if d becomes larger. 4.1.1.2. Effect of mass of body on tilt angle, θ, control Table 3 below shows that when the mass of the body increase to 20kg the unstable pole only increase about 1 from its initial value. Thus the effect is less significant on the tilt angle balancing control. This is true as shown in Fig. 4(a). Table 3. Variation of unstable pole over mb. mb(kg) Sθ1 1 5.451 2 5.777 4 6.110 6 6.279 10 6.451 20 6.609 4.1.1.3. Effect of mass of wheel on tilt angle, θ, control Table 4 shows that when the mass of wheel increase to 2kg the unstable pole only decreases about 0.6 from its initial value. Thus the effect is less significant on the tilt angle balancing control as shown in Fig. 4(b). Table 4. Variation of unstable pole over mw. mw(kg) Sθ1 0.2 6.675 0.4 6.564 0.6 6.465 0.8 6.377 1 6.298 2 5.999 4.1.1.3. Inertia forces over initial condition From the model, the motors need to generate enough amount of torque to compensate inertia forces, F*1, F*2, and F*3 while balancing and moving in the Cartesian plane. Thus these inertia forces were analysed over three initial conditions of position, x, tilt angle, θ, and heading angle, ϕ. Three initial conditions are considered, (x,θ,ϕ)=(0.01745m,0,0), (x,θ,ϕ)=(0,0.01745rad,0), and (x,θ,ϕ)=(0,0,0.01745rad). 13
  • 14. International Journal of Control Theory and Computer Modeling (IJCTCM) Vol.3, No.6, November 2013 (b) (a) Figure 3. Responses of (a) tilt angle and (b) input torque over various COG of robot main body (b) (a) Figure 4. Response of (a) tilt angle of over various mass of body and (b) tilt angle of over various mass of wheel (a) (b) (c) Figure 5. Responses of (a) Inertia force F 1, (b) Inertia force F 2, and (c) Inertia force F x, θ, and ϕ initial conditions. 3 due to Fig. 5 shows the effect of these three initial conditions. In this work, WIP’s motors have maximum torque τ wr (max) = 4 Nm . Thus it is important to determine the radius of the wheels. Based on force and torque relationship, the wheels radius R must be less than the ratio of maximum wheels torque and maximum heading inertia force, 2τ wr (max) F1* (max) . It was shown in Fig. 5(a), maximum heading inertia force F1* (max) is about 81.22N when robot needs to compensate tilt angle initial error. Thus, based on this fact, R should less than 0.098m . 4.2. Controller analysis 4.2.1. Basic input test A WIP system with LQR controller tested on three types of input, unit step, ramp function, and exponential function. The test showed the suitability of input to the mobile WIP system application. Fig. 6 shows, LQR controller was the best on unit step input. However its 14
  • 15. International Journal of Control Theory and Computer Modeling (IJCTCM) Vol.3, No.6, November 2013 performance deteriorated when operates on others input function as shown in Fig. 7 and Fig. 8. Fig. 7 shows, WIP with LQR had position and heading states error on ramp input. Fig. 8 shows, WIP with LQR had position, velocity, heading angle, heading angular velocity state errors occur in exponential input. For mobile WIP application, unit step input was not suitable where it required tremendous large amount of torque as maximum as 45Nm as showed in Fig. 6(c). In contrast, ramp and exponential type input functions are suitable input for the WIP system; these inputs do not only have velocity information, it also enables the WIP system to be driven in optimum velocity using permissible torque energy as shown in Fig. 7(c) and Fig. 8(c). 4.2.2. Cartesian motion WIP was tested on two types of motion, rectilinear and curvilinear motions. WIP needed to be held in a vertical while moving to a specify distance either in a straight line or in a curve. Below are the equations of position input and heading angle input for both rectilinear and curvilinear motions. xin (t ) = Pos , 1 + e −T (t −Tc ) φin (t ) = − Hea , 1 + e −T (t −Tc ) (50) The constants T=0. 3, Tc=20 for both types of motions. The constants Pos=5, Hea=0 and Pos=1.25π, Hea=π/4 were respectively for rectilinear and curvilinear motions. Both inputs have s-shape trajectory and its slope is maximum time t=Tc. From both Fig. 9 and 10, system with PSPID controller had better dynamic performance over the system with LQR controller. Comparatively, WIP with PSPID controller took only 40s to reach at specified position and orientation compare to WIP with LQR controller which took twice time longer (about 80s) as shown in Fig. 10(e). It verified that the trajectory error can be reduced to zero by adding an additional pole at zero to the system; and this process was achievable by implementing PSPID controller to the WIP system. Moreover on QOR tuning formulation, required torque of the WIP system with PSPID can be guaranteed within permissible torque limitation. (a) (b) (c) Figure 6. Responses of (a) state x, (b) state ϕ and (a) torques τwr, τwl on unit step input. 15
  • 16. International Journal of Control Theory and Computer Modeling (IJCTCM) Vol.3, No.6, November 2013 (c) (b) (a) Figure 7. Responses of (a) state x, (b) state ϕ and (c) torques τwr, τwl on ramp input. (c) (b) (a)   φ Figure 8. Responses of (a) states x, x , (b) states ϕ, and (c) torques τwr, τwl on exponential input. (c) (b) (a) (d) (e)   Figure 9. Responses of (a) state x, (b) state x , (c) state θ, (d) state θ and (e) torques τwr, τwl on rectilinear motion. 16
  • 17. International Journal of Control Theory and Computer Modeling (IJCTCM) Vol.3, No.6, November 2013 (a) (b) (c) (d) (e) (f) (g)    x θ φ Figure 10. Responses of (a) state x, (b) state , (c) state θ, (d) state , (e) state ϕ, (f) state and (g) torques τwr, τwl on curvilinear motion. 5. CONCLUSION Nonlinear dynamic mathematical model of a WIP system successfully derived. Applying right geometric context of the active force and inertia force led to a correct derivation of the WIP system using Kane’s method. Furthermore, an optimal PSPID controller had been proposed to control the system for better dynamic performance. The controller had both advantages of PID and QOR tuning method. Theoretical design, simulation and numerical results depicted that: 1) the nonlinear dynamic model correctly derived, 2) WIP system with proposed controller had a satisfactory dynamic performance where the trajectory error was very small, 3) QOR tuning scheme used and this guarantee stability of WIP system, and 4) WIP required low magnitude of torque and this permit practical implementation. Further research should concern on: 1) variable type of WIP model since it is closer to human transporter and WIP service robot application and 2) design and implementation of the proposed controller in a microcontroller based system as a standalone and low level controller since of its simple and easy realization. 17
  • 18. International Journal of Control Theory and Computer Modeling (IJCTCM) Vol.3, No.6, November 2013 APPENDIX Nonlinear and linear WIP state variables ( ) DIP1 = (mb + 3mw ) mb d 2 + I B3 − (mb d cos θ)2 , 2   DIP 2 = mb (d sin θ)2 + I b 2 +  4 L2 + R + (L cos φ)2 mw ,     2 2 2   m d 1 − cos 2 θ + I b3 mb d sin θφ m d + I b3 mb d sin θθ A24 = b , A26 = b , DIP1 DIP1    3mw mb d 2 sin θ cos θφ − mb d 2 sin θ cos θθ − (mb d )2 sin θ cos θθ A44 = , A46 = , A66 = , DIP1 DIP1 DIP 2 ( B21 = B22 = F2 = ( ) (mb d 2 + I b3 ) , B 41 DIP1R − (mb d )2 g sin θ cos θ DIP = B42 = , F4 = ( ( ) −mb d cos θ DIP1 R ) , B61 = − B61 = mb dg sin θ(mb + 3mw ) L cos φ , DIP 2 R , DIP ) D IPL 1 = ( m B + 3 m w ) m b d 2 + I b 3 − ( m b d ) 2 , 2  D IPL 2 = I b 2 +  5 L 2 + R   2 A 23 L = − (m b d )2 g D IPL 1 B 21 L = B 22 L =  m w ,   , A 43 L = (m b d 2 + I B 3 ) , D IPL 1 R ( m b + 3 m w )m b dg , D IPL 1 B 41 L = B 42 L = −mbd D IPL 1 R , B 61 L = − B 62 L = L , D IPL 2 R REFERENCES [1] [2] [3] [4] [5] [6] [7] [8] Z. Kausar, K. Stol, and N. Patel, "The Effect of Terrain Inclination on Performance and the Stability Region of Two-Wheeled Mobile Robots," International Journal of Advanced Robotic Systems, vol. 9, no. 218, pp. 1-11, 2012. S. H. Miao, "Modeling of self-tilt-up motion for a two-wheeled inverted pendulum," Industrial Robotan International Journal, vol. 38, no. 1, pp. 76-85, 2011. F. Grasser, A. D’Arrigo, S. Colombi, and A. C. Rufer, "JOE: a mobile, inverted pendulum," IEEE Transactions on Industrial Electronics, vol. 49, no. 1, pp. 107-114, 2002. L. Jingtao, X. Gao, H. Qiang, D. Qinjun, and D. Xingguang, "Mechanical Design and Dynamic Modeling of a Two-Wheeled Inverted Pendulum Mobile Robot," Automation and Logistics, 2007 IEEE International Conference on, Jinan, China, pp. 1614-1619, 2007. M. Baloh and M. Parent, "Modeling and Model Verification of an Intelligent Self-Balancing TwoWheeled Vehicle for an Autonomous Urban Transportation System," Conference on Computational Intelligence, Robotics, and Autonomous Systems, Singapore, pp. 1-7, 2003. J. S. Noh, G. H. Lee, and S. Jung, "Position control of a mobile inverted pendulum system using radial basis function network," International Journal of Control, Automation and Systems, vol. 8, no. 1, pp. 157-162, 2010. H. Ozaki, T. Ohgushi, T. Shimogawa, and C.-J. Lin, "Position and orientation control of a wheeled inverted pendulum," JSME International Journal, Series C: Mechanical Systems, Machine Elements and Manufacturing, vol. 44, no. 1, pp. 188-195, 2001. K. Teeyapan, J. Wang, T. Kunz, and M. Stilman, "Robot Limbo: Optimized Planning and Control for Dynamically Stable Robots Under Vertical Obstacles," 2010 IEEE International Conference on Robotics and Automation, Anchorage, Alaska, USA, pp. 4519-45 S. H. Jeong and T. Takahashi, 18
  • 19. International Journal of Control Theory and Computer Modeling (IJCTCM) Vol.3, No.6, November 2013 [10] [11] [12] [13] [14] [15] [16] [17] [18] [19] [20] [21] [22] [23] [24] [25] "Wheeled inverted pendulum type assistant robot: inverted mobile, standing, and sitting motions," IEEE/RSJ International Conference on Intelligent Robots and Systems 2007, San Diego, CA, USA., pp. 1932-1937, 2007. M. L. Chen, "Analysis and design of robust feedback control systems for a nonlinear two-wheel inverted pendulum system," 2012 International Symposium on Computer, Consumer and Control, Taichung City, Taiwan, pp. 949-953, 2012. K. M. Goher, M. O. Tokhi, and N. H. Siddique, "Dynamic modelling and control of a two wheeled robotic vehicle with a virtual payload," Journal of Engineering and Applied Sciences, vol. 6, no. 3, pp. 7-41, 2011. A. Bajodah, D. Hodges, and Y.-H. Chen, "Nonminimal Kane's Equations of Motion for Multibody Dynamical Systems Subject to Nonlinear Nonholonomic Constraints," Multibody System Dynamics, vol. 14, no. 2, pp. 155-187, 2005. Y. Kim, S. Kim, and Y. Kwak, "Dynamic analysis of a nonholonomic two-wheeled inverted pendulum robot," Journal of Intelligent and Robotic Systems, vol. 44, no. 1, pp. 25-46, 2005. H. Jian, G. Zhi-Hong, T. Matsuno, T. Fukuda, and K. Sekiyama, "Sliding-Mode Velocity Control of Mobile-Wheeled Inverted-Pendulum Systems," Robotics, IEEE Transactions on, vol. 26, no. 4, pp. 750-758, 2010. C. H. Chiu and C. H. Lin, "A WIP control based on an intelligent controller," World Academy Of Science Engineering and Technology vol. 54, no. 126, pp. 656-661, 2011. C. H. Huang, W. J. Wang, and C. H. Chiu, "Design and implementation of fuzzy control on a twowheel inverted pendulum," IEEE Transactions on Industrial Electronics, vol. 58, no. 7, pp. 29883001, 2011. C. C. Tsai, H. C. Huang, and S. C. Lin, "Adaptive Neural Network Control of a Self-Balancing TwoWheeled Scooter," Industrial Electronics, IEEE Transactions on, vol. 57, no. 4, pp. 1420-1428, 2010. E. Minnaert, B. Hemmelman, and D. Dolan, "Inverted pendulum design with hardware fuzzy logic controller," 11th World Multi-Conference on Systemics, Cybernetics and Informatics, (Wmsci 2007), Orlando, pp. 76-81, 2007. T. Ren, T. C. Chen, and C. J. Chen, "Motion control for a two-wheeled vehicle using a self-tuning PID controller," Control Engineering Practice, vol. 16, no. 3, pp. 365-375, 2008. M. Fallahi and S. Azadi, "Adaptive Control of an inverted pendulum using adaptive PID neural network," Proceedings of the 2009 International Conference on Signal Processing Systems, Los Alamitos, CA, USA, pp. 589-593, 2009. S. Liang and G. Jiafei, "Researching of Two-Wheeled Self-Balancing Robot Base on LQR Combined with PID," 2nd International Workshop on Intelligent Systems and Applications (ISA), pp. 1-5, 2010. A. N. K. Nasir, M. A. Ahmad, and R. M. T. R. Ismail, "The control of a highly nonlinear two-wheels balancing robot: A comparative assessment between LQR and PID-PID control schemes," World Academy Of Science Engineering and Technology, vol. 46, no. 44, pp. 227-232, 2010. S. Ahmad and M. O. Tokhi, "Linear Quadratic Regulator (LQR) approach for lifting and stabilizing of two-wheeled wheelchair," 4th International Conference On Mechatronics (ICOM), pp. 1-6, 2011. S. Y. Seo, S. H. Kim, S.-H. Lee, S. H. Han, and H. S. Kim, "Simulation of attitude control of a wheeled inverted pendulum," International Conference on Control, Automation and Systems, (ICCAS '07), pp. 2264-2269, 2007. T. Takei, R. Imamura, and S. Yuta, "Baggage Transportation and Navigation by a Wheeled Inverted Pendulum Mobile Robot," IEEE Transactions on Industrial Electronics, vol. 56, no. 10, pp. 39853994, 2009. 19
  • 20. International Journal of Control Theory and Computer Modeling (IJCTCM) Vol.3, No.6, November 2013 Authors Mohamad Amir Shamsudin was born in Johor, Malaysia, in 1983. He received the B.S and M.S degrees in mechatronics engineering from Universiti Teknologi Malaysia (UTM) respectively in 2007 and 2009. He is currently a PhD student in the Faculty of Electrical Engineering, UTM. His research is on Modelling and Control of Wheel Inverted Pendulum system. Rosbi Mamat is Associate Professor at Department of Control and Mechatronic UTM, Malaysia. His research interests include control and intelligent systems, mechatronic system, and embedded system. Sophan Wahyudi Nawawi received his PhD from UTM, Malaysia in 2006. His PhD research was in Control area. His research interests include nonlinear system and control, robust control and robotic system. 20