Changed controllers gains. Paramtrized ROS blocks.

Now the user has to choose only the number of robots he/she wants to simulate and all the model is parametrized.