#include "fadcLib.h"        /* library of FADC250 routines */


unsigned int  MAXFADCWORDS  =  0;

/* FADC Library Variables */


extern   int nfadc;                 /* Number of FADC250s verified with the library */
extern   int fadcID[FA_MAX_BOARDS]; /* Array of slot numbers, discovered by the library */
extern   unsigned int fadcAddrList[FA_MAX_BOARDS];   /* Array of a24 addresses for FADCs */

unsigned int fadcSlotMask   = 0;    /* bit=slot (starting from 0) */


int fa250_download(){

  int slot, ii;

  int Naddr = 0;

  for(slot = 3; slot < 21; slot++){
    if(fa250[slot].group == 1){
      fadcAddrList[Naddr] = (slot<<19);
      Naddr++;
    }
  }

  printf("\n");
  printf(" NUMBER OF FADC250  boards found in config file =  %d \n",Naddr);
  printf("\n");


  NFADC = 0;

  /* Initially set block level, will be reseted when blockLevel is updated */
  MAXFADCWORDS = 16 * blockLevel * (1 + 2 + 100*16 + 1) + 2*32;


  /* Setup the iFlag.. flags for FADC initialization */
  int iFlag;
  iFlag = 0;
  /* Sync Source */
  iFlag |= (1<<0);    /* VXS */
  /* Trigger Source */
  iFlag |= (1<<2);    /* VXS */
  /* Clock Source */
  iFlag |= (0<<5);    /* self*/

  iFlag |= (1<<17);     /* activate useing fadcAddrList in faInit */


  vmeSetQuietFlag(1);   /* skip the errors associated with BUS Errors */
  
  faInit(fadcAddrList[0],0,Naddr,iFlag);
  
  vmeSetQuietFlag(0);   /* Turn the error statements back on */

  NFADC = nfadc;        /* Redefine our NFADC with what was found from the driver */

  printf("\n");
  printf(BOLDBLUE " Number of boards found by faInit =  %d \n" RESET, NFADC);
  printf("\n");


  for(slot = 0; slot < NFADC; slot++){

    FA_SLOT = fadcID[slot];
    
    fadcSlotMask |= (1<<FA_SLOT); /* Add it to the mask */
    
    faEnableMultiBlock(1);

  }

  for(slot = 0; slot < NFADC; slot++){

    FA_SLOT = fadcID[slot];
    
    printf("\nfadc250Download:  FA_SLOT=%d  group=%d  mode=%d  nsb=%d \n",
	   fa250[FA_SLOT].group, fa250[FA_SLOT].mode, fa250[FA_SLOT].nsb);

    faSetProcMode(FA_SLOT,
		  fa250[FA_SLOT].mode,
		  fa250[FA_SLOT].winOffset,
		  fa250[FA_SLOT].winWidth,
		  fa250[FA_SLOT].nsb,
		  fa250[FA_SLOT].nsa,
		  fa250[FA_SLOT].npeak, 0);
    
    //    faChanDisable(  FA_SLOT, fa250[FA_SLOT].chDisMask);

    for(ii = 0; ii < MAX_FADC250_CH; ii++) {
      faSetDAC(             FA_SLOT, fa250[FA_SLOT].dac[ii], (1<<ii));
      faSetThreshold(       FA_SLOT, fa250[FA_SLOT].read_thr[ii],(1<<ii));
      /* Trigger Settings */
      faSetChannelPedestal( FA_SLOT, ii, fa250[FA_SLOT].trig_bl[ii]);

    }

    faSetTriggerPathThreshold(FA_SLOT,  fa250[FA_SLOT].trig_thr);
    faSetTriggerPathSamples(FA_SLOT, fa250[FA_SLOT].trig_nsb, fa250[FA_SLOT].trig_nsa);

    faPrintThreshold(FA_SLOT);
    faPrintDAC(FA_SLOT);


    /* Bus errors to terminate block transfers (preferred) */
    faEnableBusError(FA_SLOT);
    /* Set the Block level to the initial value*/
    faSetBlockLevel(FA_SLOT,1);
      
      
    faStatus(FA_SLOT, 0);

  }


  /***************************************
   *   SD SETUP
   ***************************************/
  sdInit();   /* Initialize the SD library */
  
  printf(BOLDBLUE "fadcSlotMask =  0x%x  \n" RESET ,fadcSlotMask); 
  
  sdSetActiveVmeSlots(fadcSlotMask);    /* Use the fadcSlotMask to configure the SD */
  sdStatus();

  return(0);

}

int fa250_prestart(){

  int islot;
 /* Unlock the VME Mutex */
  vmeBusUnlock();
  

  /* FADC Perform some resets, status */
  for(islot = 0; islot < NFADC; islot++){

      FA_SLOT = fadcID[islot];
      
      printf(BOLDRED " SASCHA Set Clock to P0 \n" RESET);

      faSetClkSource(FA_SLOT,2);
      //      faClear(FA_SLOT);
      
      faResetToken(FA_SLOT);
      faResetTriggerCount(FA_SLOT);
      
      faEnable(FA_SLOT,0,0);
      faStatus(FA_SLOT,0);
      

      //      faSetMGTTestMode(FA_SLOT,0);

      // Enable Playback mode for fADC250 in slot FA_SLOT
      //      faPPGEnable(FA_SLOT);
    }

}

int fa250_end(){

  int islot;
  
  /* FADC Disable */
  for(islot = 0; islot < NFADC; islot++) {
    FA_SLOT = fadcID[islot];

    faDisable(FA_SLOT,0);
    faStatus(FA_SLOT,0);      
    faPPGDisable(FA_SLOT);
  }
  
  return(0);
}


int fa250_cleanup(){
  int islot;

  for(islot = 0; islot < NFADC; islot++){
      FA_SLOT = fadcID[islot];
      faReset(FA_SLOT,1); /* Reset, and DO NOT restore A32 settings (1) */
    } 
  
  return(0);
}