Professional Documents
Culture Documents
net/publication/238008621
CITATIONS READS
34 2,754
3 authors:
SEE PROFILE
Some of the authors of this publication are also working on these related projects:
Hybrid Controllers based on Fuzzy Logic for PV Solar and Wind Power Systems/Farms View project
All content following this page was uploaded by Gia Minh Thao NGUYEN on 22 June 2017.
Access provided by:
WASEDA UNIVERSITY LIBRARY
Sign Out
BROWSE MY SETTINGS GET HELP WHAT CAN I ACCESS?
Browse Conferences > Strategic Technology (IFOST),... Back to Results
A PID backstepping controller for twowheeled selfbalancing Related Articles
robot Experimental study on a learning control system
with bound estimation for underw...
8 1531 Adaptive independent joint control of
View Document Paper Full manipulators: theory and experiment
Citations Text Views
Lyapunovbased tracking control in the presence
of uncertain nonlinear parameter...
View All
3 Nguyen Gia Minh Thao ; Duong Hoai Nghia ; Nguyen Huu Phuc View All Authors
Author(s)
Abstract:
This paper presents a method to design and control a twowheeled selfbalancing robot and it focus on hardware description, signal processing,
discrete Kalman filter algorithm, system modelling and PID backstepping controller design. In the system, signals from angle sensors are filtered by a
discrete Kalman filter before being fed to the PID backstepping controller. The objectives of the proposed controller are to stabilize the robot while try to
keep the motion of robot to track a reference signal. The proposed PID backstepping controller has three control loops, in which the first loop uses a
backstepping controller to maintain the robot at equilibrium, the second loop uses a PD controller to control the position of robot and the last uses a PI
controller to control the motion direction. Simulations and experimental results show that the proposed control system has good performances in terms
of quick response, good balance, stability .
Published in: Strategic Technology (IFOST), 2010 International Forum on
Date of Conference: 1315 Oct. 2010 INSPEC Accession Number: 11697445
Date Added to IEEE Xplore: 13 December 2010 DOI: 10.1109/IFOST.2010.5668001
ISBN Information: Publisher: IEEE
Conference Location: Ulsan, Korea (South), Korea (South)
Download PDF
Read the full document
Download Citations Abstract
Keywords
View References Authors
IEEE Keywords
Robots, Radio frequency, Hardware, Tuners Figures
Email
INSPEC: Controlled Indexing References
Print
uncertain systems, control system synthesis, Kalman filters, mobile robots, motion control,
multivariable systems, nonlinear control systems, PD control, PI control, position control, stability, Citations
Request Permissions threeterm control
Keywords
Export to Collabratec INSPEC: NonControlled Indexing
Back to Top
IFOST 2010 Proceedings
Abstract - This paper presents a method to design and control a Figure 1 and Figure 2 show the prototype design of the
two-wheeled self-balancing robot and it focus on hardware robot. The designed robot has an aluminum chassis, two
description, signal processing, discrete Kalman filter algorithm, 24V-30W DC-Servo motors for actuation, an accelerator and a
system modelling and PID backstepping controller design. In the
gyroscope for measuring pitch angle and angular velocity of
system, signals from angle sensors are filtered by a discrete
the body of robot, two incremental encoders built in motors for
Kalman filter before being fed to the PID backstepping controller.
The objectives of the proposed controller are to stabilize the robot
measuring the position of the wheels. Two serial 12V-3.5 Ah
while try to keep the motion of robot to track a reference signal. batteries make a 24V-3.5 Ah power which supplies energy for
The proposed PID backstepping controller has three control loops, two DC-Servo motors. Another 12V-1.5 Ah battery supplies
in which the first loop uses a backstepping controller to maintain energy for the central control module. Some operations of the
the robot at equilibrium, the second loop uses a PD controller to robot (upright and balance, moving forward, moving backward,
control the position of robot and the last uses a PI controller to turning left, turning right,... ) which can be controlled from
control the motion direction. Simulations and experimental buttons on the central control module or the RF remote
results show that the proposed control system has good
control.
performances in terms of quick response, good balance, stability .
Signals processing and control algorithm are embedded in
Keywords - Two wheeled self-balancing robot, Discrete Kalman a two-core micro-controller (MCU) MC9S12XDP512 which is
filter, Backstepping control, PID control, Embedded system. a 16-bit MCU of FreeScale.
I. INTRODUCTION
Two-wheeled self-balancing robot is a multi-variable and
uncertain nonlinear system [1],[2],[7],[8], so that the
performance of the robot depends heavily on the signal
processing and the control method in use. In recent years, the
number of researches on backstepping control have increased
[4],[5],[6]. The backstepping approach provides a powerful
design tool for nonlinear system in the pure feedback and strict
feedback forms. So it is of great interest and feasible to use
backstepping approach to design a compatible controller for Figure 1. The prototype two-wheeled self-balancing robot
two-wheeled self-balancing robot when the mathematical
model of robot is identified. Pitch angle
measurement module RF
The designed two-wheeled self-balancing robot is given in
Figure 1. Signals from angle sensors are filtered by a discrete
-receiver
module
The remainder of this paper is organized as follows. Cl=d 0, J Ci>=Id 0, J Ci>=Id 6, 7 Cl=d 2, 3
(MMA7260)
,,
GyroScope
Sensor
r--- , , , , , , , , ,
L--.--I....J
(LlSY300A) . "
'''''.(Iee)
i '------.-/
Initial estimates
Figure 6. Free body diagram of the chassis and the wheels
Figure 4. The discrete Kalman filter algorithm
• For the left wheel of robot (same as the right wheel).
TABLE I. TIME UPDATE EQUATIONS
Pk- = A Pk_1AT +Q
Project the error covariance ahead
(2) JWJiWL = CL -H R
xWL =8WLR
n (8)
(9)
JWL = 2 MWLR
TABLE II MEASUREMENT UPDATE EQUATIONS
Compute the Kalman gain
1 2
(10)
Kk = Pk-HT HPk-HT +R
-
( ( (3)
( XWL +XWR )
• For the body of robot.
Update estimate with measurement Zk
xk = x; + Kk ( Z k Hx; ) - (4)
XB = Lsin8B + 2
(11)
YB = - L(1 - cos8B)
It = (I - KkH)It-
Update the error covariance (12)
(5 )
MBxB =HL +HR (13)
L
JijB =(VL +VR )LsinOB -
(15)
-(HL +H R )LcosOB -( CL +CR)
1 2
JB =-M
3
BL (16)
(17)
[�+M, q'lS(�+�=;))(=;)]
Symbols Parameter Value {uflit!
0,c5 Pitch and yaw angle [rad]
(
Mass of wheel 0.5 [leg]
Mw
'h �)
Mass of body 7 [leg]
(MA (AZ)2)
MB
R Radius of whe el 0.07 [m]
siru;)
[�+M, q �+�=;))(=;)]
L Distance between the centres of the wheels and the 0.3 [m]
robot's centre of gravity
(
D Distance between the contact patches of the wheels 0.41 [m]
'.r. �,x,)
g Gravity constant '
9.8fms ]
'IS(
[o,75(AO?+��) (1+(siru;)2)
Input torque for left and right wheels [N.m]
CL,CR
�J
From equations (6) to (17), the state equations of
two-wheeld self-balancing robot are written as:
I
l (2Mw+Ms)L (2Mw+Ms)L VI
+
]
L
0,75 (1+(sin0)2) 0,75 (aEO)
I C
MJ3 (2Mw+Ms)RL 0
From equations (19.1) and (19.2), we can use
Backstepping approach to control the pitch angle 0 of robot.
{J
0,75(A()?+MJ,(aEO))(aEO) = --{),75g(A()?+MJ,(aEO))(sinO)
x +
I]
L L
V. pm BACKSTEPPING CONTROLLER DESIGN
2
(18)
Xl = 8, x = 8, X3 = x, X4 = X.
c
Define some state variables:
PI
The state equations of two-wheeled self-balancing robot are (Rotation
rewritten as: Controller)
Xi =X2 (19.1)
BackSteppillg Two-
(Balance
x2 =h (.x;) +J; (.x;,x2) +gl (.�;)Ce
.--�r..,,----, wheeled
(19.2)
Controlkr) + ROBOT
Where:
B. Backstepping Controller Design [4], [5 ], [6]
Co CL +CR
el = xlre! - Xl
o =
Step la: Defme a tracking error as
Define the virtual control a such that limH� e\ (t) = 0 , as D. Rotation Controller Design. [11]
a=k\e\ +C\ Z\ + x\ re! (20) In this control loop, a PI controller is designed to control
the direction of motion (Figure 9).
where k], c] are positive contants and z\ = fe\ ( r)dr.
co
Step Ib:
2
C\
2
I
The fIrst Lyapunov function is defined as
�:
� =CIZIZI +eIE\ =clzlel +eA =el (CIZI +el)
The derivation of
Figure 9. PI-controller for rotation scheme
(22)
When the robot doesn't move, or moves forward, or
Step 2a:
0 ).
Define the error between the virtual control a and moves backward (doesn't tum left-right), the reference yaw
input x2 of (19.2) as e2 =a -x2 angle equals zero (Jre! =
(19.1) is rewritten as XI =a -e2 = klel +CIZI + xl re! -e2 (23) The control signal from the Rotation controller combines
with the control signals from the Balance controller and
From (23), we have c:\ = xlre! -XI = -klel -CIZI +e2 (24) Position Controller to make two separately control signals for
The derivation of e2: left and right wheels (Figure 10).
(26)
VI. SIMULATIONS, EXPERIMENTAL RESULTS
Step 2b:
2
�=V;+-�2 1
The second Lyapunov function is defined as
�n
A. Simulations
Vz
The parameters of the robot are defmed in Table III. Both
the pitch angle and the position of the robot are shown
simultaneously in Figure 11, Figure 12, Figure 13, Figure 14 .
Compute the derivation of as
< (30)
Time (sec)
0.05
When the robot uprights and doesn't move ( Bre! = 0 ), the O.Q.4 •
003 .
If the reference pitch angle doesn't equal zero, the robot ° 0� � �==�=,�0== ------�51
will move forward ( Bre! > 0 ) or move backward (Bre! < 0 ). In
Time (sec)
---------- ------ =---
Figure II. The robot maintains at equilibrium with small initial pitch angle
this operation, the position PD controller isn't used. (00 =5 [deg])
Figure 12. The robot maitains at equilibrium with large initial pitch angle
(00 = 25 [deg])
: -7-1'I
� 5
: : :
o 2 4 5
·_
.. ·_
...._
.. ·_
-- - -- TIme (sec)
. . . .. . . . . .. . .. . . ..
10 � �
!:�
. . - . - .. .. - - . .. ..
_
.. .. . ...
__
.. .. - .. . . ....
_
.... - -.
- - .
: : :
:
.
..................... ... ; ............ . .. .. .. ..
..e : :
...J : :
-- - - - - -
�
1.5 2.5 3.5 4.5
Time (sec)
o 1 2 3 4 5
Time (sac)
6 t t t t , ; ; ;...........;
,,, ,,, ,,
········· ·········· ··· ····__··· ·········· ············_-_·········· ......._-_.......
---------�----------�----------� ,
--------_._---------_._---------_._-----
Figure 15. A experimental result that the designed robot is in equilibrium
:- ::-
4 ---------�----------�----------� - The robot maintains at equilibrium with an external
�
•
- - - - - - - -�
- - -------�----------�----------�
-=0
'
---- ----------;----------- j 1 1
a.
-------------------------
:
--------------
Time (sec)
Time (sec)
Time (sec)
B.
Figure 14.
Experimental Results
Time (sec)
The robot moves to the new position which is at the
distance of two mets.
i.� � ·�0�--'-0�.5'-----'�--�'.5:--��2----�2 .5
:---�3----�3.
- 5--�4
""'
Time (sec)
• Parameters of the proposed PID Backstepping Figure 16. The designed robot maintains at equilibrium when it is affected
controller are shown in Table IV. by a external disturbance
• The robot moves to the set position (xre! "# 0 [m]) VII. CONCLUSION
In this operation, both the Backstepping controller This paper presented a method to design and control a
for balance and the PD controller for position are two-wheeled self-balancing robot. Simulations and
active. When the robot moves forward, the reference experimental results show that the nonlinear controller based
signals of the proposed controller are: on Backstepping approach has good performances in terms of
Ore! 0 , xre! > O. When the robot moves backward,
= quick response, good balance and robust against disturbance.
In the future, the proposed Backstepping controller will be
reference signals of the proposed controller are:
Ore! 0 , xre! < 0 . Figure 17 and Figure 18 show the
combined with fuzzy logic to design a hybrid controller for
=
improving the performance of the robot.
responses of the robot when the robot moves forward
(with xre! 0.8 [m]) and moves backward (with
= VIII. REFERENCES
xre! =
-0.4 [m]). [1] Felix Grasser, Aldo D'Arrigo, Silvio Colombi, Alfred Ruffer , "JOE: A
Mobile Inverted Pendulum", IEEE Trans. Electronics, vol. 49, no 1, Feb
2002, pp. 107-114.
I:� WI
[2] S.W.Nawawi , M.N.Ahmad , lH.S. Osman , "Development of
Two-Wheeled Inverted Pendulum Mobile Robot",
SCOReD07,Malaysia, Dec 2007, pp 153-158
l" �'" f
[3] Greg Welch, Gary Bishop , "An Introduction to the Kalman Filter"
Siggraph 2001 Conference, Course 8.
o 1 2 3 4 5 6
Time (sec)
[ 4] Tatsuya Nomura , Yuta Kitsuka, Hauro Suemistu, Takami Matsuo ,
"Adaptive Backstepping Control for a Two-Wheeled Autonomous
I : : : i i 1
Robot", ICROS-SICE International Joint Conference 2009, Aug. 2009,
a. : : : : : :
o i ' , . , i Conference on Informatics in Control, Automation and Robotics.
o 1 2 3 4 5 6 [6] Arbin Ebrahim, Gregory Y.Murphy, "Adaptive Backstepping Controller
Time (sec)
Design of an Inverted Pendulum", System Theory, 2005, Proceedings of
the Thirty-Seventh Southeastern Symposium on, pp. 172-174.
i]� l
[7] D. Y. Lee, Y. H. Kim, B. S. Kim, Y. K. Kwak , "Dynamics and
Control of Non-holonomic Two Wheeled Inverted Pendulum Robot",
Proceedings of the eighth International Symposium on Artificial Life
and Robotics, 2003.
· � L-----� ------� ------- L-----�L-----�------�
O 1 2 3 4 5 6 [8] Jingtao Li, Xueshan Gao, Qiang Huang, Matsumoto, "Controller design
Time (sec)
of a two-wheeled inverted pendulum mobile robot", Mechatronics and
Figure 17. The designed robot moves forward to the positive set position. Automation 2008, ICMA 2008, IEEE International Conference on.
[9] S.W.Nawawi, M.N.Ahmad
, J.H.S. Osman, "Real-Time Control of
Two-Wheeled Inverted Pendulum Mobile Robot" ,
www.waset.orgjjournals/wasetlv39/v39-39.pdf
[l0] David P. Anderson , "nBot - a Balancing Robot", 2003
http://www.geology.smu.edu/-dpa-www/robo/nbotl
[II] Brian Kuschak, "bk-Bot, yet another 2-wheel balancing robot", 2007
i
05 35 4 www.bkinnovation.comlbkbotl
Time (sec)
[12] Ted Larson, Bob Allen, "Bender - a balancing robotic" , 2003
www.tedlarson.com/robots/balancingbot.htm
TIme (sec)
Figure 18. The robot moves backward to the negative set position.