Revert "Debugging contact constraint for articulated body systems"

This reverts commit c6c2b1daa35e17c05f9b633ddfe3936278c56228.