Multi-robot Formation Control with Obstacle Avoidance