/*echoDriver.c */ /*********************************************************************** * Copyright (c) 2002 The University of Chicago, as Operator of Argonne * National Laboratory, and the Regents of the University of * California, as Operator of Los Alamos National Laboratory, and * Berliner Elektronenspeicherring-Gesellschaft m.b.H. (BESSY). * asynDriver is distributed subject to a Software License Agreement * found in file LICENSE that is included with this distribution. ***********************************************************************/ /*test driver for asyn support*/ /* * Author: Marty Kraimer */ #include #include #include #include #include #include #include #include #include #include #include #include #define BUFFERSIZE 4096 #define NUM_DEVICES 2 typedef struct deviceBuffer { char buffer[BUFFERSIZE]; int nchars; }deviceBuffer; typedef struct deviceInfo { deviceBuffer buffer; int connected; }deviceInfo; typedef struct echoPvt { deviceInfo device[NUM_DEVICES]; const char *portName; int connected; int multiDevice; double delay; asynInterface common; asynInterface octet; char eos[2]; int eoslen; void *pasynPvt; /*For registerInterruptSource*/ }echoPvt; /* init routine */ static int echoDriverInit(const char *dn, double delay, int noAutoConnect,int multiDevice); /* asynCommon methods */ static void report(void *drvPvt,FILE *fp,int details); static asynStatus connect(void *drvPvt,asynUser *pasynUser); static asynStatus disconnect(void *drvPvt,asynUser *pasynUser); static asynCommon asyn = { report, connect, disconnect }; /* asynOctet methods */ static asynStatus echoWrite(void *drvPvt,asynUser *pasynUser, const char *data,size_t numchars,size_t *nbytesTransfered); static asynStatus echoRead(void *drvPvt,asynUser *pasynUser, char *data,size_t maxchars,size_t *nbytesTransfered,int *eomReason); static asynStatus echoFlush(void *drvPvt,asynUser *pasynUser); static asynStatus setEos(void *drvPvt,asynUser *pasynUser, const char *eos,int eoslen); static asynStatus getEos(void *drvPvt,asynUser *pasynUser, char *eos, int eossize, int *eoslen); static int echoDriverInit(const char *dn, double delay, int noAutoConnect,int multiDevice) { echoPvt *pechoPvt; char *portName; asynStatus status; int nbytes; int attributes; asynOctet *pasynOctet; nbytes = sizeof(echoPvt) + sizeof(asynOctet) + strlen(dn) + 1; pechoPvt = callocMustSucceed(nbytes,sizeof(char),"echoDriverInit"); pasynOctet = (asynOctet *)(pechoPvt + 1); portName = (char *)(pasynOctet + 1); strcpy(portName,dn); pechoPvt->portName = portName; pechoPvt->delay = delay; pechoPvt->multiDevice = multiDevice; pechoPvt->common.interfaceType = asynCommonType; pechoPvt->common.pinterface = (void *)&asyn; pechoPvt->common.drvPvt = pechoPvt; attributes = 0; if(multiDevice) attributes |= ASYN_MULTIDEVICE; if(delay>0.0) attributes|=ASYN_CANBLOCK; status = pasynManager->registerPort(portName,attributes,!noAutoConnect,0,0); if(status!=asynSuccess) { printf("echoDriverInit registerDriver failed\n"); return 0; } status = pasynManager->registerInterface(portName,&pechoPvt->common); if(status!=asynSuccess){ printf("echoDriverInit registerInterface failed\n"); return 0; } pasynOctet->write = echoWrite; pasynOctet->read = echoRead; pasynOctet->flush = echoFlush; pasynOctet->setInputEos = setEos; pasynOctet->getInputEos = getEos; pechoPvt->octet.interfaceType = asynOctetType; pechoPvt->octet.pinterface = pasynOctet; pechoPvt->octet.drvPvt = pechoPvt; if(multiDevice) { status = pasynOctetBase->initialize(portName,&pechoPvt->octet,0,0,0); } else { status = pasynOctetBase->initialize(portName,&pechoPvt->octet,1,1,0); } if(status==asynSuccess) status = pasynManager->registerInterruptSource( portName,&pechoPvt->octet,&pechoPvt->pasynPvt); if(status!=asynSuccess){ printf("echoDriverInit registerInterface failed\n"); return 0; } return(0); } /* asynCommon methods */ static void report(void *drvPvt,FILE *fp,int details) { echoPvt *pechoPvt = (echoPvt *)drvPvt; int i,n; fprintf(fp," echoDriver. " "multiDevice:%s connected:%s delay = %f\n", (pechoPvt->multiDevice ? "Yes" : "No"), (pechoPvt->connected ? "Yes" : "No"), pechoPvt->delay); n = (pechoPvt->multiDevice) ? NUM_DEVICES : 1; for(i=0;idevice[i].connected ? "Yes" : "No"), pechoPvt->device[i].buffer.nchars); } } static asynStatus connect(void *drvPvt,asynUser *pasynUser) { echoPvt *pechoPvt = (echoPvt *)drvPvt; deviceInfo *pdeviceInfo; int addr; asynStatus status; status = pasynManager->getAddr(pasynUser,&addr); if(status!=asynSuccess) return status; asynPrint(pasynUser, ASYN_TRACE_FLOW, "%s echoDriver:connect addr %d\n",pechoPvt->portName,addr); if(!pechoPvt->multiDevice) { if(pechoPvt->connected) { asynPrint(pasynUser,ASYN_TRACE_ERROR, "%s echoDriver:connect port already connected\n", pechoPvt->portName); return asynError; } /* simulate connection delay */ if(pechoPvt->delay>0.0) epicsThreadSleep(pechoPvt->delay*10.); pechoPvt->connected = 1; pechoPvt->device[0].connected = 1; pasynManager->exceptionConnect(pasynUser); return asynSuccess; } if(addr<=-1) { if(pechoPvt->connected) { asynPrint(pasynUser,ASYN_TRACE_ERROR, "%s echoDriver:connect port already connected\n", pechoPvt->portName); return asynError; } /* simulate connection delay */ if(pechoPvt->delay>0.0) epicsThreadSleep(pechoPvt->delay*10); pechoPvt->connected = 1; pasynManager->exceptionConnect(pasynUser); return asynSuccess; } if(addr>=NUM_DEVICES) { asynPrint(pasynUser,ASYN_TRACE_ERROR, "%s echoDriver:connect illegal addr %d\n",pechoPvt->portName,addr); return asynError; } pdeviceInfo = &pechoPvt->device[addr]; if(pdeviceInfo->connected) { asynPrint(pasynUser,ASYN_TRACE_ERROR, "%s echoDriver:connect device %d already connected\n", pechoPvt->portName,addr); return asynError; } /* simulate connection delay */ if(pechoPvt->delay>0.0) epicsThreadSleep(pechoPvt->delay*10.); pdeviceInfo->connected = 1; pasynManager->exceptionConnect(pasynUser); return(asynSuccess); } static asynStatus disconnect(void *drvPvt,asynUser *pasynUser) { echoPvt *pechoPvt = (echoPvt *)drvPvt; deviceInfo *pdeviceInfo; int addr; asynStatus status; status = pasynManager->getAddr(pasynUser,&addr); if(status!=asynSuccess) return status; asynPrint(pasynUser, ASYN_TRACE_FLOW, "%s echoDriver:disconnect addr %d\n",pechoPvt->portName,addr); if(!pechoPvt->multiDevice) { if(!pechoPvt->connected) { asynPrint(pasynUser,ASYN_TRACE_ERROR, "%s echoDriver:disconnect port not connected\n", pechoPvt->portName); return asynError; } pechoPvt->connected = 0; pechoPvt->device[0].connected = 0; pasynManager->exceptionDisconnect(pasynUser); return asynSuccess; } if(addr<=-1) { if(!pechoPvt->connected) { asynPrint(pasynUser,ASYN_TRACE_ERROR, "%s echoDriver:disconnect port not connected\n", pechoPvt->portName); return asynError; } pechoPvt->connected = 0; pasynManager->exceptionDisconnect(pasynUser); return asynSuccess; } if(addr>=NUM_DEVICES) { asynPrint(pasynUser,ASYN_TRACE_ERROR, "%s echoDriver:disconnect illegal addr %d\n",pechoPvt->portName,addr); return asynError; } pdeviceInfo = &pechoPvt->device[addr]; if(!pdeviceInfo->connected) { asynPrint(pasynUser,ASYN_TRACE_ERROR, "%s echoDriver:disconnect device %d not connected\n", pechoPvt->portName,addr); return asynError; } pdeviceInfo->connected = 0; pasynManager->exceptionDisconnect(pasynUser); return(asynSuccess); } /* asynOctet methods */ static asynStatus echoWrite(void *drvPvt,asynUser *pasynUser, const char *data,size_t nchars,size_t *nbytesTransfered) { echoPvt *pechoPvt = (echoPvt *)drvPvt; deviceInfo *pdeviceInfo; deviceBuffer *pdeviceBuffer; int addr; asynStatus status; status = pasynManager->getAddr(pasynUser,&addr); if(status!=asynSuccess) return status; if(!pechoPvt->multiDevice) addr = 0; asynPrint(pasynUser, ASYN_TRACE_FLOW, "%s echoDriver:write addr %d\n",pechoPvt->portName,addr); if(addr<0 || addr>=NUM_DEVICES) { epicsSnprintf(pasynUser->errorMessage,pasynUser->errorMessageSize, "addr %d is illegal. Must be 0 or 1\n",addr); return asynError; } pdeviceInfo = &pechoPvt->device[addr]; if(!pdeviceInfo->connected) { asynPrint(pasynUser,ASYN_TRACE_ERROR, "%s echoDriver:write device %d not connected\n", pechoPvt->portName,addr); epicsSnprintf(pasynUser->errorMessage,pasynUser->errorMessageSize, "%s echoDriver:write device %d not connected\n", pechoPvt->portName,addr); return asynError; } if(pechoPvt->delay>pasynUser->timeout) { if(pasynUser->timeout>0.0) epicsThreadSleep(pasynUser->timeout); asynPrint(pasynUser, ASYN_TRACE_ERROR, "%s echoDriver write timeout\n",pechoPvt->portName); epicsSnprintf(pasynUser->errorMessage,pasynUser->errorMessageSize, "%s echoDriver write timeout\n",pechoPvt->portName); return asynTimeout; } pdeviceBuffer = &pdeviceInfo->buffer; if(nchars>BUFFERSIZE) nchars = BUFFERSIZE; if(nchars>0) memcpy(pdeviceBuffer->buffer,data,nchars); asynPrintIO(pasynUser,ASYN_TRACEIO_DRIVER,data,nchars, "echoWrite nchars %d\n",nchars); pdeviceBuffer->nchars = nchars; if(pechoPvt->delay>0.0) epicsThreadSleep(pechoPvt->delay); *nbytesTransfered = nchars; return status; } static asynStatus echoRead(void *drvPvt,asynUser *pasynUser, char *data,size_t maxchars,size_t *nbytesTransfered,int *eomReason) { echoPvt *pechoPvt = (echoPvt *)drvPvt; deviceInfo *pdeviceInfo; deviceBuffer *pdeviceBuffer; char *pfrom,*pto; char thisChar; int nremaining; int nout = 0; int addr; asynStatus status; if(eomReason) *eomReason=0; if(nbytesTransfered) *nbytesTransfered = 0; status = pasynManager->getAddr(pasynUser,&addr); if(status!=asynSuccess) return status; if(!pechoPvt->multiDevice) addr = 0; asynPrint(pasynUser, ASYN_TRACE_FLOW, "%s echoDriver:read addr %d\n",pechoPvt->portName,addr); if(addr<0 || addr>=NUM_DEVICES) { epicsSnprintf(pasynUser->errorMessage,pasynUser->errorMessageSize, "addr %d is illegal. Must be 0 or 1\n",addr); return(0); } pdeviceInfo = &pechoPvt->device[addr]; if(!pdeviceInfo->connected) { asynPrint(pasynUser,ASYN_TRACE_ERROR, "%s echoDriver:read device %d not connected\n", pechoPvt->portName,addr); epicsSnprintf(pasynUser->errorMessage,pasynUser->errorMessageSize, "%s echoDriver:read device %d not connected\n", pechoPvt->portName,addr); return asynError; } if(pechoPvt->delay>pasynUser->timeout) { if(pasynUser->timeout>0.0) epicsThreadSleep(pasynUser->timeout); asynPrint(pasynUser, ASYN_TRACE_ERROR, "%s echoDriver read timeout\n",pechoPvt->portName); epicsSnprintf(pasynUser->errorMessage,pasynUser->errorMessageSize, "%s echoDriver read timeout\n",pechoPvt->portName); return asynTimeout; } if(pechoPvt->delay>0.0) epicsThreadSleep(pechoPvt->delay); pdeviceBuffer = &pdeviceInfo->buffer; nremaining = pdeviceBuffer->nchars; pdeviceBuffer->nchars = 0; pfrom = pdeviceBuffer->buffer; pto = data; while(nremaining>0 && nouteoslen>0) { if(thisChar==pechoPvt->eos[0]) { if(pechoPvt->eoslen==1) { if(eomReason) *eomReason |= ASYN_EOM_EOS; break; } if(nremaining==0) { if(eomReason) *eomReason |= ASYN_EOM_CNT; break; } if(*pfrom==pechoPvt->eos[1]) { *pto++ = *pfrom++; nremaining--; nout++; if(eomReason) { *eomReason |= ASYN_EOM_EOS; if(nremaining==0) *eomReason |= ASYN_EOM_CNT; break; } } } } } if(nbytesTransfered) *nbytesTransfered = nout; if(eomReason) { if(*nbytesTransfered>=maxchars) *eomReason |= ASYN_EOM_CNT; if(nremaining==0) *eomReason |= ASYN_EOM_END; } pasynOctetBase->callInterruptUsers(pasynUser,pechoPvt->pasynPvt, data,nbytesTransfered,eomReason); asynPrintIO(pasynUser,ASYN_TRACEIO_DRIVER,data,nout, "echoRead nbytesTransfered %d\n",*nbytesTransfered); return status; } static asynStatus echoFlush(void *drvPvt,asynUser *pasynUser) { echoPvt *pechoPvt = (echoPvt *)drvPvt; deviceInfo *pdeviceInfo; deviceBuffer *pdeviceBuffer; int addr; asynStatus status; status = pasynManager->getAddr(pasynUser,&addr); if(status!=asynSuccess) return status; if(!pechoPvt->multiDevice) addr = 0; asynPrint(pasynUser, ASYN_TRACE_FLOW, "%s echoDriver:flush addr %d\n",pechoPvt->portName,addr); if(addr<0 || addr>=NUM_DEVICES) { epicsSnprintf(pasynUser->errorMessage,pasynUser->errorMessageSize, "addr %d is illegal. Must be 0 or 1\n",addr); return(0); } pdeviceInfo = &pechoPvt->device[addr]; if(!pdeviceInfo->connected) { asynPrint(pasynUser,ASYN_TRACE_ERROR, "%s echoDriver:flush device %d not connected\n", pechoPvt->portName,addr); return -1; } pdeviceBuffer = &pdeviceInfo->buffer; asynPrint(pasynUser,ASYN_TRACE_FLOW, "%s echoFlush\n",pechoPvt->portName); pdeviceBuffer->nchars = 0; return(asynSuccess); } static asynStatus setEos(void *drvPvt,asynUser *pasynUser, const char *eos,int eoslen) { echoPvt *pechoPvt = (echoPvt *)drvPvt; int i; if(eoslen>2 || eoslen<0) { epicsSnprintf(pasynUser->errorMessage,pasynUser->errorMessageSize, "setEos illegal eoslen %d\n",eoslen); return(asynError); } pechoPvt->eoslen = eoslen; for(i=0; ieos[i] = eos[i]; asynPrint(pasynUser,ASYN_TRACE_FLOW, "%s setEos\n",pechoPvt->portName); return(asynSuccess); } static asynStatus getEos(void *drvPvt,asynUser *pasynUser, char *eos, int eossize, int *eoslen) { echoPvt *pechoPvt = (echoPvt *)drvPvt; int i; *eoslen = pechoPvt->eoslen; for(i=0; i<*eoslen; i++) eos[i] = pechoPvt->eos[i]; asynPrint(pasynUser,ASYN_TRACE_FLOW, "%s setEos\n",pechoPvt->portName); return(asynSuccess); } /* register echoDriverInit*/ static const iocshArg echoDriverInitArg0 = { "portName", iocshArgString }; static const iocshArg echoDriverInitArg1 = { "delay", iocshArgDouble }; static const iocshArg echoDriverInitArg2 = { "disable auto-connect", iocshArgInt }; static const iocshArg echoDriverInitArg3 = { "multiDevice", iocshArgInt }; static const iocshArg *echoDriverInitArgs[] = { &echoDriverInitArg0,&echoDriverInitArg1, &echoDriverInitArg2,&echoDriverInitArg3}; static const iocshFuncDef echoDriverInitFuncDef = { "echoDriverInit", 4, echoDriverInitArgs}; static void echoDriverInitCallFunc(const iocshArgBuf *args) { echoDriverInit(args[0].sval,args[1].dval,args[2].ival,args[3].ival); } static void echoDriverRegister(void) { static int firstTime = 1; if (firstTime) { firstTime = 0; iocshRegister(&echoDriverInitFuncDef, echoDriverInitCallFunc); } } epicsExportRegistrar(echoDriverRegister);