#include #include #include #include #include "drvLinkNodeSim.h" #define DEBUG 0 /******************************************************************************************/ static long initBo(boRecord *); static long ioIntBoInfo(int cmd, dbCommon *precord, IOSCANPVT *ppvt); static long writeBo(boRecord *); struct { /* bo dset */ long number; DEVSUPFUN dev_report; DEVSUPFUN init; DEVSUPFUN init_record; DEVSUPFUN get_ioint_info; DEVSUPFUN write_bi; } devBoMpsLN={ 5, NULL, NULL, initBo, ioIntBoInfo, writeBo, }; epicsExportAddress(dset,devBoMpsLN); typedef struct recordBoPvt_s { int nodeID; } recordBoPvt_t; static long initBo(boRecord *pbo) { recordBoPvt_t *recordPvt = NULL; int lnID; int module; switch(pbo->out.type) { case(INST_IO): { // Allocate the memory for this records private data structure recordPvt = (recordBoPvt_t *) malloc(sizeof(recordBoPvt_t)); if (recordPvt == NULL) { errlogPrintf("%s %s:%d: record (%s): no memory to create record pvt structure \n", __FILE__, __func__, __LINE__, pbo->name); return S_dev_noMemory; } pbo->dpvt = recordPvt; int retval = sscanf(pbo->out.value.instio.string, "%d %d", &lnID, &module); if(retval != 2) { errlogPrintf("%s %s:%d: record (%s): wrong format of input filed (%s) \n", __FILE__, __func__, __LINE__, pbo->name, pbo->out.value.instio.string); return -1; } if(lnID < MPSLinkNodeIdMin || lnID > MPSLinkNodeIdMax) { errlogPrintf("%s %s:%d: record (%s): nodeID out of range (%d)\n", __FILE__, __func__, __LINE__, pbo->name, lnID); return -1; } if(module < 1 || module > 4) { errlogPrintf("%s %s:%d: record (%s): module out of range (%d)\n", __FILE__, __func__, __LINE__, pbo->name, module); return -1; } recordPvt->nodeID = lnID; if(linkNode[lnID].ID != lnID) { errlogPrintf("%s %s:%d: record (%s): mismatching linkNode IDs [LN %d : REC %d ] \n", __FILE__, __func__, __LINE__, pbo->name, linkNode[lnID].ID, recordPvt->nodeID); return -1; } if(epicsMutexLock(linkNode[lnID].bsaDataMutex) != epicsMutexLockOK) { errlogPrintf("%s %s:%d: record (%s): Could not lock the mutex!\n", __FILE__, __func__, __LINE__, pbo->name ); } strcpy(linkNode[lnID].recName, pbo->name); linkNode[lnID].present = pbo->val; linkNode[lnID].module = module; epicsMutexUnlock(linkNode[lnID].bsaDataMutex); break; } default: errlogPrintf("%s %s:%d: record (%s): link type not supported \n", __FILE__, __func__, __LINE__, pbo->name); return -1; break; } return 2; } static long ioIntBoInfo( int cmd, dbCommon *precord, IOSCANPVT *ppvt ) { recordBoPvt_t *recordPvt = precord->dpvt; if (recordPvt == NULL) { errlogPrintf("ioIntInfo: uninitialized record (%s)\n", precord->name); return -1; } *ppvt = linkNode[recordPvt->nodeID].ioscanpvtStatus; return 0; } static long writeBo(boRecord *pbo) { int lnID = ((recordBoPvt_t*)pbo->dpvt)->nodeID; if(DEBUG) printf("Record: %s change value to %d\n",pbo->name, pbo->val); if(epicsMutexLock(linkNode[lnID].bsaDataMutex) != epicsMutexLockOK) { errlogPrintf("%s %s:%d: record (%s): Could not lock the mutex!\n", __FILE__, __func__, __LINE__, pbo->name ); } linkNode[lnID].present = pbo->val; if(pbo->val == 0) { linkNode[lnID].active = epicsFalse; } epicsMutexUnlock(linkNode[lnID].bsaDataMutex); pbo->udf = FALSE; return 0; } /******************************************************************************************/