us.ihmc.robotics.math.frames.YoFramePoseUsingQuaternions类的使用及代码示例

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

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

YoFramePoseUsingQuaternions介绍

暂无

代码示例

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

public void set(FramePose framePose)
{
 set(framePose, true);
}

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

@Override
  protected void updateTransformToParent(RigidBodyTransform transformToParent)
  {
   locatedFiducialPoseInWorldFrame.getPose(transformToParent);
  }
};

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

@Override
public void set(YoFramePoseUsingQuaternions other)
{
 setPosition(other.position);
 setOrientation(other.orientation);
}

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

public void getFramePoseIncludingFrame(FramePose framePoseToPack)
{
 framePoseToPack.setToZero(getReferenceFrame());
 getFramePose(framePoseToPack);
}

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

detectorReferenceFrame.update();
cameraPose.setOrientation(cameraOrientationInWorldXForward);
cameraPose.setPosition(cameraPositionInWorld);
 tempFiducialDetectorFrame.changeFrame(ReferenceFrame.getWorldFrame());
 locatedFiducialPoseInWorldFrame.set(tempFiducialDetectorFrame);
 tempFiducialDetectorFrame.changeFrame(ReferenceFrame.getWorldFrame());
 reportedFiducialPoseInWorldFrame.set(tempFiducialDetectorFrame);

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

public FindGoalBehavior(DoubleYoVariable yoTime, CommunicationBridge behaviorCommunicationBridge, FullHumanoidRobotModel fullRobotModel, HumanoidReferenceFrames referenceFrames,
            GoalDetectorBehaviorService fiducialDetectorBehaviorService)
{
 super(FollowFiducialBehavior.class.getSimpleName(), behaviorCommunicationBridge);
 this.fullRobotModel = fullRobotModel;
 this.referenceFrames = referenceFrames;
 foundFiducialYoFramePose = new YoFramePoseUsingQuaternions(prefix + "FoundGoalPose", ReferenceFrame.getWorldFrame(), registry);
 this.fiducialDetectorBehaviorService = fiducialDetectorBehaviorService;
 addBehaviorService(fiducialDetectorBehaviorService);
 headPitchToFindFucdicial.set(0.6);
 headTrajectorySentTimer = new YoTimer(yoTime);
 headTrajectorySentTimer.start();
 //      behaviorCommunicationBridge.attachNetworkListeningQueue(robotConfigurationDataQueue, RobotConfigurationData.class);
 //      behaviorCommunicationBridge.attachNetworkListeningQueue(footstepStatusQueue, FootstepStatus.class);
 //      behaviorCommunicationBridge.attachNetworkListeningQueue(walkingStatusQueue, WalkingStatusMessage.class);
 //      behaviorCommunicationBridge.attachNetworkListeningQueue(planarRegionsListQueue, PlanarRegionsListMessage.class);
}

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

public void setPose(RigidBodyTransform rigidBodyTransform)
{
 setPose(rigidBodyTransform, true);
}

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

public DoubleYoVariable getYoQz()
  {
   return getOrientation().getYoQz();
  }
}

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

public void getReportedFiducialPoseWorldFrame(FramePose framePoseToPack)
{
 reportedFiducialPoseInWorldFrame.getFramePoseIncludingFrame(framePoseToPack);
}

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

detectorReferenceFrame.update();
cameraPose.setOrientation(cameraOrientationInWorldXForward);
cameraPose.setPosition(cameraPositionInWorld);
 tempFiducialDetectorFrame.changeFrame(ReferenceFrame.getWorldFrame());
 locatedFiducialPoseInWorldFrame.set(tempFiducialDetectorFrame);
 tempFiducialDetectorFrame.changeFrame(ReferenceFrame.getWorldFrame());
 reportedFiducialPoseInWorldFrame.set(tempFiducialDetectorFrame);

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

YoFramePoint position = new YoFramePoint(x, y, z, worldFrame);
YoFrameQuaternion orientation = new YoFrameQuaternion(qx, qy, qz, qs, worldFrame);
currentRegionPose = new YoFramePoseUsingQuaternions(position, orientation);

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

currentMeshIndex.set(currentIndex);
planarRegionToProcess.getTransformToWorld(regionTransform);
currentRegionPose.setPose(regionTransform);
currentRegionId.set(planarRegionToProcess.getRegionId());

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

public DoubleYoVariable getYoQs()
{
 return getOrientation().getYoQs();
}

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

public void getReportedFiducialPoseWorldFrame(FramePose framePoseToPack)
{
 reportedFiducialPoseInWorldFrame.getFramePoseIncludingFrame(framePoseToPack);
}

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

public void set(YoFramePose yoFramePose)
{
 set(yoFramePose.getPosition().getFrameTuple(), yoFramePose.getOrientation().getFrameOrientation());
}

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

@Override
  protected void updateTransformToParent(RigidBodyTransform transformToParent)
  {
   locatedFiducialPoseInWorldFrame.getPose(transformToParent);
  }
};

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

currentRegionId = new IntegerYoVariable(name + "CurrentRegionId", registry);
isPlanarRegionsListComplete = new BooleanYoVariable(name + "IsComplete", registry);
currentRegionPose = new YoFramePoseUsingQuaternions(name + "CurrentRegionPose", worldFrame, registry);

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

public DoubleYoVariable getYoQx()
{
 return getOrientation().getYoQx();
}

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

@Override
public void doControl()
{
 if (fiducialDetectorBehaviorService.getGoalHasBeenLocated())
 {
   fiducialDetectorBehaviorService.getReportedGoalPoseWorldFrame(foundFiducialPose);
   foundFiducialYoFramePose.set(foundFiducialPose);
   foundFiducial.set(true);
   Point3d position = new Point3d();
   foundFiducialPose.getPosition(position);
   sendTextToSpeechPacket("Target object located at " + position);
 } else {
   sendTextToSpeechPacket("Target object not located");
 }
 if (headTrajectorySentTimer.totalElapsed() < 2.0)
 {
   return;
 }
 pitchHeadToFindFiducial();
 //      pitchHeadToCenterFiducial();
}

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

currentRegionPose.getPose(transform);

相关文章