Started work on PID controller