Cleaned up pid-controller.py with documentations and erasing redundant code.