public void setFinalPosition(double x, double y, double z) { this.finalPosition.set(x, y, z); }
public void setFinalPosition(FramePoint finalPosition) { this.finalPosition.set(finalPosition); }
public void setIncludingFrame(YoFrameTuple<?, ?> yoFrameTuple) { multipleFramesHelper.switchCurrentReferenceFrame(yoFrameTuple.getReferenceFrame()); set(yoFrameTuple); }
public void setIncludingFrame(FrameTuple2DReadOnly frameTuple2d, double z) { multipleFramesHelper.switchCurrentReferenceFrame(frameTuple2d.getReferenceFrame()); set(frameTuple2d, z); }
public void setIncludingFrame(FrameTuple<?, ?> frameTuple) { multipleFramesHelper.switchCurrentReferenceFrame(frameTuple.getReferenceFrame()); set(frameTuple); }
public void setIncludingFrame(FrameTuple3DReadOnly frameTuple) { multipleFramesHelper.switchCurrentReferenceFrame(frameTuple.getReferenceFrame()); set(frameTuple); }
public void setInitialPose(FramePoint initialPosition, FrameOrientation initialOrientation) { this.initialPosition.set(initialPosition); this.initialOrientation.set(initialOrientation); initialOrientationForViz.setAndMatchFrame(initialOrientation); }
public void setInitialPoseWithInitialVelocity(FramePoint initialPosition, FrameVector initialVelocity, FrameOrientation initialOrientation, FrameVector initialAngularVelocity) { this.initialPosition.set(initialPosition); this.initialVelocity.set(initialVelocity); this.initialOrientation.set(initialOrientation); this.initialAngularVelocity.set(initialAngularVelocity); }
public void setInitialPoseWithoutInitialVelocity(FramePoint initialPosition, FrameOrientation initialOrientation) { this.initialPosition.set(initialPosition); this.initialVelocity.setToZero(); this.initialOrientation.set(initialOrientation); this.initialAngularVelocity.setToZero(); }
public void setFinalPose(FramePose finalPose) { finalPose.getPoseIncludingFrame(tempPosition, tempOrientation); finalPosition.set(tempPosition); finalOrientation.set(tempOrientation); finalOrientationForViz.setAndMatchFrame(tempOrientation); }
public void setInitialPoseWithoutInitialVelocity(FramePose initialPose) { initialPose.getPoseIncludingFrame(tempPosition, tempOrientation); this.initialPosition.set(tempPosition); this.initialVelocity.setToZero(); ; this.initialOrientation.set(tempOrientation); this.initialAngularVelocity.setToZero(); }
public void setInitialPoseWithInitialVelocity(FramePose initialPose, FrameVector initialVelocity, FrameVector initialAngularVelocity) { initialPose.getPoseIncludingFrame(tempPosition, tempOrientation); this.initialPosition.set(tempPosition); this.initialVelocity.set(initialVelocity); this.initialOrientation.set(tempOrientation); this.initialAngularVelocity.set(initialAngularVelocity); }
@Override public void changeFrame(ReferenceFrame desiredFrame) { point.set(this); ReferenceFrame currentReferenceFrame = multipleFramesHelper.switchCurrentReferenceFrame(desiredFrame); framePoint.setIncludingFrame(currentReferenceFrame, point); framePoint.changeFrame(desiredFrame); point.set(framePoint); set(point); }
public void setFinalPoseWithoutFinalVelocity(FramePoint finalPosition, FrameOrientation finalOrientation) { this.finalPosition.set(finalPosition); this.finalOrientation.set(finalOrientation); finalPositionForViz.setAndMatchFrame(finalPosition); finalOrientationForViz.setAndMatchFrame(finalOrientation); this.finalVelocity.setToZero(); this.finalAngularVelocity.setToZero(); }
@Override public void changeFrame(ReferenceFrame desiredFrame) { get(point); ReferenceFrame currentReferenceFrame = multipleFramesHelper.switchCurrentReferenceFrame(desiredFrame); framePoint.setIncludingFrame(currentReferenceFrame, point); framePoint.changeFrame(desiredFrame); framePoint.get(point); set(point); }
public void setFinalPose(FramePoint finalPosition, FrameOrientation finalOrientation) { this.finalPosition.set(finalPosition); this.finalOrientation.set(finalOrientation); finalOrientationForViz.setAndMatchFrame(finalOrientation); tempPosition.setIncludingFrame(finalPosition); tempOrientation.setIncludingFrame(finalOrientation); finalOrientationForViz.setAndMatchFrame(tempOrientation); }
private void reset() { currentTime.set(0.0); currentPosition.set(initialPosition); currentVelocity.setToZero(); currentAcceleration.setToZero(); currentOrientation.set(initialOrientation); currentAngularVelocity.setToZero(); currentAngularAcceleration.setToZero(); }
private void reset() { currentTime.set(0.0); currentPosition.set(initialPosition); currentVelocity.set(initialVelocity); currentAcceleration.setToZero(); currentOrientation.set(initialOrientation); currentAngularVelocity.set(initialAngularVelocity); currentAngularAcceleration.setToZero(); }
public void setInitialPose(FramePose initialPose) { initialPose.getPoseIncludingFrame(tempPosition, tempOrientation); tempPosition.changeFrame(initialPosition.getReferenceFrame()); initialPosition.set(tempPosition); tempOrientation.changeFrame(initialOrientation.getReferenceFrame()); initialOrientation.set(tempOrientation); initialOrientationForViz.setAndMatchFrame(tempOrientation); }
public void setInitialLeadOut(FramePoint initialPosition, FrameVector initialDirection, double leaveDistance) { this.initialPosition.set(initialPosition); this.initialDirection.set(initialDirection); this.initialDirection.normalize(); this.initialDirection.get(tempVector); GeometryTools.getAxisAngleFromZUpToVector(tempVector, tempAxisAngle); initialDistortionPose.setToZero(this.initialPosition.getReferenceFrame()); initialDistortionPose.setPosition(initialPosition); initialDistortionPose.setOrientation(tempAxisAngle); this.leaveDistance.set(leaveDistance); }