Added : motor command, draft of comm protocol