Added motor control and setup mode to tune the PID and more.
Added a command to jumpstart the motor in case it has been stopped.
Stopp the motor when going for a Reset.