Added a serial command setup

ToDo: Update readme

Changes haven't been tested on the multirotor rig