Adding encoder and improved motor interface(untested)
Motor and serial headers are now in sync
TBD: 1) Check and regress motor functions
     2) Sync motor and encoder headers