Commented out testDynamics, testForwardKinematics, and testKinematics. (These tests will be uncommented at last).