PID working on test motor