us.ihmc.robotics.math.trajectories.YoMinimumJerkTrajectory.setParams()方法的使用及代码示例-6ren

us.ihmc.robotics.math.trajectories.YoMinimumJerkTrajectory.setParams()方法的使用及代码示例

转载作者：知者更新时间：2024-03-13 21:30:03

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

YoMinimumJerkTrajectory.setParams介绍

暂无

代码示例

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

private void setTransitionSplines()
{
 for (int i = 0; i < oneDoFJoints.size(); i++)
 {
   OneDoFJoint oneDoFJoint = oneDoFJoints.get(i);
   YoMinimumJerkTrajectory spline = transitionSplines.get(oneDoFJoint);
   double initialPosition = initialPositions.get(oneDoFJoint).getDoubleValue();
   double finalPositon = finalPositions.get(oneDoFJoint).getDoubleValue();
   spline.setParams(initialPosition, 0.0, 0.0, finalPositon, 0.0, 0.0, 0.0, splineDuration.getDoubleValue());
 }
}

代码示例来源：origin: us.ihmc/ihmc-whole-body-controller

private void setTransitionSplines()
{
 for (int i = 0; i < oneDoFJoints.size(); i++)
 {
   OneDoFJointBasics oneDoFJoint = oneDoFJoints.get(i);
   YoMinimumJerkTrajectory spline = transitionSplines.get(oneDoFJoint);
   double initialPosition = initialPositions.get(oneDoFJoint).getDoubleValue();
   double finalPositon = finalPositions.get(oneDoFJoint).getDoubleValue();
   spline.setParams(initialPosition, 0.0, 0.0, finalPositon, 0.0, 0.0, 0.0, splineDuration.getDoubleValue());
 }
}

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

@ContinuousIntegrationTest(estimatedDuration = 0.0)
@Test(timeout = 30000)
public void testZeroLength()
{
 YoVariableRegistry registry = new YoVariableRegistry("TestMinimumJerkTrajectory");
 YoMinimumJerkTrajectory minimumJerkTrajectory = new YoMinimumJerkTrajectory("tester", registry);
 
 double t = 0.5e-7;
 double[] vals = new double[3];
 minimumJerkTrajectory.setParams(0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 0.0, 1.0);
 minimumJerkTrajectory.computeTrajectoryDoubles(t, vals);
 if (Double.isNaN(vals[0]) || Double.isNaN(vals[1]) || Double.isNaN(vals[2]))
 {
   throw new RuntimeException("TestMinimumJerkTrajectory.testZeroLength: failed on zero displacement");
 }
 minimumJerkTrajectory.setParams(0.0, 0.0, 0.0, 10.0, 0.0, 0.0, 0.0, 0.0);
 minimumJerkTrajectory.computeTrajectoryDoubles(t, vals);
 if (Double.isNaN(vals[0]) || Double.isNaN(vals[1]) || Double.isNaN(vals[2]))
 {
   throw new RuntimeException("TestMinimumJerkTrajectory.testZeroLength: failed on zero time difference");
 }
 minimumJerkTrajectory.setParams(0.0, 0.0, 0.0, 10.0, 0.0, 0.0, 0.0, 0.5);
 double Tf = minimumJerkTrajectory.timeExtension(t, 0.0, 0.0, true);
 System.out.println("TestMinimumJerkTrajectory.testZeroLength: Extending with maximums at 0.0: Tf = " + Tf);
 System.out.flush();
}

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

@ContinuousIntegrationTest(estimatedDuration = 0.1)
@Test(timeout = 30000)
public void testTimeExtensionRuntime()
{
 YoVariableRegistry registry = new YoVariableRegistry("TestMinimumJerkTrajectory");
 YoMinimumJerkTrajectory minimumJerkTrajectory = new YoMinimumJerkTrajectory("tester", registry);
 
 long starttime, endtime;
 double t = 0.0;
 double maxV = 10;
 double maxA = 10;
 int runs = 10000;
 starttime = System.nanoTime();
 Random random = new Random(107L);
 for (int i = 0; i < runs * 6; i++)
 {
   minimumJerkTrajectory.setParams(0.0, 0.0, 0.0, random.nextDouble() * 0.5 + 0.75, 0.0, 0.0, 0.0, 0.5);
   minimumJerkTrajectory.timeExtension(t, maxV, maxA, true);
 }
 endtime = System.nanoTime();
 double runtime = (endtime - starttime) / runs * 1.0e-6;
 System.out.println("TestMinimumJerkTrajectory.testTimeExtensionRuntime: Execution Time = " + (runtime) + "ms per 6 calls");
}

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

@ContinuousIntegrationTest(estimatedDuration = 0.0)
  @Test(timeout = 30000)
  public void testBadInitialParams()
  {
   YoVariableRegistry registry = new YoVariableRegistry("TestMinimumJerkTrajectory");
   YoMinimumJerkTrajectory minimumJerkTrajectory = new YoMinimumJerkTrajectory("tester", registry);
   
   double maxV = 10;
   double maxA = 50;
   minimumJerkTrajectory.setParams(0.0, maxV * 1.1, 0.0, 1.0, 0.0, 0.0, 0.0, 0.05);
   double newTime = minimumJerkTrajectory.timeExtension(1e-7, maxV, maxA, true);
   if (newTime > 100000)
   {
     throw new RuntimeException("TestMinimumJerkTrajectory.testBadInitialParams: cannot find suitable time");
   }
   else
   {
     System.out.println("TestMinimumJerkTrajectory.testBadInitialParams: Tf = " + newTime);
   }
  }
}

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

@ContinuousIntegrationTest(estimatedDuration = 0.0)
@Test(timeout = 30000)
public void testFindMaxVals()
{
 YoVariableRegistry registry = new YoVariableRegistry("TestMinimumJerkTrajectory");
 YoMinimumJerkTrajectory minimumJerkTrajectory = new YoMinimumJerkTrajectory("tester", registry);
 
 double t = 0.0;
 double[] maximums = new double[2];
 double maxVexpected = 5.625;
 double maxAexpected = 34.641;
 double percent = 0.01;
 minimumJerkTrajectory.setParams(0.0, 0.0, 0.0, 1.5, 0.0, 0.0, 0.0, 0.5);
 minimumJerkTrajectory.findMaxVelocityAndAccel(t, maximums);
 if (!MathTools.percentEquals(maxVexpected, maximums[0], percent))
 {
   throw new RuntimeException("TestMinimumJerkTrajectory.testFindMaxVals: Max velocity is wrong: expected=" + maxVexpected + ", actual=" + maximums[0]);
 }
 if (!MathTools.percentEquals(maxAexpected, maximums[1], percent))
 {
   throw new RuntimeException("TestMinimumJerkTrajectory.testFindMaxVals: Max accel is wrong: expected=" + maxAexpected + ", actual=" + maximums[1]);
 }
}

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

@Ignore
@ContinuousIntegrationTest(estimatedDuration = 0.1, categoriesOverride = IntegrationCategory.EXCLUDE)
@Test(timeout=300000)
public void testTimeExtension()
{
 YoVariableRegistry registry = new YoVariableRegistry("TestMinimumJerkTrajectory");
 YoMinimumJerkTrajectory minimumJerkTrajectory = new YoMinimumJerkTrajectory("tester", registry);
 
 double t = 0.0;
 double maxV = 5.0;
 double maxA = 10.0;
 double expectedTime = 0.930605;
 minimumJerkTrajectory.setParams(0.0, 0.0, 0.0, 1.5, 0.0, 0.0, 0.0, 0.0);
 double newTime = minimumJerkTrajectory.timeExtension(t, maxV, maxA, true);
 if (!MathTools.percentEquals(expectedTime, newTime, 0.01))
 {
   throw new RuntimeException("TestMinimumJerkTrajectory.testTimeExtension: Returned desired time= " + newTime + ", expected= " + expectedTime);
 }
}

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

public void initialize(FramePoint initialPosition, FrameVector initialVelocity, FrameVector initialAcceleration, FramePoint finalDesiredPosition,
           FrameVector finalDesiredVelocity)
{
 timeIntoStep.set(0.0);
 this.stepTime.set(stepTimeProvider.getValue());
 if (stepTime.getDoubleValue() < 1e-10)
 {
   stepTime.set(1e-10);
 }
 minimumJerkTrajectory.setParams(0.0, 0.0, 0.0, 1.0, 0.0, 0.0, 0.0, stepTime.getDoubleValue());
 double middleOfTrajectoryParameter = 0.5;
 parabolicTrajectoryGenerator.initialize(initialPosition, finalDesiredPosition, groundClearance.getDoubleValue(), middleOfTrajectoryParameter);
}

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

@Override
public void initialize(FramePoint3D initialPosition, FrameVector3D initialVelocity, FrameVector3D initialAcceleration, FramePoint3D finalDesiredPosition,
           FrameVector3D finalDesiredVelocity)
{
 timeIntoStep.set(0.0);
 this.stepTime.set(stepTimeProvider.getValue());
 if (stepTime.getDoubleValue() < 1e-10)
 {
   stepTime.set(1e-10);
 }
 minimumJerkTrajectory.setParams(0.0, 0.0, 0.0, 1.0, 0.0, 0.0, 0.0, stepTime.getDoubleValue());
 double middleOfTrajectoryParameter = 0.5;
 parabolicTrajectoryGenerator.initialize(initialPosition, finalDesiredPosition, groundClearance.getDoubleValue(), middleOfTrajectoryParameter);
}

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

public void initialize()
{
 timeIntoStep.set(0.0);
 this.stepTime.set(stepTimeProvider.getValue());
 if (stepTime.getDoubleValue() < 1e-10)
 {
   stepTime.set(1e-10);
 }
 minimumJerkTrajectory.setParams(0.0, 0.0, 0.0, 1.0, 0.0, 0.0, 0.0, stepTime.getDoubleValue());
 double middleOfTrajectoryParameter = 0.5;
 FramePoint3D initialPosition = new FramePoint3D(ReferenceFrame.getWorldFrame());
 initialPositionProvider.getPosition(initialPosition);
 FramePoint3D finalPosition = new FramePoint3D(ReferenceFrame.getWorldFrame());
 finalPositionProvider.getPosition(finalPosition);
 initialPosition.changeFrame(parabolicTrajectoryGenerator.getReferenceFrame());
 finalPosition.changeFrame(parabolicTrajectoryGenerator.getReferenceFrame());
 double maxAnkleHeight = Math.max(initialPosition.getZ(), finalPosition.getZ());
 double apexHeight = maxAnkleHeight + groundClearance.getDoubleValue();
 parabolicTrajectoryGenerator.initialize(initialPosition, finalPosition, apexHeight, middleOfTrajectoryParameter);
}

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

public void initialize()
{
 timeIntoStep.set(0.0);
 this.stepTime.set(stepTimeProvider.getValue());
 if (stepTime.getDoubleValue() < 1e-10)
 {
   stepTime.set(1e-10);
 }
 minimumJerkTrajectory.setParams(0.0, 0.0, 0.0, 1.0, 0.0, 0.0, 0.0, stepTime.getDoubleValue());
 double middleOfTrajectoryParameter = 0.5;
 FramePoint initialPosition = new FramePoint(ReferenceFrame.getWorldFrame());
 initialPositionProvider.getPosition(initialPosition);
 FramePoint finalPosition = new FramePoint(ReferenceFrame.getWorldFrame());
 finalPositionProvider.getPosition(finalPosition);
 initialPosition.changeFrame(parabolicTrajectoryGenerator.getReferenceFrame());
 finalPosition.changeFrame(parabolicTrajectoryGenerator.getReferenceFrame());
 double maxAnkleHeight = Math.max(initialPosition.getZ(), finalPosition.getZ());
 double apexHeight = maxAnkleHeight + groundClearance.getDoubleValue();
 parabolicTrajectoryGenerator.initialize(initialPosition, finalPosition, apexHeight, middleOfTrajectoryParameter);
}

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

double tf = t0 + randomBetween(0.1, 10.0);
minimumJerkTrajectory.setParams(x0, v0, a0, xf, vf, af, t0, tf);

Ruby 方法() 方法
我想了解 Ruby 方法 methods() 是如何工作的。我尝试使用“ruby 方法”在 Google 上搜索，但这不是我需要的。我也看过 ruby-doc.org，但我没有找到这种方法。
VBS教程：方法-Test 方法
Test 方法对指定的字符串执行一个正则表达式搜索，并返回一个 Boolean 值指示是否找到匹配的模式。 object.Test(string) 参数 object 必选项。总是一个
VBS教程：方法-Replace 方法
Replace 方法替换在正则表达式查找中找到的文本。 object.Replace(string1, string2) 参数 object 必选项。总是一个 RegExp 对象的名称。
VBS教程：方法-Raise 方法
Raise 方法生成运行时错误 object.Raise(number, source, description, helpfile, helpcontext) 参数 object 应为
VBS教程：方法-Execute 方法
Execute 方法对指定的字符串执行正则表达式搜索。 object.Execute(string) 参数 object 必选项。总是一个 RegExp 对象的名称。 string
VBS教程：方法-Clear 方法
Clear 方法清除 Err 对象的所有属性设置。 object.Clear object 应为 Err 对象的名称。说明在错误处理后，使用 Clear 显式地清除 Err 对象。此
VBS教程：方法-CopyFile 方法
CopyFile 方法将一个或多个文件从某位置复制到另一位置。 object.CopyFile source, destination[, overwrite] 参数 object 必选
VBS教程：方法-Copy 方法
Copy 方法将指定的文件或文件夹从某位置复制到另一位置。 object.Copy destination[, overwrite] 参数 object 必选项。应为 File 或 F
VBS教程：方法-Close 方法
Close 方法关闭打开的 TextStream 文件。 object.Close object 应为 TextStream 对象的名称。说明下面例子举例说明如何使用 Close 方
VBS教程：方法-BuildPath 方法
BuildPath 方法向现有路径后添加名称。 object.BuildPath(path, name) 参数 object 必选项。应为 FileSystemObject 对象的名称
VBS教程：方法-GetFolder 方法
GetFolder 方法返回与指定的路径中某文件夹相应的 Folder 对象。 object.GetFolder(folderspec) 参数 object 必选项。应为 FileSy
VBS教程：方法-GetFileName 方法
GetFileName 方法返回指定路径（不是指定驱动器路径部分）的最后一个文件或文件夹。 object.GetFileName(pathspec) 参数 object 必选项。应为
VBS教程：方法-GetFile 方法
GetFile 方法返回与指定路径中某文件相应的 File 对象。 object.GetFile(filespec) 参数 object 必选项。应为 FileSystemObject
VBS教程：方法-GetExtensionName 方法
GetExtensionName 方法返回字符串，该字符串包含路径最后一个组成部分的扩展名。 object.GetExtensionName(path) 参数 object 必选项。应
VBS教程：方法-GetDriveName 方法
GetDriveName 方法返回包含指定路径中驱动器名的字符串。 object.GetDriveName(path) 参数 object 必选项。应为 FileSystemObjec
VBS教程：方法-GetDrive 方法
GetDrive 方法返回与指定的路径中驱动器相对应的 Drive 对象。 object.GetDrive drivespec 参数 object 必选项。应为 FileSystemO
VBS教程：方法-GetBaseName 方法
GetBaseName 方法返回字符串，其中包含文件的基本名 (不带扩展名), 或者提供的路径说明中的文件夹。 object.GetBaseName(path) 参数 object 必
VBS教程：方法-GetAbsolutePathName 方法
GetAbsolutePathName 方法从提供的指定路径中返回完整且含义明确的路径。 object.GetAbsolutePathName(pathspec) 参数 object
VBS教程：方法-FolderExists 方法
FolderExists 方法如果指定的文件夹存在，则返回 True；否则返回 False。 object.FolderExists(folderspec) 参数 object 必选项
VBS教程：方法-FileExists 方法
FileExists 方法如果指定的文件存在返回 True；否则返回 False。 object.FileExists(filespec) 参数 object 必选项。应为 FileS

知者

个人简介

我是一名优秀的程序员,十分优秀！

作者热门文章

滴滴打车优惠券免费领取

全站热门文章

首页

博学

6Ren·AI

商城

us.ihmc.robotics.math.trajectories.YoMinimumJerkTrajectory.setParams()方法的使用及代码示例

YoMinimumJerkTrajectory.setParams介绍

代码示例