Optimization-based Formation Control
All robot has randomly initial positions and velocities.
Followers will pursuit the leader such that the energy of the whole system is minimized.
The target velocity of the leader is (1,1) m/s.
There are three simulation cases with 6, 10 and 30 robots in the demonstration, respectively.