Added functions for rotations

Specifically functions used to rotate coincident constraints.  Added
several geometric functions: parallel?, etc.