Fixed small non-rigid constraint bug

If boundary collision needs to be checked before satisfying constraints,
otherwise constraint distance will change, resulting in
semi-rigid-looking system