Added motor inversion and updated motor order

The inverted motors may need to be changed!