Made a wrapper around the Fast (integer) PID control code and removed the old one