Inertia Moment calculation fixes