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

YoFramePoseUsingYawPitchRoll.<init>介绍

暂无

代码示例

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

public YoReferencePose(String frameName, ReferenceFrame parentFrame, YoVariableRegistry registry)
{
 super(frameName, parentFrame);
 yoFramePose = new YoFramePoseUsingYawPitchRoll(frameName + "_", this, registry);
}

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

public YoGraphicVRML(String name, ReferenceFrame referenceFrame, YoFramePoint3D position, YoFrameYawPitchRoll orientation, String modelFilePath,
          Vector3D graphicOffset, RotationMatrix graphicRotation, AppearanceDefinition appearance, boolean showCoordinateSystem,
          double coordinateAxisLength)
{
 this(name, referenceFrame, new YoFramePoseUsingYawPitchRoll(position, orientation), modelFilePath, graphicOffset, graphicRotation, appearance,
    showCoordinateSystem, coordinateAxisLength);
}

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

/**
  * Creates a copy of {@code this} by finding the duplicated {@code YoVariable}s in the given
  * {@link YoVariableRegistry}.
  * <p>
  * This method does not duplicate {@code YoVariable}s. Assuming the given registry is a duplicate
  * of the registry that was used to create {@code this}, this method searches for the duplicated
  * {@code YoVariable}s and use them to duplicate {@code this}.
  * </p>
  *
  * @param newRegistry YoVariableRegistry to duplicate {@code this} to.
  * @return the duplicate of {@code this}.
  */
  public YoFramePoseUsingYawPitchRoll duplicate(YoVariableRegistry newRegistry)
  {
   return new YoFramePoseUsingYawPitchRoll(position.duplicate(newRegistry), orientation.duplicate(newRegistry));
  }
}

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

private void setupNextFootstepVisualization()
{
 nextFootstepPoses = new ArrayList<>();
 for (int i = 0; i < numberOfFootstepsToConsider; i++)
 {
   Graphics3DObject nextFootstepGraphic = new Graphics3DObject();
   nextFootstepGraphic.addExtrudedPolygon(contactPointsInFootFrame, footstepHeight, nextFootstepColor);
   YoFramePoseUsingYawPitchRoll nextFootstepPose = new YoFramePoseUsingYawPitchRoll("NextFootstep" + i + "Pose", worldFrame, registry);
   nextFootstepPoses.add(nextFootstepPose);
   graphicsListRegistry
      .registerYoGraphic("UpcomingFootsteps", new YoGraphicShape("NextFootstep" + i + "Viz", nextFootstepGraphic, nextFootstepPose, 1.0));
 }
}

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

private void createCandidateFootstep(String name, int index, YoVariableRegistry registry, YoGraphicsListRegistry yoGraphicsListRegistry)
{
 YoFramePoseUsingYawPitchRoll footstepYoFramePose = new YoFramePoseUsingYawPitchRoll(name + index + "FramePose", ReferenceFrame.getWorldFrame(), registry);
 footstepYoFramePose.setToNaN();
 YoGraphicPolygon footstepYoGraphicPolygon = new YoGraphicPolygon(name + index + "YoGraphicPolygon", footstepYoFramePose,
                                  defaultFootPolygon.getNumberOfVertices(), registry, 1.0, YoAppearance.Red());
 footstepYoGraphicPolygon.updateConvexPolygon2d(defaultFootPolygon);
 candidateFootstepPolygons.put(index, footstepYoGraphicPolygon);
 yoGraphicsListRegistry.registerYoGraphic(getClass().getSimpleName(), footstepYoGraphicPolygon);
}

代码示例来源：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-humanoid-behaviors

footstepPlannerGoalPose = new YoFramePoseUsingYawPitchRoll(prefix + "FootstepGoalPose", ReferenceFrame.getWorldFrame(), registry);
footstepPlannerInitialStepPose = new YoFramePoseUsingYawPitchRoll(prefix + "InitialStepPose", ReferenceFrame.getWorldFrame(), registry);
YoFramePoseUsingYawPitchRoll desiredLeftFootstepStatusPose = new YoFramePoseUsingYawPitchRoll(prefix + "DesiredLeftFootstepStatusPose",
                                               ReferenceFrame.getWorldFrame(), registry);
YoFramePoseUsingYawPitchRoll desiredRightFootstepStatusPose = new YoFramePoseUsingYawPitchRoll(prefix + "DesiredRightFootstepStatusPose",
                                                ReferenceFrame.getWorldFrame(), registry);
desiredFootStatusPoses = new SideDependentList<>(desiredLeftFootstepStatusPose, desiredRightFootstepStatusPose);
YoFramePoseUsingYawPitchRoll leftFootstepStatusPose = new YoFramePoseUsingYawPitchRoll(prefix + "LeftFootstepStatusPose", ReferenceFrame.getWorldFrame(),
                                            registry);
YoFramePoseUsingYawPitchRoll rightFootstepStatusPose = new YoFramePoseUsingYawPitchRoll(prefix + "RightFootstepStatusPose",
                                            ReferenceFrame.getWorldFrame(), registry);
actualFootStatusPoses = new SideDependentList<>(leftFootstepStatusPose, rightFootstepStatusPose);

代码示例来源：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-common-walking-control-modules-test

private void setupCurrentFootPoseVisualization()
{
 currentFootLocations = new SideDependentList<>();
 for (RobotSide side : RobotSide.values())
 {
   Graphics3DObject footstepGraphic = new Graphics3DObject();
   footstepGraphic.addExtrudedPolygon(contactPointsInFootFrame, footstepHeight, side == RobotSide.LEFT ? leftFootstepColor : rightFootstepColor);
   YoFramePoseUsingYawPitchRoll footPose = new YoFramePoseUsingYawPitchRoll(side.getCamelCaseName() + "FootPose", worldFrame, registry);
   currentFootLocations.put(side, footPose);
   graphicsListRegistry.registerYoGraphic("currentFootPose", new YoGraphicShape(side.getCamelCaseName() + "FootViz", footstepGraphic, footPose, 1.0));
 }
}

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

public Controller(YoGraphicsListRegistry graphicsListRegistry)
{
  for (int i = 0; i < numberOfPoints; i++)
  {
   YoFramePoint3D yoPoint = new YoFramePoint3D("Position" + i, ReferenceFrame.getWorldFrame(), registry);
   YoGraphicPosition position = new YoGraphicPosition("Position" + i, yoPoint, 0.02, YoAppearance.Blue());
   points.add(yoPoint);
   graphicsListRegistry.registerYoGraphic("BodyPath", position);
  }
  YoFrameConvexPolygon2D yoDefaultFootPolygon = new YoFrameConvexPolygon2D("DefaultFootPolygon", ReferenceFrame.getWorldFrame(), 4, registry);
  yoDefaultFootPolygon.set(PlannerTools.createDefaultFootPolygon());
  for (RobotSide side : RobotSide.values)
  {
   AppearanceDefinition appearance = side == RobotSide.RIGHT ? YoAppearance.Green() : YoAppearance.Red();
   ArrayList<YoFramePoseUsingYawPitchRoll> poses = new ArrayList<>();
   for (int i = 0; i < stepsPerSide; i++)
   {
     YoFramePoseUsingYawPitchRoll yoFootstepPose = new YoFramePoseUsingYawPitchRoll("footPose" + side.getCamelCaseName() + i, ReferenceFrame.getWorldFrame(), registry);
     YoGraphicPolygon footstepViz = new YoGraphicPolygon("footstep" + side.getCamelCaseName() + i, yoDefaultFootPolygon, yoFootstepPose, 1.0,
                               appearance);
     poses.add(yoFootstepPose);
     yoFootstepPose.setToNaN();
     graphicsListRegistry.registerYoGraphic("viz", footstepViz);
   }
   yoSteps.put(side, poses);
  }
  planner.setTimeout(1.0);
}

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

viz.update();
YoGraphicCoordinateSystem coordinateSystem = new YoGraphicCoordinateSystem("coord", new YoFramePoseUsingYawPitchRoll("World", ReferenceFrame.getWorldFrame(), null), 1);

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

private boolean testTranslationInterpolationToRandomTargets(final Robot robot, YoVariableRegistry registry, int numTargets)
   throws SimulationExceededMaximumTimeException
 YoFramePoseUsingYawPitchRoll target = new YoFramePoseUsingYawPitchRoll("target_", ReferenceFrame.getWorldFrame(), registry);
 RigidBodyTransform[] targets = createRandomCorrectionTargets(numTargets);
 boolean success = true;

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

public PolygonSnapperVisualizer(ConvexPolygon2D snappingPolygonShape)
{
 Robot robot = new Robot("Robot");
 scs = new SimulationConstructionSet(robot);
 scs.setDT(0.1, 1);
 polygonToSnap = new YoFrameConvexPolygon2D("polygonToSnap", ReferenceFrame.getWorldFrame(), 4, registry);
 snappedPolygon = new YoFrameConvexPolygon2D("snappedPolygon", ReferenceFrame.getWorldFrame(), 4, registry);
 polygonToSnap.set(snappingPolygonShape);
 snappedPolygon.set(snappingPolygonShape);
 polygonToSnapPose = new YoFramePoseUsingYawPitchRoll("polygonToSnapPose", ReferenceFrame.getWorldFrame(), registry);
 snappedPolygonPose = new YoFramePoseUsingYawPitchRoll("snappedPolygonPose", ReferenceFrame.getWorldFrame(), registry);
 polygonToSnapPose.setToNaN();
 snappedPolygonPose.setToNaN();
 polygonToSnapViz = new YoGraphicPolygon("polygonToSnapViz", polygonToSnap, polygonToSnapPose, 1.0, YoAppearance.Green());
 snappedPolygonViz = new YoGraphicPolygon("snappedPolygonViz", polygonToSnap, snappedPolygonPose, 1.0, YoAppearance.Red());
 polygonToSnapViz.update();
 snappedPolygonViz.update();
 scs.addYoGraphic(polygonToSnapViz);
 scs.addYoGraphic(snappedPolygonViz);
 scs.addYoVariableRegistry(registry);
 scs.setGroundVisible(false);
 scs.startOnAThread();
}

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

endeffectorPose.put(robotSide, new YoFramePoseUsingYawPitchRoll("" + robotSide + "endeffectorPose", ReferenceFrame.getWorldFrame(), registry));
testFramePose = new YoFramePoseUsingYawPitchRoll("testFramePose", ReferenceFrame.getWorldFrame(), registry);
testFrameViz = new YoGraphicCoordinateSystem("testFrameViz", testFramePose, 0.25);
yoGraphicsListRegistry.registerYoGraphic("testFrameYoGraphic", testFrameViz);

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

public SingleFootstepVisualizer(RobotSide robotSide, int maxContactPoints, YoVariableRegistry registry, YoGraphicsListRegistry yoGraphicsListRegistry)
{
 Integer index = indices.get(robotSide);
 String namePrefix = robotSide.getLowerCaseName() + "Foot" + index;
 YoGraphicsList yoGraphicsList = new YoGraphicsList(namePrefix);
 this.robotSide = robotSide;
 ArrayList<Point2D> polyPoints = new ArrayList<Point2D>();
 yoContactPoints = new YoFramePoint3D[maxContactPoints];
 for (int i = 0; i < maxContactPoints; i++)
 {
   yoContactPoints[i] = new YoFramePoint3D(namePrefix + "ContactPoint" + i, ReferenceFrame.getWorldFrame(), registry);
   yoContactPoints[i].set(0.0, 0.0, -1.0);
   YoGraphicPosition baseControlPointViz = new YoGraphicPosition(namePrefix + "Point" + i, yoContactPoints[i], 0.01, YoAppearance.Blue());
   yoGraphicsList.add(baseControlPointViz);
   polyPoints.add(new Point2D());
 }
 footPolygon = new YoFrameConvexPolygon2D(namePrefix + "yoPolygon", "", ReferenceFrame.getWorldFrame(), maxContactPoints, registry);
 footPolygon.set(new ConvexPolygon2D(Vertex2DSupplier.asVertex2DSupplier(polyPoints)));
 soleFramePose = new YoFramePoseUsingYawPitchRoll(namePrefix + "polygonPose", "", ReferenceFrame.getWorldFrame(), registry);
 soleFramePose.setXYZ(0.0, 0.0, -1.0);
 footPolygonViz = new YoGraphicPolygon(namePrefix + "graphicPolygon", footPolygon, soleFramePose, 1.0, footPolygonAppearances.get(robotSide));
 yoGraphicsList.add(footPolygonViz);
 if (yoGraphicsListRegistry != null)
 {
   yoGraphicsListRegistry.registerYoGraphicsList(yoGraphicsList);
   yoGraphicsListRegistry.registerGraphicsUpdatableToUpdateInAPlaybackListener(footPolygonViz);
 }
 index++;
 indices.set(robotSide, index);
}

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

private boolean testTranslationAndRotationInterpolationToRandomTargets(final Robot robot, YoVariableRegistry registry, int numTargets)
   throws SimulationExceededMaximumTimeException
 YoFramePoseUsingYawPitchRoll target = new YoFramePoseUsingYawPitchRoll("target_", ReferenceFrame.getWorldFrame(), registry);
 RigidBodyTransform[] targets = createRandomCorrectionTargets(numTargets);
 boolean success = true;

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

swingOverPlanarRegionsTrajectoryExpander.attachVisualizer(this::update);
solePose = new YoFramePoseUsingYawPitchRoll("SolePose", WORLD, registry);
AppearanceDefinition bubble = YoAppearance.LightBlue();
bubble.setTransparency(0.5);

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

yoWristJointPose = new YoFramePoseUsingYawPitchRoll("wristJointPose", HumanoidReferenceFrames.getWorldFrame(), registry);
yoWristJointPose.set(wristJointPose);
YoGraphicCoordinateSystem yoWristCoordinateSystem = new YoGraphicCoordinateSystem("wristCoordinateSystemViz", yoWristJointPose, 0.1, YoAppearance.Red());
handControlFramePose = new FramePose3D(HumanoidReferenceFrames.getWorldFrame(), transform);
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-avatar-interfaces

YoFramePoseUsingYawPitchRoll footIK = new YoFramePoseUsingYawPitchRoll(sidePrefix + "FootIK", "", HumanoidReferenceFrames.getWorldFrame(), registry);
feetIKs.put(robotSide, footIK);
YoFramePoseUsingYawPitchRoll handIK = new YoFramePoseUsingYawPitchRoll(sidePrefix + "HandIK", "", HumanoidReferenceFrames.getWorldFrame(), registry);
handIKs.put(robotSide, handIK);

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

YoFramePoseUsingYawPitchRoll yoFootstepPose = new YoFramePoseUsingYawPitchRoll("footPose" + i, worldFrame, vizRegistry);
yoFootstepPose.set(footstepPose);
yoFootstepPose.setZ(yoFootstepPose.getZ() + (footstep.getRobotSide() == RobotSide.RIGHT ? 0.001 : 0.0));