gpt4 book ai didi

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

转载 作者:知者 更新时间:2024-03-15 21:28:40 27 4
gpt4 key购买 nike

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

YoFrameQuaternion.setAndMatchFrame介绍

暂无

代码示例

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

public void setDesiredPelvisOrientation(FrameOrientation desiredPelvisOrientation)
{
 yoDesiredPelvisOrientation.setAndMatchFrame(desiredPelvisOrientation);
}

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

public void setAndMatchFrame(FrameOrientation frameOrientation)
{
 setAndMatchFrame(frameOrientation, true);
}

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

public void setDesiredChestOrientation(FrameOrientation desiredChestOrientation)
{
 yoDesiredChestOrientation.setAndMatchFrame(desiredChestOrientation);
}

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

public void setAndMatchFrame(FramePoint framePoint, FrameOrientation frameOrientation)
{
 boolean notifyListeners = true;
 position.setAndMatchFrame(framePoint, notifyListeners);
 orientation.setAndMatchFrame(frameOrientation, notifyListeners);
}

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

public void setDesiredHandPose(RobotSide robotSide, FramePoint desiredHandPosition, FrameOrientation desiredHandOrientation)
{
 yoDesiredHandPositions.get(robotSide).setAndMatchFrame(desiredHandPosition);
 yoDesiredHandOrientations.get(robotSide).setAndMatchFrame(desiredHandOrientation);
}

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

public void submitFeedbackControlCommand(OrientationFeedbackControlCommand command)
{
 if (command.getEndEffector() != endEffector)
   throw new RuntimeException("Wrong end effector - received: " + command.getEndEffector() + ", expected: " + endEffector);
 base = command.getBase();
 baseFrame = base.getBodyFixedFrame();
 output.set(command.getSpatialAccelerationCommand());
 accelerationControlModule.setGains(command.getGains());
 command.getIncludingFrame(tempOrientation, tempAngularVelocity, feedForwardAngularAcceleration);
 yoDesiredOrientation.setAndMatchFrame(tempOrientation);
 yoDesiredAngularVelocity.setAndMatchFrame(tempAngularVelocity);
 yoFeedForwardAngularAcceleration.setAndMatchFrame(feedForwardAngularAcceleration);
}

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

public void submitFeedbackControlCommand(SpatialFeedbackControlCommand command)
{
 if (command.getEndEffector() != endEffector)
   throw new RuntimeException("Wrong end effector - received: " + command.getEndEffector() + ", expected: " + endEffector);
 base = command.getBase();
 output.set(command.getSpatialAccelerationCommand());
 accelerationControlModule.setGains(command.getGains());
 command.getControlFramePoseIncludingFrame(tempPosition, tempOrientation);
 accelerationControlModule.setBodyFixedControlFrame(tempPosition, tempOrientation);
 command.getIncludingFrame(tempPosition, tempLinearVelocity, feedForwardLinearAcceleration);
 yoDesiredPosition.setAndMatchFrame(tempPosition);
 yoDesiredLinearVelocity.setAndMatchFrame(tempLinearVelocity);
 yoFeedForwardLinearAcceleration.setAndMatchFrame(feedForwardLinearAcceleration);
 command.getIncludingFrame(tempOrientation, tempAngularVelocity, feedForwardAngularAcceleration);
 yoDesiredOrientation.setAndMatchFrame(tempOrientation);
 yoDesiredAngularVelocity.setAndMatchFrame(tempAngularVelocity);
 yoFeedForwardAngularAcceleration.setAndMatchFrame(feedForwardAngularAcceleration);
}

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

private void updateOrientationVisualization()
{
 desiredSpatialAcceleration.getAngularPart(desiredAngularAcceleration);
 yoDesiredAngularAcceleration.setAndMatchFrame(desiredAngularAcceleration);
 tempOrientation.setToZero(accelerationControlModule.getTrackingFrame());
 yoCurrentOrientation.setAndMatchFrame(tempOrientation);
 accelerationControlModule.getEndEffectorCurrentAngularVelocity(tempAngularVelocity);
 yoCurrentAngularVelocity.setAndMatchFrame(tempAngularVelocity);
 yoDesiredOrientation.get(tempAxisAngle);
 yoDesiredRotationVector.set(tempAxisAngle.getX(), tempAxisAngle.getY(), tempAxisAngle.getZ());
 yoDesiredRotationVector.scale(tempAxisAngle.getAngle());
 yoCurrentOrientation.get(tempAxisAngle);
 yoCurrentRotationVector.set(tempAxisAngle.getX(), tempAxisAngle.getY(), tempAxisAngle.getZ());
 yoCurrentRotationVector.scale(tempAxisAngle.getAngle());
}

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

@Override
public void compute()
{
 if (!isEnabled())
   return;
 yoDesiredOrientation.getFrameOrientationIncludingFrame(tempOrientation);
 yoDesiredAngularVelocity.getFrameTupleIncludingFrame(tempAngularVelocity);
 yoFeedForwardAngularAcceleration.getFrameTupleIncludingFrame(feedForwardAngularAcceleration);
 accelerationControlModule.compute(desiredAngularAcceleration, tempOrientation, tempAngularVelocity, feedForwardAngularAcceleration, base);
 yoDesiredAngularAcceleration.setAndMatchFrame(desiredAngularAcceleration);
 tempOrientation.setToZero(endEffectorFrame);
 yoCurrentOrientation.setAndMatchFrame(tempOrientation);
 accelerationControlModule.getEndEffectorCurrentAngularVelocity(tempAngularVelocity);
 yoCurrentAngularVelocity.setAndMatchFrame(tempAngularVelocity);
 yoDesiredOrientation.get(tempAxisAngle);
 yoDesiredRotationVector.set(tempAxisAngle.getX(), tempAxisAngle.getY(), tempAxisAngle.getZ());
 yoDesiredRotationVector.scale(tempAxisAngle.getAngle());
 yoCurrentOrientation.get(tempAxisAngle);
 yoCurrentRotationVector.set(tempAxisAngle.getX(), tempAxisAngle.getY(), tempAxisAngle.getZ());
 yoCurrentRotationVector.scale(tempAxisAngle.getAngle());
 output.setAngularAcceleration(endEffectorFrame, baseFrame, desiredAngularAcceleration);
}

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