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

YoFrameEuclideanTrajectoryPoint.getPosition介绍

[英]Return the original position held by this trajectory point.
[中]返回该轨迹点保持的原始位置。

代码示例

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

private void initializeSubTrajectory(int waypointIndex)
{
 int secondWaypointIndex = Math.min(waypointIndex + 1, numberOfWaypoints.getValue() - 1);
 YoFrameEuclideanTrajectoryPoint start = waypoints.get(waypointIndex);
 YoFrameEuclideanTrajectoryPoint end = waypoints.get(secondWaypointIndex);
 subTrajectory.setCubic(0.0, end.getTime() - start.getTime(), start.getPosition(), start.getLinearVelocity(), end.getPosition(), end.getLinearVelocity());
}

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

assertEquals(expectedNamePrefix, testedYoFrameEuclideanTrajectoryPoint.getNamePrefix());
assertEquals(expectedNameSuffix, testedYoFrameEuclideanTrajectoryPoint.getNameSuffix());
assertTrue(expectedPosition.epsilonEquals(testedYoFrameEuclideanTrajectoryPoint.getPosition(), epsilon));
assertTrue(expectedLinearVelocity.epsilonEquals(testedYoFrameEuclideanTrajectoryPoint.getLinearVelocity(), epsilon));
Vector3D actualLinearVelocity = new Vector3D();
testedYoFrameEuclideanTrajectoryPoint.getPosition(actualPosition);
testedYoFrameEuclideanTrajectoryPoint.getLinearVelocity(actualLinearVelocity);
FrameVector3D actualFrameLinearVelocity = new FrameVector3D(expectedFrame);
testedYoFrameEuclideanTrajectoryPoint.getPosition(actualFramePosition);
testedYoFrameEuclideanTrajectoryPoint.getLinearVelocity(actualFrameLinearVelocity);

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

@Override
public void initialize()
{
 if (numberOfWaypoints.getIntegerValue() == 0)
 {
   throw new RuntimeException("Trajectory has no waypoints.");
 }
 currentWaypointIndex.set(0);
 if (numberOfWaypoints.getIntegerValue() == 1)
 {
   subTrajectory.setConstant(waypoints.get(0).getPosition());
 }
 else
   initializeSubTrajectory(0);
}

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

public void setTrajectoryParameters(YoFrameEuclideanTrajectoryPoint initialYoFrameEuclideanWaypoint, YoFrameEuclideanTrajectoryPoint finalYoFrameEuclideanWaypoint)
{
 setTrajectoryTime(finalYoFrameEuclideanWaypoint.getTime() - initialYoFrameEuclideanWaypoint.getTime());
 initialPosition.set(initialYoFrameEuclideanWaypoint.getPosition());
 initialVelocity.set(initialYoFrameEuclideanWaypoint.getLinearVelocity());
 finalPosition.set(finalYoFrameEuclideanWaypoint.getPosition());
 finalVelocity.set(finalYoFrameEuclideanWaypoint.getLinearVelocity());
}

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

public void setTrajectoryParameters(YoFrameEuclideanTrajectoryPoint initialYoFrameEuclideanWaypoint, YoFrameEuclideanTrajectoryPoint finalYoFrameEuclideanWaypoint)
{
 setTrajectoryTime(finalYoFrameEuclideanWaypoint.getTime() - initialYoFrameEuclideanWaypoint.getTime());
 initialPosition.set(initialYoFrameEuclideanWaypoint.getPosition());
 initialVelocity.set(initialYoFrameEuclideanWaypoint.getLinearVelocity());
 finalPosition.set(finalYoFrameEuclideanWaypoint.getPosition());
 finalVelocity.set(finalYoFrameEuclideanWaypoint.getLinearVelocity());
}

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

currentPosition.set(start.getPosition());
currentVelocity.setToZero();
currentAcceleration.setToZero();
currentPosition.set(end.getPosition());
currentVelocity.setToZero();
currentAcceleration.setToZero();
currentPosition.set(start.getPosition());
currentVelocity.set(start.getLinearVelocity());
currentAcceleration.setToZero();

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

assertTrue(testedYoFrameEuclideanTrajectoryPoint.getPosition().containsNaN());
assertTrue(testedYoFrameEuclideanTrajectoryPoint.getLinearVelocity().containsNaN());
assertTrue(testedYoFrameEuclideanTrajectoryPoint.getPosition().containsNaN());
assertTrue(testedYoFrameEuclideanTrajectoryPoint.getLinearVelocity().containsNaN());

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

assertFalse(position.epsilonEquals(yoFrameEuclideanTrajectoryPoint.getPosition(), 1e-10));
assertFalse(linearVelocity.epsilonEquals(yoFrameEuclideanTrajectoryPoint.getLinearVelocity(), 1e-10));
linearVelocity.changeFrame(poseFrame);
assertTrue(position.epsilonEquals(yoFrameEuclideanTrajectoryPoint.getPosition(), 1e-10));
assertTrue(linearVelocity.epsilonEquals(yoFrameEuclideanTrajectoryPoint.getLinearVelocity(), 1e-10));

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

testedYoFrameEuclideanTrajectoryPoint.getTime(), testedYoFrameEuclideanTrajectoryPoint.getPosition(),
testedYoFrameEuclideanTrajectoryPoint.getLinearVelocity(), testedYoFrameEuclideanTrajectoryPoint, epsilon);

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

YoFrameVector3D linearVelocityForVerification = new YoFrameVector3D("linearVelocityForVerification", worldFrame, registry);
yoFrameEuclideanTrajectoryPoint.getPosition(pointForVerification);
yoFrameEuclideanTrajectoryPoint.getLinearVelocity(linearVelocityForVerification);
yoFrameEuclideanTrajectoryPoint.setLinearVelocityToZero();
yoFrameEuclideanTrajectoryPoint.getPosition(position);
yoFrameEuclideanTrajectoryPoint.getLinearVelocity(linearVelocity);
yoFrameEuclideanTrajectoryPoint.getPosition(position);
yoFrameEuclideanTrajectoryPoint.getLinearVelocity(linearVelocity);