Removed PID service and reconfigure.
Additional removal.
Removed debug info from firmware
Added no cmd timeout to config.`
Minor changes.
Fixed bug that led to the motors not initializing.