gpt4 book ai didi

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

转载 作者:知者 更新时间:2024-03-15 23:32:40 26 4
gpt4 key购买 nike

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

YoFramePoint.setToNaN介绍

暂无

代码示例

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

@Override
public void setPositionToNaN()
{
 position.setToNaN();
}

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

@Override
public void setPositionToNaN()
{
 position.setToNaN();
}

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

@Override
public void setPositionToNaN()
{
 position.setToNaN();
}

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

@Override
public void setPositionToNaN()
{
 position.setToNaN();
}

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

@Override
  public void hideVisualization()
  {
   yoStartOfSplineICP.setToNaN();
   yoEndOfSplineICP.setToNaN();
  }
}

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

public void hide()
  {
   for (RigidBody rigidBody : footRigidBodies)
   {
     footRawCoPPositionsInWorld.get(rigidBody).setToNaN();
   }
   overallRawCoPPositionInWorld.setToNaN();
  }
}

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

public void setToNaN()
  {
   pointOne.setToNaN();
   pointTwo.setToNaN();
   pointThree.setToNaN();

   this.update();
  }
}

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

@Override
public void setToNaN()
{
 position.setToNaN();
 orientation.setToNaN();
}

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

public void setToNaN()
{
 position.setToNaN();
 orientation.setToNaN();
}

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

public void setPoseToNaN()
{
 yoFramePoint.setToNaN();
 yoFrameOrientation.setToNaN();
}

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

private void clearConfiguration()
{
 orientation.setToNaN();
 position.setToNaN();
}

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

/**
* Backward calculation of desired end of step capture point locations.
* @param cornerPointsToPack
* @param constantCMPs
* @param skipFirstCornerPoint whether the first is to be skipped or not. When in double support, the first corner point is useless and usually skipped.
* @param stepTime equals to the single plus double support durations
* @param omega0 the natural frequency &omega; = &radic;<span style="text-decoration:overline;">&nbsp; g / z0&nbsp;</span> of the biped.
*/
public static void computeDesiredCornerPoints(List<? extends YoFramePoint> cornerPointsToPack, List<YoFramePoint> constantCMPs, boolean skipFirstCornerPoint,
                       double stepTime, double omega0)
{
 double exponentialTerm = Math.exp(-omega0 * stepTime);
 YoFramePoint nextCornerPoint = constantCMPs.get(cornerPointsToPack.size());
 int firstCornerPointIndex = skipFirstCornerPoint ? 1 : 0;
 for (int i = cornerPointsToPack.size() - 1; i >= firstCornerPointIndex; i--)
 {
   YoFramePoint cornerPoint = cornerPointsToPack.get(i);
   YoFramePoint initialCMP = constantCMPs.get(i);
   cornerPoint.interpolate(initialCMP, nextCornerPoint, exponentialTerm);
   nextCornerPoint = cornerPoint;
 }
 if (skipFirstCornerPoint)
   cornerPointsToPack.get(0).setToNaN();
}

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

@Override
public void doTransitionOutOfAction()
{
 super.doTransitionOutOfAction();
 yoDesiredPosition.setToNaN();
 yoDesiredLinearVelocity.setToNaN();
 trajectoryWasReplanned = false;
}

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

private void updateCurrents()
{
 if (numberOfFeetTrusted.getIntegerValue() == numberOfFeet)
 {
   for (int i = 0; i < numberOfFeet; i++)
   {
    RigidBody foot = allFeet.get(i);
    footPosition.setToZero(footSoleFrames.get(foot));
    currentFootPositions.get(foot).setAndMatchFrame(footPosition);
   }
   currentAverageFootPosition.setToZero();
   for (int i = 0; i < numberOfFeet; i++)
   {
    RigidBody foot = allFeet.get(i);
    currentAverageFootPosition.add(currentFootPositions.get(foot));
   }
   currentAverageFootPosition.scale(1.0 / numberOfFeet);
 }
 else
 {
   for (int i = 0; i < numberOfFeet; i++)
    currentFootPositions.get(allFeet.get(i)).setToNaN();
   currentAverageFootPosition.setToNaN();
 }
}

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

private void updateContactPointDynamicGraphicObjects(int i, ContactPointInterface contactPoint)
  {
   if (contactPoint.isInContact())
   {
     contactPoint.getPosition(tempFramePoint);
     tempFramePoint.changeFrame(worldFrame);
     contactPointsWorld.get(i).set(tempFramePoint);
     normalVectors.get(i).set(tempFrameVector);

     dynamicGraphicPositions.get(i).showGraphicObject();
     dynamicGraphicVectors.get(i).showGraphicObject();
   }
   else
   {
     contactPointsWorld.get(i).setToNaN();
     normalVectors.get(i).set(Double.NaN, Double.NaN, Double.NaN);
     dynamicGraphicPositions.get(i).hideGraphicObject();
     dynamicGraphicVectors.get(i).hideGraphicObject();
   }

   dynamicGraphicPositions.get(i).update();
   dynamicGraphicVectors.get(i).update();
  }
}

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

public void compute(Map<RigidBody, Wrench> externalWrenches)
{
 for (int i = 0; i < contactablePlaneBodies.size(); i++)
 {
   ContactablePlaneBody contactablePlaneBody = contactablePlaneBodies.get(i);
   FramePoint2d cop = cops.get(contactablePlaneBody);
   YoFramePoint2d yoCop = yoCops.get(contactablePlaneBody);
   yoCop.getFrameTuple2d(cop);
   Wrench wrench = externalWrenches.get(contactablePlaneBody.getRigidBody());
   if (wrench != null)
   {
    wrench.getLinearPartIncludingFrame(tempForce);
    double normalTorque = centerOfPressureResolver.resolveCenterOfPressureAndNormalTorque(cop, wrench, contactablePlaneBody.getSoleFrame());
    centersOfPressure2d.get(contactablePlaneBody).set(cop);
    tempCoP3d.setXYIncludingFrame(cop);
    centersOfPressureWorld.get(contactablePlaneBody).setAndMatchFrame(tempCoP3d);
    groundReactionForceMagnitudes.get(contactablePlaneBody).set(tempForce.length());
    normalTorques.get(contactablePlaneBody).set(normalTorque);
   }
   else
   {
    groundReactionForceMagnitudes.get(contactablePlaneBody).set(0.0);
    centersOfPressureWorld.get(contactablePlaneBody).setToNaN();
    cop.setToNaN();
   }
   yoCop.set(cop);
   desiredCenterOfPressureDataHolder.setCenterOfPressure(cop, contactablePlaneBody.getRigidBody());
 }
}

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

@Override
public void reset()
{
 copFiltered.reset();
 footRotating.set(false);
 if (yoLineOfRotation != null)
 {
   yoLineOfRotation.setToNaN();
 }
 if (yoPlanePoint != null)
 {
   yoPlanePoint.setToNaN();
 }
 if (yoPlaneNormal != null)
 {
   yoPlaneNormal.setToNaN();
 }
}

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

public void clear()
{
 currentSolutionQuality.set(Double.POSITIVE_INFINITY);
 yoDesiredChestOrientation.setToNaN();
 yoDesiredPelvisOrientation.setToNaN();
 for (RobotSide robotSide : RobotSide.values)
 {
   yoDesiredHandPositions.get(robotSide).setToNaN();
   yoDesiredHandOrientations.get(robotSide).setToNaN();
 }
}

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

public void resetSwingParameters()
{
 yoDesiredFootPosition.setToNaN();
 yoCorrectedDesiredFootPosition.setToNaN();
 yoDesiredFootLinearVelocity.setToNaN();
 yoCorrectedDesiredFootLinearVelocity.setToNaN();
 if (visualize)
 {
   yoDesiredFootPositionGraphic.hideGraphicObject();
   yoCorrectedDesiredFootPositionGraphic.hideGraphicObject();
   if (moreVisualizers)
   {
    virtualLegTangentialFrameHipCenteredGraphics.update();
    virtualLegTangentialFrameAnkleCenteredGraphics.update();
    yoDesiredFootLinearVelocityGraphic.hideGraphicObject();
    yoCorrectedDesiredFootLinearVelocityGraphic.hideGraphicObject();
   }
 }
 alphaSwingSingularityAvoidance.set(0.0);
 unachievedSwingTranslation.setToZero();
 unachievedSwingVelocity.setToZero();
 unachievedSwingAcceleration.setToZero();
}

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

yoDesiredLinearVelocity.setToNaN();
yoDesiredPosition = new YoFramePoint(namePrefix + "DesiredPosition", worldFrame, registry);
yoDesiredPosition.setToNaN();
yoSetDesiredAccelerationToZero = new BooleanYoVariable(namePrefix + "SetDesiredAccelerationToZero", registry);
yoSetDesiredVelocityToZero = new BooleanYoVariable(namePrefix + "SetDesiredVelocityToZero", registry);

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