Collision_free_formation Formation navigation with collision avoidance Some parameters need to be adjusted