src/model/contact_mechanics/resolution_utils.cc