Update controller.c

Part of PID Code Included