Improve check on nonzero inertia with zero mass.

Body::_inertia is no longer a mutable variable, even though we modify it in a
const function.

Created a testBody test to test the check that a nonzero inertia is changed to
zero if the mass of the body is zero.