Added Motor Class

Re-organised files to use libraries.
Added motor class