Small clean-up
Fix TrfmRotateAxis to calculate derivatives correctly
Fix bug in inertia calculation introduced in d64c12a1bf6e1ffe4ec60a0c633c1c374df60270