Subversion Repositories f9daq

#include <ctype.h>

#include <stdio.h>

#include <stdlib.h>

#include <unistd.h>

#include "pcivme_ni.h"

#include "wienvme_dll.h"

//----------- DEFINES -----------------------------------------------------

#define DEVICENAME_LINUX "/dev/vmemm_1"     // a device name 'template' for WINNT

int hHandle24, hHandle32, hHandle16;

int VMEerrors=0;

void VME_load (char* module_path)

{

  VMEerrors=0;

}

int VME_open (int* hHandle, unsigned char AddMod, char* device_name,

                 unsigned short module_number)

{

  int   result;

  char dname[256];

/* open a path to a device. */

  if (device_name == NULL) sprintf(dname,"%s", DEVICENAME_LINUX);

  else sprintf(dname,"%s", device_name);

  result = VMEinit(dname, module_number, AddMod, hHandle);

  if (result) {

    printf("Can't open interface \"%s\" to VMEMM-module ! err=%d\n", dname, result);

    printf("module_number %d, AddMod %d, hHandle %d\n",module_number, AddMod, *hHandle);

    exit(-1);

  }

  return(result);

}

int VME_open24 (void)

{

  return (VME_open (&hHandle24, Std_NoPriv_Data, NULL, 1));

}

int VME_open32 (void)

{

  return (VME_open (&hHandle32, Ext_NoPriv_Data, NULL, 1));

}

int VME_open16 (void)

{

  return (VME_open (&hHandle16, Short_NoPriv, NULL, 1));

}

int VME_start (char* module_path)

{

  VME_load(module_path);

  VME_open24();

  VME_open32();

  VME_open16();

  return 0;

}

void VME_unload ()

{

  return;

}

int VME_close (int hHandle)

{

  int result;

/* close the opened path */

  //printf("VME_Close at addr=%d\n",hHandle);

  result = VMEclose(hHandle);

  if (result) {

    printf("Can't close interface!\n");

  }

  return (result);

}

int VME_close24 ()

{

  return (VME_close (hHandle24));

}

int VME_close32 ()

{

  return (VME_close (hHandle32));

}

int VME_close16 ()

{

  return (VME_close (hHandle16));

}

int VME_stop ()

{

  VME_close24();

  VME_close32();

  VME_close16();

  VME_unload();

  return 0;

}

int VME_reset ()

{

  int result;

/* close the opened path */

  result = VMEreset(hHandle16);

  if (result) {

    printf("Can't reset interface A16!\n");

  }

  result = VMEreset(hHandle24);

  if (result) {

    printf("Can't reset interface A24!\n");

  }

  result = VMEreset(hHandle32);

  if (result) {

    printf("Can't reset interface A32!\n");

  }

  return (result);

}

int VME_read8 (int hHandle, unsigned long n, unsigned long at, void* buff)

{

  int result;

/* D8 read */

  result = VMEread(hHandle, at, 1, n, buff);

  if (result) {

    VMEerrors++;

    printf("D8 read at 0x%lX failed!\n", at);

  }

//  printf("0x%X, 0x%X, 0x%X, 0x%X\n", hHandle, at, n, * (unsigned short *) buff);

  return (result);

}

int VME_read16 (int hHandle, unsigned long n, unsigned long at, void* buff)

{

  int result;

/* D16 read */

  result = VMEread(hHandle, at, 2, n, buff);

  if (result) {

    VMEerrors++;

    printf("D16 read at 0x%lX failed!\n", at);

  }

//  printf("0x%X, 0x%X, 0x%X, 0x%X\n", hHandle, at, n, * (unsigned short *) buff);

  return (result);

}

int VME_read32 (int hHandle, unsigned long n, unsigned long at, void* buff)

{

  int result;

/* D32 read */

  result = VMEread(hHandle, at, 4, n, buff);

  if (result) {

    VMEerrors++;

    printf("D32 read at 0x%lX failed!\n", at);

  }

  //printf("0x%X, 0x%X, 0x%X, 0x%X\n", hHandle, at, n, * (unsigned short *) buff);

  return (result);

}

int VME_write8 (int hHandle, unsigned long n, unsigned long at, void* buff)

{

  int result;

/* D8 write */

  result = VMEwrite(hHandle, at, 1, n, buff);

  if (result) {

    VMEerrors++;

    printf("D8 write at 0x%lX failed!\n", at);

  }

  return (result);

}

int VME_write16 (int hHandle, unsigned long n, unsigned long at, void* buff)

{

  int result;

/* D16 write */

  result = VMEwrite(hHandle, at, 2, n, buff);

  if (result) {

    VMEerrors++;

    printf("D16 write at 0x%lX failed!\n", at);

  }

  return (result);

}

int VME_write32 (int hHandle, unsigned long n, unsigned long at, void* buff)

{

  int result;

/* D32 write */

  result = VMEwrite(hHandle, at, 4, n, buff);

  if (result) {

    VMEerrors++;

    printf("D32 write at 0x%lX failed!\n", at);

  }

  //printf("D32 write at 0x%X buff=0x%X\n", at,((int*) buff)[0]);

  return (result);

}

#ifdef MAIN

int GetHandle(int w){

switch (w){

case 16: return hHandle16;

case 24: return hHandle24;

case 32: return hHandle24;

}

return 24;

}

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

 unsigned long address=0x32100000, value;

 unsigned char modifier=24;

 int hHandle, result=0;

 int width=4;

 int c;

       opterr = 0;

       VME_start(NULL);

       while ((c = getopt (argc, argv, "a:w:rm:osd:")) != -1)

         switch (c)

           {

          case 's':

            VME_reset();

            break;             // reset

          case 'a':

            address  =  strtoul (optarg,NULL,0);

            break;             // address

          case 'm':

            modifier = strtoul (optarg,NULL,0);

            break;             // modifier

          case 'd':

            width    = strtoul (optarg,NULL,0);

            printf("Width= %d\n",width);

            break;             // data width

          case 'w':

             value = strtoul (optarg,NULL,0);

             hHandle = GetHandle(modifier);

             result = VMEwrite(hHandle, address, width, 1, &value);

             if (result) printf("A%d D%d write at 0x%lX failed! result=%d err=%d\n", modifier, width*8, address, result, GetLastError(hHandle));

             break;            // write

          case 'r':

           hHandle = GetHandle(modifier);

           result = VMEread(hHandle, address, width, 1, &value);

           if (result) printf("A%d D%d read at 0x%lX failed! result=%d err=%d\n", modifier,width*8, address, result, GetLastError(hHandle));

           break;              // read

           default:

             printf("Unknown command %c\n",c);

           }

      VME_stop();

}

#endif