#include #include #include #include "alarm.h" #include "cvtTable.h" #include "dbDefs.h" #include "devLib.h" #include "dbAccess.h" #include "recSup.h" #include "callback.h" #include "devSup.h" #include "dbScan.h" /* for SCAN_IO_EVENT */ #include "link.h" #include "aoRecord.h" /* for aoRecord structure */ #include "epicsExport.h"/* for epicsExportAddress */ #include /* for DEBUGPRINT */ #include "drvMpsLinkNode.h" /* for mpsSet* routines */ typedef struct aoMps_s { int routine; int channel; int thld_type; } aoMps_t; typedef struct { long number; DEVSUPFUN report; DEVSUPFUN init; DEVSUPFUN init_record; DEVSUPFUN get_ioint_info; DEVSUPFUN write_ao; DEVSUPFUN special_linconv; } AODSET; #ifdef DEBUG_PRINT int devAoMpsFlag = 0; #endif LOCAL long init_ao(); LOCAL long ao_ioinfo(); LOCAL long write_ao(); AODSET devAoMpsLinkNode = { 6, NULL, NULL, init_ao, ao_ioinfo, write_ao, NULL }; epicsExportAddress(dset, devAoMpsLinkNode); LOCAL long init_ao(struct aoRecord *pao) { aoMps_t *paop; switch(pao->out.type) { case(INST_IO): /* Allocate the memory for this records private data structure */ paop = (aoMps_t *) malloc(sizeof(aoMps_t)); if (paop == NULL) { return S_dev_noMemory; } /* Tell the record about its private data structure */ pao->dpvt = paop; DEBUGPRINT(DP_INFO, devAoMpsFlag, ("init_ao: %s: has parm: %s\n", pao->name, pao->out.value.instio.string)); sscanf(pao->out.value.instio.string, "%d %d %d", &(paop->routine), &(paop->channel), &(paop->thld_type)); DEBUGPRINT(DP_INFO, devAoMpsFlag, ("init_ao: %s's dpvt has routine: %d, ch: %d thldty: %d\n", pao->name, paop->routine, paop->channel, paop->thld_type)); break; default: DEBUGPRINT(DP_ERROR, devAoMpsFlag, ("init_ao: %s: illegal INP field: %d", pao->name, (int) pao->out.type)); break; } return 0; } LOCAL long ao_ioinfo( int cmd, struct aoRecord *pao, IOSCANPVT *ppvt ) { return 0; } LOCAL long write_ao(struct aoRecord *pao) { aoMps_t *paop; int rc; double intermediary; unsigned short for_transfer; /* Set this to facilitate easy access to index field */ paop = (aoMps_t *)pao->dpvt; switch(paop->routine) { case 0: /* 1/15/9 Brute force method since rval is getting stuck at -10 intermediary = pao->val * pao->aslo + pao->aoff; */ /* 1/29/9: replaces line above: */ intermediary = (pao->oval - pao->egul) / pao->eslo; pao->rval = intermediary; DEBUGPRINT(DP_DEBUG, devAoMpsFlag, ("%s's intermediary %g = (%g - %g)/%g + 0.5\n", pao->name, intermediary, pao->oval, pao->egul, pao->eslo)); intermediary = intermediary * pao->aslo + pao->aoff; DEBUGPRINT(DP_INFO, devAoMpsFlag, ("%s's %g = intermediary * %g) + %g\n", pao->name, intermediary, pao->aslo, pao->aoff)); for_transfer = (unsigned short) intermediary; rc = mpsSetBLMHV(paop->channel, for_transfer); /* rc = mpsSetBLMHV(paop->channel, pao->rval); from RRM, rval should be val, adjusted by EGUL and EGUF (which here should change nothing and then rval = rval * ASLO + AOFF */ DEBUGPRINT(DP_INFO, devAoMpsFlag, ("%s's val is %g\n", pao->name, pao->val)); break; case 1: /* BYKIK Low and High Threshold Settings */ /* enter voltage [-10,10] scaled to 2 byte unsigned offset binary (-10 V -> 0 counts; 0 V -> 32768 counts; 10 V -> 65535 counts) */ /* need brute force method here, too? 2/6/9 yes, for now */ /* rc = mpsSetBYKThreshold(paop->thld_type, pao->val); */ /* 2/6/9: replaces line above */ /* 2/6/9: input voltage * 65536/20 + 10 = counts */ pao->rval = (pao->oval + pao->aoff) * pao->aslo; rc = mpsSetBYKThreshold(paop->thld_type, pao->rval); break; case 2: /* 1/30/9: make subrout of case 0 and invoke it here */ /* 1/15/9 Brute force method since rval is getting stuck at -10 intermediary = pao->val * pao->aslo + pao->aoff; */ /* 1/30/9: replaces line above: */ intermediary = (pao->oval - pao->egul) / pao->eslo; pao->rval = intermediary; DEBUGPRINT(DP_DEBUG, devAoMpsFlag, ("%s's intermediary %g = (%g - %g)/%g + 0.5\n", pao->name, intermediary, pao->oval, pao->egul, pao->eslo)); intermediary = intermediary * pao->aslo + pao->aoff; DEBUGPRINT(DP_DEBUG, devAoMpsFlag, ("%s's %g = intermediary * %g) + %g\n", pao->name, intermediary, pao->aslo, pao->aoff)); for_transfer = (unsigned short) intermediary; rc = mpsSetBLMHVThreshold(paop->channel, paop->thld_type, for_transfer); /* rc = mpsSetBLMHVThreshold(paop->channel, paop->thld_type, pao->val); from RRM, rval should be val, adjusted by EGUL and EGUF (which here should change nothing and then rval = rval * ASLO + AOFF */ DEBUGPRINT(DP_DEBUG, devAoMpsFlag, ("%s's val is %g\n", pao->name, pao->val)); break; case 3: rc = mpsSetQADCBaseThreshold(paop->channel, paop->thld_type, (short) pao->rval); break; case 4: rc = mpsSetQADCTestThreshold(paop->channel, paop->thld_type, (short) (pao->rval)); break; case 5: rc = mpsSetQADCBeamThreshold(paop->channel, paop->thld_type, (short) (pao->rval)); break; case 6: rc = mpsSetFiducialDelay((unsigned) pao->val); break; case 7: rc = mpsSetFiducialWidth((unsigned) pao->val); break; default: pao->udf = 1; return ERROR; } DEBUGPRINT(DP_DEBUG, devAoMpsFlag, ("%s's val is %g rval is %d\n", pao->name, pao->val, pao->rval)); return rc; }