Implemented the new PID idea and the userInterrupt