public void FromBPoseToAPose()
{
Pose bFromA = POSE_B.From(POSE_A);
Pose recoverB = POSE_A.Then(bFromA);
Assert.That(AreVector3sEqual(recoverB.position, VEC_B));
Assert.That(AreQuaternionsEqual(recoverB.rotation, QUAT_B));
}
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 ToPoseBFromPoseA()
{
Assert.That(ArePosesEqual(POSE_A.Then(POSE_A.To(POSE_B)), POSE_B));
}
public void FromPoseBToPoseA()
{
Assert.That(ArePosesEqual(POSE_A.Then(POSE_B.From(POSE_A)), POSE_B));
}
