How to use

getAndGrowIfNeeded

method

in

us.ihmc.robotics.lists.RecyclingArrayList

/**
* Add a new element at the end of this list.
* @return the new element.
*/
public T add()
{
 return getAndGrowIfNeeded(size);
}

public void set(int jointIndex, SimpleTrajectoryPoint1DList otherTrajectoryPointList)
{
 SimpleTrajectoryPoint1DList thisJointTrajectoryPointList = jointTrajectoryInputs.getAndGrowIfNeeded(jointIndex);
 thisJointTrajectoryPointList.set(otherTrajectoryPointList);
}

public void set(int jointIndex, SimpleTrajectoryPoint1DList otherTrajectoryPointList)
{
 SimpleTrajectoryPoint1DList thisJointTrajectoryPointList = jointTrajectoryInputs.getAndGrowIfNeeded(jointIndex);
 thisJointTrajectoryPointList.set(otherTrajectoryPointList);
}

public void set(int jointIndex, SimpleTrajectoryPoint1DList otherTrajectoryPointList)
{
 SimpleTrajectoryPoint1DList thisJointTrajectoryPointList = jointTrajectoryInputs.getAndGrowIfNeeded(jointIndex);
 thisJointTrajectoryPointList.set(otherTrajectoryPointList);
}

public void appendTrajectoryPoint(int jointIndex, SimpleTrajectoryPoint1D trajectoryPoint)
{
 jointTrajectoryInputs.getAndGrowIfNeeded(jointIndex).addTrajectoryPoint(trajectoryPoint);
}

public void addNeckTrajectoryPoint(double trajectoryPointTime, double[] desiredJointPositions, double[] desiredJointVelocities)
{
 MathTools.checkIfEqual(desiredJointPositions.length, desiredJointVelocities.length);
 for (int jointIndex = 0; jointIndex < desiredJointPositions.length; jointIndex++)
 {
   SimpleTrajectoryPoint1DList jointTrajectoryInput = jointTrajectoryInputs.getAndGrowIfNeeded(jointIndex);
   jointTrajectoryInput.addTrajectoryPoint(trajectoryPointTime, desiredJointPositions[jointIndex], desiredJointVelocities[jointIndex]);
 }
}

public void addArmTrajectoryPoint(double trajectoryPointTime, double[] desiredJointPositions, double[] desiredJointVelocities)
{
 MathTools.checkIfEqual(desiredJointPositions.length, desiredJointVelocities.length);
 for (int jointIndex = 0; jointIndex < desiredJointPositions.length; jointIndex++)
 {
   SimpleTrajectoryPoint1DList jointTrajectoryInput = jointTrajectoryInputs.getAndGrowIfNeeded(jointIndex);
   jointTrajectoryInput.addTrajectoryPoint(trajectoryPointTime, desiredJointPositions[jointIndex], desiredJointVelocities[jointIndex]);
 }
}

removeRay.getAndGrowIfNeeded(i).setValue(false);