Kinematics and Dynamics of Mechanical Systems, Implementation in MATLAB and SimMechanics, Kevin Russell, Shen & Sodhi, 2nd Edition