improve stepmotor with setOrigin