Fix soft contact constraint