add non-penetration contact constraints to the list of state constraints