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