@Override public void getPosition(FramePoint positionToPack) { currentPosition.getFrameTupleIncludingFrame(positionToPack); }
@Override public void getPosition(FramePoint positionToPack) { currentPosition.getFrameTupleIncludingFrame(positionToPack); }
public void getPosition(FramePoint positionToPack) { currentPosition.getFrameTupleIncludingFrame(positionToPack); }
public void getPosition(FramePoint positionToPack) { currentPosition.getFrameTupleIncludingFrame(positionToPack); }
public void getSingleSupportInitialCapturePointPosition(FramePoint capturePointPositionToPack) { singleSupportInitialICP.getFrameTupleIncludingFrame(capturePointPositionToPack); }
public void getPosition(FramePoint positionToPack) { currentPosition.getFrameTupleIncludingFrame(positionToPack); }
@Override public void variableChanged(YoVariable<?> v) { getFrameTupleIncludingFrame(localFramePoint); point.setAndMatchFrame(localFramePoint); } });
public String toStringForASingleReferenceFrame(ReferenceFrame referenceFrame) { getFrameTupleIncludingFrame(framePoint); framePoint.changeFrame(referenceFrame); return framePoint.toString(); }
public void getFinalDesiredCapturePointPosition(FramePoint finalDesiredCapturePointPositionToPack) { if (isStanding.getBooleanValue()) referenceCMPsCalculator.getNextEntryCMP(tempFinalICP); else entryCornerPoints.get(1).getFrameTupleIncludingFrame(tempFinalICP); tempFinalICP.changeFrame(worldFrame); finalDesiredCapturePointPositionToPack.setIncludingFrame(tempFinalICP); }
public void getFinalDesiredCapturePointPosition(YoFramePoint2d finalDesiredCapturePointPositionToPack) { if (isStanding.getBooleanValue()) referenceCMPsCalculator.getNextEntryCMP(tempFinalICP); else entryCornerPoints.get(1).getFrameTupleIncludingFrame(tempFinalICP); tempFinalICP.changeFrame(finalDesiredCapturePointPositionToPack.getReferenceFrame()); finalDesiredCapturePointPositionToPack.setByProjectionOntoXYPlane(tempFinalICP); }
private void visualizeTrajectory() { for (int i = 0; i < numberOfBalls; i++) { double t = i / ((double) numberOfBalls - 1) * trajectoryTime.getDoubleValue(); compute(t); currentPosition.getFrameTupleIncludingFrame(ballPosition); ballPosition.changeFrame(ReferenceFrame.getWorldFrame()); bagOfBalls.setBallLoop(ballPosition); } }
private void visualizeTrajectory() { for (int i = 0; i < numberOfBalls; i++) { double t = (double) i / ((double) numberOfBalls - 1) * trajectoryTime.getDoubleValue(); compute(t); currentPosition.getFrameTupleIncludingFrame(ballPosition); ballPosition.changeFrame(ReferenceFrame.getWorldFrame()); bagOfBalls.setBallLoop(ballPosition); } }
private void visualizeTrajectory() { for (int i = 0; i < numberOfBalls; i++) { double t = i / ((double) numberOfBalls - 1) * trajectoryTime.getDoubleValue(); compute(t); currentPosition.getFrameTupleIncludingFrame(ballPosition); ballPosition.changeFrame(ReferenceFrame.getWorldFrame()); bagOfBalls.setBallLoop(ballPosition); } }
private void visualizeTrajectory() { for (int i = 0; i < numberOfBalls; i++) { double t = (double) i / ((double) numberOfBalls - 1) * trajectoryTime.getDoubleValue(); compute(t); currentPosition.getFrameTupleIncludingFrame(ballPosition); ballPosition.changeFrame(ReferenceFrame.getWorldFrame()); bagOfBalls.setBallLoop(ballPosition); } reset(); }
private void visualizeTrajectory() { for (int i = 0; i < numberOfBalls; i++) { double t = (double) i / ((double) numberOfBalls - 1) * trajectoryTime.getDoubleValue(); compute(t); currentPosition.getFrameTupleIncludingFrame(ballPosition); ballPosition.changeFrame(ReferenceFrame.getWorldFrame()); currentOrientationForViz.set(currentOrientation); bagOfBalls.setBallLoop(ballPosition); } reset(); }
singleSupportInitialICP.getFrameTupleIncludingFrame(tempICP); tempICP.changeFrame(worldFrame); double currentSwingTime = swingTimes.get(0).getDoubleValue();