Update ContactGeometry.h