Geometric Fundamentals of Robotics - Selig, J. M. (Springer New York, 2005)