gpt4 book ai didi

us.ihmc.robotics.math.frames.YoFrameOrientation.getYaw()方法的使用及代码示例

转载 作者:知者 更新时间:2024-03-15 19:28:40 24 4
gpt4 key购买 nike

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

YoFrameOrientation.getYaw介绍

暂无

代码示例

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

public DoubleYoVariable getYoYaw()
  {
   return getOrientation().getYaw();
  }
}

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

public double getYaw()
{
 return getOrientation().getYaw().getDoubleValue();
}

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

public void add(YoFrameOrientation orientation)
{
 yaw.add(orientation.getYaw());
 pitch.add(orientation.getPitch());
 roll.add(orientation.getRoll());
}

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

public YoGraphicCoordinateSystem(String name, YoFramePoint framePoint, YoFrameOrientation orientation, double scale)
{
 super(name);
 ReferenceFrame.getWorldFrame().checkReferenceFrameMatch(framePoint);
 framePoint.checkReferenceFrameMatch(orientation.getReferenceFrame());
 x = framePoint.getYoX();
 y = framePoint.getYoY();
 z = framePoint.getYoZ();
 yaw = orientation.getYaw();
 pitch = orientation.getPitch();
 roll = orientation.getRoll();
 this.scale = scale;
}

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

@Override
public YoVariable<?>[] getVariables()
{
 //poly + framePoint + frameOrientation
 YoVariable<?>[] vars = new YoVariable[1 + 2 * yoFrameConvexPolygon2d.getMaxNumberOfVertices() + 6];
 int i = 0;
 vars[i++] = yoFrameConvexPolygon2d.getYoNumberVertices();
 for (YoFramePoint2d p : yoFrameConvexPolygon2d.getYoFramePoints())
 {
   vars[i++] = p.getYoX();
   vars[i++] = p.getYoY();
 }
 vars[i++] = yoFramePoint.getYoX();
 vars[i++] = yoFramePoint.getYoY();
 vars[i++] = yoFramePoint.getYoZ();
 vars[i++] = yoFrameOrientation.getYaw();
 vars[i++] = yoFrameOrientation.getPitch();
 vars[i++] = yoFrameOrientation.getRoll();
 return vars;
}

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

FramePose2d endPose = new FramePose2d(worldFrame);
endPose.setPosition(new FramePoint2d(worldFrame, targetLocation.getX(), targetLocation.getY()));
endPose.setOrientation(new FrameOrientation2d(worldFrame, targetOrientation.getYaw().getDoubleValue()));

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

@Override
public double calculateCost(FramePose stanceFoot, FramePose swingStartFoot, FramePose idealFootstep, FramePose candidateFootstep, double percentageOfFoothold)
{
 double cost = footstepBaseCost.getDoubleValue();
 setXYVectorFromPoseToPoseNormalize(forwardCostVector, swingStartFoot, idealFootstep);
 setXYVectorFromPoseToPoseNormalize(backwardCostVector, idealFootstep, swingStartFoot);
 inwardCostVector.set(forwardCostVector.getY(), -forwardCostVector.getX());
 outwardCostVector.set(-forwardCostVector.getY(), forwardCostVector.getX());
 upwardCostVector.set(0.0, 0.0, 1.0);
 downwardVector.set(0.0, 0.0, -1.0);
 setVectorFromPoseToPose(idealToCandidateVector, idealFootstep, candidateFootstep);
 setOrientationFromPoseToPose(idealToCandidateOrientation, idealFootstep, candidateFootstep);
 double downwardPenalizationWeightConsideringStancePitch = downwardCostScalar.getDoubleValue();
 if (stanceFoot.getPitch() < 0)
 {
   downwardPenalizationWeightConsideringStancePitch += -stanceFoot.getPitch() * stancePitchDownwardCostScalar.getDoubleValue();
 }
 cost += penalizeCandidateFootstep(forwardCostVector, forwardCostScalar.getDoubleValue());
 cost += penalizeCandidateFootstep(backwardCostVector, backwardCostScalar.getDoubleValue());
 cost += penalizeCandidateFootstep(inwardCostVector, inwardCostScalar.getDoubleValue());
 cost += penalizeCandidateFootstep(outwardCostVector, outwardCostScalar.getDoubleValue());
 cost += penalizeCandidateFootstep(upwardCostVector, upwardCostScalar.getDoubleValue());
 cost += penalizeCandidateFootstep(downwardVector, downwardPenalizationWeightConsideringStancePitch);
 cost += angularCostScalar.getDoubleValue() * Math.abs(idealToCandidateOrientation.getYaw().getDoubleValue());
 cost += angularCostScalar.getDoubleValue() * Math.abs(idealToCandidateOrientation.getPitch().getDoubleValue());
 cost += angularCostScalar.getDoubleValue() * Math.abs(idealToCandidateOrientation.getRoll().getDoubleValue());
 cost += (1.0 - percentageOfFoothold) * negativeFootholdLinearCostScalar.getDoubleValue();
 return cost;
}

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

sliderBoard.setSlider(sliderChannel++, yoFramePose.getPosition().getYoZ(), footPosition.getZ() - zRange / 2.0, footPosition.getZ() + zRange / 2.0);
sliderBoard.setSlider(sliderChannel++, yoFramePose.getOrientation().getYaw(), -Math.PI, Math.PI);
sliderBoard.setSlider(sliderChannel++, yoFramePose.getOrientation().getPitch(), -Math.PI, Math.PI);
sliderBoard.setSlider(sliderChannel++, yoFramePose.getOrientation().getRoll(), -Math.PI, Math.PI);

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

sliderBoard.setSlider(sliderChannel++, yoFramePose.getPosition().getYoZ(), footPosition.getZ() - zRange / 2.0, footPosition.getZ() + zRange / 2.0);
sliderBoard.setSlider(sliderChannel++, yoFramePose.getOrientation().getYaw(), -Math.PI, Math.PI);
sliderBoard.setSlider(sliderChannel++, yoFramePose.getOrientation().getPitch(), -Math.PI, Math.PI);
sliderBoard.setSlider(sliderChannel++, yoFramePose.getOrientation().getRoll(), -Math.PI, Math.PI);

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

sliderBoard.setSlider(sliderChannel++, yoFramePose.getPosition().getYoZ(), handPosition.getZ() - zRange / 2.0, handPosition.getZ() + zRange / 2.0);
sliderBoard.setSlider(sliderChannel++, yoFramePose.getOrientation().getYaw(), -Math.PI, Math.PI);
sliderBoard.setSlider(sliderChannel++, yoFramePose.getOrientation().getPitch(), -Math.PI, Math.PI);
sliderBoard.setSlider(sliderChannel++, yoFramePose.getOrientation().getRoll(), -Math.PI, Math.PI);

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

sliderBoard.setSlider(sliderChannel++, yoFramePose.getPosition().getYoZ(), handPosition.getZ() - zRange / 2.0, handPosition.getZ() + zRange / 2.0);
sliderBoard.setSlider(sliderChannel++, yoFramePose.getOrientation().getYaw(), -Math.PI, Math.PI);
sliderBoard.setSlider(sliderChannel++, yoFramePose.getOrientation().getPitch(), -Math.PI, Math.PI);
sliderBoard.setSlider(sliderChannel++, yoFramePose.getOrientation().getRoll(), -Math.PI, Math.PI);

24 4 0
Copyright 2021 - 2024 cfsdn All Rights Reserved 蜀ICP备2022000587号
广告合作:1813099741@qq.com 6ren.com