CollinearityConstraint.h Node1 CollinearityConstraint.h Node2 CollinearityConstraint.cxx Node1->Node2