本文整理了Java中us.ihmc.euclid.tuple4D.Quaternion.distance方法的一些代码示例，展示了Quaternion.distance的具体用法。这些代码示例主要来源于Github/Stackoverflow/Maven等平台，是从一些精选项目中提取出来的代码，具有较强的参考意义，能在一定程度帮忙到你。Quaternion.distance方法的具体详情如下：
包路径：us.ihmc.euclid.tuple4D.Quaternion
类名称：Quaternion
方法名：distance

Quaternion.distance介绍

暂无

代码示例

代码示例来源：origin: us.ihmc/euclid-test

@Test
public void testDistance() throws Exception
{
 Random random = new Random(5321);
 for (int i = 0; i < ITERATIONS; i++)
 {
   YawPitchRoll firstYPR = EuclidCoreRandomTools.nextYawPitchRoll(random);
   YawPitchRoll secondYPR = EuclidCoreRandomTools.nextYawPitchRoll(random);
   Quaternion firstQ = new Quaternion(firstYPR);
   Quaternion secondQ = new Quaternion(secondYPR);
   assertEquals(firstQ.distance(secondQ), YawPitchRollTools.distance(firstYPR, secondYPR), EPSILON);
   assertEquals(firstQ.distance(secondQ), YawPitchRollTools.distance(firstYPR.getYaw(), firstYPR.getPitch(), firstYPR.getRoll(), secondYPR.getYaw(),
                                    secondYPR.getPitch(), secondYPR.getRoll()),
         EPSILON);
 }
}

代码示例来源：origin: us.ihmc/euclid-test

@Test
public void testDistance() throws Exception
{
 Random random = new Random(32434L);
 for (int i = 0; i < ITERATIONS; i++)
 {
   AxisAngleReadOnly aa1 = createRandomAxisAngle(random);
   AxisAngleReadOnly aa2 = createRandomAxisAngle(random);
   Quaternion q1 = new Quaternion(aa1);
   Quaternion q2 = new Quaternion(aa2);
   double actualDistance = aa1.distance(aa2);
   double expectedDistance = q1.distance(q2);
   assertEquals(expectedDistance, actualDistance, getEpsilon());
   assertEquals(0.0, aa1.distance(aa1), getEpsilon());
 }
}

代码示例来源：origin: us.ihmc/ihmc-manipulation-planning

public static double getDistance(RigidBodyTransform from, RigidBodyTransform to, double positionWeight, double orientationWeight)
{
 Point3D pointFrom = new Point3D(from.getTranslationVector());
 Quaternion orientationFrom = new Quaternion(from.getRotationMatrix());
 Point3D pointTo = new Point3D(to.getTranslationVector());
 Quaternion orientationTo = new Quaternion(to.getRotationMatrix());
 double positionDistance = positionWeight * pointFrom.distance(pointTo);
 double orientationDistance = orientationWeight * orientationFrom.distance(orientationTo);
 double distance = positionDistance + orientationDistance;
 return distance;
}

代码示例来源：origin: us.ihmc/euclid-test

double expectedDistance = q1.distance(q2);
assertEquals(expectedDistance, actualDistance, EPSILON);
assertEquals(0.0, aa1.distance(aa1), EPSILON);
double expectedDistance = q1.distance(q2);
assertEquals(expectedDistance, actualDistance, EPSILON);
assertEquals(0.0, aa1.distance(aa1), EPSILON);

代码示例来源：origin: us.ihmc/euclid-test

double expectedDistance = Math.abs(EuclidCoreTools.trimAngleMinusPiToPi(q1.distance(q2)));
assertEquals(expectedDistance, actualDistance, EPS);
assertEquals(0.0, RotationMatrixTools.distance(m1, m1), EPS);