Markus Trying to get PID working