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

YoFrameSE3TrajectoryPoint介绍

暂无

代码示例

代码示例来源：origin: us.ihmc/IHMCRoboticsToolkit

public void set(SE3TrajectoryPointInterface<?> se3TrajectoryPoint)
{
 frameWaypoint.setToZero(getReferenceFrame());
 frameWaypoint.set(se3TrajectoryPoint);
 getYoValuesFromFrameWaypoint();
}

代码示例来源：origin: us.ihmc/IHMCRoboticsToolkit

@Override
public void setToNaN()
{
 super.setToNaN();
 setTimeToNaN();
 setPositionToNaN();
 setOrientationToNaN();
 setLinearVelocityToNaN();
 setAngularVelocityToNaN();
}

代码示例来源：origin: us.ihmc/ihmc-robotics-toolkit

@Override
public void setToNaN(ReferenceFrame referenceFrame)
{
 super.setToNaN(referenceFrame);
 setToNaN();
}

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

YoFrameSE3TrajectoryPoint yoFrameSE3TrajectoryPoint = new YoFrameSE3TrajectoryPoint(namePrefix, nameSuffix, registry, worldFrame);
yoFrameSE3TrajectoryPoint.checkReferenceFrameMatch(ReferenceFrame.getWorldFrame());
yoFrameSE3TrajectoryPoint.setIncludingFrame(worldFrame, simpleTrajectoryPoint);
yoFrameSE3TrajectoryPoint.getPosition(pointForVerification);
yoFrameSE3TrajectoryPoint.getOrientation(quaternionForVerification);
yoFrameSE3TrajectoryPoint.getLinearVelocity(linearVelocityForVerification);
yoFrameSE3TrajectoryPoint.getAngularVelocity(angularVelocityForVerification);
assertEquals(time, yoFrameSE3TrajectoryPoint.getTime(), 1e-10);
assertTrue(pointForVerification.epsilonEquals(position, 1e-10));
assertTrue(quaternionForVerification.epsilonEquals(orientation, 1e-10));
assertFalse(yoFrameSE3TrajectoryPoint.containsNaN());
yoFrameSE3TrajectoryPoint.setPositionToNaN();
assertTrue(yoFrameSE3TrajectoryPoint.containsNaN());
yoFrameSE3TrajectoryPoint.setPositionToZero();
assertFalse(yoFrameSE3TrajectoryPoint.containsNaN());
yoFrameSE3TrajectoryPoint.setOrientationToNaN();
assertTrue(yoFrameSE3TrajectoryPoint.containsNaN());
yoFrameSE3TrajectoryPoint.setOrientationToZero();
assertFalse(yoFrameSE3TrajectoryPoint.containsNaN());
yoFrameSE3TrajectoryPoint.setLinearVelocityToNaN();
assertTrue(yoFrameSE3TrajectoryPoint.containsNaN());
yoFrameSE3TrajectoryPoint.setLinearVelocityToZero();

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

String expectedNamePrefix = "test";
String expectedNameSuffix = "blop";
YoFrameSE3TrajectoryPoint testedYoFrameSE3TrajectoryPoint = new YoFrameSE3TrajectoryPoint(expectedNamePrefix, expectedNameSuffix,
                                             new YoVariableRegistry("schnoop"), expectedFrame);
testedYoFrameSE3TrajectoryPoint.set(expectedTime, expectedPosition, expectedOrientation, expectedLinearVelocity, expectedAngularVelocity);
testedYoFrameSE3TrajectoryPoint.setToNaN();
assertTrue(Double.isNaN(testedYoFrameSE3TrajectoryPoint.getTime()));
assertTrue(testedYoFrameSE3TrajectoryPoint.getPosition().containsNaN());
assertTrue(testedYoFrameSE3TrajectoryPoint.getOrientation().containsNaN());
assertTrue(testedYoFrameSE3TrajectoryPoint.getLinearVelocity().containsNaN());
assertTrue(testedYoFrameSE3TrajectoryPoint.getAngularVelocity().containsNaN());
testedYoFrameSE3TrajectoryPoint.registerReferenceFrame(expectedFrame);
expectedTime = RandomNumbers.nextDouble(random, 0.0, 1000.0);
expectedPosition = EuclidFrameRandomTools.nextFramePoint3D(random, worldFrame, 10.0, 10.0, 10.0);
expectedLinearVelocity = EuclidFrameRandomTools.nextFrameVector3D(random, worldFrame);
expectedAngularVelocity = EuclidFrameRandomTools.nextFrameVector3D(random, worldFrame);
testedYoFrameSE3TrajectoryPoint.switchCurrentReferenceFrame(worldFrame);
testedYoFrameSE3TrajectoryPoint.registerReferenceFrame(worldFrame);
testedYoFrameSE3TrajectoryPoint.set(expectedTime, expectedPosition, expectedOrientation, expectedLinearVelocity, expectedAngularVelocity);
testedYoFrameSE3TrajectoryPoint.setToNaN(expectedFrame);
assertTrue(expectedFrame == testedYoFrameSE3TrajectoryPoint.getReferenceFrame());
assertTrue(Double.isNaN(testedYoFrameSE3TrajectoryPoint.getTime()));
assertTrue(testedYoFrameSE3TrajectoryPoint.getPosition().containsNaN());
assertTrue(testedYoFrameSE3TrajectoryPoint.getOrientation().containsNaN());

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

assertTrue(expectedFrame == testedYoFrameSE3TrajectoryPoint.getReferenceFrame());
assertEquals(expectedTime, testedYoFrameSE3TrajectoryPoint.getTime(), epsilon);
assertEquals(expectedNamePrefix, testedYoFrameSE3TrajectoryPoint.getNamePrefix());
assertEquals(expectedNameSuffix, testedYoFrameSE3TrajectoryPoint.getNameSuffix());
assertTrue(expectedPosition.epsilonEquals(testedYoFrameSE3TrajectoryPoint.getPosition(), epsilon));
Quaternion trajectoryPointQuaternion = new Quaternion(testedYoFrameSE3TrajectoryPoint.getOrientation());
assertEquals(expectedOrientation.getReferenceFrame(), testedYoFrameSE3TrajectoryPoint.getOrientation().getReferenceFrame());
EuclidCoreTestTools.assertQuaternionGeometricallyEquals(expectedOrientation, trajectoryPointQuaternion, epsilon);
assertTrue(expectedLinearVelocity.epsilonEquals(testedYoFrameSE3TrajectoryPoint.getLinearVelocity(), epsilon));
assertTrue(expectedAngularVelocity.epsilonEquals(testedYoFrameSE3TrajectoryPoint.getAngularVelocity(), epsilon));
testedYoFrameSE3TrajectoryPoint.getIncludingFrame(actualFrameSE3TrajectoryPoint);
FrameSE3TrajectoryPointTest.assertTrajectoryPointContainsExpectedData(expectedFrame, expectedTime, expectedPosition, expectedOrientation,
                                   expectedLinearVelocity, expectedAngularVelocity, actualFrameSE3TrajectoryPoint,
                                   epsilon);
actualFrameSE3TrajectoryPoint = new FrameSE3TrajectoryPoint(expectedFrame);
testedYoFrameSE3TrajectoryPoint.get(actualFrameSE3TrajectoryPoint);
FrameSE3TrajectoryPointTest.assertTrajectoryPointContainsExpectedData(expectedFrame, expectedTime, expectedPosition, expectedOrientation,
                                   expectedLinearVelocity, expectedAngularVelocity, actualFrameSE3TrajectoryPoint,
testedYoFrameSE3TrajectoryPoint.getPosition(actualPosition);
testedYoFrameSE3TrajectoryPoint.getOrientation(actualOrientation);
testedYoFrameSE3TrajectoryPoint.getLinearVelocity(actualLinearVelocity);
testedYoFrameSE3TrajectoryPoint.getAngularVelocity(actualAngularVelocity);
testedYoFrameSE3TrajectoryPoint.getPosition(actualFramePosition);
testedYoFrameSE3TrajectoryPoint.getOrientation(actualFrameOrientation);
testedYoFrameSE3TrajectoryPoint.getLinearVelocity(actualFrameLinearVelocity);
testedYoFrameSE3TrajectoryPoint.getAngularVelocity(actualFrameAngularVelocity);

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

YoFrameSE3TrajectoryPoint testedYoFrameSE3TrajectoryPoint = new YoFrameSE3TrajectoryPoint(expectedNamePrefix, expectedNameSuffix,
                                             new YoVariableRegistry("schnoop"), expectedFrame);
expectedAngularVelocity = EuclidFrameRandomTools.nextFrameVector3D(random, expectedFrame);
testedYoFrameSE3TrajectoryPoint.set(expectedTime, expectedPosition, expectedOrientation, expectedLinearVelocity, expectedAngularVelocity);
expectedAngularVelocity = EuclidFrameRandomTools.nextFrameVector3D(random, expectedFrame);
testedYoFrameSE3TrajectoryPoint.set(expectedTime, expectedPosition, expectedOrientation, expectedLinearVelocity,
                  expectedAngularVelocity);
expectedAngularVelocity = EuclidFrameRandomTools.nextFrameVector3D(random, expectedFrame);
YoFrameSE3TrajectoryPoint expectedYoFrameSE3TrajectoryPoint = new YoFrameSE3TrajectoryPoint("sdfsd", "asd", new YoVariableRegistry("asawe"),
                                              expectedFrame);
testedYoFrameSE3TrajectoryPoint.set(expectedYoFrameSE3TrajectoryPoint);
assertTrue(expectedYoFrameSE3TrajectoryPoint.epsilonEquals(testedYoFrameSE3TrajectoryPoint, epsilon));
assertWaypointContainsExpectedData(expectedNamePrefix, expectedNameSuffix, testedYoFrameSE3TrajectoryPoint.getReferenceFrame(),
                  testedYoFrameSE3TrajectoryPoint.getTime(), testedYoFrameSE3TrajectoryPoint.getPosition(),
                  testedYoFrameSE3TrajectoryPoint.getOrientation(), testedYoFrameSE3TrajectoryPoint.getLinearVelocity(),
                  testedYoFrameSE3TrajectoryPoint.getAngularVelocity(), testedYoFrameSE3TrajectoryPoint, epsilon);

代码示例来源：origin: us.ihmc/ihmc-robotics-toolkit

@Override
protected void putYoValuesIntoFrameWaypoint()
{
 frameWaypoint.setToZero(getReferenceFrame());
 frameWaypoint.setTime(time.getDoubleValue());
 frameWaypoint.setPosition(position);
 frameWaypoint.setOrientation(orientation);
 frameWaypoint.setLinearVelocity(linearVelocity);
 frameWaypoint.setAngularVelocity(angularVelocity);
}

代码示例来源：origin: us.ihmc/IHMCRoboticsToolkit

@Override
public double positionDistance(YoFrameSE3TrajectoryPoint other)
{
 putYoValuesIntoFrameWaypoint();
 other.putYoValuesIntoFrameWaypoint();
 return frameWaypoint.positionDistance(other.frameWaypoint);
}

代码示例来源：origin: us.ihmc/IHMCRoboticsToolkit

@Override
protected void putYoValuesIntoFrameWaypoint()
{
 frameWaypoint.setToZero(getReferenceFrame());
 frameWaypoint.setTime(time.getDoubleValue());
 frameWaypoint.setPosition(position.getFrameTuple());
 frameWaypoint.setOrientation(orientation.getFrameOrientation());
 frameWaypoint.setLinearVelocity(linearVelocity.getFrameTuple());
 frameWaypoint.setAngularVelocity(angularVelocity.getFrameTuple());
}

代码示例来源：origin: us.ihmc/ihmc-robotics-toolkit

@Override
public double positionDistance(YoFrameSE3TrajectoryPoint other)
{
 putYoValuesIntoFrameWaypoint();
 other.putYoValuesIntoFrameWaypoint();
 return frameWaypoint.positionDistance(other.frameWaypoint);
}

代码示例来源：origin: us.ihmc/ihmc-robotics-toolkit

@Override
public void setToNaN()
{
 super.setToNaN();
 setTimeToNaN();
 setPositionToNaN();
 setOrientationToNaN();
 setLinearVelocityToNaN();
 setAngularVelocityToNaN();
}

代码示例来源：origin: us.ihmc/ihmc-robotics-toolkit

public void set(SE3TrajectoryPointInterface<?> se3TrajectoryPoint)
{
 frameWaypoint.setToZero(getReferenceFrame());
 frameWaypoint.set(se3TrajectoryPoint);
 getYoValuesFromFrameWaypoint();
}

代码示例来源：origin: us.ihmc/IHMCRoboticsToolkit

@Override
public void setToNaN(ReferenceFrame referenceFrame)
{
 super.setToNaN(referenceFrame);
 setToNaN();
}

代码示例来源：origin: us.ihmc/ihmc-robotics-toolkit

@Override
  public String toString()
  {
   putYoValuesIntoFrameWaypoint();
   return frameWaypoint.toString();
  }
}

代码示例来源：origin: us.ihmc/IHMCRoboticsToolkit

@Override
  public String toString()
  {
   putYoValuesIntoFrameWaypoint();
   return frameWaypoint.toString();
  }
}