#include "pcivme_dll.h"      
#include <utility.h>
//#include <stdlib.h>
//#include <stdio.h>
//#include "vme.h"
#include "CAENV1290.h"
#include "CAENV1290_DEF.h"
//#include <unistd.h>    


#define usleep(x) Delay(x/1.0e6)
static unsigned long ModuleAddress[10];

int _VI_FUNC V1290_map (int ModuleNumber, unsigned long ModuleOffset, int print)
{
  int i;
  unsigned short geo, fw, ah, al;
  
  ModuleAddress[ModuleNumber] = ModuleOffset;
  
  if (print) {
    printf("V1290_map offset = 0x%08x\n", ModuleOffset);
    printf("V1290_map firmware = %d.%d\n", (fw>>8)&0xff, fw&0xff);
    printf("V1290_map geo      = %d\n", geo&0x1f );
    printf("V1290_map addr	 = 0x%04X0000\n", (ah<<8)|(al&0xff));
  }
  return 0;
}


/************************************************/
static void mloop(int n){ int i; for (i=0;i<n;i++);}
#define MLOOP mloop(1000);



int  _VI_FUNC V1290_writeOC(int ModuleNumber, unsigned long data){
	unsigned short dum16=0;
        int nc=0;
	do { 
          usleep(1000);

 	     VME_A24D16_R(ModuleAddress[ModuleNumber] + CAENV1290_MHSK, &dum16);
 	     if (nc++==1000) {
 	         printf("CAENV1290_MHSK not ready for writing\n");
 	         break;
 	     }
	} while (!(dum16 & 0x1)); // Micro Handshake Register	            
	dum16=data;
	printf("Writing to Micro register 0x%04x\n",dum16);     
	VME_A24D16_W(ModuleAddress[ModuleNumber] + CAENV1290_MCR, &dum16); // Micro Register   
	return 0;
}

unsigned short  _VI_FUNC V1290_readOC(int ModuleNumber){
    unsigned short dum16;
    int nc=0;
	do { 
          usleep(1000);
          if (nc++==1000) {
 	         printf("CAENV1290_MHSK not ready for read\n");
 	         break;
 	      }
        
	      VME_A24D16_R(ModuleAddress[ModuleNumber] + CAENV1290_MHSK, &dum16);
	} while (!(dum16 & 0x2)); // Micro Handshake Register	
	        
	VME_A24D16_R(ModuleAddress[ModuleNumber] + CAENV1290_MCR, &dum16);                    
	return dum16;    // Micro Register
}



int _VI_FUNC V1290_init (int ModuleNumber)
{
  unsigned short dum16;
  int dum,i;
  VME_A24D16_W(ModuleAddress[ModuleNumber] + CAENV1290_RST, &dum16);
  
  V1290_writeOC(ModuleNumber,TRG_MATCH	);//Trigger matching
  V1290_writeOC(ModuleNumber,EN_ALL_CH);//enable all channels
  V1290_writeOC(ModuleNumber,DIS_HEAD_TRAILER); //enable(0x30xx)/disable(0x31xx) TDC Header and Trailer
  V1290_writeOC(ModuleNumber,EN_SUB_TRG); //enable(0x14xx)/disable(0x15xx) substraction of trigger time
  
  V1290_writeOC(ModuleNumber,SET_WIN_WIDTH);//set window width
  dum=(int)(10000/25.0); V1290_writeOC(ModuleNumber,dum);//def=20*25ns=500ns	//podaljsal cas zajemanja
  //dum=(int)(1000/25.0); V1290_writeOC(ModuleNumber,dum);//def=20*25ns=500ns     
  
  V1290_writeOC(ModuleNumber,SET_WIN_OFFS);//set window offset
  dum=(int)(-600/25.0); V1290_writeOC(ModuleNumber,dum);//def=-1000ns=FD8; FE4=-700ns; FEC=-500ns; FF6=-250ns; 
  
  V1290_writeOC(ModuleNumber,SET_SW_MARGIN);//set extra search margin
  dum16=(int)(200/25.0); V1290_writeOC(ModuleNumber, dum16);//def=8*25ns=200ns
  
  //pair(00)/trailing(01)/leading(10)/both(11) edge
  //V1290_writeOC(ModuleNumber,SET_DETECTION); 
  //dum=0x3; V1290_writeOC(ModuleNumber,dum);
  
  
  // read configuration
  
  V1290_writeOC(ModuleNumber,READ_TRG_CONF	);
  for (i=0;i<5;i++) {
   dum16=V1290_readOC(ModuleNumber);
   printf("READ_TRG_CONF	 %d  0x%04x\n",i,dum16);
  }
  
  V1290_writeOC(ModuleNumber,READ_ACQ_MOD	);
  for (i=0;i<1;i++) {
   dum16=V1290_readOC(ModuleNumber);
   printf("READ_ACQ_MODE	 %d  0x%04x\n",i,dum16);
  }
  
  V1290_writeOC(ModuleNumber,READ_DETECTION	);
  for (i=0;i<1;i++) {
   dum16=V1290_readOC(ModuleNumber);
   printf("READ_DETECTION	 %d  0x%04x\n",i,dum16);
  }
  
  V1290_writeOC(ModuleNumber,READ_HEAD_TRAILER	);
  for (i=0;i<1;i++) {
   dum16=V1290_readOC(ModuleNumber);
   printf("READ_HEAD_TRAILER	%d  0x%04x\n",i,dum16);
  }
  
  V1290_writeOC(ModuleNumber,READ_EVENT_SIZE	);
  for (i=0;i<1;i++) {
   dum16=V1290_readOC(ModuleNumber);
   printf("READ_EVENT_SIZE	%d  0x%04x\n",i,dum16);
  }
  
  printf ( "CAENV1290 Module %d initialized!\n", ModuleNumber ) ;
  return 0;
}

int _VI_FUNC V1290_clear (int ModuleNumber)
{

  unsigned short dum16;
  
  dum16= 0x0;
  VME_A24D16_W(ModuleAddress[ModuleNumber] + CAENV1290_CLR, &dum16);
 
  
  return 0;
  
}

int _VI_FUNC V1290_status (int ModuleNumber)
{
  unsigned short dum16;
   
  VME_A24D16_R(ModuleAddress[ModuleNumber] + CAENV1290_SREG, &dum16);
  
  return (int)dum16;
}


int _VI_FUNC V1290_read (int ModuleNumber, unsigned long whereto[],int len)
{
  int ndata=0;

  do {
    if (ndata>=len) {
      printf("ERROR V1290_read: Increase storage size: ndata=%d >= len=%d \n",ndata, len);
      break;
    }
    VME_A24D32_R(ModuleAddress[ModuleNumber] + CAENV1290_OB, &whereto[ndata++]);
  } while ( (whereto[ndata-1]& 0xF8000000) != 0x80000000 );

  return ndata;  
}