Added motor control command, splite master code file into headers
Updated readme file