Escolar Documentos
Profissional Documentos
Cultura Documentos
4, AUGUST 2015
915
I. I NTRODUCTION
Manuscript received September 15, 2014; revised March 13, 2015; accepted
May 18, 2015. Date of publication May 31, 2015; date of current version July
31, 2015. This work was supported by the Ministry of Science and Technology,
Taiwan, under Grant MOST 103-2221-E-197-028. Paper no. TII-14-1031.
The author is with the Department of Electrical Engineering, National Ilan
University, Yilan 26047, Taiwan (e-mail: hc.jack.huang@gmail.com).
Color versions of one or more of the figures in this paper are available online
at http://ieeexplore.ieee.org.
Digital Object Identifier 10.1109/TII.2015.2440173
and parallel PSOs have been proposed to address the optimization problems in recent years [9][11]. Although the parallel or
distributed metaheuristics have been proven useful in solving
complex combinatorial problems, these individual algorithms
have their strengths and restrictions.
To date, there are several modified ACOs and PSOs proposed to improve the system performance [12][14]. However,
the control parameters in these parallel and hybrid metaheuristic researches are usually set by an inefficient trial-and-error
approach [9][14] and there has no attempt to develop a heterogeneous parallel metaheuristic algorithm using Taguchi quality
method. Moreover, these personal computer (PC)-based metaheuristic algorithms [9][14] suffer from their high cost, so
that they are not suitable for real-time embedded robotics
applications. These disadvantages of the conventional metaheuristic paradigms can be circumvented by using the heterogeneous parallel processing, Taguchi method, and system-ona-programmable chip (SoPC) hardware/software codesign in
field-programmable gate array (FPGA) chip.
Taguchi quality method is a statistical method developed by
Genichi Taguchi to improve the product quality and cost in
industrial design [15][17]. On the other hand, FPGA-based
metaheuristics is a new challenging field in computational
intelligence. This computing transition from general purpose
processors to embedded systems has been emerging as a
new paradigm in terms of time-to-market, cost, implementation flexibility, and long-term maintenance [18][21]. To the
authors best understanding, there has no attempt to designing
intelligent FPGA-based Taguchi-based heterogeneous parallel
metaheuristic ACO-PSO (THPACOPSO) optimal redundant
controllers for four-wheeled mobile robots.
Mobile robots with Swedish omnidirectional driving capability are superior to those with differential wheels in terms
of dexterity and locomotion mechanism [22][24]. The fourwheeled mobile robots are expected to have better effective
floor traction, even though at the expense of increased mechanical and control complexities. However, there exists a redundant
control problem because more than three wheels provide redundancy [22].
Mathematical modeling and control of redundant fourwheeled omnidirectional mobile robots have been investigated
by several researchers [25][28]. Overall, these studies applied
more complex mechanisms of the mobile robots to resolve the
1551-3203 2015 IEEE. Personal use is permitted, but republication/redistribution requires IEEE permission.
See http://www.ieee.org/publications_standards/publications/rights/index.html for more information.
916
redundant problem in Cartesian space. These researches neither cope with the polar-space redundant control problem of
four-wheeled mobile robots, nor address the control parameter
optimization problem.
Polar-space locomotion controllers of mobile robots have
been proven superior to the Cartesian controllers in tracking
the special trajectories, such as Archimedes spiral, rose curves,
and Limacon of Pascal [29][33]. These trajectories are easily
described in polar coordinates, but they are more complex in
Cartesian space. The polar-space tracking problems for nonholonomic mobile robots have been investigated by several
researchers [29][31]. There have been few studies related to
holonomic three-wheeled polar-space omnidirectional mobile
robot control [32], [33], in which the control parameters are
obtained by a trial-and-error approach. However, to the authors
best understanding, the polar-space redundant control problem
of four-wheeled mobile robots remains open.
The objective of this paper is to develop a pragmatic
metaheuristic THPACOPSO to optimal polar-space locomotion control of four-wheeled redundant mobile robots
to achieve trajectory tracking. This paper is organized as
follows. In Section II, the THPACOPSO algorithm is proposed. Section III elaborates the FPGA realization to optimal polar-space THPACOPSO locomotion control of fourwheeled redundant mobile robots to achieve trajectory tracking.
Section IV conducts experimental results and comparative
works to show the performance and merit of the proposed
methods. Section V concludes this paper.
II. TAGUCHI -BASED H ETEROGENEOUS PARALLEL
M ETAHEURISTIC ACO-PSO
Fig. 1 presents the architecture of the proposed
THPACOPSO which is a parallel processing strategy using
both ACO and PSO with Taguchi-based control parameter
tuners. This THPACOPSO consists of one Taguchi-based
ACO (TACO) slave processor and one Taguchi-based PSO
(TPSO) processor along with a communication master operator. The independent TACO and TPSO works in parallel
for searching the optimal solutions more efficiently by using
parallel architecture and Taguchi orthogonal array method.
This heterogeneous parallel model is employed to not only circumvents the premature convergence problem in conventional
1
dij
(2)
where dij is the cost between the nodes i and j. The pheromone
update rule is given by
ij (t + 1) = (1 )ij (t) + ij (t)
(3)
917
TABLE I
ACO C ONTROL PARAMETERS AND THE L EVELS
with
ij (t) =
m
k ij (t)
(4)
k=1
TABLE II
TAGUCHI L25 (56 ) O RTHOGONAL A RRAY
Nt
1
yi 2
Nt i=1
(5)
(6)
(7)
918
TABLE III
PSO C ONTROL PARAMETERS AND T HEIR L EVELS
where
sin((t))
cos((t))
P ((t)) =
sin((t))
cos((t))
cos((t))
sin((t))
cos((t))
sin((t))
L
L
.
L
L
(9)
SNR techniques. There are six control parameters in the conventional PSOs, including the number of generations (NPSO ),
swarm size (Ss ), neighborhood size (Ns ), and three positive
constants w, c1, c2. Table III lists the control parameters and
their five levels. Furthermore, the slave TPSO processor adopts
the Taguchi L25 (56 ) orthogonal array in Table II to determine
the qualified control parameters by using only 25 experiments.
C. Communication Module
In the proposed masterslave metaheuristic THPACOPSO
computing, each slave processor is regarded as an independent agent. Each slave processor independently evolves new
solutions in parallel, and the master processor is employed for
collecting and evaluating the best solutions in slave processors
to find the parallel global best (Gbest ), and then send it to each
slave processor. Therefore, the worst solution in each slave processor is replaced by the received parallel global best (Gbest ).
The master processor and two slave processors communicate
with each other in a communication interval.
P # ((t)) =
cos((t))
2
1
4L
1
4L
1
4L
(10)
x(t)x(t)
+ y(t)y(t)
x(t)x(t)
+ y(t)y(t)
=
r(t)
x2 (t) + y 2 (t)
x(t)
= r(t)
cos (t) r(t)(t)
sin (t)
(12)
y(t)
= r(t)
sin (t) + r(t)(t)
cos (t)
one can combine (10), (11), and (12) to obtain the kinematic
model of the Swedish four-wheeled mobile robot in polar coordinates. Thus, it follows from (12) that the time derivative of
the polar radius is given by
x(t)x(t)
+ y(t)y(t)
r(t)
x(t)r(t)
sin (t)
=
r(t)
= x(t)
cos (t) + y(t)
sin (t)
1
1
sin((t) (t)) cos((t) (t))
=
2
2
r(t)
=
III. FPGA-BASED THPACOPSO FOR R EDUNDANT
C ONTROL OF M OBILE ROBOTS
A. Kinematic Model in Polar Space
Fig. 2 depicts the structure and geometry of the four-wheeled
Swedish omnidirectional driving configuration with respect to a
world frame in Cartesian coordinates. In what follows describes
the kinematic model of this kind of redundant robot, where
represents the vehicle orientation. The Cartesian-space kinematic model of the four-wheeled Swedish mobile robot is
presented in [22]; the relationship between the wheel velocity
vector and the vehicle velocity vector can be given by
R1 (t)
V1 (t)
x(t)
V2 (t) R2 (t)
(8)
(t) =
V3 (t) = R3 (t) = P ((t)) y(t)
(t)
V4 (t)
R4 (t)
R1 (t)
R2 (t)
1
1
y(t)
cos (t) x(t)
sin (t) = r(t)(sin2 (t) + cos2 (t))(t)
= r(t)(t)
919
R1 (t)
R2 (t)
1
1
R1 (t)
= 1 1 1 1 R2 (t) .
(t)
(15)
4L 4L 4L 4L R (t)
3
R4 (t)
(t)
R1 (t)
r(t)
R2 (t)
(t)
= T # (r(t), (t) (t))
(16)
R3 (t)
(t)
R4 (t)
where T # (r(t), (t) (t)) is defined at the bottom of this
page.
The pseudoinverse matrix of T # (r(t), (t) (t)) can be
found as below
T (r(t), (t) (t))
=
.
sin((t) (t)) r(t) cos((t) (t)) L
cos((t) (t)) r(t) sin((t) (t)) L
Note that T # ((t))T ((t)) = I3 , where I3 is the 3 3
identity matrix.
B. Pseudoinverse Tracking Control in Polar Coordinates
With the polar-space kinematic model of the four-wheeled
Swedish redundant mobile robot in (16), this section is devoted
to developing a kinematic locomotion controller to achieve trajectory tracking for the Swedish wheeled mobile robot in Fig. 2.
The trajectory control goal is to find the controlled velocity vec
T
tor V1 V2 V3 V4
to steer the redundant mobile robot from
T
any starting pose r0 0 0 to track any given time-varying,
T
smooth, and differentiable trajectory rd (t) d (t) d (t) .
1
2
sin((t) (t))
1
2r(t)
cos((t) (t))
1
4L
r(t)
rd (t)
re (t)
e (t) = (t) d (t) .
(17)
(t)
e (t)
d (t)
Thus, one obtains
R1 (t)
re (t)
rd (t)
(t)
R
2
e (t) = T # (r(t), (t) (t))
R3 (t) d (t) .
e (t)
d (t)
R4 (t)
(18)
The control aim is therefore to find a set of control
T
output 1 (t) 2 (t) 3 (t) 4 (t)
that makes the closedloop system asymptotically stable. In doing so, the following
pseudoinverse redundant control law is proposed; the gain
matrices KP and KI are symmetric and positive definite,
meaning that KP = diag{Kp1 , Kp2 , Kp3 } = KPT > 0, KI =
diag{Ki1 , Ki2 , Ki3 } = KIT > 0
1 (t)
2 (t)
1
t
re ( )d
0
rd (t)
re (t)
e (t) KI t e ( )d + d (t) .
K
0
e (t)
t
d (t)
( )d
0 e
(19)
Substituting (19) into (18) leads to the underlying closedloop error system governed by
t
r ( )d
0 e
re (t)
re (t)
e (t) = Kp e (t) KI t e ( )d (20)
0
e (t)
t
e (t)
( )d
0 e
where the globally asymptotical stability of the closed-loop
error system (20) can be easily proven by selecting the quadratic
Lyapunov function
re (t)
1
re (t) e (t) e (t) e (t)
V (t) =
2
e (t)
t
t
1 t
+
re ( )d 0 e ( )d 0 e ( )d
0
2
t
r ( )d
0 e
t
(21)
KI
0 e ( )d .
t
( )d
0 e
12 cos((t) (t))
1
2r(t)
21 sin((t) (t))
1
2
cos((t) (t))
1
1
sin((t) (t)) 2r(t)
cos((t) (t)) 2r(t)
sin((t) (t))
.
1
4L
1
4L
1
4L
920
(23)
D. FPGA Implementation
Fig. 3 depicts the architecture of the Altera FPGA implementation for the proposed polar-space THPACOPSO redundant
locomotion controller using SoPC technology and hardware/
software codesign technique. There are four very high speed
integrated circuit (VHSIC) hardware description language
(VHDL) hardware intellectual property (IP) cores developed
for the four-wheeled mobile robot, including quadratureencoder-pulse (QEP), pulse width modulation (PWM), communication module, and digital filter. The QEPs aim at calculating
the posture of the mobile robot from the encoders mounted
on the dc motors. The PWM is a technique used to encode a
message into a pulsing signal for steering the dc motors. These
components are interconnected by means of the interconnection
network.
T
of
The current position and orientation r(t) (t) (t)
the Swedish redundant mobile robot in polar coordinates can
be directly dead-reckoned by the embedded central processing unit (CPU) via the obtained QEP signals from the motor
encoders. With this QEP information, the proposed polar-space
THPACOPSO optimal locomotion controller determine the outT
to the PWM module,
put = 1 (t) 2 (t) 3 (t) 4 (t)
which conforms the pulse duration and then steers the four DC
brushless motors on the four Swedish omnidirectional wheels
to achieve trajectory tracking.
IV. E XPERIMENTAL R ESULTS AND D ISCUSSIONS
The aims of this section are to examine the effectiveness and
performance of the proposed polar-space THPACOPSO optimal redundant control law (19) to the four-wheeled Swedish
omnidirectional mobile robot. This heterogeneous parallelization strategy increases the searching diversity for this optimal
redundant problem.
A. System Architecture of the Experimental Swedish FourWheeled Mobile Robot
Fig. 4 presents the picture of the experimental mobile robot.
The four Swedish omnidirectional wheels are driven by four
dc brushless servomotors with four mounted rotary encoders
to provide QEP information and then achieve dead-reckoning
of the redundant mobile robot. The proposed metaheuristic
THPACOPSO tuning method and polar-space control law are
realized using C/C++ code in the embedded processors incorporating with the robotics custom logic IPs. In this study, the
FPGA chip integrated the embedded processors, real-time operating system (RTOS), lightweight IP (lwIP), and VHDL-based
IPs for performing the THPACOPSO optimal control law of the
Swedish mobile robot.
B. Polar-Space Limacon of Pascal Trajectory Tracking
This experimental result was conducted to explore how
the proposed embedded THPACOPSO polar-space locomotion controller (19) steers the Swedish mobile robot to track
the Limacon of Pascal trajectory expressed by rd (t) = 2 +
1.5 cos d (t) (m), d (t) = 0.2t (rad), and d (t) = /4 (rad).
921
Fig. 6. Evolutions of performance index for the THPACOPSO and conventional Taguchi controllers.
Fig. 4. Picture of the experimental four-wheeled redundant mobile robot.
V. C ONCLUSION
922