Planning Algorithms - LaValle, Steven M. (Cambridge University Press, 2006)