Formation and avoidance control of multi-robot