- Store collision manifold points as local to body before applying them, this way penetration can be calculated exactly for each contact point - Fix implementation error in closest_point_between_segments - Calculate separation for each contact point separately