A Mathematical Introduction to Robotic Manipulation door Richard M. Murray, Zexiang Li & S. Shankar Sastry