Comparison of Formation Algorithms with Collision Avoidance for Second-Order Agents