PID controller now returns a waitHandle
Removed position PID from motor class