Update controller.c

Further PID changes