Motor controller code w/ feedback from test

blah