bugFixes to ConstraintGroup/Orientation methods

  - ConstraintGroup: propagate SetIK() to child Constraints
  - ConstraintGroup: size Jacobian as matrix not vector
  - GoalOrientation: use correct ordering of goal-pose in CalcError