public void set(RigidBodyTransform transform3D) { tempFrameOrientation.setIncludingFrame(getReferenceFrame(), transform3D); set(tempFrameOrientation); }
public void set(Quat4d quaternion, boolean notifyListeners) { tempFrameOrientation.setIncludingFrame(getReferenceFrame(), quaternion); set(tempFrameOrientation, notifyListeners); }
public void set(Matrix3d rotation) { tempFrameOrientation.setIncludingFrame(getReferenceFrame(), rotation); set(tempFrameOrientation); }
public void set(YoFrameQuaternion orientation) { orientation.checkReferenceFrameMatch(getReferenceFrame()); orientation.getFrameOrientationIncludingFrame(tempFrameOrientation); set(tempFrameOrientation); }
@Override public String toString() { return "(yaw = " + yaw.getDoubleValue() + ", pitch = " + pitch.getDoubleValue() + ", roll = " + roll.getDoubleValue() + ")-" + getReferenceFrame().getName(); } }
public FrameOrientation getFrameOrientationCopy() { FrameOrientation orientation = new FrameOrientation(getReferenceFrame(), yaw.getDoubleValue(), pitch.getDoubleValue(), roll.getDoubleValue()); return orientation; }
public void set(FrameOrientation orientation, boolean notifyListeners) { orientation.checkReferenceFrameMatch(getReferenceFrame()); orientation.getYawPitchRoll(tempYawPitchRoll); yaw.set(tempYawPitchRoll[0], notifyListeners); pitch.set(tempYawPitchRoll[1], notifyListeners); roll.set(tempYawPitchRoll[2], notifyListeners); }
private void putYoValuesIntoFrameOrientation() { tempFrameOrientation.setToZero(getReferenceFrame()); tempFrameOrientation.setYawPitchRoll(yaw.getDoubleValue(), pitch.getDoubleValue(), roll.getDoubleValue()); }
public void getFrameOrientationIncludingFrame(FrameOrientation orientationToPack) { orientationToPack.setToZero(getReferenceFrame()); orientationToPack.setYawPitchRoll(yaw.getDoubleValue(), pitch.getDoubleValue(), roll.getDoubleValue()); }
public void interpolate(YoFrameOrientation orientationOne, YoFrameOrientation orientationTwo, double alpha) { orientationOne.putYoValuesIntoFrameOrientation(); orientationTwo.putYoValuesIntoFrameOrientation(); tempFrameOrientation.setToZero(getReferenceFrame()); tempFrameOrientation.interpolate(orientationOne.tempFrameOrientation, orientationTwo.tempFrameOrientation, alpha); this.set(tempFrameOrientation); }
public void setAndMatchFrame(YoFrameOrientation yoFrameOrientation, boolean notifyListeners) { yoFrameOrientation.getFrameOrientationIncludingFrame(tempFrameOrientation); tempFrameOrientation.changeFrame(getReferenceFrame()); tempFrameOrientation.getYawPitchRoll(tempYawPitchRoll); yaw.set(tempYawPitchRoll[0], notifyListeners); pitch.set(tempYawPitchRoll[1], notifyListeners); roll.set(tempYawPitchRoll[2], notifyListeners); }
public void setAndMatchFrame(YoFrameQuaternion yoFrameQuaternion, boolean notifyListeners) { yoFrameQuaternion.getFrameOrientationIncludingFrame(tempFrameOrientation); tempFrameOrientation.changeFrame(getReferenceFrame()); tempFrameOrientation.getYawPitchRoll(tempYawPitchRoll); yaw.set(tempYawPitchRoll[0], notifyListeners); pitch.set(tempYawPitchRoll[1], notifyListeners); roll.set(tempYawPitchRoll[2], notifyListeners); }
public void setAndMatchFrame(FrameOrientation orientation, boolean notifyListeners) { tempFrameOrientation.setIncludingFrame(orientation); tempFrameOrientation.changeFrame(getReferenceFrame()); tempFrameOrientation.getYawPitchRoll(tempYawPitchRoll); yaw.set(tempYawPitchRoll[0], notifyListeners); pitch.set(tempYawPitchRoll[1], notifyListeners); roll.set(tempYawPitchRoll[2], notifyListeners); }
/** * Sets the orientation of this to the origin of the passed in ReferenceFrame. * * @param referenceFrame */ public void setFromReferenceFrame(ReferenceFrame referenceFrame, boolean notifyListeners) { tempFrameOrientation.setToZero(referenceFrame); tempFrameOrientation.changeFrame(getReferenceFrame()); tempFrameOrientation.getYawPitchRoll(tempYawPitchRoll); yaw.set(tempYawPitchRoll[0], notifyListeners); pitch.set(tempYawPitchRoll[1], notifyListeners); roll.set(tempYawPitchRoll[2], notifyListeners); }
public void set(YoFrameOrientation orientation) { orientation.checkReferenceFrameMatch(getReferenceFrame()); yaw.set(orientation.yaw.getDoubleValue()); pitch.set(orientation.pitch.getDoubleValue()); roll.set(orientation.roll.getDoubleValue()); }
public YoGraphicCoordinateSystem(String name, YoFramePoint framePoint, YoFrameOrientation orientation, double scale) { super(name); ReferenceFrame.getWorldFrame().checkReferenceFrameMatch(framePoint); framePoint.checkReferenceFrameMatch(orientation.getReferenceFrame()); x = framePoint.getYoX(); y = framePoint.getYoY(); z = framePoint.getYoZ(); yaw = orientation.getYaw(); pitch = orientation.getPitch(); roll = orientation.getRoll(); this.scale = scale; }
tempOrientation.changeFrame(currentOrientationForViz.getReferenceFrame()); currentOrientationForViz.set(tempOrientation);