Added derivative gain and changed the number of robots