A New Algorithm for Distributed Control Problem with Shortest-Distance Constraints

Figure 2

State trajectories of agents 1, 2, 3, and 4.