Text this: Rigid body dynamics of mechanisms :