Switching time-invariant formation control of a collaborative multi-agent system using negative imaginary systems theory

The movement of cooperative robots in a densely cluttered environment may be impossible if the formation type is invariant. Hence, we investigate a novel method of switching time-invariant formation control for a group of heterogeneous autonomous vehicles, which may include Unmanned Ground Vehicles (UGV) and Unmanned Aerial Vehicles (UAV). We have extended a Negative Imaginary (NI) consensus control approach to switch the formation shape of the robots whilst only using the relative distances between agents, in combination with those between agents and obstacles. All agents can automatically create a new safe formation to overcome obstacles, then restore the prototype formation once the obstacles are cleared. We address the oscillation and local minima problems, generated by existing algorithms, using a newly developed circle fitting approach. We also highlight the advantages of our proposed algorithms over the kinematic controller and the conventional Artificial Potential Field (APF) controller from both theoretical and experimental standpoints. Simulation and experimental results are then analyzed to validate the feasibility of our proposed approach.