MotorControlThread receives and sends data.
LCPThread sends BT messages.
Added logic for robot control thread management.
Merge branch 'robot_control' into develop