private Fiducial findFiducial(Color bottom, Color top) { for (Fiducial fid : fiducialPairs) { if (fid.getBottomColor() == bottom && fid.getTopColor() == top) { return fid; } } return null; }