本文整理了Java中us.ihmc.euclid.referenceFrame.ReferenceFrame.checkReferenceFrameMatch
方法的一些代码示例,展示了ReferenceFrame.checkReferenceFrameMatch
的具体用法。这些代码示例主要来源于Github
/Stackoverflow
/Maven
等平台,是从一些精选项目中提取出来的代码,具有较强的参考意义,能在一定程度帮忙到你。ReferenceFrame.checkReferenceFrameMatch
方法的具体详情如下:
包路径:us.ihmc.euclid.referenceFrame.ReferenceFrame
类名称: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);
}
内容来源于网络,如有侵权,请联系作者删除!