A Linear Iterative Approach for
Hierarchical Shortest Path Finding
Gutemberg Guerra Filho
Hanan Samet
Department of Computer Science
University of Maryland, College Park 20742
Department of Computer Science
Center for Automation Research
Institute for Advanced Computer Studies
University of Maryland, College Park 20742
[email protected]
[email protected]
!"#$%'& )()&*
+ !!, <=("+ -/
.0#(">?.A@B
3 12!4&35
67!7
E + )6-F
8("
F99 $679%:68 ;!7G2H$9%:1I8!;D<JC 7&K
2#67!7
L4/ !7:!M
-("567!-9N!4OP&QR!GHP&S!T PP&
NPA2!M! + G#
("
?L8U !7$ #!"QN!7 *
$("7V:1
!79)T-XW4
!GE#95YP&4#)6!*
-9Z[9!\]
2=))[H!=
$("!*
95^ !"
L=_B2W %)&5!G[PR6!-9`!#:*
<a!9b2*c
6)!Ped2$)\RF! + GJ
("
'!& $
&fL
g\EG6WD$
E$%d2$
N!<h(7
FF%:
!765!
[!Gi + F$-W8
!9$6E + !F!*
G4^Ljg\S2W% )&k6!-9ld2$-
Rm8> ;DC 9SP&
A$96no$<a!9l& )G%$!7o!<1("
Lpg\
24n<a$49 !(7
9
25
!7
)60P7VE
5PS( !"Sd2$-
Em8>
P
D#! G
(7
?L=t!Z+ )6hu2*v)("
VE(;Q + qr sC!":
P& Zm8+ >Gw C
9NP&R
d$-
[m8>?Ix ;C P
7L
ABSTRACT
Xy <a!INTRODUCTION
95!NGWG9f^GZ&)(7^Nz)6[\(7
d2$-&{!k9!("A<a|W}P&{]
WB!<5$!79!*
%)#("
?L1g\GW G
9E$#
-*c)9#]#<a!95!
67&5%WH]J
!!'&8$("
)
E
i,"J<a*
O8
!67G)!n&S!77& + !,:L5g\WA)&S(7
1)SOP&6
~!7 95fP5!
-J&
GP!7J
!)&6&G
7V
97VP&1!Y-) L=g\)e
^!E
9Ph$
W
("f9E& $
6
z& 2JP&M:!7$!7fL
_
2€
&DPSOP& )65-
$ N<!~$D) <!95*
!BGW G
95
!G4{n!2
60
2MPR
("
0d2$)Hn4!77&n + !,P&
:!P&#/-*c97L
g\H-*v9#:<!95
Nd2$-
9
2J<!N#GWG9
1.
g\# $:!
&Q/P%2WSM‚i!2!&
P7ƒ „ !
& ~_J:<
X
ƒ !79
+ 2!H&E…†
!"e& E‡#‰ ˆ (7
^U $:)!\*=‚\_F…hŠhU'L
Permission to make digital or hard copies of all or part of this work for
personal or classroom use is granted without fee provided that copies are
not made or distributed for profit or commercial advantage and that copies
bear this notice and the full citation on the first page. To copy otherwise, to
republish, to post on servers or to redistribute to lists, requires prior specific
permission and/or a fee.
‹'
)(7
Y
\F& ("e95WE,"iJT†$ + -HJ< +
!P& LE_)67# $9%:J!<id2$
FS$6# + !,R95W
("
2~GW G
9`<z!79b9
)6H~-*c9Ed2$-
9
2
+ _DHŽYŒ:Ž"[P‘’Ž"“R”~OP&!2&=6!Z$%'!"&(4z& )i[$i&f!L 67P6HP
2iJ + !,:L=g\[!"M!7("iFPOP& *
6J!%
9B
-e%WET $ )6JJ6*v!7$i!
GY
6!-9• + !7R + !,—– ˜V=™ši!1
(6S
—S *v
!79$&QP0( L/›E K|,G œ +-!0
!7G1RP!2!7/,$0
)6!-9
d$-
1m8>?.~!76h. C + 9P&Am8>?. C
P
N)PJ61– ž2Vew
ŸšcL
_  Ža”R¡¢v£¤S!E?‘Ž¥¦¢a?¢¡£#“
§’¦¨‘£i
!72\J) <!95!7
d2$-&!)("M!G8P/
!
:!7&6D!D
P-E!<Y("
J4E + !,:Lig\[G
6W *v
!79$
!GiZ8 + !,:LZ©E
\8( + h*
&fVW#d2$WH=:<!9& -~!2!7,$8
( + P&4
:!)681d2$
1!+ <=(")
F[
2
MP^L_`Pªd2$WQ
d$-
8m8>?.^« C R&0:P&
m8>?. )9V)
~F$9%:\!<†("
R~PR95
W5%:
C 0 + !G
7L0g\R0( + G6W/d2$
m8>?. « C )9F<!J *v!2
6D– ¬2VewwšcL
­e67\ !,Y95
WN&H$P
%9!7$2e!<9
&#
hH+ !&†!JG<zW#h-*v9h
!7G2LZg\*
<!7VY5h!"Q1)
&fL_`”¢c£‘Ž‘G“”¢c“Ž7§hŽ:®
P‘G’Ž"“”[$%'&(z& †6i + !,~2!95†
6)!
LZg\
!2
\
\N)W!<f9$-)
(7
!,h<a!N
OP&6Q^LB/D!7)& R6)*X+-!
GM
!%
9¯<!N)N6 + -S!*v
67("#&6 + 672
L
g\ !7%)9j
!7)G=OP&6~E!
G=PH<a!79°~6("
!7$ 8("TQ±H!M67("
Q&
G!7Q("TS²QRzP
6fL
y|N)eP:V i
2YF !"1Pe$% *
&()&
Z + +!,#!N3J
67!
LhŠh$8
67!7Z
9H$9%: ; !<h("
N&S%:)!6~!MH! + G1
(7
!<E42W2Log\494€
<a!5
6)!55Q !7:XW
<!&kk4!4m8>?!6\3 C (7
M%2W—6n67
("
'966#I~7&K
2
67!
Lhg\<!VFP9
³ 3´ ´GI
µF
!9
-WS& OP#HG$$#!<iM9)#*
WM; !<Y + !, L
/Z2!&$
h-("F>?!7 *v
$(" 6!-9e!OP&~
!
G=PH!$68)("
Z!<: ³ 3C ´ ; ´Iµ†)WHP&
!T&M!
G[42!8H!G[PR
!79:!&
%2W8& 67
h!7W8)J! + G
("
P=
=J!67
+ !,:L
¶ ("
A2WD!<i !,
V'#!7:!&D)
!
G—67!-9·G+ 8—R! + G5
(7
+ !,
<z!79 R!$
R("T'L/ nM
$ 2
6)!k8
!98*
-W5(7&fV~4[!9!&!H~T \67
(7
?LAg\5!9!!7nG
)HT $ &$2i-##
67G\
("
?L=g\
^V2J
Mi&
9!&!N[Th! + (7
E! + &4Q& GP)!{("T'L g\Q&9!!7oG
5:<a!9&—$2J-
! GR
(7
[ !,:L{_
$-60”2¢v£‘Ž‘G“”¢c“Ž7§¦G”’‘X£¦F Ža”S
+ !7)G!<~$%+ PH)
—
(7
\!<[M + !,:LAg\M[!7nT *
$
J¢¥?‘GŽ7®v‘£ ¢c’¥:Ž§ ¨£‘¢v£¦Y<!\5
("5!&h!1T PP&
~$%P =!HFTi)! + [
("
?Lhg\Ed$
~:*
<a!9&A$2Y + !75PQ1
2&A%2WS$%N)
N! + GJ
("
f + !,'L
yXH !Gh7V2!7$ =P!7d2$-
=m8>?.
d2$W9+ ~&R
7V + ~.D@ 3 ; J!f$9H%:\!C<
(7
NAH!67Ph + !,:LHg\
9#$:~%:!$P& J
("&8$61~2W&O-!7 + [3N@ ; @ .
P&/IM@ ˜LAyX< + M$9H*v!2
6D!D%$))&
2Wn!<F !, H8:<!9&0D
6)&0 $9%:#!<
9
[
!
6+ N$9%:!<=d2$)
V!$F!"
+!7$
nz&n!7$ Ad2$-5 !7!" }95)Si!79M*c
$&0("7
V~5
/!
$!9
L/T t-|$W{
!* V
G2F95?V + 9)
\9!E])WM
+ 1
!9!5P!:&M!7!8H!8 G
$
6("W4N!!95T ^$N2!"*c
67L !P
d2$
[)R~)+ † !"fLig\JG
6WRF%&
!#12W% )&E!
GYP167!-9}^$
eJ)7P
D!&J!8OP&867#!
G~%: + + !(7
!AH%:!&E!<\67!7fL#_°)ZSN$%
d$
!<Z("
[%:
!76!N!GFfL
F652W %)&!
GP/67!9VZ95P&
Md2$-
9
2N<!2*c
67!P[d2$
nM! + G
(7
~4m8> ;C L g\44o9!("
98
!79&k!/
m8> ;Aqr sC P
d2$-&Q%2WQ4/( + L4t!#6#
("
V
˜V2F(
+E $!"ENP:
5( &[ + m8>Gw )!"9~fLZP›~&5Od2$-6N
IJ[@{
m8>?I x ;DC ~4+ C
u2*v
("
f + !,M<a!Fu ªŸ L
g\H:H!67)€&n#<!7! LAy|0U
!7—˜2V *
( + + !,z&!#f+ 8OP&6LZg\ ³ 3+ ´ ; ´I
µ
Y!"4)[ 2&RSU
!7™ L=/~ 2
2W %)&D!
GNP67!-9/U
!7
LU !7¬
& $
[E954
!2)%$!7[!<Y:L
t RELATED
&,!7A– ¬šfWORK
!7:!&MHf6!-9 <a!
67*v!7$ !
GND !7%
9 !7D)PN6
L~g\
67!-9·,"
8m8>?. !6i. $6S97V .o8
$9%:R!<("
D}—zC PS6^L g\+ n67!-9 %&{!7B›~ KG,Gœ S67!-9 &{$
D—&()!p!<H
)PJ62!8H *v
("
'2WM!<e
67!7
L\_B$-*
%46ª& ( !7—8&nªm8>?.N!6i. *v!2
6
9$6/S
)d2$R%P&ª! Q)PMC P!R)6!*
-9 –-w˜šcL#g\867!-9&:
P& E!7D#<~E)
6ZP("h
P! + -8€
[m8> . C LZg\\!
G=P
%: + ("W5P-J!<†%:!&[("
JF<!7$P&5<!J + !
(2*
)
Lhg\<!7V ~67!-9b$
#PR( 5E
<a!~8!GE4 !7$64N2W!<Z+ + !,
L[g\
*v-E!
GFP4!%
9¯F!("&4Dm8>?.^« C )9~P&
L
t &,!75– š&
(7
!7:&1#)6!-9}<!†
!79$6[)-*
-!
G)ªA&-
&0)P86 + -0-*
($&o&6
!GS&{!0
67("W)
L¯g\Q67!-9
,"
5m8> P. C 97V + ª849)9H$9•& P-|W—!<
$%#!<8<?
1PH!(7Hi(")
V†,7
/!("H
2.
)PJ
9H%:&& 67!<†N)PJ6^L
N
/£hŽ7§ –-w7wš^ 2&55!95:6*v!7$~!*
G1/67!-9<!#$P&-
&A)P#6 + -!7 *
6"("4&6 + )628Pd2$-
5m8>?. C 9P&0P7L
g\^
$ )(7h !"17& ^![%6
!G2 PeN*
2!79D&& !P[94
!GLBg\+D67!-9
!M$
J
!
Vf%$[WH!Jd2$-&4!(7#€
m8> . LZg\W& ( )& \682!E
6!7=m8>?!76 f. (2*
=$C Ph)! + Gi
(7
6!7h
!7Gi!<eF)67JC&67L
g\N]
W4!<Y16!-9¯E& $E!H~<?[PJzT
!7:!7i:<!9&H$)6~95=!XWHd$
$
LYg\
6!-9 !2!
1M
6!7^Ve:<!9 R$9%:F!<h
)TA!7 *
)![& :
P& 61!7F
("
P!<eJ
6!7^VP&5%P& !7
P†
6)!^L=_n
)T#!7:!7H95W~$J!& + !z%:
![~
!
J!
GJPD&G
~![!& 7Lhg\*
<!7V E
6)!95
WH%:[
&67^L=g\W)!1
!9$ i
-*vPJ!
GJP[m8>?.^« C )9~P&MP
7L
›iK|z&KG
(5– š !)(7
†\67*vPZ!
GZ#!%
9$G*
6H#$%'&()! + !7~! + G[)("
P
6)!\!72R#6
("TfLig\F!"
d$-
Em8>?. qr s C *X !2
689
&A
L›iK|)&KG(D
2N/)6!-9 !4
!9$#!7-W
N!
GJ& GN%: + S±1&R²5Dm8> . C )9L
g\R6!-9·!2
85(")
5±RP&n²0! G
(7
6)!
VPOP&H
GE!799!74
G!>?‡N‚\_ C + 67!7SP&
!9$\~99H$9`& GN
!7z& 6N("
[
E‡N‚\_}
6!7
!L
764£iŽ7§ [– š'$676
G&R#5() !"5PG!
8&-
1$
!H(7TA&A8
+ !7G1!<[4!
G1
<!NS!7$ *X&G)!7S-~A8
67!7fLNg\<!7V'
P/( + d2$-
Hm8> ; « C P
<!8R67!70)! + G
("
?V + ; E#$9%:E!<i(")
~56)#
67!^L
g\WS$5PAOP&64)6!-91d2$
~
$ )(7
-W
N!
GEP
!7GJ!$6D†
(")JN)W4!<
+ !,
L=t†GV-J&9)
h~ FP& N!<Y%:!&
("
8—
6!7!726A4!7$ 4(7T—±4P&n
&G)!7Q("T²PV:
:
("
-W2L#g\67!-9$
~*
!9$
&k!
GM%: + B±A
& & !
& P&R²8!HOPP&E67!7%e9)9H$9 !7G[<![~
<!9•±H!4²%2WS69!76ZP-#> "$%´ " C !<%:!&
("
V + " '& &(" )& Lg\56!-9•&!2
!Y
!9$Z + !)#&%:&H%2WN& 67
Y1h)! + G
("
?L
U ,PR£1Ž7§ –-w™š\<!2
$!nP( 9
9
2)!
<!E + !*v
("2W2LZg\W8 !7:!&+ ~2W% )&P8() +
P~
!&E&-
E$
!#&A!7G~<a!1W!G
P1!7-W~<z!792!†("
f!Jh%:!&e("
†1
! + G
(7
\
67!^L0g\R)68)("
\<a$-Wn95))€
&fL
¶ )&o6 Q$& {
!79T XW PW !
6
MP
R
d+ $-&/<!MP0( + L—g\MP
4G!6
d2$-&5<!F~P4( + FJm8>?. %s *,+ C L
‚i.& -E$4–-wš:!7("
Z67*vPi!
Gi8 !7% *
9 j$P& -
&zP6 + -°!*v6"("n
&67
+))P62=
6L g\YW0!E
!,"947$&(h2\6794!<E9H$49B))P68-XW09!!7<~6E6
P6H !7$67MP-!<e%:!&[(")
5JPMOP& *
6A6!-9 $&/%2/
W 76ª£#Ž7§ n– šcL/g\W/$4D& )()&*
& *v
!Pd2$=
9\!N
5~P-h!<f%:!& h("
=9!
])-W2L~_)678!
GEPS
!GN~
!9$
&4S9
m8>1> 0 0$230 0 C !6:1> 0 0$230 0 CC $65 4‘7Ž 6£1¦£Ž‘“”2L
9³ 8 ,´ :{,´ ;Nµ
3.
_}”¢v£‘GŽ‘“”¢?“Ž§^HIERARCHICAL
Ž"P‘’Ž7“”#\%P&!75APPROACH
[$%'& )(!7M!<f
!6) + !,A)2!
6!7M>?
Mt†6L\w C LS_ 6!7n
!*
:!P& 1!
!7
&Q$%6/!<86/
26
~ + !,:L=_B)6[
(7
^ + !,
!G[!7WM!<Y%:!& (7
Lh_’‘2£‘N¡£‘X£1[1("T%:)!6\![)
G
+ !R&-‹'
2F
67!7NSH + !,:L1U
5!
G~P
65!$6D9!NPD!71
6)!S9$GJ)$&#%:!& (7
V4&6
R!<1)6M + !,n
2R:!%
!7
!7F%: + 4%:!&J("
JM[ + !,:L
>c Ÿ*X
(7
~ + !,—*
6)!C L
6)!^Lhg\~u*v
("
: + !,5$%'& )()&
&52!!7
&Mu2*
("
P67!7\
!72)6#IE&K
2N>cuTPAw *v
("
67!$
P5>cHu Ppw C *v)("
[
67!7k%:
!76MC !Q!7Wª!7Du2*X
(7
6)!n>?
1t†6L:˜ C L
_`2W!<J !, #<!D !,
2&/%2W/
6K6[
+ &4%2W4HU6 > !+ <Z3$%6 ³ 6?>> ´B6 >q ´
@A@A@B´ 6 C/D µLZg\
F$%6i
!
:!7&8!~
67!7iP %:49> 67q &0!A65
("\
67!75
!72)6I5
67!+ q L
g\ W2V\[
67!75)kQ
$)5)("
[P("4%:!7$ 9n+ $9%:D!<("
L·Š=$%6A&
!&}%W
6?V 8FV :´ 9QV V 4uQ)#5
("Z& YE
*
xU2W x D
x67X !^+ L—g\R!<E$%6
2)6D
67!7
<!u2*v
("
h)H&!
&%2[
W 6 LSg\H!<J%:!&#("
S8$%6K6 Vx F
2x&4%2W xV P& x &
!
[
%:!& J("TM<a!JNu2*v
("
?L
>?% w*X
(7
F + !,n*
67!7C L
0
01
000
071
003
7
001
010
071
771
770
67
002
010
772
070
011
671
111
160
070
011
110
1
671
670
670
160
661
120
121
220
121
130
560
230
330
560
230
561
440
561
551
222
2
120
6
660
130
223
550
450
340
231
340
450
231
441
221
451
552
331
5
451
23
341
3
>? ˜*v
("
~ + !,k*
6)!C L
>c& ™*X
(7
F + !,n*
67!7C L
2 2 "!#%$&(')*+!,-$.#/01+
*3+ ,54
g\DŸ*v
("F !,08!)6PF !,0
2&
%2W {
9%:
&&6/+ !<H{$P&-
& )+ 4676>18=´:9 C
!oA)7V + ;
8 <> 9 4S!<#("
Q>?&6
C
=
6HL g\Q$9H%:5!<#("C )
R=
8 R.ZL g\46o
$%'&()&&2!3R95#
!7
&Q
67!!
:!P&6
!$%6 ³ 6?>> :´ 6 >q A´ @A@A@
B´ 6?CA> D q µ[$RPJ#$%6
!(7[~!)6P^ + !,A1> 8}E
@ 8F> 8
8 CAD V 9}@
9 >> G 9 > q GMJLJ/JG 9F>CAD q C P&/0>H& G67M%:>Iq GK!7JAJL6JHG !S> !7q -Wn!7
$%6fL
Š=Ÿ*v)("
'$%6R ("
[P&5<!9`H$-%
$%'&()!!<YN6N6 + ; 1%:!7$&)J!<Y!*
:!P& )6~
67!Mi~)€F!<em8> ;DC ("
L=U$8$-%
$%'&()!DF!%&Sm8>?.~!76i. 9N$65<z679*
!7R67!9 – ¬šcL ¶ !2!& – OšfC !:!7&MR6!-9 !
OP&0S
P!&
!9:!7-!7ª&—S$-%$%'& ( !7
Rm8>?. C 97L=g\F$%'&(!7M)2!1$%6\&
\
€
H!<hPA( + V:
%2W4& $
65H
H&D952*
H!7G
LFg\1%:
GE
!7GE)E
("
& + #$%6
("!T 95
-WNi9$9H%:†!<:("
LYg\<a!7V
[67
!M!<^~67i
(7
!N%:[
!7G
&
+ªF$<k!
[
W0
P8ª
6!7 + F("%:!7$49
$9%:!<Y+ ("
L
t!Ju ªŸ VNu*v
("f + !,567
&R<a!9`>cQu P
w C *v)("
~ + !,:L _("S
T RªR) Au*v
("
E !,ª-<
-1%:
!67N!M + !4&-‹'
2>c.u Pow C *v
("†
67!7
L‡E!+ P
4u2*v
("
+ !,/8!-Wn%:!& (")
L0g\4
&67!7
6M + !Du*v
("=(7
1Q8u*v
("
Z + !,
-<Y~EHPR
!7
)69b)R~9>c&u Pªw C *v)("
442
4
>c C Ÿ*X
(7
^ + !,:L
341
45
>?% C w*v)("
f + !,:L
+
]\_^Q$F 2 3+ 2 ,S`](ab2 ;!c*#%$F'c,54
dT(=*+!ef,I,/
!g*gihEg,/cjg f!*,I!gi#/c
hkgl3+#/f(j,&Km*,A*!#Ljg)hc[n 22 *gop 2 *,54
qQ8 x V F#PD() + <!~#%:!& ~(7
Er6 Vx LEg\
P( <!#%:!& 1("
1
!2N) <!95!7
d2$-&#+ !E
("[~!
GhP!7-W%: + 52W#P-h!<
%:!& \(7
iM1u*v
("
6)!l YL=g\J<a$)!sqQ8 V >ute´R
$ Y &
!h!<'("FT R#\!
GhPxH<a!79 C
("rT t^-L v Vx )N81!<[
&67N), 6D=P-1!<[%:!&
("
#H5
!&%2WP)Q$%6M
6 V
H& v x &
!
[
NJ<a!E1u*v
("cL\Šh4&6Mu> t^´ R C x V
H v Vx 2[H!
G[M<a!7w
9 t4x! RI 6 V LZyX<^
5!5&6u> te:´ R fC y o
v x Vh
+ K|$G,7
0x 4
&67
+ -y|H!9& Z9$!N9 !7-WG€
L :<!95
$
Z<!h\)
!7^V
!79T XWM9$ E<!EHJ!<Z%:!& [("
Mu2*X
(7
Y + !,D)~
d$-&fL1_°
)N!<\6~GO
;
ze>?. !N!
9V'-<=#T GNMN!<im81> ze>?.
("
C + !789!(Z& ( )& 1R6A<a!9zH2C! C
+ !R + -A~9!7G? {e.n("
FA<a!N!9H!7G2
w |I˜ }i{E~ wLH­^!P&Ag†?KGk–-w˜š=<!7$P&SRN!<i!&
!<f€
Fm8> . C + !7[
9!(7P&()&
hN)h65!~*
67! + -S€
#)FP « .YLEg\<a!7V'Nz~!<=zP
68' .:*v
P%7L—+ _J ; *X&(!7—!<EAzP86
+-4).S6#("h9
!7GJ [H("&()
!=
$!&m861>?.cm8| ;D> C 67%:!7!
&VPh("R
!7
*
– ¬šcLJU$H
$; ("1
P!~& !79:!-;4)C!DD%:~<a!7$P&
$9 -!7$ ~!7N!<i6
-|W~3N:! N!<
I q V'?L 7LVf38@pIA+ V + x€AJ#67
G~
("†SH+ 2W
!<Z + !,
L
m8>?. C 9M– OšcLg\$9H%:~!<\%:!& N(")
NWAu2*
(7
^!79
<a!9` ; *|& ( !7R!<=)PJ6^L
w
L ¢a¥:“£Aa”£Q¥¨ 6£‘’ 4A¡£‘?¢c“£¦/£ 6£:52£ª¢¥pŽ
u'®v§)£¡£§†‘£ ¢c’¥/“’‘‘£¦v ’+¥ ¢¥ v’M¦j¨ ‘ŽN” 6 Vx ¢¦Jm8>?I x ;DC a”£
¥¨ 6.£‘F’ 4T’‘ 2£‘J¡£‘?¢c“£¦ 0 x 0¢¦Z
m I x ; ¤†”£‘£ ; ¢a¦\a”£
¥¨ 6.£‘H’ 4~¡£‘?¢c“£¦N¢¥AŽ#Ÿ®v§)£¡£§^¦j¨ ‘Ž ” ?a:4EU 8– ¬2+V O Vfw˜šcL
©E
5#!<[%:!&H("
#0u2*v
("
h !,AP#
!79T -|W89$ 7V + FM
G95JJ)€E!<†+ #$%6
A567N
("
?L~_F$-W2V #!7%Q
!9T -|W49$ <a!=Y!<P("
8 x P&H
&67+ k 9 x Fu*v
("
$%6x 6?Vx L
yX8!& Z!~!("h
!9T -|W#%:!7$P& V + )2!& $
\
¦¨j ‘Ž ”DŽ5Ž"“£¥:“J
!
LZg !#$%6\E&K
2i!
!1-<i8
!7Q%:+ + QH
:("81!<
(7
[F![
9 |W2L
`˜2
L 4Nu °Ÿ a”£¥¨ 6.£‘M’ 4¡£‘?¢c“£¦'0 8 0Z¢¥0Ž5uf®
§)£¡£§^¦¨j ‘Ž”N6 Vx ¢¦Jm I x q ; Ž¥+Ra”£H¥¨ 6.£x ‘’ 4£ £¦
0 9 x 0^¢a¦m W I x ; X ?a:4[g\i("
Z.6?V !
:!P&H!J\%:!&Z(7
!<:I\$%6Y)#~>cukP5x w C *v
("
?LF
V 0 8 x 0=mk>I 0 x D q 0 C
!&6!­^
995/wV[&0 8 x 0i@ m I x q ; LkyX—
+!7!GH
&ªV†&fVh
$!7%6d2$
2N)-QW2Vh4>c-u $Po9Hw%:C *vH
!("<N
h& 67
) G09 !670†-W x @
m W I 0 x D q 0« X
m WI x ; X L
g\! G8
(7
h!<)WQ1
!79:!&%2WA)
$%6+ L E
7VYR)67*v!7$ 5!
G#P67!-9
d$-
Jm8> ; !6 ;DC 9F)R~! + GJ
("cLh_B67[
("
>cu'kŸ $%6.6?V )#iu*v
("
Z!Z)=&H
!G
!<C $!7/!<[I8
x )d2$
1
!
:!7&6!DI67!7H
>cu P—w *v
("
?LFg\<!7V'›~ KG,G ~!
GEPD67!-9
:<!95C NJ&-‹'JH67J)("
?L
™
L H!£ Z¥¢¥ I/@ ˜ ~¢ #"¦?‘%Ž $ ¦SŽ7§ ’‘¢a” 6l¦c£+¥ ¦
?¢ 65£Fm8>?I x ;DC ¢¥AŽ1u'®X§)£ ¡£§f¦j¨ ‘ŽI” 6?Vx ¤†”£¥R 'u ªŸ ?a:4[›~ KG,G 67!-9 d2$-
imª1> 0 8 0X)!6 0 8 0 2 0 9 0 C
97L U)
{!76 0 8 x 0n@ m8'> & 0 8 x 0 C V
x 0 8 x 0|!7x 6 0 8 x 0nx @
m 0 8 x 0(& 0 8 x 0 L
!(" P 0 8 x 0)& 0 8 x 0 @
m81> 0 9 0 C VY
MI 0 q 0 & I 0 x D q 0 ~ I 0 x D q 0 «LSg\)Hd2$P*
!}xDd2$(
24x D *
! & I 0 0x~ 0 0 L Ud2$P)6—P&
9)-<zW6RNT !7^V x + D q P("#-I x ~ D q 0 x D q 0 L­^9954w
G
4/ 0 0F@ m8> I x D ;DC VF
!d2$-W2V + Q(7
IR@¯m8> I x D q ;Dx D C L q 0 x D q 0e#q 5G(7)$ + 0u0@w7V
AI@ m8> ;C Lg\<!7VY›~ KG,G+ #)6!-9
d$-
m8>10 9 x 0 C @{m8>?I x ;DC 9~DH67J)("
?L
yX8!& =!EOP&8~!
GifV"!7$ i:!"
G4<a!9 A!7$ (7T oQŸ*v
("N + !,p>?
t†6 Lf™ C LNŠZ("W4)9NHS
!9
-W
J#%:!*
& h!<fNu2*X
(7
6!7^V7[h !79!&#!~N>cu 2Sw *
(7
[G6<z!79 ("
)—8%:!&LoU RC
!2
& $5
#56
G)("
?V=
("WQ)9M
3.1 Hierarchical Optimal Path Finding
!9
-WM
N%:!&F!<=4>cu 2 w *v
("
'
67!D
!7 *
)65& GP!/("T'V^
8C nH&
9!&
!Nu*v
("^G)6<a!9b
N%:!&[(")
L
yX<i2WQ!< !,#PF € 2}w5
(")
Ve
!2&$ QT $
4—6
+)€&B!
GP{67!-9
(˜ € 2{w9
N!&N!MOPP&DH$%PNQ)("
Z!<
5)W2LAg\R6
€
&—67!9 H)9)H!S›~-*
KG,G+ 167!-9 %$ N)! + N-)€
64H !-|WSd2$
$
P=,"
h$ (-&(")
+ 9!\P8!7J!$
[("*
T#P&1)-z!7GY6
ZPŸLZg\h67
€
&H!G
PS67!-9 !79$
[N!
GEP<z!79 8- ,0!<
!7$ J("
Z!#P("
h5N$%6$6N!-W8
&67
4$%6fL
g\Z) .0/21304650798;:N67!-9}%:
! e!*
G[5
~)
W2 q=< x ><!F !79!)! C P+ l& q=< x D ><a!J&*
9!! C Du2*v
("
f!<†~2W ³ 6 > %´ 6 q A´ @L@/@
%´ 6  µ\!<
+ !,
V + s 6 x #
(" ³ 6 >x %´ 6 xq A´ @/@L@
%´ 6 C?x >5D q µ
—4)W2Ln4& OP40¦G”’‘X£¦F Ža”—?‘££85S
+
2!#D4$z!d2$4
GH9PfLR_ 0§9Ž <a"£!7‘N9·!<!2!!!nG2HW0("Tn
)# *
$%\!<†1!
G
J
!72&)RNP)$)
(7
!<=1)W!<h + !,
LEg\#!
GNP
#z
W2
F
!79$&5!& \!1OPP&8E'!
G
<a!9bH!$
N(7TM±F!&G)!7R("T5²H!7$67!7$
Y
(")E!<Z#2W2LEg\H67!9 $
~5- ,0P
2h!$
J("
=<a!~)
W2h5Nu*v
("cV + [
("TR@ ,0J!2
)& + !7GL
2 #/BAC.D/E130465D768;::> ³ 6 > %´ 6 q A´ @A@L@
B´ 6  µ´±7´² C
w7L,GF >v±7´GŸ C
˜L HHu F•xŸ #AK€Pª"w g
>c C ±
3 x FJI0KL;798M+46N0M;OD/9K61:>±7%´ 6 x C
>?% C q=< x FCPQ65:R> ,†%´ 6 x C#>S C
>? C ,TFVU
>c& C xt & x C >S g
?WL ,GFX, G u> t^´ Y/;Z680761L6M<> q=< x :´ t CC
™ L q=<F D F[P+Q65 W ,Y:´ 6?> X
L HH
u F €.P—"w #ASxŸ g
>c C ±
3 x D FCIDKL9798M46NM;OD/;K61P>|²P:´ 6 x C
>?% C ,TFVU
>? C xt & x C>\ gc
?WL ,GFX, G u> t^´ Y/;Z680761L6M<> q=<Qx D q ´ t CC
>c& C q=< x D FCPQ65:R> ,†B´ 6 x C>\ C
y|-zW2Vi] ,4
e!7-W1i!7$\("TH± -
!G5Ÿn>?G
ow C L0t!8ªu2*X
(7
\%$ HR67G!74+ P&
G6J~= ! + G†
("
>?G
#˜ C Vh67!-9p!2Z±=
8$%6K 6 x C >S $6^ IDKL;798+M46N0M;O0/;K61 !2
& $5>?G
˜L P&
!9$ hE!
G
E)
W2 q=< <a!7_
9 ,
8C =$%6$6~J6
€
&5)67*v!7$ Jx !G
PS67!-9•`> PQ65 C >?G
A˜L % C LJg\1TF^ ,n
2
1F!<=%:!&F("
5 x C>S + -N
:
)(7H
!GE
q=< >?G
5˜L DP&ª˜L & Lªg\M<$!7a Y/+Z280761L9M$
~x &G
E<a!9`~!$C N(7TR±E!H~("-T t4)M
!
GHPA
- q=<1LMg\
fV†!GQz
W2
>c C Ÿ*v
("^fL
>?% C w *v
("
f^L
>? C ˜*v)("
f^L
>c& C ™*v
("
f^L
>? C *v)("
f^L
>< C ™*v
("^fL
>?6 C ˜*v
("^fL
>? C w *v
("
f^L
>? C Ÿ*X
(7
^
^L
.^Fr,/#A*,A#sm#/=,Ao#/+
+=M
j(5 2 !#%$&' 4
q=< D <!~H67
GN
("
Y~!79$ &/>?G
Q™ LN‡F!#P
J 6
Gi)("
:P^K|$G\!J!
GP
FC )
W2L=_[<a
PV"<!\5u2*v
("
%$ZJ67Gi!J&8G618
!P&n6 GH
("
~>?G C VYM)6!-9•!28²Q0
$%6I 6 x C >\ >?G
' L C VE ,$'&&8!#
J%:!& h("
x C> \ + -
:
("F
!7Ghl q=< x D q
>?G
L % P& L C L°t†PW2VD!
G4kDz
W2
q=< x D <z!79 ,nK 6 x C>\ [<!7$P&A>?G
L & C L
w7L^”£ Ž7§ ’‘¢a” 6 .D/E130465D768;: “7’ 6FP¨X£¦ a”£
¦G”’‘X£¦= Žar” ¢¦vŽ¥P“£ 4‘7’ 6¯a”£H¦’¨‘G“£H¡£‘X£ ±Mv’5a”x£ 2£¦?¢?®
¥:Ž?¢c’¥S¡£‘X£ ²S¢l¥ 6
?a%4\y|-)-W2V2[
,Q
!Gi!-W!<'J!$
J("T
±N&ME67!-9 PQ655
!9$ iE!G[PM<a!9 ±
!N)%:!& Z("
Z\$%6. 6 > C S P=
!
:!P& !8~67!7D
!26R±N4N! + GE
("
?L[_J$P)-W2V !
G1P189 9$9 !-WQ9!65!7PN
!798*
WM
!2&R)H 6 > C#S L E! + (7VP#!
GJPM<a!9 ±
!DWQ%:!& #("TAM
6 C#S 95
WQ!#%:
!9
-WQ
!7 *
&4671)! + GE
(7> f67!7fL
g\N!
GJR<z!79 ±~!8WM%:!&J("lT t4)N 6 q C#S
95
WD
$&!9!N%:!&~("
L­^? R%:HHOG
%:!& F("T5<a!9±~.! tD[!
G~^]L E
7V
$%P<a!]
9 R1"! t5)i~!
G\$%P8
!9:!7&%2WH$% *
P + !7N!7$ NP&4& GP)!("
[~%:!&[("*
L=g\
$%PZi
2&H) 6 q C#S %W1
&67 + -
9
!GLMg\ <a!7VY8!
G#P~<a!9 ±8!
%:!& h("
Zs 6 q C#S P&!79WH
!&s 6 q C#S !9$
&8%WF 67!_
9 PQ25%2W8-)€
6 ,Q!#F%:!*
&F(7
[!< 6 C#S -4N!
GFP4
!GF
!9$ &
( !$-W2L[g\1> 9#+ GD)&$("
-WM! + FJ#67!*
-9 .D/2130425D798;:5
!9$ iJ!
G[PR!7G\<z!79¯±F!
%:!&Z("
Zi67
G=)("
?LZ_F!76!7$W2V"!
P& $!7H!()&
eY\6!-9°
!9$eh!G
P5
!7G\!#%:!& \(")
i! + &\F&G)!7M("T
²PLYt†-W2V7[)GZG
11=)! + GY
("
?V
!79$
f=!*
GJP4
!G[<a!79 ±E!8²PL
g\S6
)€&B!
GRP{67!-9 &!79
5
9Ed2$-
9h<!J~67!9 .D/2130425D798;:PL
˜L^”£ Ž7§ ’‘¢a” 6 .D/21+30465D7989: ¦v£¥¦l?¢ 65£
m8> ; !76 ; 2/. C ?a%4kg\M!2&$ IDK+L;798M42N0M;OD/;K21nOPP& S!<J$% *
6e~Zu2*v)("
7^95WJ
!2NY!7$ &
GP!7
("TfL4U)
8$%6N
2H!7
&A
67!7
9H%:&& &—{)VJM4Mm8>Gw C $%6
Lp…Z!*
()&&R[N(7
J!<=$%6D1!&'V'7&&-!7P
5,"m8>?!76 0 8 x 0 C )9[!1)&
2-<aWJ
6!7M)5Fu2*
("
FF!$
&G)!74("T\!2&fL F
V
E+!2
& $=I0KL;798M+46N0M;OD/9K61:
&[m8>?3 x 2/!7650 8 x 0 C )9L
g\J!2&$ = PQ25:
&=)9Jm81> 0 8 0|!6 0 8 02 0 9 0 V
%P-W/-#P189898!79x T -|WAx 1›~ KG,Gx C H-*
67!-9L=_F
!& )6!8­f
995#™ V ~ !2
&$ ^ PQ655:P&
91m8>?/I  ;DC @}m8>?3 ;DC @Bm8>?. C 4F €*v)("
?L[g\1!2!7E
M)6!-9 T $ 85!2
&$ IDKL9798M46NM;OD/;K61V PQ65
&ª$'&8!$
D , + -k%:!& 5("
5
:
P& F9m8>?3 x 2—!7650 8 x 0 2
x0 8 C0X> )!-L 6 F0 8 02 7V'0 9 02 A0 0 C LY!7yX<PQu8@o
Ÿ Vh)!2!8-!8:
P& m8>?x 3 2 ; !x 6 ;DC x97V!x + 7Ve:
P& em W 3 x 2nI
x ; X 97L
g\<a!7VPN6!-9 .D/21+30465D7989:4:
&\!^9
m >?3 2 ; !6 ;DC 2  D q 3 x 2nI x ; 2/.kL
x q
g\n)n
d$(7)Q!pm ; !6 ; 2n. 2
CAD q 2
CAD L
g\<a!7V~67!-9 .D/2130425D798;:M:
& m8D q > ; !76 ; D q 2. C
97L
g\R$%6/<a!H567
G8
(7
id2$-
m8>?. P
7L
\g EF#$[<a!E1!2
& $ PQ65R16
C GF
("
P&Q&!79
~8P
8d2$-
9
2N!76R)6!*
-9 .D/2130425D798;:PL
D ™L^”£ Ž7§ ’‘¢a!” 6 .D/E130465D768;: ‘%£ ¨¢‘£¦}m8>?. C
¦c Ž"“£ ?a:4Hg\#!2
& $^IDKL9798M46NM;OD/;K61S$
F1("TR
8 !<m8>Gw C 67!7D{u2*v
("
?L F
VEA!2&$ I0Kx L;798M+46N0M;OD/9K61 d$-
m8>10 8 x 0 C P
7L
g\ + W2V
3.2 Expanding Subpaths in Higher Levels
_o!
G[PM<z!79b±F!#²8
!G[!<eHd2$
F!<^$% *
P ³ >v±7´ q C ´ q > q ´ « C ´ « > « ´ + C ´ ´ q > q ´ C ´
> ´ q C ´ q > q ´ « C ´ ´ « > « « ´ « q C ´
q R q uR R :q uR :R A@/@A@ :q uR R
qx D uR  :R >  qx D D uR  :R  L@A@A@ :qxD uR  D  D R  D  D 
qxD >uR ´ R ´:qxD >uR ´² µV A/$%k<z!79l("T
R V q !« (" D q T`« R y C )Q> 5«  u2*X
C (7
h+ + !,AH& !&Q%2WA
-
q >uR ´R y ! qxD >uR ´R y LZyXM!&!#P("FH!79F!*
Gx V fV=C x )6!V -9 C T $2*c
67!PJd2$)<!
Qu*v
("YT P&65$%PF)SHu2*X
(7
†!R$%
4ET! + F
("
f$2: + !71P4
!G[!7-WR!<
& 67
[4E)! + GE
(7
^ + !,A>?
1t†6LP¬ C L
>c ™*v
(" !
G
PC ^L
>?% ˜*X
(7
!
G
C fL
>? w*v)("
!
G
PC ^L
>c& Ÿ*X
(7
!
G
C fL
I0KL;798M+46N0M;OD/9K614d2$[m8> ;DC P
N4E)! + GJ)("
^P&
m8> I x q ;DC 4! + )L g\!2
&$ PQ65/
d$-
m8>10 x 02 0 x 0 C P
7L=g\<!7V P+Q6H5 d$-
\m8> ;C P
J)
8
9
! + G1
(7
Z&Qm8>?I x ;DC P8! + 7L8g\ )!-|W
d2$
$ ,°G!
M67
E!7$A(7
PA!-Wª%:!*
& ~(7
LE
7V%,—d2$~m8>10 x 0 C @m8> I x ;4C P
7L
g\<a!7VZ867!9•
d$-
#m8> P
<!1)! *
G[)("
?VPm8>?I x ;DC P~<!Nu2*X
(7
;D+ C RxŸ ~ªlu ~€^VP+ &
m8>?3 ;DC h<!Z PQ651 !2
& $\Hi)6
GZ
(7
?LZg\
+m8
>?W23 Vf@om8>?. #L d2$-
9
2E<a!~8)6!-9 .D/2130425D798;:S ;DC
C
yv< \& OPh31@ @ .YVi67!-
9 .D/E130465D768;:1:
P& m8>?. C + 97L F! + ("; V #!
G<a!9¯±J!#²8\
!&&
#!
GYP#i)
W2e !7$6#)("
†!<=2W
P&d2$=<a$i !2
6N!1T PP&H)=!
GhP
2!n!7D
!79:!&k%2Wª&6
R!-Wª)ªD! + G4)("
#>?
t†6 L C L
071
771
770
772
070
160
671
670
120
121
130
223
220
560
230
561
222
231
340
221
341
c c#A*,A#.mj#/S#A 2 +,54
+
Z^F) cm!,/+!e0f5 2 ,/#Lj,A#
mj#/S#/+
c+o 2f2 2 *3+ 2 ,&#/`4
g\ D7613465D798;:67!-9 %:
! OP&[ !71!G
P<a!9 ±1!5²M
&%W+ d2$
1!+ <h&6
ED
! + G#
("
= + !,:Lg\867!9 (7
~!G
PM~)W"q=<x R!&!H
("J~$%hP
!9:!7~N!
G<a!9¯±J!1²8M:
("
!<^F)*
2W2L#g\
fV'H67!9 :<!9~2*c
67!P=d2$)
!T P&A/& 67!<
$%PN2!D4[
q`n
! + F
("
?L
2 #/BA !"D76130425D798;: W q=< ´±"´G² X
w7L q > D u> R «  ´² C F$#%7"&'D7L( W q=< > D ´² X
˜L HHu F "w #AK€Ng
>c C qxx D u> R «  D x ´ R «  D x q C F)#%07"&'D7+L*( W q=<Fx D ´ R «  D x q X
™ L HHu F €.P—"w #A/"w g
>c C q x u> R x ´ R x q C F #%07"&'07L*( W q=< x ´ R x q X
L q >v±"´ R C F)#%07"&'D7+L*( W q=< ´ R X
> q
¬L > HHu F q €H#A/Qw g
>c C q FXU
>?% C Qu> te:´ R C V & qxx D u> R x ´ R «  D x q C g
?Lq F q,+.-218%07+46N0M9OD/;K61D7/>ute´BRP´u'´:Y C
>? C q x D D q >uR x D q ´R «  D x « C F q x D q >uR x D q ´R x C +bq +
qxx D D q >uR «  D x q ´R «  D x « C
yX-)-W2V†567!-9 ("
H
/!
G
)
W21%, + & 1$6M8 !2
&$ #%07 &'D7L*(—>?G8w7VY˜V
™VP& C L=g\E !2
& $J\J$% q x >uR y ´R y q C
P&lqxD >uR y ´ R y Mu2*v)("
'%2W8
(6#d2$
E!<
&67Nx u> te´ R C V <! [q C 4$%P^LZg\~)6!-9bT&\
$%G6D#86
G1
("h$Z-1OPP& N + !7
2&%2WR&6
E!-W1! + GE
("
h>?G
A¬ C L
t!hMu*v
("
?V"J67!9 ,"
Z[
!
:!7&61$% *
0
qxD u> R ´ R
P&—D!2&$ -218%07;46N0M;OD/9K61D7/
T&x[x« & D675x >uqteC ´R C V 4[$%P!88$%R)
E>cu P8w C *v
(":>?G
8¬2L % C LZg\)Y !2
& $hOP& eh$%
<z!7]
9 tMQ! R#)J$%6l 6 V !
:!P&6#!#~
67!
Ye)81>cu PSw C *v
("
?LZg\
J$%x D qh1>cu PAw C *v)("
P
!7
&D>?!7:! + C )2!1NP. q°>?G
5¬L %fL C Lhg\^V
†$%PF>cuxPkw *v
("†1
!
P&D!!-W
!N$%PH qxx D D q u> R x D q ´ R « C  D x « C >?G
¬L C L
_J9:!2=$F)8JP-W\!<' !D761+30465D7989:5-*
6!-9 ~8$9%:~!<i&6
NP#T&&D!
G
+ =("1)QP)$)N
(7
Y!<=#2W2LJo-*
!$!M!<~6
XW2V + D$9R8R%:!&(7
%: + n + !S
6)!8!79:!7RD!
G8^LGE
7VZ<a!
67
(")
V=2WQ!
GH$%P/
2-
-W
!2&Q)/
67#67!7SF!79:!7
&4%2WE9!GJ + !& 67
J41T
! + E
("cL
L^”£A¥¨ 6.£‘Q’ 4£ £¦S¢¥}Ž0¦” ’‘X£¦1 Ža”p£ 7®
 Ž+¥ 2£ Mv’a”£H<> €PrY C ®X§)£¡£§f¢¦m8>v˜ V C ?a:4yv</
u w8&Q& OP)6RIH@ ˜Ve2WS!
G#$%
-
-W4))&#8
67!7DSu2*v)("
eF
!79:!&4%2WE9!G
+ !/
&67M—/>cHu Ppw C *v)("
?LBg\<!VJ$9H%:8!<
&67N)M!
G1AP)6R !7$6Q952W
67!1T*
&&!N1>cu PAw C *v)("
= + !N9
Z[$9H%:=!<f&6
D1
!
:!7&65$%PD#u*v
("e$J<a!7$E&6
!76N$%=!67P)-W58N>cu Pw C *X
(7
q x D q
P&q D L E
7V\$9%: 0 q 0Y!<N& 67
5ª6*
G
("x D q !
G0 + !P&n M$9%:H!<~& 67
)
M!
G1PT PP& &!RR><€lP[Y *v
("
Z1&O&S%2W
$
( 0 q  D V 0Y@ ˜ 0 q  D V q 0 2 LC g\
$ 5
(7)$&4! 0 q  D V 0"@>v˜VPªw C 2—˜L[g\<a!7V:N $9%:
!<Y& 67
[#!GF$%MT P&&!H<> €xP`Y C *v)("
Fm8>v˜ V C L
t!#*c
67!7id$
V M95
WS$52WQŒP1G
6W2L
_o5() + G6W5*X!79+ $ h:!
GPh)
+ !,D<!#A67!7fLMU 8IH@ ˜V^NG6WA:
P& m8> ;C 94!Q
(7SQ!
GMPkª! + GM
("
P&Am8>Gw C 9! + 7L8g\8A() + G
6WA
d$-
m8> ;Aqr sC P
N4~! + GE
("eP&4m8>?I x ;DC ! + 7L
D L 4Ra”£D¢¥?‘GŽ7®v‘£ ¢c’¥:Ž§ ¨£‘ ¢¦R¢ 6E:§)£ 6£¥X£ ¨¦¢¥ Žk Ža” ¡¢v£¤ Ž"P‘G’Ž"“” a”£BŽ7§ ’‘¢a” 6 !"D76130425D798;:
¦c£¥ ¦Jm8>?. C ?¢ 6£ ?a:41g\N("e!<=N!
GE
N)
W2J$6
!2
& $ #%07"&M"%DZ9M4 '07L*(D7 %+3DZ4S1)! + GN
("
†
d$-
m8> 97LQU
M2W$%/H
!79:!&/%2W !D&6
A;67C N
(")
Vf1("=:P&J9m8><€ C @°+ m8>?)!6i3 C
AY)6E
("
LNg\<a!7V'1("†!<=1!
G
n
M)W",7
8m8> ; 2o!76i3 C )9/
L F)6A5P
( !7^Vi !2
& $ -E18%07+42N0M;OD/;K21D7/~:
P& †
9+ i1i€
i!<i$%P^L E
7Vh!2
& $\:P&
m8> ;DC 98-<Fu/@ w7VZP&/m8>Gw C 98! + 7LAg\<!7V
!& )6R!M­^995. V'#$%P~T PP& &S9
m8> «x  ˜  D x 2B˜  D q;4C L—g\8T !7—8d2$(
2!
m8>v5˜  2j(˜  D q ;DC @ m8>?3 2}3 ;DC L g\<!7V~Q67!-9
!0761304650798;:R:
P& Fm8>?. C 97L
g\AP{( 4)oA67GD
("
NP& AT PP& &
!
G1PS)S+ #! + G1
("Z
d$-m8>?. C P
7LHg\W
&!9P P
d$-
9
2 <a! 67!-9
!0761304650798;:PL
¬L 4Ma”£D¢a¥?‘Ž®v‘£ ¢?’¥:Ž75§ ¨£‘ n¢¦M¢ 6F:§)£ 65£¥X:£ ¨¦¢¥ ŽH Ža”A¡¢v£¤BŽ"P‘G’Ž"“” a” £8Ž7§ ’‘¢a!” 6 !0761304650798;:0‘£®
¨¢‘£¦Jm8>?.
. 2 ;Aqr sC ¦v Ž7“£ ?a%4Fg\~)
†!
GJP4!%&4%2W~*
("!<:!
G=P
)
W2=P=m8> ; 2M!6i3 C &67
!$6)
(")Y!<i2W2L†_—#( + qQ8 x d2$
m8>10 0 « P4—A)6
("
?Vh)
S!
G8$%
B0x 67C ("
N49!GR + !—&6
_
L F
7V~n
( + d2$-
m8>?I x ;C R)—D6
(7
+ 4n
! + GR
("
?VJ ( + d2$-
Mm81> 0 x 0 0 8 x 0 C @•m8> ;Qqr sC
P
7L=g\<!7V[P
[d2$-&!1G![[P() + m x D qq I x ; 2 ;Qqr s LRg\1T !n)1d2$)(
2N!
m8>?3 ; 2 ;Qqr s
C @bm8>?. 2 ;Aqr sC L4g\5T PP&
&QP[
qbP
m8>v(˜ V C &67e~[<> €P Y C *X
(7
7
!&6[!J­^
995 L F
V
MP
R
d$-&/!AG!H q )0Sw*v
("\m8>v˜  D qC @
m8>?3 LkyX— !G57V\k& 67!"< q —Qw*v)("
[
T PC P& &n)2!+ m8> ;DC & 67
—4! + G5)("
?L g\ + W2V
M
q`d2$-
Hm8>?3 @bm8>?. P
7LSg\<!7VZ
6!-9 !0761304650798;:#;Dd2$C -
=m8>?. C 2 ;Qqr sC P
E
( + !"fL
4. THE HYBRID SHORTEST PATH ALGORITHM
¶ ("
5M
&67 F@ju> t^:´ R 8Fu*v
("
!,:V5)2*
6)!PZd$WR
!7)GE)DC V T&68#
&67+ H2!M8$% *
PR<z!79 t4! RM~$%6I 6?V M8>cQu P—w C *v)("
?V
+%::"tS<!9Ps& &}RM$N%:6k!&WoJŒP("DG
[N
x 6D 6W2q VNVx D q L=6g\)6k1d2%:$ WM
95pW
6)*X!$
[!
GZ867!-9 P&HF!2!7,$H8+ E
( + <!F%:!& [("
L
g\G
6W!:!7&/)1:#<!H)! G
(7
$ZJ2W %)&NPH( + <!Z%:!& Y("
LZg\hW + % z&N
( 2E
Q!
GEPD%: S%:!&~("
KG$G+\%2WNd2$
J!<f6$)&J("
L=_ + ¨<¢ "£~¡£‘X£ E\N*
&
!J("T<!F9!EP4!~("T5RE& !
95-TH9
9
26JP8( + <a!h%:!&i(")
LZg\
P4( + <!E%:!&[(7
!GF!<Y!
G[PR
!9:!7&0!7W/%W/!GPH<z!79 S%:!& ("T!
N![%:!&J(")
1>?
#t†)6 L C LiŠ=4! + !<Z &*
!E95-TM
2J8!
GJP4
N
!
:!7&6
!
$zJ!7$#(7TM[F!2!L
D ¬L ^”£n¥¨ 6.£‘—’ 4 ¨<¢ 2£n¡£‘?¢c“£¦/¢a¥ Žo¦G”’‘X£¦
 Ža”—?‘££D’ 4RŽR Ža”0¡¢c£¤ 4’‘RŽQ ¦¨ ‘GŽ”ª¢¥—a”£4§’¤i£¦H§)£¡£§
¢¦\m8> ;DC ?a%4F‚i!
6~$9H%:\!<Y67$z& ~("
V !G
i<!=F!
GZP#iZF%)WN
LZU \J!+ G
2 #/BA D/6304;Q6:DK +8+M0Z6804650798;::> t^´RP´Y C
w7L q > V >u^t ´R C FC5D7989:D46IDK+K qQ8 > V ´et ´ R ˜L q=< F*FXU
™ L F F G >uet ´Ÿ´Ÿ C
L FR & 8 > V PrtKgc
>c C F G >uR v´ ´ C
¬L # />v±7´² C & q > V >uet ´:R C g
>c C >ut X´:ez >ut C ´ C F ;8 07L684/21:> C
>?% C F P`t >? C =q < F =q < >ut ´:ez >ut C ´ C
>c& C $. 2 It @{ G ²-g
?L R >ut ´:t Cuy & 9 >V
_#L ez >ut C 230->ut ´ t Cuy 0 ~oez >ut C #/cj!
ez >ut C F ez >ut C 20>ut ´t Cuy 0
F >ut X´t C y
F t ?L1>ut ´%ze>ut C ´ C F G +8 07L2804/21P> C
?L! F Prt (:Lq=< F q=< >ut ´%ze>ut C ´ C
>? C xt & g G
?L ez >ut C F " F#
>< C 4 >?²P´ t Cuy & 9 >V
?L ez >ut C F 0->?²P´t Cuy 0
?L F >?²P´ t C y
>?6 C FXU
L *
q F 07 D7L :><=q <J´:R C
!%
"%
*( >c C ›~
G!7E1e(")
L
! %
%
>?% ›~G)!7~H!-WD%:!& F("*
C L
c#Lj,A#smj#/=#L*,-!g0+
gZ3+#/f5*,sf!
2 *$&*,A# 2 *3+ 2 + +! 4
4~<!E$%6MN! GF
("
fP 0 0("
V
N0 > 0"2!J!& iPJ+ ~6$)&F("
> Lhg\*
<a!7Vi
!& )6D!Q­f
995QwVY5$9%:H!<J67$)& M(7
A8!
G~
1<!N$%6D1! + GN
(7
e
m8> ;4C L
g\~2W %)&PM( qQ8 V <a![M
67!IYZRF! G
(7
E!<N)Wª+ M> )("&—<z!79 D!
:!P+&6
S( + qQ8 > V L1yXS!&~!5 qQ8 > V V'A67$z& ("T
Hz& 2-OP&/0("i!T< qQ8 > V LQ_ 2W %)&/P/( + 9)9
2&5[H &
![~95-T + !7E
!7$9
Q!-Wkz&k!n67$)&S("
8 > V &k%:!& 4(7
V L1t$ VP &
!~z!7DFP95-T
J> !7WMT &4R9!<Z67$)&~(")
L
_Jo*c
67!71d2$Wª<a!D{&6—u> t^:´ R Bkw*v
("
+ !,1Z:<!9&H%2W1hW % z&1!
G=PC V 86!-9L
g\H67!-9 $
N$%6Z
6 V P&A2W %)&SP
( + qQ8 > V ) <!95!75!& h!NOP&8> ~6E!
GhP
q <z!79 t8"! RH)! G\
("
6)!. YL qQ8 V &
)%:=
!
G\P59i+ !<e6$)&F("
i1P> ):!
G
q V u> t^:´ R L{g\<!VJD6!-9lT PP& q V u> t^´ R
OP& )6> Sd2C $
R!<~$%%: + —
!7
$("4> 67$)& C
(7
[ q > V u> te´ R C L
g\k67!-9! %0/6304+Q6:0K"%+8M0Z280465D7989: %:)! /
!
G\P
Uq=< + !7F!2!\
2iJ+ !7$ E(7*
Z
T teLS_` !-|W/d$
$¯$&Q!S,"
Q,!<J\*
<a!95)!
)&4!HN
$ 2[("
JK 8F> V PZq=<1LiŠh
W u> te%´ zeu> t C ´ C 2Q(7[
T t ª—
G-*
951
!7G?ze>ut C P&D8 &
!F& 672L\g\1+ †,"
,—!<ND("
5 + !A!7GMR!MOP-|Wª&fV
!7
d$
2-W2V + e%:~[<![NT$%P4fL
#%
&'
*(
t†-GVZ6!-9BOPP& :ZPz"!
G† q V u> te:´ R
$681!2
&$^5D768;:D46IDK;K (J("
[12> W %)& C
PS( + qQ8 > V >?G
0w C L1yX-)-W2cV q=<jN
9XWP&$ P
†(7
-D
!7GE&4& !~& 671d2$Pf!% V%$
[!$
[("+ xT t + !F!7G\hŸ>?G
i˜V™NP.& C LZg\
fV
~67!9bOPP& [!
GJ$%PMK 6 V> !
:!7&6
!1& 67#>v±"´G² C [P)P!
GiPD>?G4¬ C LZg\
!
G$%P8<!5&6F\!79$ &M#9) W
!›E K|,G [!G[PR6!-9L E! + ("VF
$+ GF!<fJ!-XW5d2$
$B9hPiF\!1
&8!
!)&i[("
i-& Ws q=<k<a!\J$
2h$%fL
g\<!7VYA<!7! + 6S1-)&pKG$G + -
Y
95)6M("
8>?G/¬2L L_JY
!7G1P&S& !
& 67
4SM!'oVJ%$ M("
C M
!7
&k!n²ª("D-
!GP& &
!H&6
#$'&&A!R
11
T J!$
#("TME² + -D
!G~d2$P^!5Ÿ>?G
D¬L < C LJg\
$%PS<z!79 tAs! R4~
!9$ &%2W4("l6 q=<p<z!79 R
$6~ !2
& $ #%07 &'D7L*(Q>?G
C L
y|5 !G[7VFW % z&!
G[R67!9bP
[9[+ 9\d2$9
2ii›~ K|, G+ i6)*X!$
F!*
GM6!-9L F! + ("V2E$9H%:=!<e("
h( -&
%2WFW % z&!
G[R67!9b9$95
(")
—(7
4$-<!9-W0& G)%$&nn
6)!5
!
+ :!P& )6N!~$%65&6$)&[("
F$<a!9-W5& )G%$&5!681!
GS>?
~t†6 LPž C L
U J[$%6I 6 V &[W % z&85( qQ8 V J$h<a!\[W % z&8> !
G\PM)6!-9+V2F> d2$-
9#<!4)6!-9 )#M9R<a!8A6*
!7$ N!
GFP467!-9L
>c U!
GSP}
<a!FC %:!&F(7
L
>?% ›E K|,G œ 67!*
-C 9L
>? C F W %)&R67!9L
a"#Af5*,F3cf,/#Ljg[hr#AH,/#Lj,A#Qmj#/Z 2 #AA;,54
D L^”£J”05‘¢<8 ¦G”’‘X£¦e Ža”Ž7§ ’‘¢a”!6`‘£%¨¢‘£¦
m8> ;C ¦c Ž"“£ ?a:4 g\—2W %)&BPp( + qQ8 > V d2$-
Am8>10 > 0 8 > C L
F
7V
!& 6!­^
9954wDP& ¬2V qQ8 > V d2$-
5m8> ;C
L=g\\) P q V d2$-
Zm8>10 8 0 2 0 0 @om8> LJg\1P
Nd2$-&> %2W51Uq=<#> V!> -C XWd2$$ ; C
P&D Nm8>10 8 0 L^E
7V=q <1V `P& d2$-m8>
Lig\E[!<†> & 67C 9 > d$-
m8> ;DC P7Lhg\<a!;7C V
F2W %)&!
G\P567!-9 d2$-
im8> ;DC L
_JQ$-<!9 &G%$ )!!<("
1Q! GH
("
Z
!79)& + Q8$9%:N!<(7
; n+ 4%:!$&&
67!7S
P& J!5O-|W4&4#
!7
G~P-E!<=:!72EF
& GR6HPn!79595\
!GLAg\ W2VY
!
GRPk
&!n/G6RA&ªD$+ 9H%:!<
(7
[D!
GJP4Jm8> ;DC L
D ž2L~¦¦¨ 65£1Ž¥D¨¥¢ 4’‘ 6 ¢¦?‘u¢ ¨ ?¢?’¥Q’ 4E¡£‘?¢?“£¦
¢a¥Aa”£H§’¤i£¦\§)£¡£§†Ž+¥ Ma”£ ¨<¢ 2£#¡£‘?¢c“£¦#Ž‘£Ž7§ ¦’5¨¥¢ 4
’,‘ 68§ ¢¦?‘<¢ ¨X£ kŽ§’¥ Ž/¦” ’‘X£¦~ Ža” ^”£D¥¨ 6£‘A’ 44¡£‘?¢?“£¦
¡¢a¦¢aX:£ l8a”£N” p ‘<¢ ¦” ’‘X£¦Y Ža”SŽ7§ ’‘¢a” 6¯¢¦\m8> ;C ?a:4B_F$9)6DM67$)& 4("
R$-<a!9-W0&G-*
%$&R!768~!
GFP^V ~$9%:H!<Y(7
[%:*
+ 0 + !A
!7
$ )(7R6$)&M("
HªD!
Gn
m LFg\#$9%:F!<=("
F( -&DA567H
<a!!
G$%%: + + !D
!7
$ )(767$)& M(7*
iim8> « C LZg\) + W2V"\! $9%:Z!<'("
h()-&
8m W 0 8 > 0 « X LAg\T !7n
d$(7)1!Sm @
m L8g\<a!7Ve$9%:E!<\(7
N(
&Q%2WD
2W %)&M !
GFP)6!-9¯Jm8> ;DC L
_F$96(7
J1$-<!9-WR&G%$ &fV F$6
9d2$-
9
2Y<!iJ2W %)&!
GiP567!9 %:*
!9
Jm8> ;DC 4E)! + GE
(7
?L
O LE¦¦¨ 6£#Ž¥D¨ ¥¢ 4
’,‘ 6_¢a¦?‘<¢ ¨?¢c’¥Q’ 4E¡£‘?¢c“£¦
¢¥Sa”£1§’¤i£¦\§)£¡£§†Ž¥ 5a”£ ¨ u¢ 2£1¡£‘?¢c“£¦HŽ‘£Ž§ ¦’¨¥¢ 4’‘ 6§ ¢¦?‘<¢ ¨X£ Ž7§’¥ Ž¦G”’‘X£¦ Ža” ^”£” p‘<¢ D¦” ’‘X£¦\ Ža”
Ž7§ ’‘¢a” 6¯¦c£+¥ ¦Jm8> ;DC ?¢ 65£~¢¥Da”£H§’¤i£¦\§)£¡£§ ?a%4 g\RP0!2!7,$—nM2W %)&/P—( :P&
9km8> ;DC L g\k!XW d2$
$—))€!7 + d2$
m8> 97Lh_F
!& )6!­f
9958ž2VE $9%:\!<Z("
(;D
C &{%2W—A6!-9 )4m8> ;DC L g\) + W2V[Q67!*
-9 :
P& \m8> ; !76 ;DC 9J !;8%07L684 /215!:!7
&ª
!G5$'&
L g\D)6!-9 :P&5m8> 94
E&)-z)€)6 !7
)6!7$ H(7;D
C LFg\*
<!7Vi467!-9·:
P& 8m8> ; !76 ; 2 ;C 97L—U
!76 ; @om8> ;C VJ2W %)&!G[PM)6!-9b:P&
m8> ;DC 9~R~! + GF
("
?L
g\%:GH95&P
d2$-
9
2~<a!H)2*v67!7
d2$
M S! + G4)("
E4
!9& %2W—S2W %)&
!
G5P—67!9l$9)6ª$-<!9 &G%$ !7
!<\("
L5t!16#
("
V^%:G1G
6W
!
6
9JP&8
[
!$
i)=[P() + !7R& OP6
IJ@{˜L
/R
QF!"—P$%'& )()&
+ !,42!
67!7 + -D191$9H%:[!<=(")
~P&
\)6i
("
\966#N
!7G2\$9H%:=!<e7&K
2
6)!
Lhg\F2W5
!79
-W5&OP
&5%2W8E$9H%:
!<Y67!7J3H4~! + GE
("cV E $9%: ; !<Z(7
[!<
67!7AAH! G1)("
?V^P&H966R&
6
IL~/
!:!7R67!-9+ H!DOP&nD!
G80&!ST P&
[P^L
g\R
!79T XWnP-W 8<!8
467!-98! P
!7$ Z)
P !"d2$Zm8>?. C d2$WN)9\P+ &#P*
53N@ @ .P&IJ@{˜LhU
J!7$ !7Ri!7 *
+ $ ("7Ve8; !9T -|WA
!7G2195cL F
Ve-#
9!E]
2[4 + 4
!9P&M!H!
$("
!7 95^ !"
L
_2W %)&E!
GeP167!-9B!:<a!9B*c
67!7
d2$
11!& $
&fL5g\)1G
6WQ$
1R$%
d$
8!<
("
ZZ%:
!6E!J\!
G=P + )[$P)-WH
!798*
$ 6 + !)1!
GFP^L=y|4~! + GF
("
?VN2W *
%)&Q67!9d2$-
1m8> ;C )9&A
5$964
$-<!9 & )G%$!7D!<h(7
L[g\)FF%:FD8
( + !"d2$-
Jm8> ;Aqr sC P7L\t!J67J
(2*
V:#PD() + !7A:P&Fm8>Gw C 9HP&4d2$
m8>?I x ;DC P
7L
g\\67!9Z)#hP!78)!N 2Z
67!2!&:!
2)'<!J
€!^Lg\NP4T P!7495W
T PP&M$%PM<a!E:
-OPN
(7
^)
?L
y|0!&!A$:!8R![$- D
("&'V
!9$!7P†T :9
2J$6† + !, J+ !5
(7$P
#9P&SP8]
WD<!1!7$ 1= !"
5. CONCLUSION AND FUTURE WORK
!7$z&n%:M9
9
2&'LSg\
4&-‹'
2HG
6
!S:*
<a!9°2*c
67!PPd$
Z\! + Gi
(" + !$)&%:
!98*
& ›~ KG,Gœ 67!-9VZPn() + !2!7,$0P&/2W %)&
!
GJD)6!-9L
–wšN›REFERENCES
LP‚i
4& L -E$^LU!GF4d$
[4)P
6
LPy| ‘G’“££¢a¥ ¦#’ 4~a”£"¥+ X 6E ’¦¢¨ 6
’¥ ^”£’#‘ R’ 4
=’76EP¨?¢¥ V6
!2žO Lf_J‚QVW
˜ŸŸ7ŸL
– ˜š 1L›~2JP& LP…†?L ¶ €
&%:
G*cOG[
G67
~P&5~!95-|WM!<=_ 2L ’¨‘¥PŽ7§†’ 4Na”£
SV™"˜>c™ C ¬Ÿ7¬ ¬™ V $-WSw 5O7¬L
– ™š1ŠL›~ K|, GL:_B!N!R + !8 !7%
9[4!7
!7
+ w 7-¬7L 6
L E¨ 65£‘¢¦“”£ QŽa”£ 6Ž?¢ "V^w 7˜ 7˜7žwV
– ^š HL›iK|z&KG
(:LŠZ]8
2E67!-9[<a!F!
GJP
d2$
[zPE& 6
Ly|
\‘GŽ” ® ^”£’‘£?¢c“
=’¥P“£X?¦#¢a¥ =7’ 6EP¨X£^‘ P“¢v£¥:“£ ¥X£‘¥:Ž?¢c’¥:Ž7§
4’'‘ "¦G”’!
 "\V^$w 7 L
– ¬š ¶ Lt&),!7fLPtPGF67!9<!F!
GJP[
)PJ6
V + -D)!
%L D # =7’ 6FP¨ )V
w 9> C wŸ7Ÿ PwŸ7˜7˜2Ve›~
9%:~w (O"žL
– š ¶ Lt&),!7fLP…Z)PE6D&
!79:!7-!7P&R
P-J!
GFP
$L ’¨‘¥:Ž7§Y’ 4Na”£ SV
5™ O >Gw C w 7˜ ˜7Ÿ V "$PWQ$w w7L
– žš QLt&95P%& 1Lg†?KGfL:t†%:!7
^J&M
-
$J9 !(7&M + !,5!7 9)€
!7D67!-9
L
’¨‘¥:Ž7§e’ 41a”£ SV7™ >c™ C 7¬ 7 w¬2V $-WSw 5O7žL
– Oš QL ¶ !2!& fL:…Z)PEP!F&4P
e:!W 6!7
)67$))!^Ly|& \‘’“££ ¢¥ ¦’ 4Na”£ 'a” 6E ’¦¢a¨ 6 ’¥ ^”£’#‘ M’ 4(=7’ 6E¨ ?¢a¥ VP6
E¬Ÿ")ž ¬2w L
_J‚ Q*V WAw 7"˜L
– šN‡HL 76 ,V +HL *vpL F$P6V&Š-L J$&
G
L
E^
!& &44( + <!E4d$W
!2
6 _FR!7 )95^9!& f&R-[:<!95
($P!7^L /.0.1. ‘GŽ¥¦Ž"“?¢?’¥¦#’¥ 21¥P’¤[§)£ £Ž¥ #Žv3
Ž .\¥ ¢¥:££‘¢¥ Vew
Ÿ>c™ C 7Ÿ "™7˜VZw 75O L
–-w
Ÿš1›L 7!7!^LŠZ])F)6!-9<a!F!GFJ
P1 + !,
L ’¨‘¥PŽ7§†’ 4Na”£ SV˜ >Gw C 4w w™ V
" $WAw 7ž7žL
–-wwš#…†L N
fV:U:-L F! *V Q,L E$^V&DU'LU$%95z^L
tPGJ!G*XD67!-9[<a!J)PJ6
LPyX
\‘’“£:£ ¢¥ ¦#’ 4Ea”5£ 76a” V 6E ’¦¢a¨ 6 ’¥^”£’‘ M’ 4
=7’ 6FP¨?¢¥ VP6
F˜7)ž ™"ž2L'_J‚ Q*V WAw 77L
–-w˜5š 1LP­f) !74P8& #Lg†?KfL:_B
P!J!
9`<a!
)PJ6
L D # i":§ $QŽa”VP7™ wžž /w O VYw 77ž L
–-w
™šHU'LPU ,PV_1LtV& 9FL ¶ !W?L )€)!
7& *v!‹'[^!GF467!9
LPyX
QLPU !7^&_#7L :=!7&'VP& !
%V D&; <>= \‘’“£:£ ¢¥ ¦H’ 4~a”3£ ?a” ¥X£‘¥PŽ?¢c’¥PŽ7§ 6E ’¦¢a¨ 6 ’¥
¡Ž¥:“£¦1¢¥ 7 Ž?¢cŽ7§ #ŽvpŽ Ž¦£¦V'("!)$9Hw7˜ "˜8!1< @†£“?¨‘£
N’X£¦N¢¥ =7’ 6FP¨X£‘ P“¢v£¥:“£VP6
7Pw7ww7L
U 67A* :=)6 V^$w 7žL
6.