#include <stdio.h>
#include <string.h>
#include "time.h"
#include "libxxusb.h"

//
// sudo ./vm-usb-debug 0 0x9 0x11110000 0
// sudo  ./vm-usb-debug 7 0x39 0x100500 0x0

// Global  variables
struct usb_device *dev;


#define V288_BUF    0x0
#define V288_STATUS 0x2
#define V288_TX     0x4
#define V288_RST    0x8

class Caenet {
private:
  usb_dev_handle *m_udev;
short m_am;
unsigned long m_addr;
public:
Caenet(usb_dev_handle *dev,short Address_Modifier, unsigned long Base){m_udev=dev;m_am= Address_Modifier;m_addr=Base;};

int  SingleRead(unsigned int addr,  long *data,int print){

  long dum;
  int ret;
  ret = VME_read_16 (m_udev,m_am, m_addr+addr,data);
  ret = VME_read_16 (m_udev,m_am, m_addr+V288_STATUS, &dum);
  if (print) printf("SingleRead Addr=0x%x Data=0x%x Status=0x%x\n",addr,*data,dum);
  return dum;
};

int  SingleWrite(unsigned int  addr,  long data, int print){
  int ret;
  long dum;
  ret = VME_write_16 (m_udev,m_am, m_addr+addr, data);
  ret = VME_read_16 (m_udev,m_am, m_addr+V288_STATUS, &dum);
  if (print) printf("SingleWrite Addr=0x%x Data=0x%x Status=0x%x\n",addr,data,dum);
  return dum;
};

int WaitForReady(){
  const int TIMEOUT=100;
  int ret;
  long dum;
  int ncount=0;
  do {
    ret=SingleRead(V288_BUF, &dum,0 );
    //printf("WAIT 0x%x\n",ret);    
    ncount++;
  } while ((ret & 0x1)&ncount<TIMEOUT);
  if (ncount==TIMEOUT) printf("Wait TIMEOUT\n"); else printf("ncount=%d\n",ncount); 
  return dum;
};

int Read(int max,long *data,int print){
  int ret;
  long dum;
  int ncount=0;
  do {
    ret=SingleRead(V288_BUF, &dum,0 );
    if (print) printf("0x%x 0x%x %d %c  \n",ret,dum,dum,dum);
    if (ncount<max) data[ncount]=dum;
    ncount++;
  } while (!(ret & 0x1) );
  return ncount -1;
}

  int Reset(){    
    SingleWrite(V288_RST,0,1);
    usleep(5000);
    return 0;
  };

  int Write(int id, int cmd,int print){
    SingleWrite(V288_BUF, 1, print);
    SingleWrite(V288_BUF, id, print);
    SingleWrite(V288_BUF, cmd, print);
    return 0;
  }

  int WriteTX(int id, int cmd,int print){
    int ret;
    long dum=0;
    ret=Write(id, cmd,print);
    ret=SingleWrite(V288_TX, dum,print );
    return ret;
  }

  int WriteTX(int id, int cmd, int value,int print){
    int ret;
    long dum=0;

    SingleWrite(V288_BUF, 1  , print);
    SingleWrite(V288_BUF, id , print);
    SingleWrite(V288_BUF, cmd, print);
    SingleWrite(V288_BUF, value, print);

    ret=SingleWrite(V288_TX, dum,0 );
    return ret;
  }

  int WriteRead(int id,int cmd,int ndata,long *data,int print){
    WriteTX(id,cmd,print);
    WaitForReady();
    return Read(ndata,data,print);
  };
};


int main(int argc, char **argv){


  char *mstr[8]={"R32","W32","R16","W16","xxusb_register_read","xxusb_register_write","RW32","CAENET_COMM"};
  if (argc<5){
    printf("\n\nUsage: %s Command AddressModifier Address Data\n\n",argv[0]);
    exit(1);
}
  int cmd=atoi(argv[1]);
  short Address_Modifier=strtol(argv[2],NULL,0); 
  long data_r=0;
  long data[1000];
 
    unsigned long adr=0;  
    if (argc>3)  adr=strtol(argv[3],NULL,0);; 

  //------------------------------
  int ret;
  usb_dev_handle *udev;   
  xxusb_device_type devices[100]; 
  
  
  ret=xxusb_devices_find(devices);
  printf("\nDevices Read %d\n",ret);
  int devnum=0;
  dev = devices[devnum].usbdev;
  udev = xxusb_device_open(dev); 
  printf("\n\n%s\n\n", devices[0].SerialString);
  
  if(!udev)  {
    printf("\n\n No VM_USB present\n\nTEST FAILED");
    return 0; 
  } else {
    printf("VM_USB loaded\n");

  } 
  


  
  switch  (cmd){
  case 0:
       
    ret = VME_read_32(udev,Address_Modifier, adr, &data_r);
    break;
  case 1:
    if (argc>4) data_r=strtol(argv[4],NULL,0);;
    ret = VME_write_32(udev,Address_Modifier, adr, data_r); 
    break;
  case 2:
       
    ret = VME_read_16(udev,Address_Modifier, adr, &data_r);
    break;
  case 3: 
     if (argc>4) data_r=strtol(argv[4],NULL,0);;
    ret = VME_write_16(udev,Address_Modifier, adr, data_r); 
    break;
  case 4:
    xxusb_register_read(udev,Address_Modifier , &data_r);
    break;
  case 5:
     if (argc>4) data_r=strtol(argv[4],NULL,0);
    xxusb_register_write(udev,Address_Modifier  , data_r);
    break;
  case 6:
    if (argc>4) data_r=strtol(argv[4],NULL,0);
    for (int i=0;i<10000;i++){

      ret = VME_write_32(udev,Address_Modifier, adr, data_r); 
      ret = VME_read_32 (udev,Address_Modifier, adr, &data_r);
    }
    break;
  case 7:
    int print=1;
    Caenet *caenet = new Caenet(udev,Address_Modifier, adr);

    int cmd;
    caenet->Reset();
    if (argc>4) cmd=strtol(argv[4],NULL,0);
    int ndat;

    caenet->WriteRead(2,cmd,1000,data, print);
    caenet->WriteRead(3,cmd,1000,data,print);


    break;


  }  
  printf(" %s IERR=%d ADDR_MOD=0x%x ADDR=0x%x DATA=0x%x\n",mstr[cmd],ret,Address_Modifier, adr, data_r);

  xxusb_device_close(udev);
}