本文整理了Java中us.ihmc.yoVariables.variable.YoFrameYawPitchRoll.getRoll()
方法的一些代码示例,展示了YoFrameYawPitchRoll.getRoll()
的具体用法。这些代码示例主要来源于Github
/Stackoverflow
/Maven
等平台,是从一些精选项目中提取出来的代码,具有较强的参考意义,能在一定程度帮忙到你。YoFrameYawPitchRoll.getRoll()
方法的具体详情如下:
包路径:us.ihmc.yoVariables.variable.YoFrameYawPitchRoll
类名称: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);
内容来源于网络,如有侵权,请联系作者删除!