public void startSimulation() { SimulationConstructionSetParameters simulationParameters = new SimulationConstructionSetParameters(true, 16000); SimulationConstructionSet scs = new SimulationConstructionSet(simulatedRobot, simulationParameters); scs.setDT(robotModel.getSimulateDT(), 10); scs.setCameraPosition(scsCameraPosition.x, scsCameraPosition.y, scsCameraPosition.z); scs.setCameraFix(scsCameraFix.x, scsCameraFix.y, scsCameraFix.z); scs.startOnAThread(); }
public void startSimulation() { SimulationConstructionSetParameters simulationParameters = new SimulationConstructionSetParameters(true, 16000); SimulationConstructionSet scs = new SimulationConstructionSet(simulatedRobot, simulationParameters); scs.setDT(robotModel.getSimulateDT(), 10); scs.setCameraPosition(scsCameraPosition.x, scsCameraPosition.y, scsCameraPosition.z); scs.setCameraFix(scsCameraFix.x, scsCameraFix.y, scsCameraFix.z); scs.startOnAThread(); }
private void startSimAndDisplayLink(Link linkToDisplay) { // Robot nullRobot = new Robot("Null"); sim = new SimulationConstructionSet(parameters); sim.addStaticLink(linkToDisplay); // position the camera to view links sim.setCameraPosition(6.0, 6.0, 3.0); sim.setCameraFix(0.5, 0.5, 0.0); sim.setGroundVisible(false); sim.startOnAThread(); ThreadTools.sleep(3000); sim.closeAndDispose(); }
public void visualizeFootstep(ContactablePlaneBody bipedFoot, Footstep footstep) { bagOfSingleFootstepVisualizers.visualizeFootstep(footstep, bipedFoot); nullRobot.setTime(nullRobot.getTime() + scs.getDT()); FramePoint solePositon = new FramePoint(footstep.getSoleReferenceFrame()); solePositon.changeFrame(worldFrame); updateFocus(solePositon); scs.setCameraFix(focusX, focusY, 0.0); scs.setCameraPosition(focusX, focusY - 1.5, 6.0); scs.tickAndUpdate(); }
public void visualizeFootstep(ContactablePlaneBody bipedFoot, Footstep footstep) { bagOfSingleFootstepVisualizers.visualizeFootstep(footstep, bipedFoot); nullRobot.setTime(nullRobot.getTime() + scs.getDT()); FramePoint3D solePositon = new FramePoint3D(footstep.getSoleReferenceFrame()); solePositon.changeFrame(worldFrame); updateFocus(solePositon); scs.setCameraFix(focusX, focusY, 0.0); scs.setCameraPosition(focusX, focusY - 1.5, 6.0); scs.tickAndUpdate(); }
private DRCRobotModel setup(DRCStartingLocation startingLocation) throws SimulationExceededMaximumTimeException { String className = getClass().getSimpleName(); FlatGroundEnvironment environment = new FlatGroundEnvironment(); DRCRobotModel robotModel = getRobotModel(); drcSimulationTestHelper = new DRCSimulationTestHelper(simulationTestingParameters, robotModel, environment); drcSimulationTestHelper.setStartingLocation(startingLocation); drcSimulationTestHelper.createSimulation(className); drcSimulationTestHelper.getSimulationConstructionSet().setCameraPosition(0.0, -3.0, 1.0); drcSimulationTestHelper.getSimulationConstructionSet().setCameraFix(0.0, 0.0, 0.2); pushController = new PushRobotController(drcSimulationTestHelper.getRobot(), robotModel.createFullRobotModel().getChest().getParentJoint().getName(), new Vector3D(0, 0, 0.15)); ThreadTools.sleep(1000); assertTrue(drcSimulationTestHelper.simulateAndBlockAndCatchExceptions(0.5)); return robotModel; }
public void startSimulation() { SimulationConstructionSetParameters simulationParameters = new SimulationConstructionSetParameters(true, 16000); SimulationConstructionSet scs = new SimulationConstructionSet(simulatedRobot, simulationParameters); scs.setDT(robotModel.getSimulateDT(), 10); scs.setCameraPosition(scsCameraPosition.getX(), scsCameraPosition.getY(), scsCameraPosition.getZ()); scs.setCameraFix(scsCameraFix.getX(), scsCameraFix.getY(), scsCameraFix.getZ()); scs.startOnAThread(); }
private void startSCS() { scs.addYoVariableRegistry(registry); scs.addYoGraphicsListRegistry(graphicsListRegistry); scs.setPlaybackRealTimeRate(0.025); Graphics3DObject linkGraphics = new Graphics3DObject(); linkGraphics.addCoordinateSystem(0.3); scs.addStaticLinkGraphics(linkGraphics); scs.setCameraFix(0.0, 0.0, 0.5); scs.setCameraPosition(-0.5, 0.0, 1.0); SimulationOverheadPlotterFactory simulationOverheadPlotterFactory = scs.createSimulationOverheadPlotterFactory(); simulationOverheadPlotterFactory.addYoGraphicsListRegistries(graphicsListRegistry); simulationOverheadPlotterFactory.createOverheadPlotter(); scs.startOnAThread(); }
scs.setMaxBufferSize(64000); scs.setCameraFix(0.0, 0.0, 0.0); scs.setCameraPosition(-0.001, 0.0, 15.0); scs.tickAndUpdate();
private void setupTest() throws SimulationExceededMaximumTimeException { BambooTools.reportTestStartedMessage(simulationTestingParameters.getShowWindows()); DRCObstacleCourseStartingLocation selectedLocation = DRCObstacleCourseStartingLocation.DEFAULT; FlatGroundEnvironment environment = new FlatGroundEnvironment(); drcSimulationTestHelper = new DRCSimulationTestHelper(simulationTestingParameters, getRobotModel()); drcSimulationTestHelper.setTestEnvironment(environment); drcSimulationTestHelper.setStartingLocation(selectedLocation); drcSimulationTestHelper.createSimulation(getClass().getSimpleName()); ThreadTools.sleep(1000); FullHumanoidRobotModel fullRobotModel = drcSimulationTestHelper.getControllerFullRobotModel(); head = fullRobotModel.getHead(); chest = fullRobotModel.getChest(); neckJoints = MultiBodySystemTools.createOneDoFJointPath(chest, head); numberOfJoints = neckJoints.length; drcSimulationTestHelper.getSimulationConstructionSet().hideAllYoGraphics(); drcSimulationTestHelper.getSimulationConstructionSet().setCameraPosition(5.0, 0.0, 2.0); drcSimulationTestHelper.getSimulationConstructionSet().setCameraFix(0.0, 0.0, 0.4); assertTrue(drcSimulationTestHelper.simulateAndBlockAndCatchExceptions(1.0)); }
scs.setCameraPosition(CAMPOS[0], CAMPOS[1], CAMPOS[2]);
scs.addYoGraphicsListRegistry(yoGraphicsListRegistry, true); scs.setCameraFix(0.0, 0.0, 1.0); scs.setCameraPosition(8.0, 0.0, 3.0); scs.startOnAThread(); blockingSimulationRunner = new BlockingSimulationRunner(scs, 60.0 * 10.0);
private static SimulationConstructionSet setupSCS(String testName, YoVariableRegistry testRegistry, PlanarRegionsList regions, Point3D start, Point3D goal) { Robot robot = new Robot(VisibilityGraphsOcclusionTest.class.getSimpleName()); robot.addYoVariableRegistry(testRegistry); SimulationConstructionSet scs = new SimulationConstructionSet(robot, simulationTestingParameters); Graphics3DObject graphics3DObject = new Graphics3DObject(); graphics3DObject.addCoordinateSystem(0.8); if (regions != null) { Graphics3DObjectTools.addPlanarRegionsList(graphics3DObject, regions, YoAppearance.White(), YoAppearance.Grey(), YoAppearance.DarkGray()); scs.setGroundVisible(false); } graphics3DObject.identity(); graphics3DObject.translate(start); graphics3DObject.translate(0.0, 0.0, 0.05); graphics3DObject.addCone(0.3, 0.05, YoAppearance.Green()); graphics3DObject.identity(); graphics3DObject.translate(goal); graphics3DObject.translate(0.0, 0.0, 0.05); graphics3DObject.addCone(0.3, 0.05, YoAppearance.Red()); scs.addStaticLinkGraphics(graphics3DObject); scs.setCameraPosition(-7.0, -1.0, 25.0); scs.setCameraFix(0.0, 0.0, 0.0); return scs; }
ThreadTools.sleep(1000); SimulationConstructionSet scs = drcSimulationTestHelper.getSimulationConstructionSet(); scs.setCameraPosition(8.0, -8.0, 5.0); scs.setCameraFix(1.5, 0.0, 0.8); assertTrue(drcSimulationTestHelper.simulateAndBlockAndCatchExceptions(0.5));
sdfRobot = drcSimulationFactory.getRobot(); simulationConstructionSet.setCameraPosition(scsCameraPosition.x, scsCameraPosition.y, scsCameraPosition.z); simulationConstructionSet.setCameraFix(scsCameraFix.x, scsCameraFix.y, scsCameraFix.z);
scs.setCameraPosition(-7.0, -1.0, 25.0); scs.setCameraFix(0.0, 0.0, 0.0);
scs.addStaticLinkGraphics(graphics3DObject); scs.addYoGraphicsListRegistry(graphicsListRegistry); scs.setCameraPosition(-0.01, 0.0, 10.0); scs.setCameraFix(0.0, 0.0, 0.0); scs.startOnAThread();
scs.addYoGraphicsListRegistry(yoGraphicsListRegistry, true); scs.setCameraFix(0.0, 0.0, 1.0); scs.setCameraPosition(8.0, 0.0, 3.0); scs.startOnAThread(); blockingSimulationRunner = new BlockingSimulationRunner(scs, 60.0 * 10.0);
scs.addYoGraphicsListRegistry(yoGraphicsListRegistry, true); scs.setCameraFix(0.0, 0.0, 1.0); scs.setCameraPosition(8.0, 0.0, 3.0); scs.startOnAThread(); blockingSimulationRunner = new BlockingSimulationRunner(scs, 60.0 * 10.0);
scs.addYoGraphicsListRegistry(yoGraphicsListRegistry, true); scs.setCameraFix(0.0, 0.0, 1.0); scs.setCameraPosition(8.0, 0.0, 3.0); scs.startOnAThread();