Fuzzy L ogic Pat h Plann er and M otion C ontroller by ...minb/pub/Fuzzy_mobile.pdfThe fuzzy motion...

10
154 A des con tion to t out and cul pat pos heu The usin Key Log M con tern tem men can sen T mu nam com tive sco can a v nate Am nin bot mo Corr Elec E-m Man Sep 4 Fuzzy L A fuzzy logi signed in hie nsists of two n control lev the destinati tputs of the d arc metho ates the rob th generated sture. The fu uristics and e applicabil ng robot soc ywords: Socc gic Controlle Making a ro nstantly chan nal constrain m. To do so, nt around it n make the ro nsors in the v The robot so lti-agent sys mically. Rob mpete efficie eness of the ores of the ga n be divided i vision system e informati mong these, n g prospects. ic soccer fa ving obstacl responding Au ctrical Engineer mail: donghani nuscript receive . 2009. Logic Pat Abs ic controller erarchical st o levels: the vel. The pla ion by avoid e planner a ods. The low bot's wheel d by the plan uzzy singlet tuned by e ity of the co ccer system. cer Robot, N er (FLC,) Ev 1. Intro obot to mov nging enviro nts is the grea the robot sh tself by usin obot to acco varying envir occer is one stem where t bots have to ently. Also, t control stra ame. The m into three pa m, navigation on, and fo navigation pl From the v aces a dynam les (opponen uthor: Donghan ring, Kyung He i@khu.ac.kr ed 20 April. 200 th Plann gra Byung-Ch tract 1 r (FLC) for tructure. Th e planner le anner level g ding obstacle are obtained wer motion c velocity so nner as to th ton outputs evolutionary ontroller is d . Navigation M volutionary P oduction e to a speci onment with atest goal in hould recogn ng the navig omplish the j ronment [1]. e of the typ the environm cooperate w to a certain ategies can b main problem arts: exact po n planning u ollowing the lan represent view point o mic navigati nt robots) and n Kim is with ee University, Y 09; revised 1 Au ner and M amming heol Min, M mobile robo he designed vel and the generates a es. The singl d by using control level as to follow he current r are obtaine y programm demonstrate Method, Fuzz Program ific position internal and a navigation nize the env ation plan w job using a s ical exampl ments change with each oth extent, the e be proved by ms of robot so ositioning thr using the co e planned ts the team's of navigation on problem d a moving t h the Departme Y ongin, Korea ug. 2009; accep International © 2009 TFSA Motion C g for Mob Moon-Su Le ots is FLC e mo- path leton lines l cal- w the robot ed by ming. ed by zy n in a d ex- n sys- viron- which set of es of e dy- her to effec- y the occer rough oordi- path. win- n, ro- with target ment of pted 17 (ball dem a fou trolle [3,4] two ball, posit field certa fuzz Fu The iors logic gene appl moti cont Shoo perfo cont non- mak Mor geom and sider l Journal of Fu A Controll bile Rob ee, and Don l). Until now onstrated for ur-mode con ers for four ] proposed points, one the vector a tion of a ro d is construct ain integer. W y controller u uzzy logic is path followi are the pote c [6-7]. In m erated by a y fuzzy logi ion control roller of socc oting action ormed by ea rol problem -holonomic e difficult to eover, there metric relatio each goal ar red: The robot s site side of ponent goal The robot s close to the Figure 1. Ove uzzy Systems, ler by Ev bots nghan Kim w, many nav r robotic soc ntrol structur divided area the uni-vect in front and angle from th obot is calcu ted by multip Wong et. al. using a gene s a widely u ing and loca ential fields most of the higher level ic to this pla level in des cer robot (Fi is the funda ach robot. It in mobile r constraints derive stabl are several on among the ea. In this pa should appro the line con l. should avoid ball on the f erall view of t Vol. 11, No.3, volution vigation met ccer. Sim et. re which ha as around a tor field me the other at hese two poin ulated. Then plying the v . [5] propose etic algorithm used tool in m al obstacle av for the appl designs, the l planner. In anner level a signing the igure 1). amental func can be view robotics' poi of wheeled le trajectory l limitations e positions o aper, the foll oach the ball nnecting the d obstacles t field. the robot socc , September 2 ary Pro- thods have b al. [2] propo as different c ball. Kim et ethod. Selec t the back of nts to the cur n the uni-ve ector angle b ed an optim m. mobile robo voidance beh ication of fu e desired pat n this paper, as well as to shooting ac ction that can wed as a pos nt of view. d mobile rob control laws because of of the ball, ro lowings are c l from the op ball and the that are not v cer system [9] 009 - been osed con- t. al. cting f the rrent ector by a ized tics. hav- uzzy th is , we o the ction n be sture The bots [8]. the obot, con- ppo- op- very

Transcript of Fuzzy L ogic Pat h Plann er and M otion C ontroller by ...minb/pub/Fuzzy_mobile.pdfThe fuzzy motion...

Page 1: Fuzzy L ogic Pat h Plann er and M otion C ontroller by ...minb/pub/Fuzzy_mobile.pdfThe fuzzy motion controller then commands robot wheel velocities to follow this desired path given

154

Adescontionto toutandculpatposheuTheusin

KeyLog

M

conterntemmencansen

Tmunamcomtivescocana vnateAmninbotmo

CorrElecE-mManSep

4

Fuzzy L

A fuzzy logisigned in hiensists of twon control levthe destinatitputs of thed arc methoates the robth generatedsture. The fuuristics and e applicabilng robot soc

ywords: Soccgic Controlle

Making a ronstantly channal constrain

m. To do so, nt around it

n make the ronsors in the vThe robot solti-agent sys

mically. Robmpete efficieeness of the ores of the gan be divided ivision systeme informati

mong these, ng prospects.

tic soccer faving obstacl

responding Auctrical Engineer

mail: donghaninuscript receive. 2009.

Logic Pat

Abs

ic controllererarchical sto levels: thevel. The plaion by avoide planner aods. The lowbot's wheel d by the planfuzzy singlet

tuned by eity of the coccer system.

cer Robot, Ner (FLC,) Ev

1. Intro

obot to movnging environts is the grea

the robot shtself by usinobot to acco

varying enviroccer is onestem where tbots have to ently. Also, t

control straame. The minto three pa

m, navigationon, and fo

navigation pl From the v

aces a dynamles (opponen

uthor: Donghanring, Kyung [email protected] ed 20 April. 200

th Planngra

Byung-Ch

tract1

r (FLC) for tructure. The planner leanner level gding obstacleare obtainedwer motion c

velocity so nner as to thton outputs evolutionaryontroller is d.

Navigation Mvolutionary P

oduction

e to a specionment with atest goal in hould recogn

ng the navigomplish the jronment [1]. e of the typthe environmcooperate wto a certain ategies can b

main problemarts: exact pon planning uollowing thelan representview point omic navigatint robots) and

n Kim is withee University, Y

09; revised 1 Au

ner and Mamming

heol Min, M

mobile robohe designed vel and thegenerates a es. The singld by using control levelas to follow

he current rare obtaine

y programmdemonstrate

Method, FuzzProgram

ific positioninternal anda navigationnize the envation plan wjob using a s

ical examplments changewith each oth

extent, the ebe proved by

ms of robot soositioning thrusing the coe planned ts the team's of navigationon problem d a moving t

h the DepartmeYongin, Korea

ug. 2009; accep

International

© 2009 TFSA

Motion Cg for Mob

Moon-Su Le

ots is FLC

e mo-path leton lines l cal-

w the robot ed by ming. ed by

zy

n in a d ex-n sys-viron-which set of

es of e dy-

her to effec-y the occer rough oordi-path. win-n, ro-

with target

ment of

pted 17

(balldema foutrolle[3,4]two ball,positfieldcertafuzz

FuThe iors logicgeneapplmoticontShooperfocontnon-makMorgeomand sider

l Journal of Fu

A

Controllbile Rob

ee, and Don

l). Until nowonstrated forur-mode coners for four ] proposed points, one the vector ation of a ro

d is constructain integer. Wy controller uuzzy logic ispath followiare the pote

c [6-7]. In merated by a y fuzzy logiion control roller of soccoting action ormed by earol problem -holonomice difficult toeover, there

metric relatioeach goal arred:

• The robot ssite side of ponent goal

• The robot sclose to the

Figure 1. Ove

uzzy Systems,

ler by Evbots

nghan Kim

w, many navr robotic socntrol structurdivided areathe uni-vectin front and

angle from thobot is calcuted by multipWong et. al.using a genes a widely uing and locaential fields most of the higher levelic to this plalevel in descer robot (Fiis the funda

ach robot. It in mobile rconstraints derive stablare several

on among theea. In this pa

should approthe line con

l. should avoidball on the f

erall view of t

Vol. 11, No.3,

volution

vigation metccer. Sim et. re which haas around a tor field methe other at

hese two poinulated. Thenplying the v. [5] proposeetic algorithmused tool in mal obstacle avfor the appldesigns, thel planner. Inanner level asigning the igure 1). amental func

can be viewrobotics' poiof wheeled

le trajectory l limitations e positions oaper, the foll

oach the ballnnecting the

d obstacles tfield.

the robot socc

, September 2

ary Pro-

thods have bal. [2] propo

as different cball. Kim etethod. Select the back ofnts to the curn the uni-veector angle bed an optim

m. mobile robovoidance behication of fu

e desired patn this paper,as well as toshooting ac

ction that canwed as a posnt of view.

d mobile robcontrol laws because of

of the ball, rolowings are c

l from the opball and the

that are not v

cer system [9]

009

-

been osed con-t. al. cting f the rrent ector by a ized

tics. hav-uzzy th is , we o the ction

n be sture The bots [8].

f the obot, con-

ppo- op-

very

Page 2: Fuzzy L ogic Pat h Plann er and M otion C ontroller by ...minb/pub/Fuzzy_mobile.pdfThe fuzzy motion controller then commands robot wheel velocities to follow this desired path given

B. C. Min et al.: Fuzzy Logic Path Planner and Motion Controller by Evolutionary Programming for Mobile Robots 155

Such methods as uni-vector field method, geometric calculation method, and heuristics method have been utilized to solve these constraints so far in the robot soc-cer competitions [2,10-13]. In this paper, we propose a fuzzy logic scheme to solve the same problem. The FLC consists of two levels: the planner and the motion con-troller level. Although there is the similar controller that was suggested in [14], we have approached a different way to reduce arrival time to the ball. Firstly, the fuzzy logic path planning is designed by modeling arcs and straight lines using fuzzy logic’s nonlinear model map-ping characteristics in this paper. However, because some path errors can be occurred when geometrical path planning does not consider kinetic characteristic, it is quite challenging to design accurate path controller. In order to solve such problems, fuzzy logic that has robust characteristic of motion controller is used. In addition, the singleton outputs of motion controller level, which are obtained in a heuristic or empirical manner, are op-timized through evolutionary programming.

In Section 2, the overall fuzzy logic posture controller structure that includes a fuzzy logic path planner and a fuzzy motion controller is described. They are explained in Sections 3 and 4, respectively. In Section 5, simula-tions and experimental results are demonstrated. We conclude in Section 6 with some remarks on the results and future research.

2. Overall Fuzzy Control Structure

A. Target System: Robot Soccer System

The system (Figure 1) consists of three parts. The first one is the vision system that locates objects on the field by the global camera that is fixed above the field. Sec-ond component is the host computer which calculates strategies and decides actions for each robot. The last one is robots that follow actions given by the host com-puter through radio frequency (RF) communication. Since the action is represented as a number of sequential motions, sometimes host computer sends each robot's left and right wheel velocities rather than higher linguis-tic commands. In this paper, the fuzzy logic controller implemented in the host computer generates and sends the velocities to the robot through RF communication to achieve shooting behavior of the robot.

B. Modeling of a mobile robot

Differential-drive mobile robots with characteristics of non-slipping and pure rolling are considered. The veloc-ity vector Q = [v w]T consists of the translational velocity of the center of the robot, v, and the rotational velocity, w, defined with respect to the center of the robot. The velocity vector Q and a posture vector P = [x y θ]T are associated with the robot kinematics as follows:

QJv

y

x

P )(

1

0

0

0

sin

cos

θω

θθ

θ=

=

=

(1)

[ ] R

VL

V

L

VR

V L

VR

V wvQ

−=

−+==

2

1

2

12

1

2

1

22

T (2)

where VL is the left wheel velocity and VR is the right wheel velocity. The robot should be controlled to move to any posture by VL and VR. Hence, the fuzzy controller gives the robot a desired direction, θd, at the current po-sition (x, y).

(a)

(b)

Figure 2. (a) Overall fuzzy logic path planner and motion controller structure (b) schematic diagram

Destination

Obstacle

Fuzzy MotionController

Actuator

Fuzzy LogicPath Planner

Fuzzy Controller forShooting BehaviorVision

System

θd + θoff

θd

VL , VR

θ

ρ

φobs

ρobs

φ

obstacle

robot

φobsθ

ρφ

ballgoalρobs

Page 3: Fuzzy L ogic Pat h Plann er and M otion C ontroller by ...minb/pub/Fuzzy_mobile.pdfThe fuzzy motion controller then commands robot wheel velocities to follow this desired path given

156 International Journal of Fuzzy Systems, Vol. 11, No.3, September2009

C. Overall Fuzzy Controller Because of the constraints mentioned in Section 1, the

three posture variables (ρ,φ,θ) (Figure 2(b)) are required to achieve the shooting action. If all the variables are to be elaborated into one fuzzy rule table, the number of rules could be too large because they will increase by the factor of the number of term sets in each variable. So the controller is decomposed into two sub-controllers (Fig-ure 2) in hierarchical manner that each takes only two variables as inputs. This will significantly reduce the number of rules and make easier to design the controller. In addition, the fuzzy motion controller and the fuzzy logic path planner are included in sub-controllers. This is for generating a global path connecting the present robot position to the ball; however, it can face the constraints. The fuzzy motion controller then commands robot wheel velocities to follow this desired path given the current robot posture.

3. Fuzzy Logic Path Planner

Fuzzy logic path planner is for generating a path glob-

ally that faces the constraints of calculating desired ro-bot's heading angle θd at each relative position (ρ,φ) (Figure 2). It is again divided into two sub-blocks: the destination block that generates a path to lead to the des-tination (the ball) to face the first constraint in Section 1 and the obstacle block that compensate θd for obstacle avoidance to meet the second constraint.

A. Destination Block

This is for obtaining desired heading angle at each robot position. The robot's relative position to the ball is represented in polar coordinates (ρ,φ). Since the lower half plane is symmetric to X-axis, only the upper-half

plane is considered. Figure 3 shows the basic idea of constructing the

planner. The desired path is represented by lines and arcs, and the desired heading angle is defined as θd for the given robot position. θd depicted in Figure 3 can be ob-tained by:

βαπθ −+−=d (3)

−−+−

−+−= −−

min222

1min1

)(tantan

RRyx

R

x

Ry

mincc

min

c

where xc and yc are the positions of the current robot, and Rmin is the turning radius, which is set to 5 cm consider-ing the size of the ball and the robot. With the Eq. (3), a fuzzy model is formed. In the fuzzy model, ρ and φ are assigned to the inputs based on the position of the robot in polar coordinates. Also, the out-put, θd, has singleton values obtained at the sampled po-sitions shown in Figure 5. As a result, the input, output, and rules of the destination block are defined as follows: 1. Input space (ρ,φ) : relative position of the robot to the ball,

ρ ∈ [0cm, 60cm] φ ∈ [0, 180 deg.]

In accordance with input spaces, the input variable membership functions are depicted in Figure 4. 2. Output (θd): desired heading angle,

θd ∈ [-180 deg., 180 deg.]

3. Rules for destination block 49 rules are obtained using θd at sampled positions as shown in Figure 5. Since input spaces are uniformly di-vided, the rules are sampled at the center of each input region. The resultant rule table for the destination block is in Table 1. Table 1. Rules for destination θd ρ φ NB NM NS ZE PS PM PB

NB 90.0 143.1 157.4 163.7 167.3 169.6 171.2

NM 120.0 158.5 -180.0 -171.0 -166.1 -163.0 -161.0

NS 160.0 172.1 -155.5 -143.6 -137.6 -134.0 -131.6

ZE -170.0 -180.0 -126.9 -120.6 -114.3 -110.7 -108.4

PS -140.0 -135.0 -80.0 -76.9 -71.8 -69.0 -67.4

PM -20.0 -30.0 -34.2 -35.9 -35.5 -40.2 -45.4

PB 0 0 0 0 0 0 0

Figure 3. The desired path using lines and arcs

minR

dθY

XO

minR

dθY

XO

Page 4: Fuzzy L ogic Pat h Plann er and M otion C ontroller by ...minb/pub/Fuzzy_mobile.pdfThe fuzzy motion controller then commands robot wheel velocities to follow this desired path given

B. C. Min et al.: Fuzzy Logic Path Planner and Motion Controller by Evolutionary Programming for Mobile Robots 157

(a) ρ

(b) φ

Figure 4. Membership functions of ρ and φ according to the

relative position of the robot to the ball

Figure 5. θd, desired heading angle, sampled at each region

B. Obstacle Block This block is to obtain offset angle θoff depicted in

Figure 6, if there are any obstacles nearby. To obtain θoff, four variables such as relative velocity

(Vr), relative direction (Dr), distance (dr), and relative position (Pr, positive if obstacle in front, negative o.w.)

are utilized to get θesc in the presence of obstacles. θesc can be calculated with following the equation:

)(tan 1esc

o

escesc Rf

d

R == −θ (4)

Also, those relative quantities are necessary for obtain-ing the escape radius (Resc) to avoid stationary or moving obstacles.

However, since there are four factors we should con-sider for obtaining Resc, it is difficult to form the FLC by using all of those factors. For this reason, those factors are divided into two FLCs and constructed in hierar-chical structure shown as Figure 7. In Figure 7, Vr and Dr are needed to obtain Resc, while Pr and dr are used to obtain the proportional gain, Wsgn. For example, if the obstacle is located far from the robot, Wsgn gets smaller and becomes 0. In contrast, if the ob-stacle is located nearby the robot, Wsgn gets bigger and reaches 2. Consequently, Wsgn is multiplied with θesc to produce θoff.

θoff = Wsgn × θesc

where, 0 ≤ Wsgn ≤ 2. As a result, the input, output, and rules for the obstacle block are defined as follows: 1. Input space (Vr, Dr, dr, Pr): relative velocity and posi-tion of the obstacle to the robot, Vr ∈ [-0.5, 1.5] Dr ∈ [0 deg., 180 deg.] d r ∈ [0cm, 90cm] Pr ∈ [-0.5, 1.5]

0 20 40 60 80 100 120 140 160 1800

0.2

0.4

0.6

0.8

1NB NM NS ZE PS PM PB

phi

Mem

bers

hip

valu

e

-6 0 -4 0 -2 0 0 2 0 4 0 6 00

1 0

2 0

3 0

4 0

5 0

6 0

-6 0 -4 0 -2 0 0 2 0 4 0 6 00

1 0

2 0

3 0

4 0

5 0

6 060

50

40

30

20

10

0-60 -40 -20 0 20 40 60

-10 0 10 20 30 40 50 60 700

0.2

0.4

0.6

0.8

1NB NM NS ZE PS PM PB

rho

Mem

bers

hip

valu

e

Figure 6. Obstacle avoidance scheme

θd

do

θesc

θoff

Resc

dr

Figure 7. FLC for obstacle avoidance block

FLC1 f ( · )

FLC2

X

Vr

Dr

Pr

dr

Resc θesc

Wsgn

Wsgn · θesc

Page 5: Fuzzy L ogic Pat h Plann er and M otion C ontroller by ...minb/pub/Fuzzy_mobile.pdfThe fuzzy motion controller then commands robot wheel velocities to follow this desired path given

158 International Journal of Fuzzy Systems, Vol. 11, No.3, September2009

In accordance with the input space, the input variable membership functions are depicted in Figure 8. 2. Ouput space (θoff): offset angle added to θd,

θoff ∈ [-18Odeg., 180 deg.]

The resultant rule table for the obstacle block divided into FLC1 for Resc and FLC2 for Wsgn is in Table 2.

Table 2. Rule for obstacle block, FLC1(left) and FLC2(right) Resc Dr Wsgn dr Vr NB ZE PB Pr ZE PS PM PB

NB 20 20 20 NE 0.8 0.7 0.6 0.0

ZE 20 25 30 ZE 1.0 1.0 0.9 0.0

PB 20 35 40 PO 1.0 1.0 1.0 0.0

4. Fuzzy Motion Controller

A. Fuzzy Motion Controller Block In the overall structure of Figure 2, the fuzzy motion

controller block receives θd from the fuzzy logic path planner block and part of robot posture information (ρ, θ) through its vision. Then the motion controller block generates appropriate left and right wheel velocities to make θ follow θd at non-zero linear speed before ρ di-minishes. So the motion controller is concerned only for heading angle θ to follow θd with at positive linear ve-locity. For this conventional problem of mobile robots, following heuristics are incorporated: If ρ large →large If | θe | = | (θd + θoff) − θ | large → | VL − VR | large The input, output, and rules for the fuzzy motion con-

(a) Vr (b) Dr

(c) Pr (d) dr

Figure 8. Membership functions of Vr, Dr, Pr and dr for the obstacle block in fuzzy planner

-0.5 0 0.5 1 1.50

0.2

0.4

0.6

0.8

1NB ZE PB

relative velocity

Mem

bers

hip

valu

e

0 20 40 60 80 100 120 140 160 1800

0.2

0.4

0.6

0.8

1NB ZE PB

relative direction

Mem

bers

hip

valu

e

-40 -30 -20 -10 0 10 20 30 400

0.2

0.4

0.6

0.8

1NB ZE PB

relative position

Mem

bers

hip

valu

e

-10 0 10 20 30 40 50 60 700

0.2

0.4

0.6

0.8

1ZE PS PM PB

relative distance

Mem

bers

hip

valu

e

Page 6: Fuzzy L ogic Pat h Plann er and M otion C ontroller by ...minb/pub/Fuzzy_mobile.pdfThe fuzzy motion controller then commands robot wheel velocities to follow this desired path given

B. C. Min et al.: Fuzzy Logic Path Planner and Motion Controller by Evolutionary Programming for Mobile Robots 159

troller block are defined as follows: 1. Input space (ρ,θe): posture error of the robot to the ball and the path, ρ ∈ [0cm, 60cm]

θe ∈ [-120 deg., 120 deg.]

Depending on the input space, the input variable mem-bership functions are depicted in Figure 9. 2. Output space (VL, VR): desired left and right wheel velocities,

VL, VR ∈ [-54cm/s, 153cm/s] 3. Rules for fuzzy motion controller block According to the above heuristics, 49 rules are acquired for left and right wheel velocities. Table 3 is the rule ta-ble for right wheel speed. Left wheel speed is symmetric with respect to φ = 0. In the table, one unit corresponds to 1.534cm/sec.

(a) ρ

(b) θ

Figure 9. Membership functions of ρ and θe

Table 3. Rules for right wheel VR ρ θe NB NM NS ZE PS PM PB

NB -35 -27 -27 -3 -3 -3 -3

NM -25 8 8 18 31 31 42

NS 15 15 22 35 57 67 67

ZE 30 30 50 60 90 100 100

PS 15 40 44 65 82 92 92

PM 25 51 51 61 68 68 77

PB 35 63 63 67 67 67 67

B. Fuzzy Motion Control Block Tuning based on Evolu-

tionary Programming In Section 4A, the singleton values of the motion con-

troller block were determined with fuzzy control, which has various strong points: intuitive and simple [15]. However, most of the times, using professionals’ knowledge for designing might not be the most suitable system because there will be no professionals’ knowledge for newly introduced subject. In order to make up for the weak points, hybrid systems such as fuzzy system, evolutionary algorithm, and neural net-works, are studied in depth.

Fuzzy system and feed-forward control of neural net-work have similar basic structures. The difference be-tween those two systems is in each node’s number of connections and the function. For instance, fuzzy system uses knowledge related with a plant to decide a network structure by connecting related variables and maintaining inside structure. On the other hand, neural network has a learning ability. In order to use such learning method in fuzzy system as gradient descent, which is back propa-gation, fuzzy system should be expressed mathematical-ly and each of the nodes should be able to differentiate. Therefore, it is impossible to optimize the fuzzy system by using this neural network.

Evolutionary algorithm is suitable to use for optimiz-ing a not differentiable system or a system with local solution. Because of such merits, numerous researchers applied fuzzy system in automation of system design.

For this reason, in this paper, evolutionary fuzzy sys-tem, real variables optimization method based on evolu-tionary algorithm, is used for tuning of fuzzy system in the path motion controller. The condition for optimiza-tion is the minimum time to reach to the target point. As shown in Figure 10, the optimization for fuzzy system uses membership function’s center point and width. In order not to change the order of the membership func-tions, following restrictions are considered in evolution-ary algorithm process.

Ai−1 < Ai (i−1 < i) (5)

-10 0 10 20 30 40 50 60 700

0.2

0.4

0.6

0.8

1NB NM NS ZE PS PM PB

rho

Mem

bers

hip

valu

e

-150 -100 -50 0 50 100 1500

0.2

0.4

0.6

0.8

1NB NM NS ZE PS PM PB

Theta error

Mem

bers

hip

valu

e

Page 7: Fuzzy L ogic Pat h Plann er and M otion C ontroller by ...minb/pub/Fuzzy_mobile.pdfThe fuzzy motion controller then commands robot wheel velocities to follow this desired path given

160 International Journal of Fuzzy Systems, Vol. 11, No.3, September2009

Figure 11 is the flow chart that shows the learning scheme of the evolutionary program. An important fea-ture of EPs is that the range of mutations, the stepsize, is not fixed but inherited. Mutation creates a new offspring x’

i from each singleton value, xi by adding it to a Gauss-ian number with mean 0 and standard deviation σi.

x’

i = xi + Ni(0, σi) (6)

where σi is xi's maximum boundary within which the designer allows to change the singleton value. By using probability selection method for selecting offspring, σi is set to one tenth of xi's original value which was obtained heuristically, and total population N is set to 20. To test the tracking performance, 36 test data were used. They are 36 different starting postures. The time consumed for the robot to arrive from each point to the origin (destina-tion) is all summed up and compared for the selection. The initial time using heuristic singleton values was 36.6 seconds. After 10,000 generations, the tuned controller

ρ(a) ρ

(b) θe

Figure 12. Optimized membership functions of ρ and θe

reduced the time from 4.3 seconds to 32.3 seconds. Fig-ure 12 is the results of optimizing the minimum time required to the target point while satisfying the re-striction condition of Eq. (6).

5. Simulation and Experiment A. Simulation

Simulation is performed based on the following robot kinematics:

SLR T

D

kVkVkk ⋅−+=+ )()(

)()1( θθ (7)

SLR T

kkkVkVkxkx ⋅++⋅−+=+

2

)1()(cos

2

)()()()1(

θθ (8)

SLR T

kkkVkVkyky ⋅++⋅

−+=+

2

)1()(sin

2

)()()()1(

θθ (9)

Robot's physical quantities are:

-10 0 10 20 30 40 50 60 700

0.2

0.4

0.6

0.8

1NB NM NS ZE PS PM PB

rho

Mem

bers

hip

valu

e

-150 -100 -50 0 50 100 1500

0.2

0.4

0.6

0.8

1NB NM NS ZE PS PM PB

Theta error

Mem

bers

hip

valu

e

Figure 11. The flow chart of the proposed Optimization method using EP

Simulator

Evaluation

Initialize

Reproduction

Mutation

Evaluation

Selection

generation<Max?

FuzzyPosture

controller

Mobilerobot

5 TestSets

Cost Function

Terminate

Figure 10. The optimization for fuzzy system using the tri-angular-shaped membership function’s center point and

width

1iA − iA 1iA +

1id − id 1id +

1iA − iA 1iA +

1id − id 1id +

Page 8: Fuzzy L ogic Pat h Plann er and M otion C ontroller by ...minb/pub/Fuzzy_mobile.pdfThe fuzzy motion controller then commands robot wheel velocities to follow this desired path given

B. C

- - -

Figtionlinesecsectim

F

B.

Esoccati

C. Min et al.: F

wheelbasewheel radisampling i

gure 13 shown controller ear segment onds. The conds. This is

me was chosen

(a) Before t

(b) After tu

Figure 13. Comtion

ExperimentExperiments ccer system (ions include

Fuzzy Logic P

e (D) = 6.7 cmius (r) = 2.0 cinterval (Ts) =

ws the simulshows bettepart earlier t

controller bes expectablen as the fitne

tuning by evo

uning by evolu

mparison of bnary programm

t were perfo

(Soty IV, Fig a vision bo

Path Planner a

m cm = 0.5 ms

lation resultser performanto arrive at tefore tuned since in app

ess function.

olutionary prog

utionary progr

before and afteming in simul

rmed using gure 14). Thoard (Meteor

and Motion C

s. The tunednce by takingthe origin infinished in

plying EP, ar

gramming

ramming

er tuning by evlation

the micro rhe system spr) of 60 Hz

Controller by E

d mo-g the

n 1.44 1.85

rrival

volu-

robot ecifi-with

640mod4). Othe Fwheerobo

Table

C

T

The trans

Fiof thvalurobopoin

Evolutionary P

480 resolutdule and batteOnce the visiFLC is inferel velocities

ot through the

F

e 4. SpecificatSize

Weight

CPU

Motors

Power

RF

Comm. rate

These procesrobot’s on-b

smitted fromigure 15, 16he proposedes were at fo

ot would havnt, the origin,

Figure 15. T

Programming

tions and theery, with 1.5 on detects thrred to outpu. Then, those RF commu

igure 14. Soty

tion of robot 7

INTEL 80296SA

DC motor 8:1

sses are comboard CPU c

m the host com, and 17 shomethod. In F

our different ve certain ar with facing

The Experimenfour different

g for Mobile R

e robot, equi m/s maximu

he ball and rout the desire

se commandsunication mo

y IV soccer ro

7.5cm × 7.5cm × 6

500 g

A 50MHz 32KB

Gear ratio 180 p

8.4 V

418/433 MH

19200bps

mputed on thecontrols the mputer. ow real expeFigure 15, thpoints and i

rbitrary veloc0 degrees.

ntal result witt initial points

obots

ipped with aum speed (Tobots’ positied left and rs are sent todule.

obot

6.0cm

ROM, 256KB RA

pulse/rev resolutio

z

e host compuspeed of wh

erimental reshe robot’s ints direction.city at its ta

th no obstacles

161

a RF able ons,

right o the

AM

on

uter. heels

sults nitial The

arget

s:

Page 9: Fuzzy L ogic Pat h Plann er and M otion C ontroller by ...minb/pub/Fuzzy_mobile.pdfThe fuzzy motion controller then commands robot wheel velocities to follow this desired path given

162

Wlociwitthatcoucon

FobsTheobscle robrobobs

2

While reachiity was 1.2mh 5cm rotatit the robot

uld reach thentrol. Figure 16 shstacle exists.e obstacle wstacle’s exactwas conside

bot detected bot could reastacle shown

Figure 16. Exthe robot star

ing the targetm/sec robot aion radius at in four kin

e target poin

hows results. First, seve

was in the rot size was alrered as a cylithe obstacle

ach the destiin the Figur

(

(

xperimental rearts at (100,120

(-110,2

t point, roboand its veloct that point. Tds of arbitrnt with the p

of the expeeral assumptobot’s moviready knownindrical shap on its moviination by avre 16 (a), (b).

(a)

(b)

esults with a s0,-10o) (b) the20,180o)

ot’s maximumity was 24cmThis result shary initial pproposed po

eriment wheions were mng path, andn. Also the oe. As a resuling path, anvoiding the

static obstaclee robot starts a

Internationa

m ve-m/sec hows

points osture

en an made. d the

obsta-lt, the

nd the static

: (a) at

Ththe ptrolleAt thveloof ththe tthoseobstaand the r

Fi

A

contsocccontapproppowellredusizedsinglcordsinglprogshowFineblocshou

al Journal of F

he next expeproposed fuzer in the situhis situation,city, 24cm/s

he moving obtrajectory of e trajectoriesacle that is creach the de

robot to avoid

gure 17. Expe

fuzzy logicrol was sugg

cer robot. Shrol problem

roach the balonent team a. Two hierar

uced the numd to generateleton output

dingly. The hleton output

gramming. wed the applie tuning and k is needed

uld be also co

Fuzzy Systems

eriment demozzy logic pauation in wh, the obstaclec, is given. bstacle is depthe robot is

s show, the rocoming towaestination evd the moving

erimental resu

towards the r

6. Conc

controller (gested and ahooting actio

with a consll in such a warea. It shoulrchical sub-b

mber of rulee paths that t for the plaheuristically t values werSimulation icability of thoptimizationin future wo

onsidered for

s, Vol. 11, No.

onstrates the ath planner ahich movingle’s cylindric In Figure 1picted as a d depicted asobot could aard the roboven though ig obstacle.

ult: when the orobot’s path

clusions

(FLC) for mapplied to shon was tacklstraint that tway that the ld avoid neablocks of th

es. The plannconsist of li

anner could obtained mo

ere tuned wiand exper

he proposed n for the obs

work. The mor optimizatio

3, September2

effectivenesand motion c obstacles ex

cal shape and7, the trajec

dotted line, wa solid line

void the movot’s moving pit is difficult

obstacle is mo

obile robot phooting actionled as a posthe robot sho

ball goes toarby obstaclee FLC strucner was synine and arc. be obtained

otion controlith evolutionrimental rescontrol sche

stacle avoidaotion of the on.

2009

ss of con-xist. d its

ctory while

. As ving path t for

ving

path n of

sture ould

o the es as cture nthe-

The ac-ller's nary sults eme. ance ball

Page 10: Fuzzy L ogic Pat h Plann er and M otion C ontroller by ...minb/pub/Fuzzy_mobile.pdfThe fuzzy motion controller then commands robot wheel velocities to follow this desired path given

B. C

EnK

[1]

[2]

[3]

[4]

[5]

[6]

[7]

[8]

[9]

[10

[11

C. Min et al.: F

This work wngineering F

Korea governm

Ching-ChHuang, aHumanoidnational JMarch 200H. -S. ShJ.-H. Kimture for coal-time apAutonomo1997. Y.-J. Kimary PrograFast MobSecond AEvolution Y.-J. Kimary Prografor Fast Min ArtificiaChing-Chand Chi-TGA for Ttional JouMarch 200S. Ishikawbot navigaRobotics, J. S. ChoiMobile Rgent ContElectrical J.-M. Yanfor TrajecMobile Rand AutomNishant Asion GuidSoccer”, BInstitute of

0] Y.-J. Kimary PrograFast MobSecond AEvolution

] Y.-J. Kim

Fuzzy Logic P

7. Acknow

was supporteFoundation (Kment (MEST

7. Ref

ang Wong, and Yu-Tingd Robot for Journal of Fu08. him, H.-S. K

m, “Designingooperative mpplication to ous Systems,

m, D.-H, Kimamming-Bas

bile Robot NAsia-Pacific and Learnin

m, D.-H. Kimamming-Bas

Mobile Roboal Intelligencang Wong,

Tai Cheng, “FTwo-wheeledurnal of Fuz07.

wa, “A methoation by usinVol. 9, NO. , J. S. Joo, “F

Robot with Otrol Class teEngineering

ng and J.-H. ctory TrackinRobots,” IEEmation, Vol. Agrawal, Tamded ReactiveB.S. thesis, D

of Technologym, D.-H, Kim

amming-Basbile Robot NAsia-Pacific and Learnin

m, D.-H. Kim

Path Planner a

wledgment

ed by the KoKOSEF) granT) (R01-2008

ferences

Chi-Tai Chg Yang, “Fu

Obstacle AFuzzy Systems

Kim, M.-J. Jg distributedmulti-agent s

soccer roboV01.21, No

m and J.-H. Ksed Vector FNavigation,”

Conferenceng, Canberram and J.-H. Ksed Uni-Vectot Navigationce, Springer-

Hoi-Yi WaFuzzy Controd Mobile Rzzy Systems

od of autonong fuzzy con1, pp.29-52,FLC for Tra

Obstacle Averm project

g, KAIST, 19Kim, “Slidin

ng of NonholEE Transacti

15, No. 3, Jumhant Jain,”

e Strategies Dept. Electry, Kanpur, In

m and J.-H. Ksed Vector FNavigation,”

Conferenceng, Canberram and J.-H. K

and Motion C

t

rea Science ant funded by8-000-20352

heng, Kai-Huzzy Controvoidance,” Is, Vol. 10, N

Jung, I.-H. Cd control archsystem and itot,” Roboticso. 2, pp. 149

Kim, “EvoluField Metho” Proceedinge on Simu, Dec. 1998.Kim, “Evolutor Field Men,” Lecture N-Verlag, 199ang, Shih-Aoller Designe

Robots,” Inte, Vol. 9, N

omous mobilntro1,” Adva 1995. cking Probleoidance,” Inreport, Dep

996. ng Mode Colonomic Whions on Robun. 1999. ” Real Timefor Micro Rical Eng., Inndia, 2000 Kim, “EvoluField Metho” Proceedinge on Simu, Dec. 1998.Kim, “Evolu

Controller by E

and y the 2-0).

Hsiang ol of Inter-

No. 1,

Choi, hitec-ts re-s and

9-166,

ution-od for gs of

ulated

ution-ethod Notes 9.

An Li ed by erna-

No. 1,

le ro-anced

em of ntelli-pt. of

ontrol heeled botics

e Vi-Robot ndian

ution-od for gs of

ulated

ution-

[12]

[13]

[14]

[15]

telemmem

he isfellowHe wcompsearc

Evolutionary P

ary Programfor Fast Min ArtificialG. SpringerWolfs, “Siin robot sotems, V01.2Proceedingics (Koreabot-soccer AM.-J. Jung,“Fuzzy Rutroller of SFuzzy Sys556-561,19Li-Xin WaRules by Lactions on 6, pp.1414-

matics researchmber.

s currently an w at Universi

was the recipipetition at thech interests are

Programming

mming-Baseobile Robot l Intelligencer, P. Hannahmple strategoccer,” Robo21, No. 2, ppgs of the 1st an), FederatAssociation , H. -S. Kim,le Extraction

Soccer Robotstems Conf999. ang, J. M. MLearning fromSys., Man, a-1427,1992.

Byung-Chgree in EleKyung Hein 2008. Hdegree in neering frocurrent resgent contro

Moon-Suin Informfrom the Seoul, KoElectrical AdvancedTechnolog2000. Sin

h division, ET

Dong-Hanand Ph. Dneering frtute of (KAIST), and 2003with the Dneering at

assistant proty of Illinois ient of the fire FIRA robot e in the area o

g for Mobile R

ed Uni-VectoNavigation,

e, Springer-Vh, R. J. Stongies for collotics and Ap.191-196, 19Workshop o

ation of Int(FIRA), 199, H. -S. Shimn for Shootit,” 1999 IEEference Pr

Mendel, “Gem Examples

and Cybernet

heol Min receectronics Engee University

He is currentlyElectronics

om Kyung Hesearch interes

rol and naviga

Su Lee receivemation & Con

University oorea in 1998 al Engineeringd Institute gy (KAIST), nce then, he

TRI, Korea, as

n Kim receivD. degrees inrom the Korea

Science a, Daejon, Kor3, respectivelDepartment ot Kyung Hee

ofessor. He waat Urbaba-Chrst award of asoccer in 200

of a multi-agen

obots

or Field Met,” Lecture NVerlag, 1999ier, S. Smithlision-avoidautonomous S997. n Soccer Roternational

99. m and J. -H. King Action CEE Internatioroceedings,

enerating Fus,” IEEE Tratics, Vol. 22,

eived his B.S.gineering fromy, Yongin, Koy pursuing his

and Radio Eee University.sts include intation control.

ed his B.S. dentrol Engineeof Kwang Wand M.S. degreg from the Kof Science Deajon, Kore

e has been s a research se

ved his B.S., n Electrical Ea Advanced Iand Technorea, in 1995, 1ly. He has b

of Electrical EUniversity, was a post doct

hampaign in 2a humanoid r02. His currennt robot system

163

thod Notes

. h, P. ance Sys-

obot-Ro-

Kim, Con-onal

pp.

uzzy ans-, No.

. de-m the orea, M.S.

Engi-. His telli-

egree ering

Woon, ee in

Korea and

ea in with

enior

M.S Engi-Insti-ology 1998 been

Engi-where

toral 2003. robot nt re-m.