Emilio Frazzoli, Munther A. Dahleh, Eric Feron: Real-time motion planning for agile autonomous vehicles. ACC 2001: 43-49