delete AngularConstraints at end of tests
Add copy ctor for JointState

create AngularConstraint for joints that need them (but not used yet)