A mathematical introduction to robotic manipulation - Murray, Richard M. (CRC Press, 1994)