|
Algorithm 2 Planning the AUV trajectory in PNCS-GHA |
|
Input: The constructed probabilistic neighborhood covering set S; the locations of nodes in S; |
Output: The traveling path of the AUV, P;
-
1:
m = ;
-
2:
for
i = 1 to m
do
-
3:
= ;
-
4:
= distance from to the surface control center;
-
5:
end for
-
6:
= {arg min {}};
-
7:
= ;
-
8:
= 1;
-
9:
P = {};
-
10:
while
do
-
11:
for
i = 1 to m
do
-
12:
if
=
then
-
13:
= distance from to ;
-
14:
else
-
15:
= ∞;
-
16:
end if
-
17:
end for
-
18:
= {arg min {}};
-
19:
= ;
-
20:
= +1;
-
21:
P = {P; };
-
22:
end while
|