Initial revision
This commit is contained in:
Janet B. Anderson
318
src/drv/drvComet.c
Normal file
318
src/drv/drvComet.c
Normal file
@@ -0,0 +1,318 @@
|
||||
/* comet_driver.c */
|
||||
/* share/src/drv $Id$ */
|
||||
/*
|
||||
* Author: Leo R. Dalesio
|
||||
* Date: 5-92
|
||||
*
|
||||
* Experimental Physics and Industrial Control System (EPICS)
|
||||
*
|
||||
* Copyright 1991, the Regents of the University of California,
|
||||
* and the University of Chicago Board of Governors.
|
||||
*
|
||||
* This software was produced under U.S. Government contracts:
|
||||
* (W-7405-ENG-36) at the Los Alamos National Laboratory,
|
||||
* and (W-31-109-ENG-38) at Argonne National Laboratory.
|
||||
*
|
||||
* Initial development by:
|
||||
* The Controls and Automation Group (AT-8)
|
||||
* Ground Test Accelerator
|
||||
* Accelerator Technology Division
|
||||
* Los Alamos National Laboratory
|
||||
*
|
||||
* Co-developed with
|
||||
* The Controls and Computing Group
|
||||
* Accelerator Systems Division
|
||||
* Advanced Photon Source
|
||||
* Argonne National Laboratory
|
||||
*
|
||||
* Modification Log:
|
||||
* -----------------
|
||||
*/
|
||||
|
||||
/*
|
||||
* Code Portions
|
||||
*
|
||||
* comet_init()
|
||||
* comet_driver(card, pcbroutine, parg)
|
||||
* cometDoneTask()
|
||||
* comet_io_report()
|
||||
*
|
||||
*/
|
||||
#include <vxWorks.h>
|
||||
# ifdef V5_vxWorks
|
||||
# include <68k/iv.h>
|
||||
# else
|
||||
# include <iv68k.h>
|
||||
# endif
|
||||
#include <types.h>
|
||||
#include <module_types.h>
|
||||
#include <task_params.h>
|
||||
#include <fast_lock.h>
|
||||
#include <vme.h>
|
||||
|
||||
|
||||
static char *stdaddr;
|
||||
static char *shortaddr;
|
||||
|
||||
|
||||
|
||||
/* comet conrtol register map */
|
||||
struct comet_cr{
|
||||
unsigned char csrh; /* control and status register - high byte */
|
||||
unsigned char csrl; /* control and status register - low byte */
|
||||
unsigned char lcrh; /* location status register - high byte */
|
||||
unsigned char lcrl; /* location status register - low byte */
|
||||
unsigned char gdcrh; /* gate duration status register - high byte*/
|
||||
unsigned char gdcrl; /* gate duration status register - low byte */
|
||||
unsigned char cdr; /* channel delay register */
|
||||
unsigned char acr; /* auxiliary control register */
|
||||
char pad[0x100-8];
|
||||
};
|
||||
|
||||
|
||||
/* defines for the control status register - high byte */
|
||||
#define DIGITIZER_ACTIVE 0x80 /* 1- Active */
|
||||
#define ARM_DIGITIZER 0x40 /* 1- Arm the digitizer */
|
||||
#define CIRC_BUFFER_ENABLED 0x20 /* 0- Stop when memory is full */
|
||||
#define WRAP_MODE_ENABLED 0x10 /* 0- Disable wrap around */
|
||||
#define AUTO_RESET_LOC_CNT 0x08 /* 1- Reset addr to 0 on trigger */
|
||||
#define EXTERNAL_TRIG_ENABLED 0x04 /* 1- use external clk to trigger */
|
||||
#define EXTERNAL_GATE_ENABLED 0x02 /* 0- use pulse start conversion */
|
||||
#define EXTERNAL_CLK_ENABLED 0x01 /* 0- uses the internal clock */
|
||||
|
||||
|
||||
/* commands for the COMET digitizer */
|
||||
#define COMET_INIT_CSRH
|
||||
#define COMET_INIT_READ
|
||||
|
||||
|
||||
/* defines for the control status register - low byte */
|
||||
#define SOFTWARE_TRIGGER 0x80 /* 1- generates a software trigger */
|
||||
#define UNUSED 0x60
|
||||
#define CHAN_DELAY_ENABLE 0x10 /* 0- digitize on trigger */
|
||||
#define DIG_RATE_SELECT 0x0f
|
||||
|
||||
/* digitizer rates - not defined but available for 250KHz to 122Hz */
|
||||
#define COMET_5MHZ 0x0000
|
||||
#define COMET_2MHZ 0x0001
|
||||
#define COMET_1MHZ 0x0002
|
||||
#define COMET_500KHZ 0x0003
|
||||
|
||||
/* defines for the auxiliary control register */
|
||||
#define ONE_SHOT 0x08
|
||||
|
||||
|
||||
|
||||
/* values that will end up in module_types.h */
|
||||
#define COMET_SHORT_BASE_ADDR 0x0a000
|
||||
#define COMET_STD_BASE_ADDR 0xf1000000
|
||||
#define FLAG_EOC 0x10
|
||||
|
||||
/* comet configuration data */
|
||||
struct comet_config{
|
||||
struct comet_cr *pcomet_csr; /* pointer to the control/status register */
|
||||
unsigned short *pdata; /* pointer to data area for this COMET card */
|
||||
void (*psub)(); /* subroutine to call on end of conversion */
|
||||
void *parg; /* argument to return to the arming routine */
|
||||
FAST_LOCK lock; /* mutual exclusion lock */
|
||||
};
|
||||
|
||||
/* task ID for the comet done task */
|
||||
int cometDoneTaskId;
|
||||
struct comet_config *pcomet_config;
|
||||
|
||||
/*
|
||||
* cometDoneTask
|
||||
*
|
||||
* wait for comet waveform record cycle complete
|
||||
* and call back to the database with the waveform size and address
|
||||
*
|
||||
*/
|
||||
void
|
||||
cometDoneTask()
|
||||
{
|
||||
register unsigned card;
|
||||
register struct comet_config *pconfig;
|
||||
register long i;
|
||||
|
||||
while(TRUE){
|
||||
|
||||
taskDelay(2);
|
||||
|
||||
/* check each card for end of conversion */
|
||||
for(card=0, pconfig = pcomet_config; card < 2;card++, pconfig++){
|
||||
|
||||
|
||||
/* is the card present */
|
||||
if (!pconfig->pcomet_csr) continue;
|
||||
|
||||
/* is the card armed */
|
||||
if (!pconfig->psub) continue;
|
||||
|
||||
/* is the digitizer finished conversion */
|
||||
if (*(pconfig->pdata+FLAG_EOC) == 0xffff) continue;
|
||||
|
||||
/* reset each of the control registers */
|
||||
pconfig->pcomet_csr->csrh = pconfig->pcomet_csr->csrl = 0;
|
||||
pconfig->pcomet_csr->lcrh = pconfig->pcomet_csr->lcrl = 0;
|
||||
pconfig->pcomet_csr->gdcrh = pconfig->pcomet_csr->gdcrl = 0;
|
||||
pconfig->pcomet_csr->acr = 0;
|
||||
|
||||
/* clear the pointer to the subroutine to allow rearming */
|
||||
pconfig->psub = NULL;
|
||||
|
||||
/* post the event */
|
||||
/* - is there a bus error for long references to this card?? copy into VME mem? */
|
||||
/* (*pconfig->psub)(pconfig->parg,0xffff,pconfig->pdata);
|
||||
*/
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
|
||||
/*
|
||||
* COMET_INIT
|
||||
*
|
||||
* intialize the driver for the COMET digitizer from omnibyte
|
||||
*
|
||||
*/
|
||||
comet_init()
|
||||
{
|
||||
register struct comet_config *pconfig;
|
||||
short readback,got_one,card;
|
||||
int status;
|
||||
struct comet_cr *pcomet_cr;
|
||||
unsigned short *stdaddr;
|
||||
|
||||
void cometDoneTask();
|
||||
|
||||
/* free memory and delete tasks from previous initialization */
|
||||
if (cometDoneTaskId){
|
||||
if ((status = taskDelete(cometDoneTaskId)) < 0)
|
||||
logMsg("\nCOMET: Failed to delete cometDoneTask: %d",status);
|
||||
}else{
|
||||
/* if (pcomet_config = (struct comet_config *)calloc(wf_num_cards[COMET]*sizeof(struct comet_config))
|
||||
!= (wf_num_cards[COMET]*sizeof(struct comet_config)){
|
||||
*/
|
||||
if ( (pcomet_config = (struct comet_config *)calloc(2*sizeof(struct comet_config))) == 0){
|
||||
logMsg("\nCOMET: Couldn't allocate memory for the configuration data");
|
||||
return;
|
||||
}
|
||||
}
|
||||
|
||||
/* get the standard and short address locations */
|
||||
if ((status = sysBusToLocalAdrs(VME_AM_SUP_SHORT_IO,COMET_SHORT_BASE_ADDR,&pcomet_cr)) != OK){
|
||||
logMsg("\nCOMET: failed in sysBusToLocalAdrs for short address space");
|
||||
return;
|
||||
}
|
||||
if ((status = sysBusToLocalAdrs(VME_AM_STD_SUP_DATA,COMET_STD_BASE_ADDR,&stdaddr)) != OK){
|
||||
logMsg("\nCOMET: failed in sysBusToLocalAdrs for standard address space");
|
||||
return;
|
||||
}
|
||||
|
||||
/* determine which cards are present */
|
||||
got_one = FALSE;
|
||||
pconfig = pcomet_config;
|
||||
for (card = 0; card < 2; card++, pconfig++, pcomet_cr++, stdaddr+= 0x20000){
|
||||
/* is the card present */
|
||||
if (vxMemProbe(pcomet_cr,READ,sizeof(readback),&readback) != OK) continue;
|
||||
if (vxMemProbe(stdaddr,READ,sizeof(readback),&readback) != OK){
|
||||
logMsg("\nCOMET: Found CSR but not data RAM %x",stdaddr);
|
||||
continue;
|
||||
}
|
||||
|
||||
/* initialize the configuration data */
|
||||
pconfig->pcomet_csr = pcomet_cr;
|
||||
pconfig->pdata = stdaddr;
|
||||
got_one = TRUE;
|
||||
|
||||
/* initialize the card */
|
||||
pcomet_cr->csrh = ARM_DIGITIZER | AUTO_RESET_LOC_CNT;
|
||||
pcomet_cr->csrl = COMET_5MHZ;
|
||||
pcomet_cr->lcrh = pcomet_cr->lcrl = 0;
|
||||
pcomet_cr->gdcrh = 0;
|
||||
pcomet_cr->gdcrl = 1;
|
||||
pcomet_cr->cdr = 0;
|
||||
}
|
||||
|
||||
|
||||
/* initialization for processing comet digitizers */
|
||||
if(got_one){
|
||||
|
||||
/* start the waveform readback task */
|
||||
cometDoneTaskId = taskSpawn("cometWFTask",WFDONE_PRI,WFDONE_OPT,WFDONE_STACK,cometDoneTask);
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
|
||||
/*
|
||||
* COMET_DRIVER
|
||||
*
|
||||
* initiate waveform read
|
||||
*
|
||||
*/
|
||||
comet_driver(card, pcbroutine, parg)
|
||||
register unsigned short card;
|
||||
register unsigned int *pcbroutine;
|
||||
register unsigned int *parg; /* number of values read */
|
||||
{
|
||||
register struct comet_cr *pcomet_csr;
|
||||
register unsigned short *pcomet_data;
|
||||
|
||||
/* check for valid card number */
|
||||
if(card >= 2) return ERROR;
|
||||
|
||||
/* check for card present */
|
||||
if(!pcomet_config[card].pcomet_csr) return ERROR;
|
||||
|
||||
/* check for card already armed */
|
||||
if(pcomet_config[card].psub) return ERROR;
|
||||
|
||||
/* mutual exclusion area */
|
||||
FASTLOCK(&pcomet_config[card].lock);
|
||||
|
||||
/* mark the card as armed */
|
||||
pcomet_config[card].parg = parg;
|
||||
pcomet_config[card].psub = (void (*)()) pcbroutine;
|
||||
|
||||
/* exit mutual exclusion area */
|
||||
FASTUNLOCK(&pcomet_config[card].lock);
|
||||
|
||||
/* reset each of the control registers */
|
||||
pcomet_csr->csrh = pcomet_csr->csrl = 0;
|
||||
pcomet_csr->lcrh = pcomet_csr->lcrl = 0;
|
||||
pcomet_csr->gdcrh = pcomet_csr->gdcrl = 0;
|
||||
pcomet_csr->acr = 0;
|
||||
|
||||
/* arm the card */
|
||||
pcomet_csr = pcomet_config[card].pcomet_csr;
|
||||
*(pcomet_config[card].pdata+FLAG_EOC) = 0xffff;
|
||||
pcomet_csr->gdcrh = 0xff; /* 64K samples per channel */
|
||||
pcomet_csr->gdcrl = 0xff; /* 64K samples per channel */
|
||||
pcomet_csr->acr = ONE_SHOT; /* disarm after the trigger */
|
||||
pcomet_csr->csrl = 0; /* sample at 5MhZ */
|
||||
/* arm, reset location counter to 0 on trigger, use external trigger */
|
||||
pcomet_csr->csrh = ARM_DIGITIZER | AUTO_RESET_LOC_CNT | EXTERNAL_TRIG_ENABLED;
|
||||
|
||||
return OK;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* COMET_IO_REPORT
|
||||
*
|
||||
* print status for all cards in the specified COMET address range
|
||||
*/
|
||||
comet_io_report(level,jg_num_read)
|
||||
short int level,*jg_num_read;
|
||||
{
|
||||
unsigned card;
|
||||
short readback;
|
||||
|
||||
for(card=0; card < 2; card++)
|
||||
return OK;
|
||||
}
|
||||
|
||||
|
||||
Reference in New Issue
Block a user