Improved physics: Finished SetMassInertia for polygons