Implementation of the mathematics described in Computer Aided Analysis of Mechanical Systems by Parviz E. Nikravesh.