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

YoFramePoseUsingYawPitchRoll.set介绍

[英]Sets this frame pose to the origin of the passed in reference frame.
[中]将此帧姿势设置为传入参照帧的原点。

代码示例

代码示例来源：origin: us.ihmc/ihmc-common-walking-control-modules-test

private void updateNextFootsteps(int stepIndex)
{
 int numberOfStepToUpdate =
    (numberOfFootstepsForTest - stepIndex) < numberOfFootstepsToConsider ? (numberOfFootstepsForTest - stepIndex) : numberOfFootstepsToConsider;
 int nextStepIndex;
 for (nextStepIndex = 0; nextStepIndex < numberOfStepToUpdate; nextStepIndex++)
 {
   nextFootstepPoses.get(nextStepIndex).set(footstepList.get(stepIndex + nextStepIndex).getFootstepPose());
 }
 for (; nextStepIndex < numberOfFootstepsToConsider; nextStepIndex++)
 {
   nextFootstepPoses.get(nextStepIndex).setToNaN();
 }
}

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

public void set(YoFramePoseUsingYawPitchRoll yoFramePose)
{
 set(yoFramePose.getPosition(), yoFramePose.getOrientation().getFrameOrientation());
}

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

yoFootstepPose.set(footstepPose);
yoFootstepPose.setZ(yoFootstepPose.getZ() + (footstep.getRobotSide() == RobotSide.RIGHT ? 0.001 : 0.0));

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

private YoGraphicPolygon createStaticFootstep(String name, FramePose3D framePose, AppearanceDefinition appearance, YoVariableRegistry registry,
                       YoGraphicsListRegistry yoGraphicsListRegistry)
{
 YoFramePoseUsingYawPitchRoll footstepYoFramePose = new YoFramePoseUsingYawPitchRoll(name + "FramePose", ReferenceFrame.getWorldFrame(), registry);
 footstepYoFramePose.set(framePose);
 YoGraphicPolygon footstepYoGraphicPolygon = new YoGraphicPolygon(name + "YoGraphicPolygon", footstepYoFramePose, defaultFootPolygon.getNumberOfVertices(),
                                  registry, 1.0, appearance);
 footstepYoGraphicPolygon.updateConvexPolygon2d(defaultFootPolygon);
 yoGraphicsListRegistry.registerYoGraphic(getClass().getSimpleName(), footstepYoGraphicPolygon);
 return footstepYoGraphicPolygon;
}

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

visiblePolygonPoses.get(polygonIdx).set(pose);
  visiblePolygons.get(polygonIdx).set(planarRegion.getConvexHull());
startStep.set(stancePose);
int stepsToShow = Math.min(plan.getNumberOfSteps(), 2 * stepsPerSideToVisualize);
for (int stepIdx = 0; stepIdx < stepsToShow; stepIdx++)
  yoSolePose.set(footstepPose);
scs.tickAndUpdate();
stepPosesTaken.get(i).set(stancePose);

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

@Override
  public void doControl()
  {
   wristJoint.getTransformToWorld(transform);
   wristJointPose.set(transform);
   yoWristJointPose.set(wristJointPose);

   wristJoint.getTransformToWorld(transform);
   transform.transform(wristToHandControlFrame, tangentVector);
   handControlFramePose.set(transform);
   handControlFramePose.prependTranslation(tangentVector);
   yoHandControlFramePose.set(handControlFramePose);
   handControlFramePositionInWorld.set(handControlFramePose.getPosition());

   efpHandControlFrame.setPosition(handControlFramePositionInWorld);

//      efpGravity.setForce(0.0, 0.0, -gGRAVITY * MASSDRILL);
//      efpGravity.setForce(0.0, 0.0, 0.0);
//      efpWrist.setForce(exponentialCutForceModel(efpHandControlFrame));
   efpWrist.setForce(quadraticCutForceModel(efpHandControlFrame));

  }

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

visiblePolygonPoses.get(polygonIdx).set(pose);
visiblePolygons.get(polygonIdx).set(planarRegion.getConvexHull());

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

private YoGraphicsListRegistry createStartAndGoalGraphics(FramePose3D initialStancePose, FramePose3D goalPose)
{
 YoGraphicsListRegistry graphicsListRegistry = new YoGraphicsListRegistry();
 YoGraphicsList graphicsList = new YoGraphicsList("testViz");
 YoFramePoseUsingYawPitchRoll yoInitialStancePose = new YoFramePoseUsingYawPitchRoll("initialStancePose", initialStancePose.getReferenceFrame(),
                                           drcSimulationTestHelper.getYoVariableRegistry());
 yoInitialStancePose.set(initialStancePose);
 YoFramePoseUsingYawPitchRoll yoGoalPose = new YoFramePoseUsingYawPitchRoll("goalStancePose", goalPose.getReferenceFrame(),
                                       drcSimulationTestHelper.getYoVariableRegistry());
 yoGoalPose.set(goalPose);
 YoGraphicCoordinateSystem startPoseGraphics = new YoGraphicCoordinateSystem("startPose", yoInitialStancePose, 13.0);
 YoGraphicCoordinateSystem goalPoseGraphics = new YoGraphicCoordinateSystem("goalPose", yoGoalPose, 13.0);
 graphicsList.add(startPoseGraphics);
 graphicsList.add(goalPoseGraphics);
 return graphicsListRegistry;
}

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

MutableInt sideCount = counts.get(robotSide);
YoFramePoseUsingYawPitchRoll stepPose = yoSteps.get(robotSide).get(sideCount.intValue());
stepPose.set(footstepPose);
sideCount.increment();

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

soleFramePose.changeFrame(ReferenceFrame.getWorldFrame());
this.soleFramePose.set(soleFramePose);

代码示例来源：origin: us.ihmc/ihmc-avatar-interfaces

private void placeCartesianTargetsAtActuals()
{
 reader.read();
 for (RobotSide robotSide : RobotSide.values())
 {
   YoFramePoseUsingYawPitchRoll yoFramePose = feetIKs.get(robotSide);
   FramePose3D framePose = new FramePose3D(fullRobotModel.getFoot(robotSide).getBodyFixedFrame());
   framePose.changeFrame(ReferenceFrame.getWorldFrame());
   yoFramePose.set(framePose);
   yoFramePose = handIKs.get(robotSide);
   framePose = new FramePose3D(fullRobotModel.getHand(robotSide).getBodyFixedFrame());
   framePose.changeFrame(ReferenceFrame.getWorldFrame());
   yoFramePose.set(framePose);
 }
 ReferenceFrame pelvisFrame = fullRobotModel.getPelvis().getBodyFixedFrame();
 FramePose3D framePose = new FramePose3D(pelvisFrame);
 framePose.changeFrame(ReferenceFrame.getWorldFrame());
 System.out.println("Pelvis is at " + framePose);
}

代码示例来源：origin: us.ihmc/ihmc-humanoid-behaviors

@Override
public void onBehaviorEntered()
{
 hasTargetBeenProvided.set(false);
 haveFootstepsBeenGenerated.set(false);
 hasInputBeenSet.set(false);
 footstepListBehavior.initialize();
 robotPose.setToZero(fullRobotModel.getRootJoint().getFrameAfterJoint());
 robotPose.changeFrame(worldFrame);
 robotYoPose.set(robotPose);
 robotLocation.set(robotPose.getPosition());
 robotOrientation.set(robotPose.getOrientation());
 this.targetLocation.set(robotLocation);
 this.targetOrientation.set(robotOrientation);
}

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

wristJointPose = new FramePose3D(HumanoidReferenceFrames.getWorldFrame(), transform);
yoWristJointPose = new YoFramePoseUsingYawPitchRoll("wristJointPose", HumanoidReferenceFrames.getWorldFrame(), registry);
yoWristJointPose.set(wristJointPose);
YoGraphicCoordinateSystem yoWristCoordinateSystem = new YoGraphicCoordinateSystem("wristCoordinateSystemViz", yoWristJointPose, 0.1, YoAppearance.Red());
handControlFramePose.prependTranslation(tangentVector);
yoHandControlFramePose = new YoFramePoseUsingYawPitchRoll("handControlFrame",HumanoidReferenceFrames.getWorldFrame(), registry);
yoHandControlFramePose.set(handControlFramePose);
YoGraphicCoordinateSystem yoToolTip = new YoGraphicCoordinateSystem("toolTipViz", yoHandControlFramePose, 0.1, YoAppearance.Yellow());

代码示例来源：origin: us.ihmc/ihmc-humanoid-behaviors

footstepPlannerGoalPose.set(goalPose);
footstepPlannerInitialStepPose.set(tempStanceFootPose);