#include <stdio.h>
#include <stdlib.h>
#include <math.h>
#include <string.h>
#include "mucal.h"
#include "panel.h"

/* ********************************************** */

int facet_connect3 (
   facet FACET[],
   int    LEN[],
   int    Order[numLayers][N_CryPos],
   float  facetR,
   int    Lens_layers)
{
   int iA, iB, iC, iiA, iiB, iiC, nlA, nlB, nlC, nabnum, allnabs = 0;
   static int nn=0;
   float dx, dy; 

   nlA = 0; 
   nlB = 1;

   if (Lens_layers < 2) return(allnabs);

   for (iiA=0; iiA<LEN[nlA]; iiA++) {
      iA = Order[nlA][iiA] + N_CryPos * nlA;
      if (FACET[iA].nOption < 0) continue;
      FACET[iA].nabo[0][0] = FACET[iA].nabo[0][1] = FACET[iA].nabo[0][2] = -1;
      FACET[iA].nabo[1][0] = FACET[iA].nabo[1][1] = FACET[iA].nabo[1][2] = -1;

      nabnum = 0;
      for (iiB=0; iiB<LEN[nlB]; iiB++) {
         iB = Order[nlB][iiB] + N_CryPos * nlB;	/* NOTE that 'iB' = facet_number + N_CryPos * layer_number */ 
         if (FACET[iB].nOption < 0) continue;
         dx = FACET[iA].x - FACET[iB].x;
         dy = FACET[iA].y - FACET[iB].y;
         if (sqrt(dx*dx + dy*dy) < facetR) {
            if (nabnum > 2) {
               printf("Found more than 3 neighbors for iA: %4d, iBs: %4d %4d %4d %4d\n",
                  iA, FACET[iA].nabo[0][0], FACET[iA].nabo[0][1], FACET[iA].nabo[0][2], iB);
               exit(0);
            }
            FACET[iA].nabo[0][nabnum++] = iB;	/* Update neighbor indicator for layer iA */
            allnabs++;

            if (FACET[iB].nabo[0][0] < 0) {
               FACET[iB].nabo[0][0] = iA;	/* Update neighbor indicator for layer iB */
            } else {
               if (FACET[iB].nabo[0][1] < 0) {
                  FACET[iB].nabo[0][1] = iA;	/* Update neighbor indicator for layer iB */
               } else {
                  if (FACET[iB].nabo[0][2] < 0) {
                     FACET[iB].nabo[0][2] = iA;	/* Update neighbor indicator for layer iB */
                  } else {
                     printf("Found more than 3 neighbors for iB: %4d, iAs: %4d %4d %4d %4d\n",
                        iB, FACET[iB].nabo[0][0], FACET[iB].nabo[0][1], FACET[iB].nabo[0][2], iA);
                     exit(0);
                  }
               }
            }

         }
      }
   }
   return(allnabs);
}