public void getContactPoint(int index, FramePoint contactPointToPack) { contactPointToPack.setIncludingFrame(contactPoints.get(index)); }
public void copyFromListAndTrimSize(FrameTupleArrayList<?> otherList) { for (int i = 0; i < otherList.size(); i++) { getAndGrowIfNeeded(i).setIncludingFrame(otherList.get(i)); } while(size() > otherList.size()) { remove(size() - 1); } }
CapturePointTools.putConstantCMPBetweenFeet(constantCentersOfPressures.get(0), footstepList.get(0), footstepList.get(1)); CapturePointTools.computeConstantCMPsOnFeet(constantCentersOfPressures, footstepList, 1, lastFootstepIndex); CapturePointTools.putConstantCMPBetweenFeet(constantCentersOfPressures.get(lastFootstepIndex), footstepList.get(lastFootstepIndex - 1), footstepList.get(lastFootstepIndex)); double omega0 = 0.5; double time = 0.5;
public void set(int i, FrameTuple<?, ?> frameTuple) { get(i).setIncludingFrame(frameTuple); }
EuclidCoreTestTools.assertTuple3DEquals("", arrayToPack.get(i), new Point3D(footstepList.get(i)), 1e-10);
public void set(int i, FrameTuple3DReadOnly frameTuple) { get(i).setIncludingFrame(frameTuple); }
FramePoint3D contactPoint = contactPoints.get(contactPointIndex); quadTree.addPoint(contactPoint.getX(), contactPoint.getY(), contactPoint.getZ());
copPos1.set(new Point3D(footstepList.get(0))); copPos1.add(new Point3D(footstepList.get(1))); copPos1.scale(0.5); EuclidCoreTestTools.assertTuple3DEquals("", copPos1, arrayToPack.get(0), 1e-10); for (int i = 1; i < arrayToPack.size() - 1; i++) EuclidCoreTestTools.assertTuple3DEquals("", arrayToPack.get(i), new Point3D(footstepList.get(i)), 1e-10);
FramePoint contactPoint = contactPoints.get(contactPointIndex); quadTree.addPoint(contactPoint.getX(), contactPoint.getY(), contactPoint.getZ());
CapturePointTools.putConstantCMPBetweenFeet(constantCentersOfPressures.get(0), footstepList.get(0), footstepList.get(1)); CapturePointTools.computeConstantCMPsOnFeet(constantCentersOfPressures, footstepList, 1, lastFootstepIndex); CapturePointTools.putConstantCMPBetweenFeet(constantCentersOfPressures.get(lastFootstepIndex), footstepList.get(lastFootstepIndex - 1), footstepList.get(lastFootstepIndex)); double omega0 = 0.5; double time = 0.5;
copPos1.set(new Point3D(footstepList.get(numberFootstepsToConsider - 1))); copPos1.add(new Point3D(footstepList.get(numberFootstepsToConsider - 2))); copPos1.scale(0.5); EuclidCoreTestTools.assertTuple3DEquals("", copPos1, arrayToPack.get(numberFootstepsToConsider - 1), 1e-10); copPos1.set(new Point3D(footstepList.get(0))); copPos1.add(new Point3D(footstepList.get(1))); copPos1.scale(0.5); EuclidCoreTestTools.assertTuple3DEquals("", copPos1, arrayToPack.get(0), 1e-10); EuclidCoreTestTools.assertTuple3DEquals("", arrayToPack.get(i), new Point3D(footstepList.get(i)), 1e-10);
copPos1.set(new Point3D(footstepList.get(numberFootstepsToConsider - 1))); copPos1.add(new Point3D(footstepList.get(numberFootstepsToConsider - 2))); copPos1.scale(0.5); EuclidCoreTestTools.assertTuple3DEquals("", copPos1, arrayToPack.get(numberFootstepsToConsider - 1), 1e-10); for (int i = 0; i < arrayToPack.size() - 2; i++) EuclidCoreTestTools.assertTuple3DEquals("", arrayToPack.get(i), new Point3D(footstepList.get(i)), 1e-10);