Reaching reference position by spiraling speed reference