|
Algorithm 1 Guarding-Circle Collision Avoidance. |
-
Require:
Set of robots ;
-
1:
Latest pose vector for each ;
-
2:
Guarding circle radius ;
-
Ensure:
Control command set ;
Stage 0 - Offline Configuration
-
3:
Choose based on worst-case stopping distance, robot dimensions, and safety regulations.
Stage 1 - Digital Twin Update
-
4:
Receive feature packet from the edge observer and update the state of the digital twins for all .
Stage 2 - Overlap Detection
-
5:
Initialize ▹ Set of potentially colliding pairs
-
6:
for all do
-
7:
for all with do
-
8:
Calculate distance
-
9:
if then
-
10:
Add pair to conflict list:
-
11:
end if
-
12:
end for
-
13:
end for
Stage 3 - Conflict Resolution
-
14:
Initialize all commands: for all .
-
15:
for all do
-
16:
if then ▹ Example priority rule: faster robot yields
-
17:
DecelerateOrStop
-
18:
else
-
19:
DecelerateOrStop
-
20:
end if
-
21:
end for
Stage 4 - Actuation
-
22:
Transmit the final control command set to the physical robots.
|