Professional Documents
Culture Documents
Icstcc2011 111
Icstcc2011 111
net/publication/252056969
CITATIONS READS
12 1,905
3 authors:
Viorel Mînzu
Universitatea Dunarea de Jos Galati
108 PUBLICATIONS 462 CITATIONS
SEE PROFILE
Some of the authors of this publication are also working on these related projects:
Computational Intelligence Tools Used to Solve Optimal Control Problems View project
Study and control of a water treatment system by ultraviolet radiation: Implementation on an embedded target View project
All content following this page was uploaded by Viorel Mînzu on 04 April 2015.
Abstract— A trajectory tracking controller based on the anywhere in a household, the only unreachable area being
backstepping technique for the PowerBot wheeled mobile the stairs. A lot of household wheeled mobile robots are
robot using the kinematic model is proposed in this paper. already commercially available like autonomous cleaning
The PowerBot is an automated differential drive guided robots or mowing robots, but we can expect a lot more
vehicle specially designed and equipped for autonomous, household tasks to be performed by wheeled mobile robots
intelligent delivery and handling of large payloads. The
as technology allows for cheaper robots. For this reasons
PowerBot is an ideal platform for laboratory and research
tasks involving delivery, navigation and manipulation thanks
research on wheeled mobile robots has been a very active
to its top speed of 1.6 m/s and payload capacity of up to 100 kg. field.
Simulations and real-time are used to validate the proposed Wheeled mobile robots are characterized by
controller and the results prove the effectiveness of the nonholonomic systems, a class of systems that cannot be
controller. stabilized by smooth static state feedback laws [1].
Backstepping control is one of the most important
I. INTRODUCTION methods for stabilizing a nonholonomic system. The control
where k 2 , k 3 0 .
e r d
vc
Consider the Lyapunov function: vd
ωd ωc
1 1 1
V (t , xe , ye ,e ) xe ye e (12) Trajectory Backstepping
2 2 2 Planner Controller
with 0 .
xd
xe
yd ye v
V (t , xe , y e , e ) k1
2
d y e2 xe ( d y e v1 v) θd
θe ω
1 (13) Error
1
e [ y e v r 0 cos(s e )ds r d ] Calculation
xCG
Odometry
yCG
The resulting controls are: θCG
0.1
1.5 0.05
x[m]
1
-0.05
y [m]
-0.1
0.5
-0.15
0 -0.2
0 5 10 15 20 25 30
Time[s]
0.02
y[m]
0
-0.02
-0.04
-0.06
-0.08
0 5 10 15 20 25 30
time[s]
10
4
Heading error [deg]
-2
2.5
Real trajectory -4
Desired trajectory -6
2
-8
-10
0 5 10 15 20 25 30
1.5 Time[s]
1
In Fig. 11 the real speed, desired speed and calculated
speed are presented. Fig. 12 presents the angular velocity of
0.5
the robot, the desired angular velocity and the calculated
angular velocity.
0
It can be seen from figs. 7-10 that the trajectory tracking
errors are small and the desired trajectory is followed, and
-0.5
-0.5 0 0.5 1 1.5 2 2.5 3 3.5 4 4.5
from Fig. 11 that the real linear velocity is similar to the
x[m] desired velocity and the calculated velocity and from Fig.
Fig. 7 Real and desired trajectories 12 that the angular velocity is similar to the calculated and
desired velocities.
even in the linear section of the trajectory. In Fig. 17 the
real speed, desired speed and calculated speed are
0.5 presented. Fig. 18 presents the angular velocity of the robot,
the desired angular velocity and the calculated angular
0.4
velocity. It can be seen that the trajectory tracking errors,
although larger than the simulated ones, are small, the real
0.3
Speed[m/s]
y[m]
1
Fig. 11 Linear velocities
0.5
1
0.8
0
0.6
-0.5
0.4 -0.5 0 0.5 1 1.5 2 2.5 3 3.5 4 4.5
x[m]
0.2
w[rad/s]
-0.4 0.8
Angular Velocity
-0.6 Desired Angular Velocity 0.6
Calculated Angular Velocity
-0.8 0.4
0 5 10 15 20 25 30
Time[s]
0.2
x[m]
0
Fig. 12 Angular velocities
-0.2
-0.6
Real-time results are presented in this section in order to
-0.8
validate the proposed control law. Experiments carried out
on the trajectory tracking problem of wheeled mobile robots -1
0 5 10 15 20 25 30
Time[s]
shows the effectiveness of the backstepping controller.
The test was carried out on the PowerBot mobile
Fig. 14 Trajectory tracking error on the X-axis
platform. The control program was written in C++ and run
on a Pc, with sampling time set to Ts 100ms . A wireless
0.08
network was used to facilitate communication between the
robot and the PC. The command architecture is presented in 0.06
Fig. 4 and the desired trajectory is identical to the one from 0.04
the simulations.
0.02
Fig.13. shows the desired trajectory with a blue
interrupted line and with a continuous red line the resulted
y[m]
the error is reduced afterwards and kept close to zero. Fig. -0.08
15 shows the error on the Y-axis and the heading error is 0 5 10 15
time[s]
20 25 30
0.5
1399.
0.4 [5] I. Kolmanovsky and N. McClamroch, ”Developments in
nonholonomic control problems”, IEEE Control Systems, vol. 15,
0.3 1995, pp. 20-36.
0.2
[6] Z. Qiang, L. Zengbo, C. Yao, “A back-stepping based trajectory
tracking controller for a non-chained nonholonomic spherical
0.1 robot”, Chinesse Journal of Aeronautics vol 21, 2008, pp. 472-480.
Real Speed
[7] Y. Kanayama, Y. Kimura, F. Miyazaki and T. Noguchi, “A stable
0 Desired Speed
tracking control scheme for an autonomous mobile robot”,
Calculated Speed
-0.1
Proceedeings of the IEEE International Conference on Robotics and
0 5 10 15 20 25 30 Automation, 1990, pp.384-389.
Time[s] [8] H.G. Tanner, K.J. Kyriakopoulos, “Backstepping for nonsmooth
Fig. 17 Linear velocities systems”, Automatica, vol. 39, 2003, pp.1259-1265.
[9] H.G. Tanner, K.J. Kyriakopoulos, “Discontinuous backstepping for
stabilization of nonholonomic mobile robots, Proceedings of the
1.2
2002 IEEE International Conference on Robotics and Automation,
1 may, 2002, pp. 3948-3953.
[10] F. Mnif, “Recursive backsteping stabilization of a wheeled mobile
0.8 robot”, International Journal of Advanced Robotic Systems, vol. 1 ,
2004, pp. 287-294.
0.6
[11] H.K. Khail, “Nonlinear systems, 2nd edition, Prentice Hall, New
0.4 Jersey, 1996
[12] J. J. E. Slotine and W. Li, “Applied nonlinear control”, Prentice
w[rad/s]