|
Algorithm 1 CGRInfotaxis for Multi-Agent System |
|
Input: Searching environment parameters, particle filter parameters, and agent parameters. |
|
Output: Action of multi-agent and the position of predicted source |
-
1:
for do
-
2:
for all agent do
-
3:
Observation: read multi-agent measurements;
-
4:
Share Sensor Measurements: Broadcast to all agents and receive ;
-
5:
end for
-
6:
using Equations (30) and (31);
-
7:
if then
-
8:
Resampling and set ;
-
9:
end if
-
10:
Compute Initial Temporary Decisions for all Agents
-
11:
while not Decisions reach consensus do
-
12:
for all agent do
-
13:
Decision Sharing: Broadcast temporary decision and receive other agent decisions
-
14:
for all do
-
15:
for other agent decisions and using Equation (29)
-
16:
using Equation (30);
-
17:
computation using Equation (25);
-
18:
computation using Equation (26);
-
19:
computation using Equation (33);
-
20:
end for
-
21:
select the motion control;
-
22:
Update the decision of agent n
-
23:
end for
-
24:
Check consensus status:
-
25:
if Decisions reach consensus then
-
26:
output the action of multi-agent
-
27:
of every agent computation using Equation (14)
-
28:
end if
-
29:
end while
-
30:
if source confirmation conditions reached then
-
31:
output the position of predicted source
-
32:
break
-
33:
end if
-
34:
end for
|