Mobile Robot Navigation based on Fuzzy Discrete Event Systems Georgios Tampakis ∗ Klaus Schmidt ∗∗ Yiannis Boutalis ∗,∗∗ ∗
Department of Electrical and Computer Engineering, Democritus University of Thrace, Xanthi, Greece. (e-mail:{gtampaki,ybout}@ee.duth.gr) ∗∗ Lehrstuhl f¨ ur Regelungstechnik, Universit¨ at Erlangen-N¨ urnberg, Erlangen, Germany, (e-mail:
[email protected]) Abstract: Recently, several approaches for the control of fuzzy discrete event systems (FDES) have been proposed. First results towards the use of FDES in mobile robot navigation have also been presented, which however mainly build on sensory information processing. In this paper, we develop a methodology to compute control actions for the navigation of a mobile robot based on distributed FDES. The FDES description permits to take into account possible uncertainties in sensory information and enables a prediction of the future behavior of the robot depending on potential control actions. This prediction can then be used to select the most appropriate control action in each time instant. Our approach is tested by simulations of a mobile robot that encounters unknown obstacles on a pre-defined path. Keywords: Fuzzy control, discrete event system, lookahead policy, mobile robot navigation. 1. INTRODUCTION Discrete event systems (DES) are discrete in both time and state space. Also changes in the system state occur asynchronously and driven by events rather than by a clock (Cassandras and Lafortune, 1999). In most of the published research on DES, it is assumed that their states and state transitions are crisp, that is, no uncertainty arises either in the states or in the state transitions. On the contrary, in Fuzzy Discrete Event Systems (FDES), being in a state or moving to another state via state transitions is not certain but determined by a possibility degree. In (Lin and Ying, 2002) the formal framework for crisp DES was extended to FDES by incorporating the fuzzy set theory in a DES framework based on existing work on fuzzy finite automata (Wechler, 1978; Mordeson and Malik, 2002). Considering the control of FDES, different perspectives are taken in the literature. On the one hand, approaches such as (Qiu, 2005; Cao and Ying, 2005; Schmidt and Boutalis, 2008) investigate how the behavior of an FDES represented by a fuzzy language can be restricted in order to fulfill a given specification. On the other hand, an optimal control approach for FDES that employs fuzzy finite automata models is presented in (Lin and Ying, 2002). In this paper, we also develop an optimal control strategy based on a state representation of FDES. DES were first used by Kosecka and Bajcy (1994) as a behavior arbitration technique in mobile robots. The DESbased methods employ sensor information to identify a new state of the robotic system. However, DES may lead to erroneous decision making if the sensor information is imprecise. The vagueness of sensor data can be better represented using fuzzy logic (FL) to describe the possibility degree of being in each state and to transition between
the states (Barbera and Skarmeta, 2002). Hence, FDES facilitate the integration of DES and FL for implementing a control scheme under uncertain conditions. FDES have been recently used in (Huq et al., 2006b,a) for robotic sensor information processing and robotic behavior modulation. To cope with multiple sensor data, distributed FDES with fuzzy states and fuzzy events are defined and the possibility of occurrence of an event varies according to the imprecision and uncertainty in the sensor data. However, the proposed behavior modulation and the selected control actions do not arise directly from an underlying FDES and its specifications but it rather emerges after a heuristic exploitation of the information gained from the distributed FDES. That is why the approach requires an additional post-decision evaluation. In this paper, a new scheme for mobile robot navigation based on FDES is introduced. The proposed formulation clearly separates the sensor evaluation and the computation of control actions. In the first step, distributed subsystem models are employed to process uncertain sensor information. Then, a further set of FDES models allows the prediction of the future system state when applying pre-defined control actions. In the last step, these FDES models are evaluated in each sampling instant of the system evolution in order to apply the best instantaneous control action. The proposed approach is verified by simulations of a mobile robot, which has to follow a specified path in an environment with unspecified obstacles. The paper is organized as follows. After providing basic notation in Section 2, we present the sensor evaluation and the state prediction for FDES in Section 3 and 4, respectively. The computation of optimal control actions is elaborated in Section 5 in conjunction with a mobile robot example. Conclusions are given in Section 6.
2. PRELIMINARIES 2.1 Fuzzy Sets Each fuzzy set A is defined in terms of a universal set X by a membership function assigning to each element x ∈ X a value A(x) in the interval [0, 1]. We denote by F (X) the set of all fuzzy subsets of X. For any A, B ∈ F (X), we say that A is contained in B, denoted by A ⊆ B, if A(x) ≤ B(x) for all x ∈ X. We say that A = B if and only if A ⊆ B and B ⊆ A. A fuzzy set is empty, denoted by O, if its membership function is identically zero on X. 2.2 Formalism for Fuzzy Discrete Event Systems This section introduces fuzzy finite automata as a formal model of FDES in the formalism of (Lin and Ying, 2002). Let the crisp state set P of a DES consist of the states P = {p1 , p2 , . . . , pn }. Then each fuzzy state in the setting of FDES can be written as a vector q = [q1 , q2 , . . . , qn ], where qi ∈ [0, 1]. This way, each fuzzy state can be considered as a possibility distribution or alternatively as a fuzzy set q ⊆ F (P) determining the degree qi by which the system participates in each crisp state pi , provided it is in the current fuzzy state. Similarly, a fuzzy event σ is characterized by a matrix [aij ]nxn , in which every element aij ∈ [0, 1] indicates the possibility of a transition in the FDES from the current state pi to the new state pj when the event σ occurs. Using the above notation, the successor fuzzy state can be evaluated using the max-min operation ⊙ (Qiu, 2005; Schmidt and Boutalis, 2008) such that n n q ⊙ σ = max min{ql , al1 }, · · · , max min{ql , aln } . (1) l=1
l=1
We use a generalized version of the formalism in (Huq et al., 2006a) to describe the behavior of a distributed FDES which is applicable to the sensing problem addressed in Section 3 and the control problem in Section 5. Each FDES models the occurrence of an event σ starting from an initial fuzzy state qσ by a tuple Fσ = (Qσ , Φσ , qσ ) with the set of crisp states Qσ , with the dimension |Qσ | = n. Accounting for the distributed nature of the FDES, the event σ is associated with the fuzzy event set Φσ in the sense that all events in Φσ contribute to the occurrence of σ: given the inital fuzzy state qσ ⊆ F (Qσ ), the successor fuzzy state qˆσ after the occurrence of σ evaluates to qˆσ := max [qσ ⊙ f ], (2) f ∈Φσ
where max takes the component-wise maximum of the respective successor state vectors. We write qˆσ = qσ ⊗ σ. Example 1. We study the FDES Fσ = (Qσ , Φσ , qσ ) with three crisp states (Qσ = {q1 , q2 , q3 }), Φσ = {f1σ , f2σ }, qσ = [0.3 0.8 0.4] and the fuzzy event matrices # # " 0 0.4 0 0 0.2 0.7 f2σ = 0.6 0 0.9 f1σ = 0 0.8 0 , 0 0.8 0 0.4 0 0.8 Then, the evaluation of qσ ⊗ σ yields qˆσ = qσ ⊗ σ= max([0.4 0.8 0.4], [0.6 0.4 0.8]) = [0.5 0.6 0.6]. "
Finally, we introduce the fuzzy state product for two fuzzy states q, p with the dimension n as
q ⊘ p := min{q1 , p1 } · · · min{q1 , pn } min{q2 , p1 } min{qn , p1 } · · · min{qn , pn } . Hence, q ⊘ p describes the fuzzy state corresponding to the product state space of the crisp states of q and p. Example 2. For example, let q = [0.5 0.6 0.6] and p = [0.6 0.4 0.4]. Then, q⊘p = min{0.5, 0.6} · · · min{0.5, 0.4} · · · min{0.6, 0.4} = 0.5 0.4 0.4 0.6 0.4 0.4 0.6 0.4 0.4 . 3. SENSOR INFORMATION PROCESSING USING DISTRIBUTED FDES
3.1 Approaches for Sensor Data Evaluation There exist three broad categories of intelligent multiple sensor data processing for robotic control: centralized, behavior-based, and hybrid strategies (Rosenblatt and Handler, 1999). It is discussed in the literature that the latter seems to be the most appropriate because it alleviates the drawbacks of the first two, namely the significant delays introduced by the centralized processing and the conflicting sequences of actions triggered by different sensor data associated with independent behaviors. Fuzzy logic (FL)-based approaches (Pirjanian and Mataric, 1999; P. Vadakkepat and Lee, 2004), are able to cope with uncertainties in sensory data and environment dynamics, but they suffer from the drawback of forming a large rule-base for complex behavior-based systems. Moreover, existing FL-based techniques do not provide a clearly structured framework for intelligent robotic control and lack the capability of system analysis. To cope with this situation (Huq et al., 2006a,b) propose a distributed FDES approach for the processing of multiple robotic sensor data. However, their approach depends on a heuristic weighting mechanism for control actions. In our approach, robot navigation is based entirely on a DES framework and comprises two components. In the first component the multiple sensory information is used by distributed FDES, which determine the current state of the robot in respect to the pre-specified goals. The current state is then the initial information of the second FDES based component, which determines the control actions. In this section the first component is described, interweaved with a simple navigation example. 3.2 FDES Framework for Sensor Information Processing In our framework, sensor data are evaluated with respect to several goals that have to be achieved by control. We consider the case, where for each element of the set of goals G = {1, . . . , p}, multiple measurements have to be evaluated. To this end, we introduce a set of measurements Σg and FDES models Sg,σ that characterize the sensor evaluation for the measurement σ ∈ Σg w.r.t. the goal g ∈ G. Then, we perform the computation of the fuzzy state qg in each sampling period w.r.t. to the objective g ∈ G as qg := ⊘σ∈Σg (qσ ⊗ σ) = ⊘σ∈Σg qˆσ . In this computation, the fuzzy state product allows the combination of multiple independent measurements to an overall characterization of the current system state w.r.t. to each objective g ∈ G. Using this approach, the main effort of the system designer is to determine the fuzzy event matrices related to the measurements based on the available sensor data.
3.3 FDES Modeling for a Mobile Robot We now illustrate the formal framework by a mobile robot example. We consider a mobile robot that moves in a known environment and tries to reach a pre-specified target, where the path to be followed is determined using a path planning technique (details will be given in Section 5). Furthermore, the environment can change dynamically, in the sense that obstacles may be unexpectedly encountered. Therefore, there are two goals for the robot: it has to follow a given path in order to reach the target (goal 1), while avoiding any encountered obstacle (goal 2). Figure 1 describes this situation, where bold dots denote path vertices (i.e., subgoals of the robot). Walls or other objects can be considered as obstacles. Based on sensor data, the distance dS to the nearest subgoal, the angle aS between the heading direction of the robot and the direction pointing to the next subgoal, the distance dO to the nearest obstacle, and the angle aO between the moving direction of the robot and the direction of the line connecting the center of the robot with the obstacle can be determined. Regarding goal 1, the two first values (dS ,aS ) characterize the state of the robot. Similarly, dO and aO represent the state of the robot in respect to goal 2. Subgoal aS Obstacle aO
dS
dO Fig. 1. Mobile robot with subgoals and obstacle. In order to conform with the simulation example in Section 5.2, we measure distance values in numbers of pixels in an image area of 200 × 400 pixels. With an area of 20mm × 20mm per pixel, each image represents an area of 4m × 8m. The angle measurement is performed in degrees. According to Section 3.2, we now develop separate FDES models that capture the sensor evaluation for dS , aS , dO and aO , and then compose the models to obtain a fuzzy state evaluation of the global position of the robot. Path Following (Goal 1) We associate the events δS and αS to the measurement of dS and aS , respectively. Hence, Σ1 = {δS , αS }. The FDES models are S1,δS and S2,αS . For S1,δS , we choose 3 crisp states (state set Q1,δS ) to characterize the distance ds as shown in Fig. 2 (a), where state 1 corresponds to a high value, state 2 corresponds to a medium value and state 3 corresponds to a low value of dS . In our scenario, these measurements carry a degree of uncertainty because they are extracted from a combination of data coming form probably inaccurate sensors located in different positions of the robot. Therefore, a fuzzy linguistic representation of their values is more appropriate. We associate the event δS with three fuzzy events such that l h m l Φ1,δS = {fh1,δS , fm 1,δS , f1,δS }. Here, f1,δS , f1,δS , f1,δS denote “high”, “medium”, “low” values of the respective variable.
Each fuzzy event is represented by a 3 × 3 fuzzy event matrix determining the state transitions triggered by this event. In order to determine the entries of these matrices, we follow an approach that is similar to (Huq et al., 2006a). Considering our choice of the crisp states in Fig. 2, we introduce state transitions that indicate the effect l of each event in ΦΣS = {fh1,δS , fm 1,δS , f1,δS }. Suppose the previous state of the robot was 2 (“medium” distance to the subgoal). Then, a new distance measurement, i.e., the occurrence of δS , causes the three different fuzzy events l h fh1,δS , fm 1,δS , f1,δS . The event f1,δS will make the system go m to state 1 (high distance), f1,δS will lead to 2, and fl1,δS will make the system go to 3 (low distance). The same rationale may be applied to all three states of the automaton, where state transitions triggered by each fuzzy event are denoted by arrows. In our setting, the entry in the i-th row and the j-th column of the fuzzy event matrix of each fuzzy event is nonzero if there is a transition from state j to state i with the respective fuzzy event. In addition, we assume that all nonzero entries for each particular fuzzy event are equal (values gdhS , gdmS , gdl S ). Having in mind the automaton l of Fig. 2, fhµd , fm µdS and fµdS are given by S # # " # " " h h fh µd = S
g dS g dS 0 0 0 gdhS 0 0 0
0 0 0 m m m , fm µd = gdS gdS gdS S 0 0 0
0 0 0 l 0 , flµd = gdS 0 S 0 gdl S gdl S
Finally, the concrete values of gdhS , gdmS and gdl S are determined using the membership function in Fig. 3 (a). That is, “low” distances are found when measuring less than 5.4 pixels, “medium” distances correspond to between 3.5 and 7.1 pixels, and high distances are found for more than 5.4 pixels. It has to be noted that it is the task of the system designer to define appropriate membership functions based on the particular system characteristics. Together, the distance measurement is modeled by the FDES S1,δS = (Q1,δS , Φ1,δS , q1,δS ). In our experiments, an initial state of q1,δS = [0.1 0.8 0.1] proved to be suitable. Similarly, the model S1,αS = (Q1,αS , Φ1,αS , q1,αS ) is constructed for the measurement of aS . Here, the fuzzy events l in Φ1,αS = {fh1,αS , fm 1,αS , f1,αS } are evaluated based on the automaton in Fig. 2 (b) and the membership function in Fig. 3 (b). q1,αS = [0.1 0.8 0.1] is the initial state. fhµd
l fm µdSfµd
S
1
fhµd
fm µd S
2 flµd
S
flµd fhµd
(a) l fm µd fµd
O
O
1
fhµd
fm µd
flµd
O
3
fhµa
flµa
S
O
fm µdO fhµd
1
fhµa
O
S
fm µa
O
2 flµa
O
flµa O (d)
fhµa S fm µa
3
O
O
O
2
flµa S (b) flµa fm µaO
fhµa
O
S
S
S
3
S
2 O
1
fm µdS fhµd
fm µa
flµa fm µaS
S
S
O
flµd (c)
S
fhµa
S
fhµa O fm µa
O
3
Fig. 2. Automata models for path following. In each sampling instant, the overall path following objective is then described by the fuzzy state product of the fuzzy states for the distributed FDES S1,αS and S1,δS .
1
Grade
0.5 0
10
2.5
gdl O
gdmO
gdhO
30 10 20 40 dO (in pixels) (c)
Grade
0.5 gal S
gdhS
7.5 5 dS (in pixels) (a) Grade
0 1
gdmS
gdl S
0.5
1
gamS
gahS
0 20 40 60 80 100 120 aS (in degrees) (b) Grade 1 l gaO gal O gahO m m 0.5 gaO gaO 0
75 105 255 285 aO (in degrees) (d)
Semantically, first, the successor states qˆ1,δS = q1,δS ⊗ δS and qˆ1,αS = q1,αS ⊗ αS are evaluated, where the corresponding fuzzy event matrices are computed depending on the current values of dS and aS . Then, the fuzzy state product qˆ1,δS ⊘ qˆ1,αS is taken, to determine the combined fuzzy state of the goal 1.
Together, the distributed FDES S2,δO and S2,αO describe the sensor data evaluation for obstacle avoidance (goal 2). In each sample instant, the successor states qˆ2,δO and qˆ2,αO of the initial fuzzy states q2,δO and q2,αO are evaluated, where the fuzzy event matrices are computed depending on the current values of dO and aO . Then, the computation of the fuzzy state product qˆ2,δO ⊘ qˆ2,αO yields the combined fuzzy state for goal 2. In our experiments, we used the initial states q2,δO = [0.1 0.8 0.1] and q2,αO = [0.1 0.8 0.1]. 4. STATE PREDICTION FOR FDES We now introduce our strategy for the prediction of the future fuzzy state by modeling control actions as FDES. 4.1 FDES Framework for State Prediction Our framework is based on the same set of goals G as in Section 3.2. We define a global set of control actions Γ, where the predicted behavior for each goal g ∈ G when applying a control action γ ∈ Γ is modeled by an FDES Cg,γ . Furthermore, we introduce the set of control action combinations A ⊆ 2Γ such that each a ∈ A denotes a potential set of control actions to be applied in each sampling instant. The initial fuzzy state qg,γ of Cg,γ is chosen as qg,γ = qg according to the sensor data evaluation
We now apply this strategy to our mobile robot example. n r1b s1
l1n r1b r1g l1g 1 r1 sn l1b ln 1 rn b sb 2 rn b b 3 n 1 l 1 1 1 l 1 s1 1 g l1 1 g l1 r1g r1n r1g s g 1 r1 sb1 sg1 r1b l1g l1g b g g b l1 g g l n sn r1 r1 l1 r1b r1 l1 1 1 sn1 l1n 6 4 5 n b n b b b sg1 ln r n r s l s l 1 1 1 1 s1 1 1 1 sb1 r1g g r1g g l1g n l r1 sg1 l1 r1g sg1 1 b l g g g g r1 l1 r1b r1g r1 l1 r1b 1 sn1 7 8 9 sn1 g n g s l1n sg r1n l1b sb1 r1n l1b sb1 l1 l1 1 1 b r1 l1n sn1 (a) angle b n s1 r
r1g
l1g
l dm 1 d1 h cl1 , d1 dm h md1 1 ah1 am a1 a1 1 dh1 c1 1 3 2 m m dl c1 a1 ch1 c1 cl1 1 h l m a c1 a1 a1 1 ah1 cm 1 , h cm 1 c d am ch1 1 1 1 cm 1 l l c1 ah1 am 1 c1 dl1 dm ah1 am 1 1 al1 6 4 ch cm 5 cl1 ch1 cm 1 1 1 l d1 a1 al1 am ah1 am dh ah1 1 ah1 h 1 1 am 1 d1 ch1 m cm l 1 c a1 1 ah1 am 1 ch1 cm dh1 1 cl1 7 8 9 h am m h a1 1 dm c c1 l cl 1 dm m 1 a 1 1 1 c d1 1 cl1 (b)
distance
Obstacle Avoidance (Goal 2) Analogous to the previous section, we determine 2 FDES models S2,δO and S2,αO with 3 crisp states each to characterize the distance dO and the angle aO as illustrated in Fig. 2 (c) and (d). We model the distance and angle measurement by the events δO and αO and the associated fuzzy events in Φ2,δO = l m l h {fh2,δO , fm 2,δO , f2,δO } and Φ2,αO = {f2,αO , f2,αO , f2,αO }. The fuzzy event matrices can again be constructed combining the information in Fig. 2 (c) and (d) and Fig. 3 (c) and (d). Note that the angle measurement of αO identifies angles smaller than 90◦ and larger than 270◦ as “low” (w.r.t. the goal of obstacle avoidance), angles around 90◦ and 270◦ as “medium” and the remaining angles as “high”.
4.2 Control Actions for the Mobile Robot
distance
Fig. 3. Membership functions for goal 1 and goal 2.
in Section 3.2. We then characterize the predicted fuzzy state after the control action a ∈ Γ for the goal g ∈ G by qˆg,a = maxγ∈a qg ⊗ γ. Again, the task of the system designer is to find fuzzy event matrices that capture the future behavior for each control action.
Fig. 4. State prediction for path following. Path Following Objective (Goal 1) We introduce the events γa , γc and γd to model acceleration (+3% of the maximum speed), constant speed, and deceleration (−3%) of the mobile robot. In addition, the events γr (5◦ to the right), γs (straight) and γl (5◦ to the left) describe the angular movement of the robot such that Γ = {γa , γc , γd , γr , γs , γl }. For each of the events, we define an FDES that captures the expected behavior when applying the corresponding control action. For example, the event γr is modeled by C1,γr with 9 crisp states that describe the expected angle and distance measure of the path following objective as depicted in Fig. 4 (a). Furthermore, we associate the three fuzzy events in Φ1,γr = {r1g , r1n , r1b } with γr . Here, r1g , r1n and r1b model a “good”, “neutral”
and “bad” effect of turning to the right. The fuzzy event matrices for the fuzzy events in Φ1,γr are constructed according to the respective state transitions in Fig. 4 (a).
event γa γc γd γr γs γl
fuzzy events m l {ah 1 , a1 , a1 } m , cl } {ch , c 1 1 1 m l {dh 1 , d1 , d1 } g n b {r1 , r1 , r1 } b {sg1 , sn 1 , s1 } {l1g , l1n , l1b }
r2b1
explanation acceleration is “high”, “medium”, “low” const. speed is “high”, “medium”, “low” deceleration is “high”, “medium”, “low” turn right is “good”, “neutral”, “bad” go straight is “good”, “neutral”, “bad” turn left is “good”, “neutral”, “bad”
grb
grn
1 grg
gsg
1
gab
5 0
25 50 75 speed [%]
gag
gsb
100 0
gcb
25 50 75 speed [%]
glb
gcg
5
100 0
gdb
gdn
25 50 75 speed [%]
d2
4
c2 d2 a2 7 d2
Grade
d2
c2 d2
a2
-15-10 -5 0 5 10 15 aS (in degrees) 1
gcn
c2
a2
1
d2
Grade
5
gln
c2
a2
1
glg
(a) 1
gan
gsn
3 2 r2b1 l2b2 rg1 g1 r2g1 l2g2 2 s2 r2b2 sb3 2 r2g2 l2g2 sb2 sb2 2 b1 2 b1 g1 l 2 s2 l2 sb1 sg2 2 2 rb2 l b1 r2g2 l2g1 sb3 2 2 2 4 6 5 r2b1 l2b2 g1 g1 r2g1 l2g2 2 r2 sb2 r2b2 sb1 2 r2b1 g2 s 2 l b3 l b1 2 g2 s 2 sb2 2 2 s2 b2 b1 sb1 r2g2 l2g1 r2 l2 2 7 8 9 b2 g2 r2b1 l2 g2 sb3 r2g1 l2 sb3 2 r2 2 b1 g1 s2 l 2 (a) angle
d2
Grade
0 5 10 15 20 25 aS (in degrees)
-15-10 -5 0 5 10 15 aS (in degrees) Grade
Grade
d2
d2 d2
6
a2 c2 d c2 2
a2 d2 a2 c2
d2 c2
8
d2 c2
a2
9
d2 c2 a2
(b) Fig. 6. State prediction for obstacle avoidance.
(b)
Grade
1
c2
a2
Fig. 5. Membership functions for speed and turning actions related to goal 1. Obstacle Avoidance Objective (Goal 2) In order to model the control actions in Γ w.r.t. to goal 2, we use the FDES models C2,γr , C2,γl , C2,γs , C2,γa , C2,γd and C2,γc with 9 crisp states each. The construction of the fuzzy event matrices for the respective events in Γ is performed according the automata representation in Fig. 6 (a) for the turning actions and in Fig. 6 (b) for the speed actions.
c2 3
2
5
gdg 100
r2b2 l2b1
distance
1
r2g2 l2g1
c2
Table 1. Path following: fuzzy events.
Grade
l2g1 l2g2 g1 s2 r2
distance
Analogous FDES models C1,γl , C1,γs , C1,γa , C1,γd and C1,γc are constructed for the remaining control actions. The corresponding fuzzy events are listed in Table 1. Finally, the non-zero entries of the fuzzy event matrices are determined by the membership functions for the angle changes in Fig. 5 (a) and for the speed actions in Fig. 5 (b). Here, the current speed of the robot is measured as a percentage of its maximum speed.
b2 sb2 l2 b1 2 r2 1
0 Grade
25 50 75 speed [%] Grade
1
d2
100
(a)
Grade
1 l2b1
l2g1
l2b2
l2g2
90 165 195 270 360 aO (in degrees)
1 r2g1
r2b1
r2g2
r2b2
90 165 195 270 360 aO (in degrees)
sg1 2
sb1 2
sb2 2
sg2 2
sb3 2
75 105 255 285 aO (in degrees)
Control Action Combinations Finally, we define the set (b) of feasible control actions as A = {{γa , γr }, {γa , γs }, {γa , γl }, {γc , γr }, {γc , γs }, {γc , γl }, {γd , γr }, {γd , γs }, {γd , γl }}, i.e. Fig. 7. Membership functions for speed and turning actions related to goal 2. we propose to combine a turning action with a speed action in each sampling instant. Hence, for each combination of control actions a = {γ, γ ′} ∈ A and each subgoal g ∈ G, 5.1 Control Problem we arrive at the predicted fuzzy state qg,a = max{qg ⊗ γ, qg ⊗ γ ′ } as outlined in Section 4.1. We formulate an optimal control problem. A similar control problem is investigated in (Lin and Ying, 2002). In our setting, we define a weight vector wg ∈ Rn for each 5. CONTROL APPROACH FOR FDES goal such that qˆg,a wg characterizes the benefit of the This section elaborates our control method. It is based control action combination a for the goal g. Accordingly, for each a ∈ A is described by the on the state prediction in the previous section that is our control objective P computed in each sample instant of the system evolution. function Ja = g∈G qˆg,a wg . Hence, we want to solve X This prediction is then employed to determine an optimal max Ja = max qˆg,a wg . (3) control strategy to be applied in the subsequent sampling a∈A a∈A g∈G period.
6. CONCLUSIONS
5.2 Mobile Robot Example We now apply the optimization described in the previous section to the mobile robot scenario in Fig. 8 (a). The robot has to move in a ’corridor’ starting from an initial position (0, 50), given in pixels, in order to reach its goal (small circle at (325, 0)). On its route, it has to go around the unknown obstacles located at (60, 140), (70, 120), (150, 160), (150, 180), (60, 325). The path that has to be followed is marked by crosses. They are determined by using a well-established procedure ((Murphy, 2000)) to construct a Voronoi diagram and then apply A∗ search to extract the safe path between the initial position of the robot and the target (obstacles are not taken into account). With a sampling period of 10 milliseconds, the maximum speed of the robot is 100 pixels/second, which corresponds to about 7.5 km/h. 0
50 100 150 200 250 300 350 0
50 100 150 200 250 300 350
Obstacle
50 100
Path
150 200
(a) 0
50 100 150 200 250 300 350 0
(b) 50 100 150 200 250 300 350
50 100 150 200
(c)
(d)
Fig. 8. (a) Scenario; (b) path following experiment; (c) obstacle avoidance; (d) combined experiment. Path Following We first implement path following (goal 1) without any obstacles. We identify the crisp states that correspond to small dS and small aS (5, 6, 8, 9 in Fig. 4) as the most desirable states for goal 1. Hence, we choose w1 = [0.01 0.2 1.6 0.05 0.4 3.2 0.1 0.8 6.4]. The application of the optimal control action according to Section 5.1 in each time instant results in the trajectory shown in Fig. 8 (b) that exactly follows the desired path. Obstacle Avoidance In the second experiment, we implement goal 2, which is best achieved by a large distance dO and a medium angle aO (states 1, 2, 5 in Fig. 6). This is captured by w2 = [1.6 6.4 0.8 0.4 3.2 0.2 0.1 2.0 0.01]. The result of our experiment is illustrated in Fig. 8 (c), where the robot always tries to move perpendicular to the direction pointing towards the obstacle. Combination of Path Following and Obstacle Avoidance Finally, we study the joint implementation of goal 1 and goal 2 with the weight vectors from above. As can be seen in Fig. 8 (d), the robot follows the given path as long as no obstacles are encountered. Moreover, each obstacle is surrounded, whereas the robot returns to the desired path as soon as there is no more obstacle in its vicinity. It also has to be mentioned that the computational effort is small, since the evaluation of the optimal control strategy only involves the enumeration of the limited number of control action combinations in the set A.
This paper presents a multi-objective framework for the control of systems that can be modeled as distributed fuzzy discrete event systems (FDES). First, in each sampling instant, a fuzzy representation of the current system state is obtained from potentially uncertain measurement data based on FDES models. This system state is then used to predict the future system state after pre-defined control actions, where again FDES are employed to model the predicted system behavior. Finally, the state predictions are used to find an optimal control strategy for the subsequent sampling instant. This feature is illustrated by simulation experiments with a mobile robot that has to both follow a given path and avoid unknown obstacles that can be encountered on the path. REFERENCES Barbera, H.M. and Skarmeta, A.G. (2002). A framework for defining and learning fuzzy behaviors for autonomous mobile robots. Int. J. Intell. Syst., 17, 1–20. Cao, Y. and Ying, M. (2005). Supervisory control of fuzzy discrete event systems. IEEE Transactions on Systems, Man and Cybernetics, Part B, 35(2), 366–371. Cassandras, C.G. and Lafortune, S. (1999). Introduction to discrete event systems. Kluwer. Huq, R., Mann, G.K.I., and Gosine, R.G. (2006a). Behavior modulation technique in mobile robotics using fuzzy discrete event system. IEEE Transanctions on Robotics, 22(5), 903–916. Huq, R., Mann, G.K.I., and Gosine, R.G. (2006b). Distributed fuzzy discrete event system for robotic sensory information processing. Expert Systems, 23(5), 273–289. Kosecka, J. and Bajcy, R. (1994). Discrete event systems for autonomous mobile agents. Robotics and Autonomous Systems, 12, 187–198. Lin, F. and Ying, H. (2002). Modeling and control of fuzzy discrete event systems. IEEE Transactions on Systems, Man and Cybernetics, Part B, 32(4), 408–415. Mordeson, J.N. and Malik, D.S. (2002). Fuzzy Automata and Languages: Theory and Applications. Chapman & Hall, CRC, London, Boca Raton, FL. Murphy, R. (2000). Introduction to AI Robotics. MA: MIT Press, Cambridge. P. Vadakkepat, O.C. Miin, X.P. and Lee, T. (2004). Fuzzy behavior-based control of mobile robots. IEEE Transactions on Fuzzy Systems, 12(4), 559–565. Pirjanian, P. and Mataric, M. (1999). A decision theoretic approach to fuzzy behavior coordination. In Proceedings of the IEEE International Symposium on Computational Intelligence in Robotics and Automation. Qiu, D. (2005). Supervisory control of fuzzy discrete event systems: A formal approach. IEEE Transactions on Systems, Man and Cybernetics, Part B, 35(1), 72–88. Rosenblatt, J. and Handler, J. (1999). Architectures for mobile robot control. Advances in Computers, 48, 315– 353. Schmidt, K. and Boutalis, Y. (2008). Computation of supremal controllable sublanguages and infimal controllable superlanguages for fuzzy discrete event systems. Control and Automation, Mediterranean Conference on. Wechler, W. (1978). The Concept of Fuzziness in Automata and Language Theory. Akademie-Verlag, Berlin.