Added some motor functionality to arduino code