working xboxjoy to servo test
cleaning out code, will finalize later