Consistent penetration depth estimation for deformable collision response