Move to initial position implemented