Brian Paden, Michal Čáp, Sze Zheng Yong, Dmitry Yershov, Emilio Frazzoli, A Survey of Motion Planning and Control Techniques for Self-Driving Urban Vehicles, IEEE Trans. Intelligent Vehicles, 1(1), 2016:33-55, DOI: 10.1109/TIV.2016.2578706