Fix typo in Joint.cpp
Clean up testDynamics.cpp