Arduino PID seems to work