Multibody Mechanics and Visualization by Harry Dankowicz