Robot motion planning and control - Laumond, J.-P. (Springer, 1998)