improve StepMotorDriver setposition velosity