Foundations of Robotics Analysis and Control - YOSHIKAWA (T) (P.H.I.(3E) E, 1998)