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