Use PID exactly as it is defined, implement Ziegler-Nichols to obtain the parameters. Also, odometry is verified with different speeds

The initial commit is based on the code done by Guillermo in order to control the Robotito.