Global off-line path planner (Central planner)
can give the safe paths to all agents. In this paper,
‘safe path’ is the meaning that no agent will not
crossover any other agent’s starting point or
destination if it keeping on its own safe path.
Therefore there can be intersection points among
agents’ paths.
2.2 Collision Map
The concept of the original collision map was
presented in the previous study (Lee, 1987). The
original concept is as follows: An agent with a
higher priority is called 'agent 1', and an agent with a
lower priority is called 'agent 2'. The radii of the two
agents are r
1
and r
2
respectively. Using the obstacle
space scheme, agent 1 can be represented as the
agent with a radius of r
1
+r
2
, and agent 2 can be
considered as a point agent. The original trajectory
of agent 1 is assumed not to be changed. On the
contrary, agent 2 must modify its trajectory if a
collision is anticipated.
Path of agent 2
Path of agent 1
C
o
l
l
i
s
i
o
n
l
e
ng
t
h
(k)
1
λ
)(k
f2
P
)(k
01
P
(k)
1
P
)(k
f1
P
(k)
2
λ
21
r r+
)(k
02
P
Figure 1: Paths of two agents and collision.
If the path of agent 2 meets agent 1 with radius
of r
1
+r
2
, the two agents will collide with each other.
At this instant, the part of agent 2's path that
overlaps with agent 1's path, is called the 'collision
length', which is denoted by the portion between
λ
1
(k) and λ
2
(k) in Fig. 1. These overlapped parts are
examined at every instant of the sampling time k to
construct a 'collision region.' If the TLVSTC
(traveled length versus servo time curve, simply
trajectory) of agent 2 arrives at the region, the two
agents will collide with each other under the original
trajectories. This colliding case is shown in Fig. 2. In
this figure, the vertical axis represents the traveled
length of agent 2 and the horizontal axis represents
the elapsed time.
Because it is difficult to mathematically
represent the boundary line of the collision region,
the concept of ‘collision box’ was introduced. This
concept can be explained in Fig. 2. In this figure, k
s
is the time when agent 1 starts overlapping agent 2’s
path. Also k
e
is the time when agent 1 leaves agent
2’s path. l
s
and l
e
are the minimum and maximum
values of the collision length in the collision region,
respectively.
Length
Time
Collision
region
Collision
length at
time k
TLVSTC
Collision
box
s
k
f
k
e
k
1
k
k
e
l
s
l
f
l
Figure 2: TLVSTC and collision region.
2.3 Extended Collision Map
The extended collision map method considers more
than two agents which have many intersections in
workspace. Thus, the intersection and its
corresponding collision region should be described.
An intersection is denoted by the symbol
jiI
k
ij
>;
(1)
where i and j represent the identifying number of the
agent, and k is the ordering number denoting
intersections along the path of the agent i from the
starting point. The corresponding collision region of
the intersection is expressed as R
k
ij
.
3 COLLISION MODEL
3.1 Collision Characteristics
We assume A1 has an intersection point with A2
which is less important than A1 in Fig.3(a). The
possible position relations between two agents
around the intersection point are as followed; First,
A1 passes through the intersection region before A2
enters the region(Case1). Second, the agents
collide with each other(Case2). Third, A1 reach the
region only after A2 exits the region. The states of
collision box related the agents in Fig.3(a) as shown
in Fig.3(b), where L1 and L2 are the minimum
traveled length and maximum length from start
position to the intersection region along A2’s path.
Time characteristics related to collision region
including T
k
(k=1,2,3,4) in Fig. 3(b) are shown on
Table I, and we define two variables, ‘M’ and ‘D’, in
order to describe the collision states among agents.
COLLISION-MODEL BASED MOTION PLANNER FOR MULTI-AGENTS IN A FACTORY
379