Modify code for getLongitudinalUnitInertia() and getRotationalUnitInertia() so similar functions have more similar code. Add comments to clarify getLongitudinalUnitInertia() and getRotationalUnitInertia()