Updated inverse inertia for rigid bodies to use faster inverse matrix