us.ihmc.euclid.referenceFrame.ReferenceFrame.checkReferenceFrameMatch()方法的使用及代码示例

x33g5p2x  于2022-01-29 转载在 其他  
字(7.5k)|赞(0)|评价(0)|浏览(101)

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

ReferenceFrame.checkReferenceFrameMatch介绍

[英]Check if this frame and the query are the same.
[中]检查此框架和查询是否相同。

代码示例

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

@Override
public void checkReferenceFrameMatch(ReferenceFrame frame) throws ReferenceFrameMismatchException
{
 getReferenceFrame().checkReferenceFrameMatch(referenceFrame);
}

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

private void checkExpressedInFrames(TwistReadOnly desiredTwist, TwistReadOnly currentTwist)
{
 desiredTwist.getReferenceFrame().checkReferenceFrameMatch(bodyFrame);
 currentTwist.getReferenceFrame().checkReferenceFrameMatch(bodyFrame);
}

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

private void checkBodyFrames(TwistReadOnly desiredTwist, TwistReadOnly currentTwist)
{
 desiredTwist.getBodyFrame().checkReferenceFrameMatch(bodyFrame);
 currentTwist.getBodyFrame().checkReferenceFrameMatch(bodyFrame);
}

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

private void checkExpressedInFrames(TwistReadOnly desiredTwist, TwistReadOnly currentTwist)
{
 desiredTwist.getReferenceFrame().checkReferenceFrameMatch(bodyFrame);
 currentTwist.getReferenceFrame().checkReferenceFrameMatch(bodyFrame);
}

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

private void checkBodyFrames(TwistReadOnly desiredTwist, TwistReadOnly currentTwist)
{
 desiredTwist.getBodyFrame().checkReferenceFrameMatch(bodyFrame);
 currentTwist.getBodyFrame().checkReferenceFrameMatch(bodyFrame);
}

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

private void checkBodyFrames(TwistReadOnly desiredTwist, TwistReadOnly currentTwist)
{
 desiredTwist.getBodyFrame().checkReferenceFrameMatch(bodyFrame);
 currentTwist.getBodyFrame().checkReferenceFrameMatch(bodyFrame);
}

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

public void queueFrameOrientation(FrameQuaternion frameOrientation)
{
 if (referenceFrame != null)
   referenceFrame.checkReferenceFrameMatch(frameOrientation);
 tempQuaternion.set(frameOrientation);
 queueQuaternion(tempQuaternion);
}

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

private void checkBodyFrames(TwistReadOnly desiredTwist, SpatialAccelerationReadOnly feedForwardAcceleration, TwistReadOnly currentTwist)
{
 checkBodyFrames(desiredTwist, currentTwist);
 feedForwardAcceleration.getBodyFrame().checkReferenceFrameMatch(bodyFrame);
}

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

@Override
public void checkReferenceFrameMatch(ReferenceFrameHolder referenceFrameHolder) throws ReferenceFrameMismatchException
{
 getReferenceFrame().checkReferenceFrameMatch(referenceFrameHolder.getReferenceFrame());
}

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

@Override
public void checkReferenceFrameMatch(ReferenceFrameHolder referenceFrameHolder) throws ReferenceFrameMismatchException
{
 getReferenceFrame().checkReferenceFrameMatch(referenceFrameHolder.getReferenceFrame());
}

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

private void checkBaseFrames(TwistReadOnly desiredTwist, SpatialAccelerationReadOnly feedForwardAcceleration, TwistReadOnly currentTwist)
{
 checkBaseFrames(desiredTwist, currentTwist);
 desiredTwist.getBaseFrame().checkReferenceFrameMatch(feedForwardAcceleration.getBaseFrame());
}

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

public void setOrientationAndUpdate(FrameQuaternion orientation)
{
 this.getParent().checkReferenceFrameMatch(orientation.getReferenceFrame());
 this.frameOrientation.set(orientation);
 this.update();
}

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

private void computeInitialConstraintError(FrameQuaternionReadOnly initialOrientation, double initialTime)
{
 trajectory.compute(initialTime);
 trajectoryFrame.checkReferenceFrameMatch(initialOrientation.getReferenceFrame());
 trajectory.getOrientation(tempOrientation);
 tempOrientation.changeFrame(trajectoryFrame);
 initialConstraintOrientationError.difference(tempOrientation, initialOrientation);
}

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

private void computeFinalConstraintError(FrameQuaternionReadOnly finalOrientation, double finalTime)
{
 trajectory.compute(finalTime);
 trajectoryFrame.checkReferenceFrameMatch(finalOrientation.getReferenceFrame());
 trajectory.getOrientation(tempOrientation);
 tempOrientation.changeFrame(trajectoryFrame);
 finalConstraintOrientationError.difference(tempOrientation, finalOrientation);
}

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

private void computeInitialConstraintError(FrameQuaternionReadOnly initialOrientation, FrameVector3DReadOnly initialAngularVelocity, double initialTime)
{
 computeInitialConstraintError(initialOrientation, initialTime);
 trajectoryFrame.checkReferenceFrameMatch(initialAngularVelocity.getReferenceFrame());
 trajectory.getAngularVelocity(tempAngularVelocity);
 tempAngularVelocity.changeFrame(trajectoryFrame);
 initialConstraintAngularVelocityError.set(initialAngularVelocity);
 initialConstraintAngularVelocityError.sub(tempAngularVelocity);
}

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

private void computeFinalConstraintError(FrameQuaternionReadOnly finalOrientation, FrameVector3DReadOnly finalAngularVelocity, double finalTime)
{
 computeFinalConstraintError(finalOrientation, finalTime);
 trajectoryFrame.checkReferenceFrameMatch(finalAngularVelocity.getReferenceFrame());
 trajectory.getAngularVelocity(tempAngularVelocity);
 tempAngularVelocity.changeFrame(trajectoryFrame);
 finalConstraintAngularVelocityError.set(finalAngularVelocity);
 finalConstraintAngularVelocityError.sub(tempAngularVelocity);
}

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

private void computeInitialConstraintError(FramePoint3DReadOnly initialPosition, FrameVector3DReadOnly initialVelocity, double initialTime)
{
 computeInitialConstraintError(initialPosition, initialTime);
 trajectoryFrame.checkReferenceFrameMatch(initialVelocity.getReferenceFrame());
 trajectory.getVelocity(tempVelocity);
 tempVelocity.changeFrame(trajectoryFrame);
 initialConstraintVelocityError.set(initialVelocity);
 initialConstraintVelocityError.sub(tempVelocity);
}

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

private void computeFinalConstraintError(FramePoint3DReadOnly finalPosition, double finalTime)
{
 trajectory.compute(finalTime);
 trajectoryFrame.checkReferenceFrameMatch(finalPosition.getReferenceFrame());
 trajectory.getPosition(tempPosition);
 tempPosition.changeFrame(trajectoryFrame);
 finalConstraintPositionError.set(finalPosition);
 finalConstraintPositionError.sub(tempPosition);
}

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

private void computeFinalConstraintError(FramePoint3DReadOnly finalPosition, FrameVector3DReadOnly finalVelocity, double finalTime)
{
 computeFinalConstraintError(finalPosition, finalTime);
 trajectoryFrame.checkReferenceFrameMatch(finalVelocity.getReferenceFrame());
 trajectory.getVelocity(tempVelocity);
 tempVelocity.changeFrame(trajectoryFrame);
 finalConstraintVelocityError.set(finalVelocity);
 finalConstraintVelocityError.sub(tempVelocity);
}

代码示例来源:origin: us.ihmc/simulation-construction-set-tools-test

private void compareWrenches(Wrench inputWrench, Wrench outputWrench)
{
 inputWrench.getBodyFrame().checkReferenceFrameMatch(outputWrench.getBodyFrame());
 inputWrench.getReferenceFrame().checkReferenceFrameMatch(outputWrench.getReferenceFrame());
 double epsilon = 1e-12; //3;
 EuclidCoreTestTools.assertTuple3DEquals(new Vector3D(inputWrench.getAngularPart()), new Vector3D(outputWrench.getAngularPart()), epsilon);
 EuclidCoreTestTools.assertTuple3DEquals(new Vector3D(inputWrench.getLinearPart()), new Vector3D(outputWrench.getLinearPart()), epsilon);
}

相关文章