gpt4 book ai didi

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

转载 作者:知者 更新时间:2024-03-16 00:52:40 30 4
gpt4 key购买 nike

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

YoFramePoint.get介绍

暂无

代码示例

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

public void get(Point3d positionToPack)
{
 currentPosition.get(positionToPack);
}

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

@Override
public void getPoint(Point3d pointToPack)
{
 this.get(pointToPack);
}

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

@Override
public Point3d getMeasurementPointInBodyFrame()
{
 yoMeasurementPointInBodyFrame.get(measurementPointInBodyFrame);
 return measurementPointInBodyFrame;
}

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

@Override
public void getPosition(Point3d positionToPack)
{
 position.get(positionToPack);
}

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

@Override
public void getPosition(Point3d positionToPack)
{
 position.get(positionToPack);
}

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

@Override
public void getPosition(Point3d positionToPack)
{
 position.get(positionToPack);
}

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

@Override
public void getPosition(Point3d positionToPack)
{
 position.get(positionToPack);
}

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

public void get(Point3d positionToPack)
{
 currentPosition.get(positionToPack);
}

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

@Override
public Point3d getMeasurementPointInBodyFrame()
{
 yoMeasurementPointInBodyFrame.get(measurementPointInBodyFrame);
 return super.getMeasurementPointInBodyFrame();
}

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

public void get(Vector3d translation)
  {
   yoFramePose.getPosition().get(translation);
  }
}

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

@Override
public Point3d getMeasurementPointInWorldFrame()
{
 yoMeasurementPointInWorldFrame.get(positionOfMeasurementPointInWorldFrame);
 return super.getMeasurementPointInWorldFrame();
}

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

@Override
public void initialize()
{
 robot.update();
 for (int i = 0; i < efp_offsetFromRootJoint.size(); i++)
 {
   externalForcePoints.get(i).getYoPosition().get(initialPositions.get(i));
   desiredHeight.add(initialPositions.get(i).getZ() / initialPositions.size());
   efp_positionViz.get(i).update();
 }
 for (int i = 0; i < efp_offsetFromRootJoint.size(); i++)
   initialPositions.get(i).setZ(desiredHeight.getDoubleValue());
 doControl();
}

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

@Override
public void initialize()
{
 robot.update();
 for (int i = 0; i < efp_offsetFromRootJoint.size(); i++)
 {
   externalForcePoints.get(i).getYoPosition().get(initialPositions.get(i));
   desiredHeight.add(initialPositions.get(i).getZ() / initialPositions.size());
   efp_positionViz.get(i).update();
 }
 for (int i = 0; i < efp_offsetFromRootJoint.size(); i++)
   initialPositions.get(i).setZ(desiredHeight.getDoubleValue());
 doControl();
}

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

@Override
  protected void updateTransformToParent(RigidBodyTransform transformToParent)
  {
   circleOrigin.get(localTranslation);
   rotationAxis.get(localRotationAxis);
   GeometryTools.getAxisAngleFromZUpToVector(localRotationAxis, localAxisAngle);
   transformToParent.set(localAxisAngle, localTranslation);
  }
};

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

@Override
protected void putYoValuesIntoFrameWaypoint()
{
 EuclideanWaypoint simpleWaypoint = frameWaypoint.getGeometryObject();
 position.get(simpleWaypoint.getPosition());
 linearVelocity.get(simpleWaypoint.getLinearVelocity());
}

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

@Override
  public void doControl()
  {
   for (int i = 0; i < efp_offsetFromRootJoint.size(); i++)
   {
     initialPositions.get(i).setZ(desiredHeight.getDoubleValue());

     ExternalForcePoint efp = externalForcePoints.get(i);
     efp.getYoPosition().get(proportionalTerm);
     proportionalTerm.sub(initialPositions.get(i));
     proportionalTerm.scale(-holdPelvisKp.getDoubleValue());
//         proportionalTerm.setZ(Math.max(proportionalTerm.getZ(), 0.0));

     efp.getYoVelocity().get(derivativeTerm);
     derivativeTerm.scale(-holdPelvisKv.getDoubleValue());

     pdControlOutput.add(proportionalTerm, derivativeTerm);

     efp.setForce(pdControlOutput);
     efp.getYoForce().getYoZ().add(robotWeight / efp_offsetFromRootJoint.size());

     efp_positionViz.get(i).update();
   }
  }

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

public void updateForFrozenState()
{
 // Keep setting the position so the localization updater works properly.
 yoRootJointPosition.get(tempRootJointTranslation);
 rootJoint.setPosition(tempRootJointTranslation);
 // Set the rootJoint twist to zero.
 rootJoint.getJointTwist(rootJointTwist);
 rootJointTwist.setToZero();
 rootJoint.setJointTwist(rootJointTwist);
 rootJointFrame.update();
 twistCalculator.compute();
 updateCoMState();
}

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

private void updateRootJoint()
{
 yoRootJointPosition.get(tempRootJointTranslation);
 rootJoint.setPosition(tempRootJointTranslation);
 tempVelocity.setIncludingFrame(rootJointVelocity);
 rootJoint.getJointTwist(rootJointTwist);
 tempVelocity.changeFrame(rootJointTwist.getExpressedInFrame());
 rootJointTwist.setLinearPart(tempVelocity);
 rootJoint.setJointTwist(rootJointTwist);
 rootJointFrame.update();
 twistCalculator.compute();
}

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

@Override
protected void putYoValuesIntoFrameWaypoint()
{
 SE3Waypoint simpleWaypoint = frameWaypoint.getGeometryObject();
 EuclideanWaypoint euclideanWaypoint = simpleWaypoint.getEuclideanWaypoint();
 SO3Waypoint so3Waypoint = simpleWaypoint.getSO3Waypoint();
 position.get(euclideanWaypoint.getPosition());
 orientation.get(so3Waypoint.getOrientation());
 linearVelocity.get(euclideanWaypoint.getLinearVelocity());
 angularVelocity.get(so3Waypoint.getAngularVelocity());
}

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

@Override
  protected void updateTransformToParent(RigidBodyTransform transformToParent)
  {
   steeringWheelRotationAxis.get(localZAxis);
   steeringWheelZeroAxis.get(localXAxis);
   localYAxis.cross(localZAxis, localXAxis);
   localYAxis.normalize();
   localXAxis.cross(localYAxis, localZAxis);
   steeringWheelZeroAxis.set(localXAxis);
   steeringWheelCenter.get(localTranslation);
   localRotation.setColumn(0, localXAxis);
   localRotation.setColumn(1, localYAxis);
   localRotation.setColumn(2, localZAxis);
   transformToParent.set(localRotation, localTranslation);
  }
};

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