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

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

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

YoFramePoint3D.getZ介绍

暂无

代码示例

代码示例来源:origin: us.ihmc/simulation-construction-set-tools

public double getHoistHeight()
{
 return teepeeLocation.getZ();
}

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

public double getZ()
{
 return getPosition().getZ();
}

代码示例来源:origin: us.ihmc/simulation-construction-set-tools

public void handleClick(Point3D intersectionPosition, Point3D cameraPosition)
{
 LaunchedBall nextBall = poolOfBalls.get(nextBallIndex);
 final double ballVelocityMagnitude = directedPerturbance.getBallVelocityMagnitude();
 tempPoint.set(ballTarget.getX(), ballTarget.getY(), ballTarget.getZ());
 Point3D initialPosition = computeInitialPosition(intersectionPosition, ballTarget.getZ());
 final Point3D finalPosition = computeFinalPosition(initialPosition, ballVelocityMagnitude);
 nextBall.launch(initialPosition, finalPosition, directedPerturbance.getBallMass(), ballVelocityMagnitude);
 nextBallIndex++;
 if (nextBallIndex >= poolOfBalls.size())
 {
   nextBallIndex = 0;
 }
}

代码示例来源:origin: us.ihmc/simulation-construction-set-tools

private Point3D computeFinalPosition(Point3D initialPosition, double ballVelocityMagnitude)
{
 tempPoint.set(ballTarget.getX(), ballTarget.getY(), ballTarget.getZ());
 double distance = initialPosition.distance(tempPoint);
 double estimatedCollisionTime = distance / ballVelocityMagnitude;
 Point3D ret = new Point3D(ballTargetVelocity);
 ret.scale(estimatedCollisionTime);
 ret.add(tempPoint);
 return ret;
}

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

@Override
protected void updateTransformToParent(RigidBodyTransform transformToParent)
{
 yoFramePose.getOrientation().getQuaternion(rotation);
 transformToParent.setRotation(rotation);
 YoFramePoint3D yoFramePoint = yoFramePose.getPosition();
 transformToParent.setTranslation(yoFramePoint.getX(), yoFramePoint.getY(), yoFramePoint.getZ());
}

代码示例来源:origin: us.ihmc/simulation-construction-set-tools

@Override
public double[] getMessageValues()
{
 return new double[]
 {
   force.getX(), force.getY(), force.getZ(), position.getX(), position.getY(), position.getZ(),
   groundContactPoint.getYoFootSwitch().getDoubleValue()
 };
}

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

private void initializePolynomials()
{
 xPolynomial.setInitialPositionVelocityZeroFinalHighOrderDerivatives(0.0, trajectoryTime.getDoubleValue(), initialPosition.getX(), initialVelocity.getX(), finalPosition.getX(), finalVelocity.getX());
 yPolynomial.setInitialPositionVelocityZeroFinalHighOrderDerivatives(0.0, trajectoryTime.getDoubleValue(), initialPosition.getY(), initialVelocity.getY(), finalPosition.getY(), finalVelocity.getY());
 zPolynomial.setInitialPositionVelocityZeroFinalHighOrderDerivatives(0.0, trajectoryTime.getDoubleValue(), initialPosition.getZ(), initialVelocity.getZ(), finalPosition.getZ(), finalVelocity.getZ());
}

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

@Override
public void initialize()
{
 currentTime.set(0.0);
 double tIntermediate = trajectoryTime.getDoubleValue() / 2.0;
 xPolynomial.setQuadraticWithFinalVelocityConstraint(0.0,trajectoryTime.getDoubleValue(), initialPosition.getX(), finalPosition.getX(), finalVelocity.getX());
 yPolynomial.setQuadraticWithFinalVelocityConstraint(0.0,trajectoryTime.getDoubleValue(), initialPosition.getY(), finalPosition.getY(), finalVelocity.getY());
 zPolynomial.setCubicWithIntermediatePositionAndFinalVelocityConstraint(0.0,  tIntermediate, trajectoryTime.getDoubleValue(), initialPosition.getZ(), intermediateZPosition.getDoubleValue(), finalPosition.getZ(), finalVelocity.getZ());
 currentPosition.set(initialPosition);
 currentAcceleration.setToZero();
}

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

if (bodyPath.get(0).distanceXY(currentPosition) > 1.0e-3 || !MathTools.epsilonEquals(bodyPath.get(0).getZ(), currentPosition.getZ(), 0.1))

相关文章