public YoFramePoint2dInMultipleFrames(String namePrefix, YoVariableRegistry registry, ReferenceFrame... referenceFrames) { super(namePrefix, null, registry); this.namePrefix = namePrefix; this.registry = registry; multipleFramesHelper = new YoMultipleFramesHelper(namePrefix, registry, referenceFrames); }
public YoFrameOrientationInMultipleFrames(String namePrefix, YoVariableRegistry registry, ReferenceFrame... referenceFrames) { super(namePrefix, null, registry); multipleFramesHelper = new YoMultipleFramesHelper(namePrefix, registry, referenceFrames); }
public YoFrameVectorInMultipleFrames(String namePrefix, YoVariableRegistry registry, ReferenceFrame... referenceFrames) { super(namePrefix, null, registry); this.namePrefix = namePrefix; this.registry = registry; multipleFramesHelper = new YoMultipleFramesHelper(namePrefix, registry, referenceFrames); }
public YoFramePoint2dInMultipleFrames(String namePrefix, YoVariableRegistry registry, ReferenceFrame... referenceFrames) { super(namePrefix, null, registry); this.namePrefix = namePrefix; this.registry = registry; multipleFramesHelper = new YoMultipleFramesHelper(namePrefix, registry, referenceFrames); }
public YoFrameQuaternionInMultipleFrames(String namePrefix, YoVariableRegistry registry, ReferenceFrame... referenceFrames) { super(namePrefix, null, registry); multipleFramesHelper = new YoMultipleFramesHelper(namePrefix, registry, referenceFrames); }
public YoFrameQuaternionInMultipleFrames(String namePrefix, YoVariableRegistry registry, ReferenceFrame... referenceFrames) { super(namePrefix, null, registry); multipleFramesHelper = new YoMultipleFramesHelper(namePrefix, registry, referenceFrames); }
public YoFramePointInMultipleFrames(String namePrefix, YoVariableRegistry registry, ReferenceFrame... referenceFrames) { super(namePrefix, null, registry); this.namePrefix = namePrefix; this.registry = registry; multipleFramesHelper = new YoMultipleFramesHelper(namePrefix, registry, referenceFrames); }
public YoFramePointInMultipleFrames(String namePrefix, YoVariableRegistry registry, ReferenceFrame... referenceFrames) { super(namePrefix, null, registry); this.namePrefix = namePrefix; this.registry = registry; multipleFramesHelper = new YoMultipleFramesHelper(namePrefix, registry, referenceFrames); }
public YoFrameOrientationInMultipleFrames(String namePrefix, YoVariableRegistry registry, ReferenceFrame... referenceFrames) { super(namePrefix, null, registry); multipleFramesHelper = new YoMultipleFramesHelper(namePrefix, registry, referenceFrames); }
public YoFrameVectorInMultipleFrames(String namePrefix, YoVariableRegistry registry, ReferenceFrame... referenceFrames) { super(namePrefix, null, registry); this.namePrefix = namePrefix; this.registry = registry; multipleFramesHelper = new YoMultipleFramesHelper(namePrefix, registry, referenceFrames); }
protected YoFrameWaypoint(F frameWaypoint, String namePrefix, String nameSuffix, YoVariableRegistry registry, ReferenceFrame... referenceFrames) { this.namePrefix = namePrefix; this.nameSuffix = nameSuffix; multipleFramesHelper = new YoMultipleFramesHelper(createName(namePrefix, nameSuffix, ""), registry, referenceFrames); this.frameWaypoint = frameWaypoint; }
protected YoFrameWaypoint(F frameWaypoint, String namePrefix, String nameSuffix, YoVariableRegistry registry, ReferenceFrame... referenceFrames) { this.namePrefix = namePrefix; this.nameSuffix = nameSuffix; multipleFramesHelper = new YoMultipleFramesHelper(createName(namePrefix, nameSuffix, ""), registry, referenceFrames); this.frameWaypoint = frameWaypoint; }
public LinearSpatialVectorTrajectoryGenerator(String namePrefix, int maximumNumberOfWaypoints, ReferenceFrame referenceFrame, YoVariableRegistry parentRegistry) { this.namePrefix = namePrefix; this.maximumNumberOfWaypoints = maximumNumberOfWaypoints; registry = new YoVariableRegistry(namePrefix + getClass().getSimpleName()); parentRegistry.addChild(registry); currentTrajectoryTime = new YoDouble(namePrefix + "CurrentTrajectoryTime", registry); numberOfWaypoints = new YoInteger(namePrefix + "NumberOfWaypoints", registry); numberOfWaypoints.set(0); currentWaypointIndex = new YoInteger(namePrefix + "CurrentWaypointIndex", registry); multipleFramesHelper = new YoMultipleFramesHelper(namePrefix, registry, referenceFrame); currentValue = new YoSpatialWaypoint(namePrefix + "CurrentValue", multipleFramesHelper, registry, referenceFrame); waypoints = new ArrayList<>(maximumNumberOfWaypoints); for (int i = 0; i < maximumNumberOfWaypoints; i++) { YoSpatialWaypoint waypoint = new YoSpatialWaypoint(namePrefix + "Waypoint" + i, multipleFramesHelper, registry, referenceFrame); waypoints.add(waypoint); } }
new YoMultipleFramesHelper("framesHelperOne", registry); fail("Need to have at least one reference frame when you create a YoMultipleFramesHelper"); new YoMultipleFramesHelper("framesHelperTwo", registry, (ReferenceFrame) null); fail("The Reference Frames cannot be null"); new YoMultipleFramesHelper("framesHelperTwoB", registry); fail("The Reference Frames cannot be null"); YoMultipleFramesHelper helper = new YoMultipleFramesHelper("framesHelperFour", registry, worldFrame); assertEquals(1, helper.getNumberOfReferenceFramesRegistered());
@ContinuousIntegrationTest(estimatedDuration = 0.0) @Test(timeout=300000) public void testRepeatFrames() { YoVariableRegistry registry = new YoVariableRegistry("framesHelper"); ReferenceFrame worldFrame = ReferenceFrame.getWorldFrame(); YoMultipleFramesHelper helper = new YoMultipleFramesHelper("framesHelperThree", registry, worldFrame, worldFrame); assertEquals("Should ignore repeat frames!", 1, helper.getNumberOfReferenceFramesRegistered()); helper.registerReferenceFrame(worldFrame); assertEquals("Should ignore repeat frames!", 1, helper.getNumberOfReferenceFramesRegistered()); }
@ContinuousIntegrationTest(estimatedDuration = 0.0) @Test(timeout=300000) public void testCommonUsageOfYoMultipleFramesHelper() { String namePrefix = "framesHelper"; YoVariableRegistry registry = new YoVariableRegistry("framesHelper"); ReferenceFrame worldFrame = ReferenceFrame.getWorldFrame(); ReferenceFrame frameA = new TranslationReferenceFrame("frameA", worldFrame); ReferenceFrame frameB = new TranslationReferenceFrame("frameB", frameA); YoMultipleFramesHelper helper = new YoMultipleFramesHelper(namePrefix, registry, worldFrame, frameA); assertEquals(2, helper.getNumberOfReferenceFramesRegistered()); assertTrue(worldFrame == helper.getCurrentReferenceFrame()); assertTrue(worldFrame == helper.getReferenceFrame()); helper.checkReferenceFrameMatch(worldFrame); assertTrue(helper.isReferenceFrameRegistered(worldFrame)); assertTrue(helper.isReferenceFrameRegistered(frameA)); assertFalse(helper.isReferenceFrameRegistered(frameB)); helper.registerReferenceFrame(frameB); assertEquals(3, helper.getNumberOfReferenceFramesRegistered()); List<ReferenceFrame> referenceFrames = new ArrayList<ReferenceFrame>(); helper.getRegisteredReferenceFrames(referenceFrames); assertEquals(3, referenceFrames.size()); }