Subversion Repositories f9daq

#include <stdlib.h>
#include <stdio.h>
#include <CAENVMElib.h>
#include <CAENVMElib.h>
#include <CAENVMEoslib.h>
#include <CAENVMEtypes.h>


int32_t udev;

int VMEerrors;

int VME_start (char* serial)
{

  CVErrorCodes result = CAENVME_Init( cvV1718 , 0 , 0 , &udev);
  if (result != cvSuccess) {
    printf("CAEN1718 Init %s\n", CAENVME_DecodeError(result));
    printf(" Check usb cable, usb udev permissions and restart!  Exiting .....\n");
    exit(-1);
  }
  if (serial == NULL) serial = malloc(100*sizeof(char));
  CAENVME_BoardFWRelease(udev, serial);
 
  return result;
}


int VME_read(long Handle, unsigned long Address, void *Data, CVAddressModifier AM, CVDataWidth DW)
{

 CVErrorCodes result;
 int ncount=0;
 while (1){
   result = CAENVME_ReadCycle(Handle, Address, Data, AM, DW );
   if (result !=cvSuccess ) {
     VMEerrors++;
     printf("%d CAENVME_ReadCycle at 0x%0lX failed! data=0x%0X  AM= 0x%0X DW= 0x%0X  err=%s\n", ncount,Address, *((uint32_t *) Data),AM,DW, CAENVME_DecodeError(result));
     ncount++;
     if (ncount==10) exit(result);
   } else break;
 }
 return result;
}

int VME_BltRead(long Handle, unsigned long Address, void *Data, int size, CVAddressModifier AM, CVDataWidth DW)
{
  int count=0;
  CVErrorCodes result;
  int ncount=0;
 
  while (1){
   
    result = CAENVME_BLTReadCycle(Handle, Address, Data, size, AM, DW , &count);
    if (result !=cvSuccess ) {
       VMEerrors++;
       printf("%d CAENVME_BLTReadCycle at 0x%0lX failed! data=0x%0X  AM= 0x%0X DW= 0x%0X  err=%s count=%d\n", ncount,Address, *((uint32_t *) Data),AM,DW, CAENVME_DecodeError(result),count);
       ncount++;
       if (ncount==10) exit(result);
    } else break;
  }  
  return count;
}

int VME_write(long Handle, unsigned long Address, void *Data, CVAddressModifier AM, CVDataWidth DW)
{

 CVErrorCodes result;
 int ncount=0;
 while (1){
 result = CAENVME_WriteCycle(Handle, Address, Data, AM, DW );
 if (result !=cvSuccess ) {
    VMEerrors++;
    printf("CAENVME_WriteCycle at 0x%0lX failed! data=0x%0X  AM= 0x%0X DW= 0x%0X  err=%s\n", Address, *((uint32_t *) Data),AM,DW, CAENVME_DecodeError(result));
    if (ncount==10)  exit(result);
 } else break;
 }
 return result;
}




uint32_t *WStackAddrs = NULL;
uint32_t *WStackBuffer;  
int WStackNCycles;
int WStackMaxCycles=100000;
CVAddressModifier *WStackAMs;
CVDataWidth *WStackDWs;
CVErrorCodes *WStackECs;


uint32_t *RStackAddrs =NULL;
int RStackNCycles;
int RStackMaxCycles=100000;
CVAddressModifier *RStackAMs;
CVDataWidth *RStackDWs;
CVErrorCodes *RStackECs;



int VME_appendread(unsigned long Address, void *Data, CVAddressModifier AM, CVDataWidth DW){
  if (RStackNCycles<RStackMaxCycles){
    RStackAddrs[RStackNCycles]  = Address;
    RStackAMs[RStackNCycles]    = AM;
    RStackDWs[RStackNCycles]    = DW;
    //int i=RStackNCycles;
    //printf("AppendRead %d ADDR= 0x%0X AM= 0x%0X DW= 0x%0X \n", i,RStackAddrs[i],RStackAMs[i], RStackDWs[i]);
    RStackNCycles++;
  } else {
    printf("Increase DataBuffer RStackMaxCycles =%d\n", RStackMaxCycles);
  }
  return RStackNCycles;
}

int VME_appendwrite(unsigned long Address, void *Data, CVAddressModifier AM, CVDataWidth DW){
  if (WStackNCycles<WStackMaxCycles){
    WStackAddrs[WStackNCycles]  = Address;
    WStackBuffer[WStackNCycles] = *((uint32_t *) Data);
    WStackAMs[WStackNCycles]    = AM;
    WStackDWs[WStackNCycles]    = DW;
    WStackNCycles++;
  } else {
    printf("Increase DataBuffer WStackMaxCycles =%d\n", WStackMaxCycles);
  }
  return 0;
}

int VME_MultiReadReset(){
  RStackNCycles=0;
  if (RStackAddrs!=NULL) return 0;
  RStackAddrs = (uint32_t *) malloc( RStackMaxCycles*sizeof(uint32_t));
 
  RStackAMs  = (CVAddressModifier *) malloc(RStackMaxCycles*sizeof(CVAddressModifier));
  RStackDWs = (CVDataWidth *) malloc(RStackMaxCycles*sizeof(CVDataWidth));
  RStackECs = (CVErrorCodes *) malloc(RStackMaxCycles*sizeof(CVErrorCodes));
 
  return 0;
}

int VME_MultiWriteReset(){
  WStackNCycles=0;
  if (WStackAddrs!=NULL) return 0;
  WStackBuffer = (uint32_t *) malloc( WStackMaxCycles*sizeof(uint32_t));  
  WStackAddrs = (uint32_t *) malloc( WStackMaxCycles*sizeof(uint32_t));  
  WStackAMs  = (CVAddressModifier *) malloc(WStackMaxCycles*sizeof(CVAddressModifier));
  WStackDWs = (CVDataWidth *) malloc(WStackMaxCycles*sizeof(CVDataWidth));
  WStackECs = (CVErrorCodes *) malloc(WStackMaxCycles*sizeof(CVErrorCodes));
 
  return 0;
}

int VME_MultiReadExecute(long Handle, uint32_t *  Data){
  //printf("len=%d\n",RStackNCycles);
  int i=0;
  CVErrorCodes result =CAENVME_MultiRead(Handle, RStackAddrs,  Data,  RStackNCycles, RStackAMs, RStackDWs, RStackECs);
 if (result !=cvSuccess ) {
   VMEerrors++;
   printf("CAENVME_MultiRead at 0x%0X failed!  err=%s RStackNCycles=%d\n", RStackAddrs[0], CAENVME_DecodeError(result), RStackNCycles);
   for (i=0;i<RStackNCycles;i++){
     if (RStackECs[i]!=cvSuccess ) printf("%d ADDR= 0x%0X AM= 0x%0X DW= 0x%0X  failed!  err=%s\n", i,RStackAddrs[i],RStackAMs[i], RStackDWs[i], CAENVME_DecodeError(RStackECs[i]) );
   }
   exit(result);
 }
 return  RStackNCycles;
}

int VME_MultiWriteExecute(long Handle){
 int i=0;
 CVErrorCodes result =CAENVME_MultiWrite(Handle, WStackAddrs, WStackBuffer,  WStackNCycles, WStackAMs, WStackDWs, WStackECs);
 if (result !=cvSuccess ) {
   printf("CAENVME_MultiWrite at 0x%0X failed!  err=%s WStackNCycles=%d\n", WStackAddrs[0], CAENVME_DecodeError(result), WStackNCycles);
               
   for (i=0;i<WStackNCycles;i++){
     if (WStackECs[i]!=cvSuccess )
     printf("%d ADDR= 0x%0X AM= 0x%0X DW= 0x%0X  data= 0x%0X  failed!  err=%s\n", i,WStackAddrs[i],WStackAMs[i], WStackDWs[i],  WStackBuffer[i], CAENVME_DecodeError(WStackECs[i]) );
   }
   exit(result);
}
 return  WStackNCycles;
}