public final void addSamplingPoint(Coordinate C0, double z) {
   if (closed) throw new IllegalStateException("Can't add a sample after closing.");
   int[] xy = sampleGrid.getLowerLeftIndex(C0);
   int x = xy[0];
   int y = xy[1];
   @SuppressWarnings("unchecked")
   ZSamplePoint<TZ>[] ABCD = new ZSamplePoint[4];
   ABCD[0] = sampleGrid.getOrCreate(x, y);
   ABCD[1] = sampleGrid.getOrCreate(x + 1, y);
   ABCD[2] = sampleGrid.getOrCreate(x, y + 1);
   ABCD[3] = sampleGrid.getOrCreate(x + 1, y + 1);
   for (ZSamplePoint<TZ> P : ABCD) {
     Coordinate C = sampleGrid.getCoordinates(P);
     P.setZ(metric.cumulateSample(C0, C, z, P.getZ()));
   }
 }
 private final ZSamplePoint<TZ> closeSample(int x, int y) {
   ZSamplePoint<TZ> A = sampleGrid.getOrCreate(x, y);
   A.setZ(
       metric.closeSample(
           A.up() != null ? A.up().getZ() : null,
           A.down() != null ? A.down().getZ() : null,
           A.right() != null ? A.right().getZ() : null,
           A.left() != null ? A.left().getZ() : null));
   return A;
 }