PID controller for diff drive