#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 module; int channel; int thld_type; /* Either LOW (0) or HIGH (1) threshold */ } 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 = 2; #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; #ifdef DEBUG_PRINT DEBUGPRINT(DP_INFO, devAoMpsFlag, ("init_ao: %s: has parm: %s\n", pao->name, pao->out.value.instio.string)); #endif sscanf(pao->out.value.instio.string, "%d %d %d %d", &(paop->routine), &(paop->module), &(paop->channel), &(paop->thld_type)); #ifdef DEBUG_PRINT DEBUGPRINT(DP_INFO, devAoMpsFlag, ("init_ao: %s's dpvt has routine: %d module: %d ch: %d thldty: %d\n", pao->name, paop->routine, paop->module, paop->channel, paop->thld_type)); #endif break; default: #ifdef DEBUG_PRINT DEBUGPRINT(DP_ERROR, devAoMpsFlag, ("init_ao: %s: illegal INP field: %d\n", pao->name, (int) pao->out.type)); #endif 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; /*double intermediary_qadc;*/ unsigned short for_transfer; /*short for_qadc_transfer;*/ /* Set this to facilitate easy access to index field */ paop = (aoMps_t *)pao->dpvt; switch(paop->routine) { case 0: /*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 but rval is getting stuck at -10 replaced 1/15/9 by: input voltage * 65536/20 + 10 = counts */ intermediary = (pao->oval - pao->egul) / pao->eslo; pao->rval = intermediary; DEBUGPRINT(DP_DEBUG, devAoMpsFlag, ("%s's intermediary %g = (%g - %g)/%g\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); DEBUGPRINT(DP_INFO, devAoMpsFlag, ("%s's val is %g\n", pao->name, pao->val)); break; case 1: /* BYKIK Low and High Threshold Settings pass in voltage between [-10 V, 10 V] */ rc = mpsSetBYKThreshold(paop->thld_type, pao->val); break; case 2: /* from RRM, rval should be val, adjusted by EGUL and EGUF (which here should change nothing) and then rval = rval * ASLO + AOFF */ intermediary = (pao->oval - pao->egul) / pao->eslo; pao->rval = intermediary; DEBUGPRINT(DP_INFO, devAoMpsFlag, ("%s's intermediary %g = (%g - %g)/%g\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 = mpsSetBLMHVThreshold(paop->channel, paop->thld_type, for_transfer); DEBUGPRINT(DP_DEBUG, devAoMpsFlag, ("%s's val is %g\n", pao->name, pao->val)); break; case 3: /* 4/13/9 add module, not because PIC uses this, but to keep consistent with mpsSetQADCBeamThreshold */ /* 7/6/9 now threshold is in space of 32 bits, with sign extension in bits 26-31. Ensure that range is limited to 26 bit, two's complement. */ if (pao->rval > (long) MPS_QADC_THRESHOLD_UPPER_LIMIT ) { pao->rval = MPS_QADC_THRESHOLD_UPPER_LIMIT; } else { if (pao->rval < MPS_QADC_THRESHOLD_LOWER_LIMIT ) { pao->rval = MPS_QADC_THRESHOLD_LOWER_LIMIT; } } rc = mpsSetQADCBaseThreshold(paop->module, paop->channel, paop->thld_type, pao->rval); #ifdef DEBUG_PRINT DEBUGPRINT(DP_INFO, devAoMpsFlag, ("%s: module: %d ch:%d type:%d rval:%ld\n", pao->name, paop->module, paop->channel, paop->thld_type, (long) pao->rval)); #endif /******************************************************************************* NOT READY FOR THIS YET 3/13/9 intermediary_qadc = (pao->oval * pao->aslo) + pao->aoff; DEBUGPRINT(DP_INFO, devAoMpsFlag, ("%s's %g = %lu * %g) + %g\n", pao->name, intermediary_qadc, pao->oval, pao->aslo, pao->aoff)); for_qadc_transfer = (short) intermediary_qadc; DEBUGPRINT(DP_INFO, devAoMpsFlag, ("calling mpsSetQADCBaseThreshold with ch:%d, thld_ty:%d, thld:%hd\n", pao->name, paop->channel, paop->thld_type, for_qadc_transfer)); rc = mpsSetQADCBaseThreshold(paop->channel, paop->thld_type, for_qadc_transfer); *******************************************************************************/ break; case 4: /* 4/13/9 add module, not because PIC uses this, but to keep consistent with mpsSetQADCBeamThreshold */ /* 7/6/9 now threshold is in space of 32 bits, with sign extension in bits 26-31. Ensure that range is limited to 26 bit, two's complement. */ if (pao->rval > (long) MPS_QADC_THRESHOLD_UPPER_LIMIT ) { pao->rval = MPS_QADC_THRESHOLD_UPPER_LIMIT; } else { if (pao->rval < MPS_QADC_THRESHOLD_LOWER_LIMIT ) { pao->rval = MPS_QADC_THRESHOLD_LOWER_LIMIT; } } rc = mpsSetQADCTestThreshold(paop->module, paop->channel, paop->thld_type, pao->rval); #ifdef DEBUG_PRINT DEBUGPRINT(DP_INFO, devAoMpsFlag, ("%s: ch:%d type:%d rval:%ld\n", pao->name, paop->channel, paop->thld_type, (long) pao->rval)); #endif /******************************************************************************* NOT READY FOR THIS YET 3/13/9 intermediary_qadc = (pao->oval * pao->aslo) + pao->aoff; DEBUGPRINT(DP_INFO, devAoMpsFlag, ("%s's %g = %lu * %g) + %g\n", pao->name, intermediary_qadc, pao->oval, pao->aslo, pao->aoff)); for_qadc_transfer = (short) intermediary_qadc; DEBUGPRINT(DP_INFO, devAoMpsFlag, ("calling mpsSetQADCBaseThreshold with ch:%d, thld_ty:%d, thld:%hd\n", pao->name, paop->channel, paop->thld_type, for_qadc_transfer)); rc = mpsSetQADCTestThreshold(paop->channel, paop->thld_type, for_qadc_transfer); *******************************************************************************/ break; case 5: /* 4/13/9 add module to accommodate PIC */ /* 7/6/9 now threshold is in space of 32 bits, with sign extension in bits 26-31. Ensure that range is limited to 26 bit, two's complement. */ #ifdef DEBUG_PRINT DEBUGPRINT(DP_INFO, devAoMpsFlag, ("%s: ch:%d type:%d rval:%ld val:%ld\n", pao->name, paop->channel, paop->thld_type, (long) pao->rval, (long) pao->val)); #endif if (pao->rval > (long) MPS_QADC_THRESHOLD_UPPER_LIMIT ) { pao->rval = MPS_QADC_THRESHOLD_UPPER_LIMIT; } else { if (pao->rval < MPS_QADC_THRESHOLD_LOWER_LIMIT ) { pao->rval = MPS_QADC_THRESHOLD_LOWER_LIMIT; } } rc = mpsSetQADCBeamThreshold(paop->module, paop->channel, paop->thld_type, pao->rval); #ifdef DEBUG_PRINT DEBUGPRINT(DP_INFO, devAoMpsFlag, ("%s: ch:%d type:%d rval:%ld\n", pao->name, paop->channel, paop->thld_type, (long) pao->rval)); #endif /******************************************************************************* NOT READY FOR THIS YET 3/13/9 intermediary_qadc = (pao->oval * pao->aslo) + pao->aoff; DEBUGPRINT(DP_INFO, devAoMpsFlag, ("%s's %g = %lu * %g) + %g\n", pao->name, intermediary_qadc, pao->oval, pao->aslo, pao->aoff)); for_qadc_transfer = (short) intermediary_qadc; DEBUGPRINT(DP_INFO, devAoMpsFlag, ("calling mpsSetQADCBaseThreshold with ch:%d, thld_ty:%d, thld:%hd\n", pao->name, paop->channel, paop->thld_type, for_qadc_transfer)); rc = mpsSetQADCBeamThreshold(paop->channel, paop->thld_type, for_qadc_transfer); *******************************************************************************/ break; case 6: rc = mpsSetFiducialDelay((unsigned) pao->val); break; case 7: rc = mpsSetFiducialWidth((unsigned) pao->val); break; default: pao->udf = 1; return ERROR; } #ifdef DEBUG_PRINT DEBUGPRINT(DP_DEBUG, devAoMpsFlag, ("%s's val is %g rval is %d\n", pao->name, pao->val, pao->rval)); #endif return rc; }