How to use us.ihmc.robotics.lists

@Override
public F getTrajectoryPoint(int trajectoryPointIndex)
{
 return trajectoryPoints.get(trajectoryPointIndex);
}

@Override
public void clear()
{
 trajectoryPoints.clear();
}

public void copyFromListAndTrimSize(FrameTuple2dArrayList<?> otherList)
{
 ensureCapacity(otherList.size());
 size = otherList.size;
 for (int i = 0; i < size; i++)
 {
   unsafeSet(i, otherList.unsafeGet(i));
 }
}

@Override
public int getNumberOfTrajectoryPoints()
{
 return trajectoryPoints.size();
}

/**
* Returns the last element of this list.
* If the list is empty, it returns {@code null}.
* @return the last element of this list
*/
public T getLast()
{
 if (isEmpty())
   return null;
 else
   return unsafeGet(size - 1);
}

/**
* @return the remaining space in this sequence (capacity() - size())
*/
public int remaining()
{
 return capacity() - size();
}

  @Override
  public boolean isCommandValid()
  {
   return timestamp != -1L && !scan.isEmpty();
  }
}

@Override
public P getLastTrajectoryPoint()
{
 return trajectoryPoints.getLast();
}

private void fillElementDataIfNeeded()
{
 for (int i = 0; i < elementData.length; i++)
 {
   if (elementData[i] == null)
    elementData[i] = builder.newInstance();
 }
}

/**
* Returns {@code true} if this list contains no elements.
*
* @return {@code true} if this list contains no elements.
*/
@Override
public boolean isEmpty()
{
 return size() == 0;
}

/**
* Safe increment that will always the previous index that is inside [0, list.size() - 1].
* @returns {@code (index - 1 + list.size()) % list.size()}.
*/
public static int previous(int index, List<?> list)
{
 return wrap(index - 1, list);
}

/** {@inheritDoc} */
@Override
public boolean containsAll(Collection<?> c)
{
 for (Object o : c)
 {
   if (!contains(o))
    return false;
 }
 return true;
}

/**
* Returns <tt>true</tt> if this list contains the specified element.
*
* @param object element whose presence in this list is to be tested
* @return <tt>true</tt> if this list contains the specified element
*/
@Override
public boolean contains(Object object)
{
 return indexOf(object) >= 0;
}

protected void unsafeSwap(int i, int j)
{
 if (i == j)
   return;
 unsafeFastSwap(i, j);
}

@SuppressWarnings("unchecked")
public RecyclingArrayList(int initialSize, GenericTypeBuilder<T> builder)
{
 elementData = (T[]) new Object[initialSize];
 size = initialSize;
 this.builder = builder;
 fillElementDataIfNeeded();
}

@Override
public P getTrajectoryPoint(int trajectoryPointIndex)
{
 return trajectoryPoints.get(trajectoryPointIndex);
}

public void clear(RobotSide robotSide)
{
 commandId = Packet.VALID_MESSAGE_DEFAULT_ID;
 jointTrajectoryInputs.clear();
 this.robotSide = robotSide;
 executionMode = null;
 previousCommandId = Packet.INVALID_MESSAGE_ID;
}

@Override
public int getNumberOfTrajectoryPoints()
{
 return trajectoryPoints.size();
}

@Override
public F getLastTrajectoryPoint()
{
 return trajectoryPoints.getLast();
}

/**
* Safe increment that will always the next index that is inside [0, list.size() - 1].
* @returns {@code (index + 1) % list.size()}.
*/
public static int next(int index, List<?> list)
{
 return wrap(index + 1, list);
}