Noticed the units on Spillman's dissipation constants
Completed force loop
quaternion stiffnesses, renamed quaternion elements
q1 torques finished, q2 in progress
All torque equations
Apply all torques
Complete equations for unconstrained motion. Boundry condition issues still need to be addressed
Updated debugging printouts and using proper quaternion matrix