Added derivative support to PID Controller