private void updatePositionGraphics() { comPositionGraphic.setPosition(icpPlannerData1.comPosition); icpPositionGraphic.setPosition(icpPlannerData1.icpPosition); cmpPositionGraphic.setPosition(icpPlannerData1.cmpPosition); copPositionGraphic.setPosition(icpPlannerData1.copPosition); }
framePointS0.setZ(s0.getY() + offsetHeightAboveGround.getDoubleValue()); framePointS0.changeFrame(worldFrame); pointS0Viz.setPosition(framePointS0); pointS0MinViz.setPosition(framePointS0); pointS0MaxViz.setPosition(framePointS0); framePointD0.setZ(d0.getY() + offsetHeightAboveGround.getDoubleValue()); framePointD0.changeFrame(worldFrame); pointD0Viz.setPosition(framePointD0); pointD0MinViz.setPosition(framePointD0); pointD0MaxViz.setPosition(framePointD0); framePointDF.setZ(dF.getY() + offsetHeightAboveGround.getDoubleValue()); framePointDF.changeFrame(worldFrame); pointDFViz.setPosition(framePointDF); pointDFMinViz.setPosition(framePointDF); pointDFMaxViz.setPosition(framePointDF); pointSFViz.setPosition(framePointSF); pointSFMinViz.setPosition(framePointSF); pointSFMaxViz.setPosition(framePointSF);
public void setPositionToNaN() { setPosition(Double.NaN, Double.NaN, Double.NaN); }
public void setPositionToNaN() { setPosition(Double.NaN, Double.NaN, Double.NaN); }
/** * Resets by placing all the balls at (0, 0, 0) and making the first ball be the next ball to place. */ public void reset() { index = 0; for (int i = 0; i < dynamicGraphicPositions.size(); i++) { YoGraphicPosition yoGraphicPosition = dynamicGraphicPositions.get(i); yoGraphicPosition.setPosition(Double.NaN, Double.NaN, Double.NaN); } }
/** * Resets by placing all the balls at (0, 0, 0) and making the first ball be the next ball to * place. */ public void reset() { index = 0; for (int i = 0; i < yoGraphicPositions.size(); i++) { YoGraphicPosition yoGraphicPosition = yoGraphicPositions.get(i); yoGraphicPosition.setPosition(Double.NaN, Double.NaN, Double.NaN); } }
public void setBall(double x, double y, double z, AppearanceDefinition appearance, int ballIndex) { if (ballIndex < yoGraphicPositions.size()) { YoGraphicPosition yoGraphicPosition = yoGraphicPositions.get(ballIndex); yoGraphicPosition.setPosition(x, y, z); if (appearance != null) yoGraphicPosition.setAppearance(appearance); } else { if (!outOfBallsWarning) { // System.err.println("Bag of Balls doesn't have enough footstep graphic positions!"); outOfBallsWarning = true; } } }
public void setBall(double x, double y, double z, AppearanceDefinition appearance, int ballIndex) { if (ballIndex < dynamicGraphicPositions.size()) { YoGraphicPosition dynamicGraphicPosition = dynamicGraphicPositions.get(ballIndex); dynamicGraphicPosition.setPosition(x, y, z); if (appearance != null) dynamicGraphicPosition.setAppearance(appearance); } else { if (!this.outOfBallsWarning) { // System.err.println("Bag of Balls doesn't have enough footstep graphic positions!"); this.outOfBallsWarning = true; } } }
public void setPosition(FramePoint3DReadOnly position) { position.checkReferenceFrameMatch(ReferenceFrame.getWorldFrame()); setPosition((Tuple3DReadOnly) position); }
/** * Sets the next ball to the given location with the given Appearance. If all the balls have been * set, then loops to the first ball. * * @param location FramePoint to set the next ball to. * @param appearance Appearance to give the next ball. */ public void setBallLoop(FramePoint3DReadOnly location, AppearanceDefinition appearance) { location.checkReferenceFrameMatch(worldFrame); if (index >= yoGraphicPositions.size()) { index = 0; } YoGraphicPosition yoGraphicPosition = yoGraphicPositions.get(index); yoGraphicPosition.setPosition(location); if (appearance != null) yoGraphicPosition.setAppearance(appearance); index++; }
/** * Sets the next ball to the given location with the given Appearance. If all the balls have been set, then loops to the first ball. * * @param location FramePoint to set the next ball to. * @param appearance Appearance to give the next ball. */ public void setBallLoop(FramePoint location, AppearanceDefinition appearance) { location.changeFrame( ReferenceFrame.getWorldFrame()); if (index >= dynamicGraphicPositions.size()) { index = 0; } YoGraphicPosition dynamicGraphicPosition = dynamicGraphicPositions.get(index); dynamicGraphicPosition.setPosition(location); if (appearance != null) dynamicGraphicPosition.setAppearance(appearance); index++; }
public void setPosition(Tuple3d tuple3d) { setPosition(tuple3d.getX(), tuple3d.getY(), tuple3d.getZ()); }
public void setPosition(Tuple3DReadOnly position) { setPosition(position.getX(), position.getY(), position.getZ()); }
private void setGraphics(YoGraphicPosition graphics, FootstepNode node) { graphics.setPosition(node.getX(), node.getY(), 0.0); graphics.update(); }
private boolean isPositionReachable(int xIndex, int yIndex, int zIndex) { voxel3dGrid.getVoxel(voxelLocation, xIndex, yIndex, zIndex); modifiableVoxelLocation.setIncludingFrame(voxelLocation); modifiableVoxelLocation.changeFrame(ReferenceFrame.getWorldFrame()); currentEvaluationPosition.setPosition(modifiableVoxelLocation); currentEvaluationPosition.update(); return solver.solveFor(voxelLocation); }
private void update(double dt) { solePose.setFromReferenceFrame(swingOverPlanarRegionsTrajectoryExpander.getSolePoseReferenceFrame()); for (SwingOverPlanarRegionsTrajectoryCollisionType swingOverPlanarRegionsTrajectoryCollisionType : SwingOverPlanarRegionsTrajectoryCollisionType.values()) { intersectionMap.get(swingOverPlanarRegionsTrajectoryCollisionType) .setPosition(swingOverPlanarRegionsTrajectoryExpander.getClosestPolygonPoint(swingOverPlanarRegionsTrajectoryCollisionType)); } double sphereRadius = swingOverPlanarRegionsTrajectoryExpander.getSphereRadius(); collisionSphere.setRadii(new Vector3D(sphereRadius, sphereRadius, sphereRadius)); collisionSphere.update(); scs.tickAndUpdate(scs.getTime() + dt); }
beforeAdjustmentPosition.setPosition(nodeToExpand.getSolePosition()); afterAdjustmentPosition.setPosition(nodeToExpand.getSolePosition());
pointsOnA.get(j).setPosition(Double.NaN, Double.NaN, Double.NaN); pointsOnB.get(j).setPosition(Double.NaN, Double.NaN, Double.NaN); pointsOnA.get(vizIndex).setPosition(pointOnA); pointsOnB.get(vizIndex).setPosition(pointOnB);
t5InWorld.changeFrame(worldFrame); t6InWorld.changeFrame(worldFrame); t5Viz.setPosition(t5InWorld); t6Viz.setPosition(t6InWorld); b5InWorld.changeFrame(worldFrame); b6InWorld.changeFrame(worldFrame); b5Viz.setPosition(b5InWorld); b6Viz.setPosition(b6InWorld);