public void FromAPoseToBPose() { Pose aFromB = POSE_A.From(POSE_B); Pose recoverA = POSE_B.Then(aFromB); Assert.That(AreVector3sEqual(recoverA.position, VEC_A)); Assert.That(AreQuaternionsEqual(recoverA.rotation, QUAT_A)); }
public void FromPoseAToPoseB() { Assert.That(ArePosesEqual(POSE_B.Then(POSE_A.From(POSE_B)), POSE_A)); }