Tuning the pid controller.
Fixing some changes