Most up-to-date code as from 8/10/13. MotorControl needs the PID algorithm to be implemented. It should also receive the PID parameters as a debug msg. The encoder processing node must be created for PID feedback to be implemented