167 lines
4.2 KiB
C
167 lines
4.2 KiB
C
/* devWfJoergerVtr1.c */
|
||
/* share/src/dev $Id$ */
|
||
|
||
/* devWfJoergerVtr1.c - Device Support Routines */
|
||
/*
|
||
* Original Author: Bob Dalesio
|
||
* Current Author: Marty Kraimer
|
||
* Date: 6-1-90
|
||
*
|
||
* 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:
|
||
* -----------------
|
||
* .01 11-11-91 jba Moved set of alarm stat and sevr to macros
|
||
* .02 12-02-91 jba Added cmd control to io-interrupt processing
|
||
* .03 12-12-91 jba Set cmd to zero in io-interrupt processing
|
||
* .04 02-05-92 jba Changed function arguments from paddr to precord
|
||
* .05 02-28-92 jba Changed callback handling, ANSI C changes
|
||
* .06 03-13-92 jba ANSI C changes
|
||
* .07 04-10-92 jba pact now used to test for asyn processing, not return value
|
||
* .08 04-18-92 jba removed process from init_record parms
|
||
* .09 09-01-93 joh expects EPICS standard status
|
||
* ...
|
||
*/
|
||
|
||
|
||
#include <vxWorks.h>
|
||
#include <types.h>
|
||
#include <stdioLib.h>
|
||
#include <string.h>
|
||
|
||
#include <alarm.h>
|
||
#include <dbDefs.h>
|
||
#include <dbAccess.h>
|
||
#include <recSup.h>
|
||
#include <devSup.h>
|
||
#include <dbScan.h>
|
||
#include <link.h>
|
||
#include <module_types.h>
|
||
#include <waveformRecord.h>
|
||
|
||
#include <drvJgvtr1.h>
|
||
|
||
static long init_record();
|
||
static long read_wf();
|
||
static long arm_wf();
|
||
|
||
|
||
struct {
|
||
long number;
|
||
DEVSUPFUN report;
|
||
DEVSUPFUN init;
|
||
DEVSUPFUN init_record;
|
||
DEVSUPFUN get_ioint_info;
|
||
DEVSUPFUN read_wf;
|
||
} devWfJoergerVtr1={
|
||
5,
|
||
NULL,
|
||
NULL,
|
||
init_record,
|
||
NULL,
|
||
read_wf};
|
||
|
||
|
||
static void myCallback(pwf,no_read,pdata)
|
||
struct waveformRecord *pwf;
|
||
int no_read;
|
||
unsigned short *pdata;
|
||
{
|
||
struct rset *prset=(struct rset *)(pwf->rset);
|
||
short ftvl = pwf->ftvl;
|
||
long i;
|
||
|
||
if(!pwf->busy) return;
|
||
dbScanLock((struct dbCommon *)pwf);
|
||
pwf->busy = FALSE;
|
||
if(no_read>pwf->nelm)no_read = pwf->nelm;
|
||
if(ftvl==DBF_CHAR || ftvl==DBF_UCHAR) {
|
||
unsigned char *pdest=(unsigned char *)pwf->bptr;
|
||
|
||
for(i=0; i<no_read; i++) {
|
||
*pdest++ = *pdata++;
|
||
}
|
||
pwf->nord = no_read; /* number of values read */
|
||
} else if(ftvl==DBF_SHORT || ftvl==DBF_USHORT) {
|
||
unsigned short *pdest=(unsigned short *)pwf->bptr;
|
||
|
||
for(i=0; i<no_read; i++) {
|
||
*pdest++ = *pdata++;
|
||
}
|
||
pwf->nord = no_read; /* number of values read */
|
||
} else {
|
||
recGblRecordError(S_db_badField,(void *)pwf,
|
||
"read_wf - illegal ftvl");
|
||
recGblSetSevr(pwf,READ_ALARM,INVALID_ALARM);
|
||
}
|
||
(*prset->process)(pwf);
|
||
dbScanUnlock((struct dbCommon *)pwf);
|
||
}
|
||
|
||
static long init_record(pwf)
|
||
struct waveformRecord *pwf;
|
||
{
|
||
|
||
/* wf.inp must be an VME_IO */
|
||
switch (pwf->inp.type) {
|
||
case (VME_IO) :
|
||
break;
|
||
default :
|
||
recGblRecordError(S_db_badField,(void *)pwf,
|
||
"devWfJoergerVtr1 (init_record) Illegal INP field");
|
||
return(S_db_badField);
|
||
}
|
||
return(0);
|
||
}
|
||
|
||
static long read_wf(pwf)
|
||
struct waveformRecord *pwf;
|
||
{
|
||
|
||
/* determine if wave form is to be rearmed*/
|
||
/* If not active then request rearm */
|
||
if(!pwf->pact) arm_wf(pwf);
|
||
/* if already active then call is from myCallback. check rarm*/
|
||
else if(pwf->rarm) {
|
||
(void)arm_wf(pwf);
|
||
}
|
||
return(0);
|
||
}
|
||
|
||
static long arm_wf(pwf)
|
||
struct waveformRecord *pwf;
|
||
{
|
||
long status;
|
||
struct vmeio *pvmeio = (struct vmeio *)&(pwf->inp.value);
|
||
|
||
pwf->busy = TRUE;
|
||
status = jgvtr1_driver(pvmeio->card,myCallback,pwf);
|
||
if(status!=0){
|
||
errMessage(status, NULL);
|
||
recGblSetSevr(pwf,READ_ALARM,INVALID_ALARM);
|
||
pwf->busy = FALSE;
|
||
return(0);
|
||
}
|
||
pwf->pact=TRUE;
|
||
return(0);
|
||
}
|