gpt4 book ai didi

us.ihmc.yoVariables.variable.YoFrameYawPitchRoll.getRoll()方法的使用及代码示例

转载 作者:知者 更新时间:2024-03-16 04:06:40 31 4
gpt4 key购买 nike

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

YoFrameYawPitchRoll.getRoll介绍

暂无

代码示例

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

public YoDouble getYoRoll()
{
 return getOrientation().getRoll();
}

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

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

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

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

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

public void update(YoFrameYawPitchRoll yoFrameVectorUnfiltered)
{
 checkReferenceFrameMatch(yoFrameVectorUnfiltered);
 update(yoFrameVectorUnfiltered.getYaw().getDoubleValue(), yoFrameVectorUnfiltered.getPitch().getDoubleValue(),
     yoFrameVectorUnfiltered.getRoll().getDoubleValue());
}

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

@Override
protected void computeRotationTranslation(AffineTransform transform3D)
{
 transform3D.setIdentity();
 transform3D.setScale(scale * radii.getX(), scale * radii.getY(), scale * radii.getZ());
 transform3D.setRotationYawPitchRoll(yawPitchRoll.getYaw().getValue(), yawPitchRoll.getPitch().getValue(), yawPitchRoll.getRoll().getValue());
 transform3D.setTranslation(position);
}

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

@Override
protected void computeRotationTranslation(AffineTransform transform3D)
{
 transform3D.setIdentity();
 double globalScale = 1.0;
 if (globalScaleProvider != null)
 {
   globalScale = globalScaleProvider.getValue();
 }
 transform3D.setScale(scale * globalScale);
 if (isUsingYawPitchRoll())
   transform3D.setRotationYawPitchRoll(yawPitchRoll.getYaw().getValue(), yawPitchRoll.getPitch().getValue(), yawPitchRoll.getRoll().getValue());
 else
   transform3D.setRotation(quaternion);
 transform3D.setTranslation(position);
}

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

public YoVariable<?>[] getVariables()
{
 YoVariable<?>[] vars = new YoVariable[isUsingYawPitchRoll() ? 6 : 7];
 int i = 0;
 vars[i++] = yoFramePoint.getYoX();
 vars[i++] = yoFramePoint.getYoY();
 vars[i++] = yoFramePoint.getYoZ();
 if (isUsingYawPitchRoll())
 {
   vars[i++] = yoFrameYawPitchRoll.getYaw();
   vars[i++] = yoFrameYawPitchRoll.getPitch();
   vars[i++] = yoFrameYawPitchRoll.getRoll();
 }
 else
 {
   vars[i++] = yoFrameQuaternion.getYoQx();
   vars[i++] = yoFrameQuaternion.getYoQy();
   vars[i++] = yoFrameQuaternion.getYoQz();
   vars[i++] = yoFrameQuaternion.getYoQs();
 }
 return vars;
}

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

@Override
public YoDouble[] getVariables()
{
 YoDouble[] vars = new YoDouble[isUsingYawPitchRoll() ? 6 : 7];
 int i = 0;
 vars[i++] = position.getYoX();
 vars[i++] = position.getYoY();
 vars[i++] = position.getYoZ();
 if (isUsingYawPitchRoll())
 {
   vars[i++] = yawPitchRoll.getYaw();
   vars[i++] = yawPitchRoll.getPitch();
   vars[i++] = yawPitchRoll.getRoll();
 }
 else
 {
   vars[i++] = quaternion.getYoQx();
   vars[i++] = quaternion.getYoQy();
   vars[i++] = quaternion.getYoQz();
   vars[i++] = quaternion.getYoQs();
 }
 return vars;
}

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

@Override
public double calculateCost(FramePose3D stanceFoot, FramePose3D swingStartFoot, FramePose3D idealFootstep, FramePose3D 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/ihmc-avatar-interfaces

sliderBoard.setSlider(sliderChannel++, yoFramePose.getOrientation().getRoll(), -Math.PI, Math.PI);

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

sliderBoard.setSlider(sliderChannel++, yoFramePose.getOrientation().getRoll(), -Math.PI, Math.PI);

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