/** * Sets the next ball to the given location. If all the balls have been set, then loops to the first ball. * @param location FramePoint to set the next ball to. */ public void setBallLoop(FramePoint location) { setBallLoop(location, null); }
private void updateCMPTrack() { cmpTrack.setBallLoop(icpPlannerData1.cmpPosition); }
private void updateCoPTrack() { copTrack.setBallLoop(icpPlannerData1.copPosition); }
/** * Sets the next ball to the given location. If all the balls have been set, then loops to the * first ball. * * @param location FramePoint to set the next ball to. */ public void setBallLoop(FramePoint3DReadOnly location) { setBallLoop(location, null); }
private void updateICPTrack() { icpTrack.setBallLoop(icpPlannerData1.icpPosition); }
private void updateCoMTrack() { comTrack.setBallLoop(icpPlannerData1.comPosition); }
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 = 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(); }
private void visualizeTrajectory() { yoInitialPosition.getFrameTupleIncludingFrame(initialPosition); yoInitialPositionWorld.setAndMatchFrame(initialPosition); yoFinalPosition.getFrameTupleIncludingFrame(finalPosition); yoFinalPositionWorld.setAndMatchFrame(finalPosition); for (int i = 0; i < numberOfBalls; i++) { double t = (double) i / ((double) numberOfBalls - 1) * trajectoryTime.getDoubleValue(); compute(t, false); yoCurrentPosition.getFrameTupleIncludingFrame(ballPosition); ballPosition.changeFrame(worldFrame); bagOfBalls.setBallLoop(ballPosition); } reset(); }
private void visualizeTrajectory() { yoInitialPosition.getFrameTupleIncludingFrame(initialPosition); yoInitialPositionWorld.setAndMatchFrame(initialPosition); yoFinalPosition.getFrameTupleIncludingFrame(finalPosition); yoFinalPositionWorld.setAndMatchFrame(finalPosition); for (int i = 0; i < numberOfBalls; i++) { double t = (double) i / ((double) numberOfBalls - 1) * desiredTrajectoryTime.getDoubleValue(); compute(t, false); yoCurrentPosition.getFrameTupleIncludingFrame(ballPosition); ballPosition.changeFrame(worldFrame); bagOfBalls.setBallLoop(ballPosition); } reset(); }
bagOfBalls.setBallLoop(new FramePoint3D(ReferenceFrame.getWorldFrame(), queryPoint), appearance); scs.setTime(scs.getTime() + 0.001); scs.tickAndUpdate();
tempFramePointForViz2.setY(tempFramePointForViz1.getY()); bagOfBalls.setBallLoop(tempFramePointForViz2);