121 lines
2.5 KiB
C
121 lines
2.5 KiB
C
/* devAiXy566Di.c */
|
||
/* share/src/dev $Id$ */
|
||
|
||
/* devAiXy566Di.c - Device Support Routines */
|
||
|
||
|
||
#include <vxWorks.h>
|
||
#include <types.h>
|
||
#include <stdioLib.h>
|
||
|
||
#include <alarm.h>
|
||
#include <cvtTable.h>
|
||
#include <dbDefs.h>
|
||
#include <dbAccess.h>
|
||
#include <devSup.h>
|
||
#include <link.h>
|
||
#include <module_types.h>
|
||
#include <aiRecord.h>
|
||
|
||
long init_record();
|
||
long read_ai();
|
||
long special_linconv();
|
||
|
||
|
||
struct {
|
||
long number;
|
||
DEVSUPFUN report;
|
||
DEVSUPFUN init;
|
||
DEVSUPFUN init_record;
|
||
DEVSUPFUN get_ioint_info;
|
||
DEVSUPFUN read_ai;
|
||
DEVSUPFUN special_linconv;
|
||
} devAiXy566Di={
|
||
6,
|
||
NULL,
|
||
NULL,
|
||
init_record,
|
||
NULL,
|
||
read_ai,
|
||
special_linconv};
|
||
|
||
|
||
static long init_record(pai)
|
||
struct aiRecord *pai;
|
||
{
|
||
char message[100];
|
||
short value;
|
||
struct vmeio *pvmeio;
|
||
long status;
|
||
|
||
/* ai.inp must be an VME_IO */
|
||
switch (pai->inp.type) {
|
||
case (VME_IO) :
|
||
break;
|
||
default :
|
||
strcpy(message,pai->name);
|
||
strcat(message,": devAiXy566Di (init_record) Illegal INP field");
|
||
errMessage(S_db_badField,message);
|
||
return(S_db_badField);
|
||
}
|
||
|
||
/* set linear conversion slope*/
|
||
pai->eslo = (pai->eguf -pai->egul)/4095.0;
|
||
|
||
/* call driver so that it configures card */
|
||
pvmeio = (struct vmeio *)&(pai->inp.value);
|
||
if(status=ai_driver(pvmeio->card,pvmeio->signal,XY566DI,&value)) {
|
||
strcpy(message,pai->name);
|
||
strcat(message,": devAiXy566Di (init_record) ai_driver error");
|
||
errMessage(status,message);
|
||
return(status);
|
||
}
|
||
return(0);
|
||
}
|
||
|
||
static long read_ai(pai)
|
||
struct aiRecord *pai;
|
||
{
|
||
short value;
|
||
struct vmeio *pvmeio;
|
||
long status;
|
||
|
||
|
||
pvmeio = (struct vmeio *)&(pai->inp.value);
|
||
status=ai_driver(pvmeio->card,pvmeio->signal,XY566DI,&value);
|
||
if(status==-1) {
|
||
status = 2; /* don't convert*/
|
||
if(pai->nsev<MAJOR_ALARM ) {
|
||
pai->nsta = READ_ALARM;
|
||
pai->nsev = MAJOR_ALARM;
|
||
|
||
}
|
||
return(status);
|
||
}else if(status==-2) {
|
||
status=0;
|
||
if(pai->nsev<MAJOR_ALARM ) {
|
||
pai->nsta = HW_LIMIT_ALARM;
|
||
pai->nsev = MAJOR_ALARM;
|
||
}
|
||
}
|
||
if(status!=0) return(status);
|
||
/*read into hardware as -0x7ff to +0x7ff */
|
||
/* normalize to 0 - 0xfff */
|
||
value = value + 0x800;
|
||
/* remove the sign bit */
|
||
value &= 0xfff;
|
||
pai->rval = value;
|
||
return(status);
|
||
}
|
||
|
||
static long special_linconv(pai,after)
|
||
struct aiRecord *pai;
|
||
int after;
|
||
{
|
||
|
||
if(!after) return(0);
|
||
/* set linear conversion slope*/
|
||
pai->eslo = (pai->eguf -pai->egul)/4095.0;
|
||
return(0);
|
||
}
|