Rewrote quaternion difference in AngleConstraint