us.ihmc.robotics.math.trajectories.providers.YoSE3ConfigurationProvider类的使用及代码示例

x33g5p2x  于2022-02-05 转载在 其他  
字(4.8k)|赞(0)|评价(0)|浏览(86)

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

YoSE3ConfigurationProvider介绍

暂无

代码示例

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

@ContinuousIntegrationTest(estimatedDuration = 0.0)
@Test(timeout = 30000)
public void testGet()
{
 provider = new YoSE3ConfigurationProvider(name, referenceFrame, registry);
 FrameQuaternion orientationToPack = new FrameQuaternion();
 provider.getOrientation(orientationToPack);
 assertEquals(referenceFrame, orientationToPack.getReferenceFrame());
 FramePoint3D framePointToPack = new FramePoint3D();
 provider.getPosition(framePointToPack);
 assertEquals(referenceFrame, framePointToPack.getReferenceFrame());
}

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

@ContinuousIntegrationTest(estimatedDuration = 0.0)
  @Test(timeout = 30000)
  public void testSetPose()
  {
   provider = new YoSE3ConfigurationProvider(name, referenceFrame, registry);
   FramePose3D framePose;
   try
   {
     framePose = new FramePose3D();
     provider.setPose(framePose);
     fail();
   }
   catch (RuntimeException rte)
   {
   }

   framePose = new FramePose3D(referenceFrame);

   provider.setPose(framePose);
  }
}

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

protected void reinitializeTrajectory()
{
 orientationTrajectoryGenerator.setTrajectoryTime(swingTimeProvider.getValue());
 if (useNewSwingTrajectoyOptimization)
 {
   TrajectoryType trajectoryType = trajectoryParametersProvider.getTrajectoryParameters().getTrajectoryType();
   finalConfigurationProvider.getPosition(finalPosition);
   touchdownVelocityProvider.get(finalVelocity);
   swingTrajectoryGeneratorNew.setFinalConditions(finalPosition, finalVelocity);
   swingTrajectoryGeneratorNew.setStepTime(swingTimeProvider.getValue());
   swingTrajectoryGeneratorNew.setTrajectoryType(trajectoryType, swingWaypointsForSole);
 }
 positionTrajectoryGenerator.initialize();
 orientationTrajectoryGenerator.initialize();
 trajectoryWasReplanned = false;
 replanTrajectory.set(false);
}

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

@ContinuousIntegrationTest(estimatedDuration = 0.0)
@Test(timeout = 30000)
public void testConstructor()
{
 provider = new YoSE3ConfigurationProvider(name, referenceFrame, null);
 provider = new YoSE3ConfigurationProvider(name, referenceFrame, registry);
}

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

finalConfigurationProvider.setPose(footstepSolePose);
orientationTrajectoryGenerator.setFinalOrientation(footstepSolePose);
orientationTrajectoryGenerator.setFinalVelocityToZero();

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

protected void initializeTrajectory()
{
 if (!hasInitialAngularConfigurationBeenProvided.getBooleanValue())
 {
   currentAngularVelocityProvider.get(initialAngularVelocity);
   initialOrientation.setToZero(controlFrame);
   orientationTrajectoryGenerator.setInitialConditions(initialOrientation, initialAngularVelocity);
 }
 orientationTrajectoryGenerator.setTrajectoryTime(swingTimeProvider.getValue());
 if (useNewSwingTrajectoyOptimization)
 {
   TrajectoryType trajectoryType = trajectoryParametersProvider.getTrajectoryParameters().getTrajectoryType();
   double swingHeight = trajectoryParametersProvider.getTrajectoryParameters().getSwingHeight();
   initialConfigurationProvider.getPosition(initialPosition);
   initialVelocityProvider.get(initialVelocity);
   finalConfigurationProvider.getPosition(finalPosition);
   touchdownVelocityProvider.get(finalVelocity);
   stanceConfigurationProvider.getPosition(stanceFootPosition);
   swingTrajectoryGeneratorNew.setInitialConditions(initialPosition, initialVelocity);
   swingTrajectoryGeneratorNew.setFinalConditions(finalPosition, finalVelocity);
   swingTrajectoryGeneratorNew.setStepTime(swingTimeProvider.getValue());
   swingTrajectoryGeneratorNew.setTrajectoryType(trajectoryType, swingWaypointsForSole);
   swingTrajectoryGeneratorNew.setSwingHeight(swingHeight);
   swingTrajectoryGeneratorNew.setStanceFootPosition(stanceFootPosition);
 }
 positionTrajectoryGenerator.initialize();
 orientationTrajectoryGenerator.initialize();
 trajectoryWasReplanned = false;
 replanTrajectory.set(false);
}

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

WalkingControllerParameters walkingControllerParameters = footControlHelper.getWalkingControllerParameters();
finalConfigurationProvider = new YoSE3ConfigurationProvider(namePrefix + "SwingFinal", worldFrame, registry);
finalSwingHeightOffset = new DoubleYoVariable(namePrefix + "SwingFinalHeightOffset", registry);
finalSwingHeightOffset.set(footControlHelper.getWalkingControllerParameters().getDesiredTouchdownHeightOffset());

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

finalConfigurationProvider.getPosition(finalPosition);
touchdownVelocityProvider.get(finalVelocity);
swingTrajectoryGeneratorNew.setFinalConditions(finalPosition, finalVelocity);

相关文章