Added test mode, will send position from args directly to motor