Pose2d "nearest" method

[Oblarg]

would be convenient for Pose2d to have a nearest(List<Pose2d> poses) method that finds the nearest of a set of reference poses to the calling pose.

[calcmogul]

In C++, this is just https://en.cppreference.com/w/cpp/algorithm/min_element with a custom comparator for translation distance.

[Starlight220]

Same goes for Java with Collections.min(Collection<T>, Comparator<T>).

[jonahsnider]

public Translation2d nearest(List<Translation2d> others) {
  return Collections.min(others, Comparator.comparing(this::getDistance));
}