A Hybrid Control Approach To Action Coordination For Mobile Robots
A Hybrid Control Approach To Action Coordination For Mobile Robots
2
3
4
5
6 Automatica 38 (2002) 125}130
7
8 Brief Paper
9
10 A hybrid control approach to action coordination for mobile robots夽
11
12 Magnus Egerstedt , Xiaoming Hu*
13
14 Division of Engineering and Applied Science, Harvard University, Cambridge, MA 02138, USA
Division of Optimization and Systems Theory, Royal Institute of Technology, SE-100 44 Stockholm, Sweden
15
16 Received 12 October 1998; revised 28 May 2001; received in "nal form 19 June 2001
17
18 Abstract
19
20 In this paper, the problem concerning how to coordinate the contributions from concurrent controllers, when controlling mobile
21 robots, is investigated. It is shown how a behavior based control system for autonomous robots can be modeled as a hybrid
22 automaton, where each node corresponds to a distinct robot behavior. This type of construction gives rise to chattering executions,
23 but it is shown how regularized automata can be used to solve this problem. As an illustration, the obstacle-negotiation problem is
24 solved by using a combination of a robust path-following behavior and a reactive obstacle-avoidance behavior that move the robot
25 around a given obstacle at a prede"ned safety distance. 2001 Published by Elsevier Science Ltd.
26
Keywords: Mobile robots; Hybrid dynamic systems; Motion control; Path planning
27
28
29
30 1. Introduction However, within this framework, a number of design 59
31 issues need to be addressed. Those range from questions 60
32 For mobile, autonomous robots the ability to function concerning the design of the individual behaviors to 61
33 in, and interact with, a dynamic, changing environment coordination issues. For instance, given a reactive ob- 62
34 is of key importance. A successful way of structuring stacle-avoidance behavior, modeled as a repulsive 63
35 the control system in order to deal with this problem potential "eld surrounding the obstacle, how should an 64
36 is within a behavior based control architecture. (See approach-target behavior be designed so that it takes 65
37 for example, Arkin, 1998; Kortenkamp, Bonasso, advantage of the fact that it is going to run in parallel 66
38 & Murphy, 1998). The main idea is to identify di!erent with an obstacle-avoidance behavior? Furthermore, how 67
39 controllers, responses to sensory inputs, with desired should these behaviors be combined? Addressing this last 68
40 robot behaviors. A behavior could, for instance, be question will be the main point of this paper. In other 69
41 obstacle-avoidance in which sonar information about words, via a case study where the robot is negotiating 70
42 a close obstacle should result in a movement away from obstacles, we will try to answer the question: How should 71
43 that obstacle. This way of structuring the control system the diwerent behaviors be combined so that the resulting 72
44 into separate behaviors, dedicated to performing certain robot response is satisfactory from both a safety and a 73
45 tasks has the major advantage that it makes the system performance perspective? 74
46 modular, which both simpli"es the design process as well 75
47 as o!ers a possibility to add new behaviors to the system 76
48 without causing any major increase in complexity, as 77
49 pointed out in Brooks (1986). 2. Path following and obstacle negotiation 78
50 79
51 夽
This paper was not presented at any IFAC meeting. This paper was
The speci"c problem that will be used to illustrate our 80
52 recommended for publication in revised form by Associate Editor Jurek point about action coordination is how to move a robot 81
53 Z. Sasiadek under the direction of Editor Mituhiko Araki. This work between two points in the plane. This point-to-point 82
54 was sponsored in part by the Swedish Foundation for Strategic motion should be done so that the detection of an ob- 83
55 Research through its Centre for Autonomous Systems at KTH and in stacle results in a repulsive potential "eld, acting on the 84
part by TFR.
56 * Corresponding author.
platform when the robot is closer to the obstacle than 85
57 a desired safety distance, d , where the subscript stands 86
E-mail addresses: [email protected] (M. Egerstedt), -
58 [email protected] (X. Hu). for obstacle-avoidance. This behavior is an example of 87
88
0005-1098/02/$ - see front matter 2001 Published by Elsevier Science Ltd. 89
PII: S 0 0 0 5 - 1 0 9 8 ( 0 1 ) 0 0 1 8 5 - 6 90
91
126 M. Egerstedt, X. Hu / Automatica 38 (2002) 125}130
1 57
2 58
3 59
4 60
5 61
6 62
7 Fig. 2. Goal attraction together with obstacle-avoidance results in 63
8 a Filippov type Zeno automaton. The grey region around the obstacle 64
9 is the region where obstacle-avoidance is active. The arrows correspond 65
10 to the di!erent vector "elds that are acting on the robot. 66
11 67
12 68
13 possibility of the so-called Zeno phenomena in the sys- 69
14 tem. What this corresponds to is a hybrid system that 70
15 exhibits an in"nite number of discrete transitions in "nite 71
16 time (Johansson, Egerstedt, Lygeros, & Sastry, 1999). 72
17 For the type of automata that we encounter here, the 73
18 in"nite number of discrete transitions, made in "nite 74
19 time, is caused by the fact that the underlying system that Fig. 3. Simulation of (a) concurrently active behaviors, (b) hard 75
switches, and (c) a regularized automaton on the Nomadic simulator,
20 the automaton tries to model is a switched system that the Nserver.
76
21 exhibits sliding in the sense of Filippov (1988). They thus 77
22 form a special class of Zeno hybrid automata since they, 78
23 theoretically, make an in"nite number of transitions in 79
24 zero time. Such sliding modes arise when the systems where 3[0,1] is chosen so that f is orthogonal to 80
1
25 have continuous #ows that point toward the switching f . Adding this type of information about the 81
-
26 surface, resulting in a new, induced #ow on that surface. di!erent behaviors makes it possible to generate the extra 82
27 In these cases, the automaton can be regularized by the node in the automaton automatically. It furthermore 83
28 introduction of a new node with the continuous #ow suggests that our method would scale when more than 84
29 given by the Filippov solution (Malmborg, 1998). two behaviors a!ect the motion of the robot, as 85
30 If we now assume that C in (2) is large enough so long as an automatic procedure for designing the sliding 86
-
31 that the heading of the robot can be considered to be solutions could be identi"ed for the new behaviors as 87
32 more or less instantaneously driven to its desired con"g- well. 88
33 uration, the hybrid automaton in Fig. 1(b) can admit The assumption about instantaneous heading control 89
34 Zeno executions. This obvious fact is best illustrated by is obviously a simpli"cation but it still gives a model that 90
35 Fig. 2, where the extra node that needs to be added in is rich enough to capture the, from our point of view, 91
36 order to regularize the automaton can easily be identi"ed relevant phenomena. In fact, in real life we have a possi- 92
37 as well. This extra node is just a node containing the bility of chattering that here reveals itself as a Zeno 93
38 sliding dynamics that is de"ned on the boundary between execution. 94
39 the two behaviors. The regularized point-to-point automaton was imple- 95
40 When an obstacle is closer to the robot than d , the mented and tested on the Nomadic 200 mobile robot. 96
-
41 obstacle-avoidance behavior becomes active. Since the In Fig. 3, the results from running the system on 97
42 repulsive potential "eld from that behavior is orthogonal the Nserver, the Nomadic simulation package, 98
43 to the surface on which the behavior becomes active, the can be seen. In Fig. 3(a), concurrently active behav- 99
44 sliding solution is just iors are displayed, resulting in a smooth movement 100
45 around the obstacles, while the chattering solution 101
46 f "f #(1!) f , (3) in Fig. 3(b) corresponds to hard switches. The reason 102
1 - %
47 why we do not have sliding in this case is due to the 103
48 part of the dynamics of the robot that was ignored 104
49 The name Zeno refers to the philosopher Zeno of Elea (500}400
in the analysis. It is still clear that from a perfor- 105
50 BC), whose major work consisted of a number of famous paradoxes. mance perspective, Fig. 3(b) is an unsuccessful 106
51 They were designed to explain his view that the ideas of motion and design. In Fig. 3(c) the result from using a regularized 107
52 evolving time lead to contradictions. An example is Zeno's Second hybrid automaton can be seen, and even though we only 108
53 Paradox of Motion, in which Achilles is racing against a tortoise. 109
The other class of Zeno automata has a slightly more complex
54 dynamics. Here the automaton changes nodes faster and faster, with the
110
55 jump times converging to a "nite, so-called Zeno time (Johansson et al., This typically depends on whether we have access to a geometric 111
56 1999). description of the switching surface or not.
128 M. Egerstedt, X. Hu / Automatica 38 (2002) 125}130
28
where the idea is to let the motion of the reference point 84
29
be governed by a di!erential equation containing error if
', 85
I "
30
feedback. It can be viewed as a combination of the
(!2
#3
)# (!2(!
)#3(!
)) 86
31 P 87
conventional trajectory tracking, where the reference tra-
32 if
), 88
jectory is parameterized in time, and a dynamic path
33 89
following approach (Sarkar, Yun, & Kumar, 1993), where (11)
34 90
the criterion is to stay close to the geometric path, but not
35 where is a small positive number. It is easy to 91
necessarily close to an a priori speci"ed point at a given
36 see that
I is well de"ned at
"0 since 92
time. This approach makes our algorithm robust to
37 lim
(!2
#3
)"0. 93
measurement errors and external disturbances since, if M
38 94
both the tracking errors and disturbances are within
39 An intuitive interpretation for this control algorithm is 95
certain bounds, the reference point moves along the refer-
40 that the robot is steered toward the reference point on the 96
ence trajectory while the robot follows it within a pres-
41 desired path with a speed proportional to the tracking 97
peci"ed look-ahead distance. Otherwise, the reference
42 error and whenever it reaches the steady tracking error 98
point should slow down and `waita for the robot, as
43 (the desired looking-ahead distance) it will track the path 99
suggested in Egerstedt, Hu, and Stotsky (1998)
44 with an almost constant speed. It is easy to see that even 100
Our control objectives are
45 if a path is planned beyond the dynamic or kinematic 101
46 lim sup
(t)) constraints of the system, this control algorithm can still 102
47 M be used to track the path the best it can. 103
R
48 In Egerstedt et al. (1998), it was shown that for the 104
lim sup
(t)!
(t)) , (7)
49 ( platform model (1), governed by the control (10), the 105
50 R steady state tracking error,
, can be made as small as 106
51 where and are positive numbers that can be made one wants while
tends to
exponentially. Further- 107
M (
52 arbitrarily small,
(t)"((x !x)#(y !y), where more, in steady state we have that v+v . Thus we, by 108
53 (x, y) is the actual position of the robot, and
and
are using the control law (10), meet the control objectives 109
54 actual and desired robot orientations. de"ned in (7). 110
55 From (6) we directly get that x "p (s)s , y "q (s)s , We thus have a way of both producing and tracking 111
56 which implies that if the robot would track the path paths, and we now combine these two together into the
130 M. Egerstedt, X. Hu / Automatica 38 (2002) 125}130