gpt4 book ai didi

us.ihmc.robotics.referenceFrames.ZUpFrame.update()方法的使用及代码示例

转载 作者:知者 更新时间:2024-03-14 18:16:49 26 4
gpt4 key购买 nike

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

ZUpFrame.update介绍

暂无

代码示例

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

public ZUpFrame(ReferenceFrame worldFrame, FramePoint3D origin, String name)
{
 super(name, worldFrame, false, true);
 this.worldFrame = worldFrame;
 this.origin = new FramePoint3D(origin);
 
 this.update();
}

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

public ZUpFrame(ReferenceFrame worldFrame, FramePoint origin, String name)
{
 super(name, worldFrame, false, false, true);
 this.worldFrame = worldFrame;
 this.origin = new FramePoint(origin);
 
 this.update();
}

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

@Override
public void updateFrames()
{
 fullRobotModel.updateFrames();
 pelvisZUpFrame.update();
 midFeetZUpFrame.update();
 midFeetZUpWalkDirectionFrame.update();
 midFeetUnderPelvisWalkDirectionFrame.update();
 for (RobotSide robotSide : RobotSide.values)
 {
   ankleZUpFrames.get(robotSide).update();
   soleFrames.get(robotSide).update();
   soleZUpFrames.get(robotSide).update();
 }
 centerOfMassFrame.update();
}

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

@Override
public void initializeDesiredFootstep(RobotSide supportLegSide, double stepDuration)
{
 RobotSide swingLegSide = supportLegSide.getOppositeSide();
 ZUpFrame supportZUpFrame = soleZUpFrames.get(supportLegSide);
 supportZUpFrame.update();
 ReferenceFrame supportFrame = soleFrames.get(supportLegSide);
 computeDistanceAndAngleToDestination(supportZUpFrame, swingLegSide, desiredDestination.getFramePoint2dCopy());
 if (distanceToDestination.getDoubleValue() < DISTANCE_TO_DESTINATION_FOR_STEP_IN_PLACE)
 {
   numberBlindStepsInPlace.increment();
 }
 FrameOrientation footOrientation = computeDesiredFootRotation(angleToDestination.getDoubleValue(), swingLegSide, supportFrame);
 FramePoint footstepPosition = getDesiredFootstepPositionCopy(supportZUpFrame, supportFrame, swingLegSide);
 setYoVariables(swingLegSide, footOrientation, footstepPosition);
}

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

@Override
public FootstepDataMessage predictFootstepAfterDesiredFootstep(RobotSide supportLegSide, FootstepDataMessage desiredFootstep, double timeFromNow,
   double stepDuration)
{
 RobotSide futureSwingLegSide = supportLegSide;
 PoseReferenceFrame futureSupportFrame = new PoseReferenceFrame("futureSupportFrame", worldFrame);
 futureSupportFrame.setPoseAndUpdate(desiredFootstep.getLocation(), desiredFootstep.getOrientation());
 ZUpFrame futureSupportZUpFrame = new ZUpFrame(worldFrame, futureSupportFrame, "futureSupportZUpFrame");
 futureSupportZUpFrame.update();
 ReferenceFrame desiredHeadingFrame = desiredHeadingControlModule.getPredictedHeadingFrame(timeFromNow);
 Matrix3d footToWorldRotation = computeDesiredFootRotation(desiredHeadingFrame);
 FrameOrientation footstepOrientation = new FrameOrientation(worldFrame, footToWorldRotation);
 FramePoint footstepPosition = getDesiredFootstepPosition(futureSupportZUpFrame, futureSwingLegSide, footToWorldRotation, timeFromNow, stepDuration);
 footstepPosition.changeFrame(worldFrame);
 FootstepDataMessage predictedFootstep = new FootstepDataMessage();
 predictedFootstep.setOrigin(FootstepOrigin.AT_SOLE_FRAME);
 predictedFootstep.setRobotSide(futureSwingLegSide);
 predictedFootstep.setLocation(footstepPosition.getPoint());
 predictedFootstep.setOrientation(footstepOrientation.getQuaternion());
 return predictedFootstep;
}

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

parentSoleZupFrame.update();

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

parentSoleZupFrame.update();

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