BIG: Fix collision order
Adds sorting for collision constraints and modified how the insertion case is handled for the capsule to surface mesh CD.
Adds sorting for collision constraints and modified how the insertion case is handled for the capsule to surface mesh CD.