Multiple fixes for contact-related algorithms, make them working