Preparing to expand constraints

Constraints from the xml file may be higher order joints.  These need to
be expanded into primitive joints.  The testing framework is close to
complete.