Marty Kraimer
153 lines
3.8 KiB
C
153 lines
3.8 KiB
C
#include <vxWorks.h>
|
|
#include <taskLib.h>
|
|
#include <string.h>
|
|
#include <stdlib.h>
|
|
#include <stddef.h>
|
|
#include <stdio.h>
|
|
#include <rngLib.h>
|
|
#include <ellLib.h>
|
|
#include <vxLib.h>
|
|
#include <dbDefs.h>
|
|
#include <taskwd.h>
|
|
#include <fast_lock.h>
|
|
#include <cadef.h>
|
|
#include <caerr.h>
|
|
#include <caeventmask.h>
|
|
#include <calink.h>
|
|
#include <task_params.h>
|
|
#include <freeList.h>
|
|
#include <caMonitor.h>
|
|
|
|
#define QUEUE_SIZE 256
|
|
LOCAL int taskid=0;
|
|
LOCAL ELLLIST capvtList;
|
|
LOCAL RING_ID ringQ;;
|
|
LOCAL FAST_LOCK lock;
|
|
LOCAL void *freeListPvt;
|
|
|
|
typedef enum {cmdNone,cmdAdd,cmdRemove} COMMAND;
|
|
|
|
typedef struct {
|
|
ELLNODE node;
|
|
CAMONITOR *pcamonitor;
|
|
chid chid;
|
|
evid evid;
|
|
COMMAND cmd;
|
|
struct dbr_sts_double rtndata; /*Not currently used */
|
|
} CAPVT;
|
|
|
|
void caMonitorTask(void);
|
|
|
|
LOCAL void eventCallback(struct event_handler_args eha)
|
|
{
|
|
struct dbr_sts_double *pdata = eha.dbr;
|
|
CAPVT *pcapvt;
|
|
CAMONITOR *pcamonitor;
|
|
|
|
pcapvt = (CAPVT *)eha.usr;
|
|
pcamonitor = pcapvt->pcamonitor;
|
|
(pcamonitor->callback)(pcamonitor);
|
|
}
|
|
|
|
LOCAL void caMonitorStart(void)
|
|
{
|
|
FASTLOCKINIT(&lock);
|
|
freeListInitPvt(&freeListPvt,sizeof(CAPVT),1);
|
|
if((ringQ = rngCreate(sizeof(void *) * QUEUE_SIZE)) == NULL) {
|
|
errMessage(0,"caMonitorStart failed");
|
|
exit(1);
|
|
}
|
|
ellInit(&capvtList);
|
|
taskid = taskSpawn("caMonitorTask",CA_CLIENT_PRI-1,VX_FP_TASK,
|
|
CA_CLIENT_STACK,(FUNCPTR)caMonitorTask,0,0,0,0,0,0,0,0,0,0);
|
|
if(taskid==ERROR) {
|
|
errMessage(0,"caMonitorStart: taskSpawn Failure\n");
|
|
}
|
|
}
|
|
|
|
long caMonitorAdd(CAMONITOR *pcamonitor)
|
|
{
|
|
CAPVT *pcapvt;
|
|
|
|
if(!taskid) caMonitorStart();
|
|
FASTLOCK(&lock);
|
|
pcapvt = freeListCalloc(freeListPvt);
|
|
pcamonitor->caMonitorPvt = pcapvt;
|
|
pcapvt->pcamonitor = pcamonitor;
|
|
pcapvt->cmd = cmdAdd;
|
|
if(rngBufPut(ringQ,(void *)&pcapvt,sizeof(pcapvt))
|
|
!=sizeof(pcamonitor)) errMessage(0,"caMonitorAdd: rngBufPut error");
|
|
ellAdd(&capvtList,(void *)pcapvt);
|
|
FASTUNLOCK(&lock);
|
|
}
|
|
|
|
long caMonitorDelete(CAMONITOR *pcamonitor)
|
|
{
|
|
CAPVT *pcapvt = pcamonitor->caMonitorPvt;
|
|
|
|
FASTLOCK(&lock);
|
|
pcapvt->cmd = cmdRemove;
|
|
if(rngBufPut(ringQ,(void *)&pcapvt,sizeof(pcapvt))
|
|
!=sizeof(pcamonitor)) errMessage(0,"caMonitorDelete: rngBufPut error");
|
|
FASTUNLOCK(&lock);
|
|
}
|
|
|
|
/*LOCAL */
|
|
void caMonitorTask(void)
|
|
{
|
|
CAPVT *pcapvt;
|
|
CAMONITOR *pcamonitor;
|
|
int status;
|
|
|
|
taskwdInsert(taskIdSelf(),NULL,NULL);
|
|
SEVCHK(ca_task_initialize(),"ca_task_initialize");
|
|
while(TRUE) {
|
|
while (rngNBytes(ringQ)>=sizeof(pcapvt)){
|
|
if(rngBufGet(ringQ,(void *)&pcapvt,sizeof(pcapvt))
|
|
!=sizeof(pcapvt)) {
|
|
errMessage(0,"caMonitorTask: rngBufGet error");
|
|
continue;
|
|
}
|
|
FASTLOCK(&lock);
|
|
pcamonitor = pcapvt->pcamonitor;
|
|
if(pcapvt->cmd==cmdAdd) {
|
|
SEVCHK(ca_build_and_connect(pcamonitor->channame,TYPENOTCONN,0,
|
|
&pcapvt->chid,0,NULL,pcapvt),
|
|
"ca_build_and_connect");
|
|
SEVCHK(ca_add_event(DBR_STS_DOUBLE,pcapvt->chid,
|
|
eventCallback,pcapvt,&pcapvt->evid),
|
|
"ca_add_event");
|
|
} else {/*must be cmdRemove*/
|
|
SEVCHK(ca_clear_channel(pcapvt->chid),"ca_clear_channel");
|
|
pcapvt->cmd=cmdNone;
|
|
ellDelete(&capvtList,(void *)pcapvt);
|
|
freeListFree(freeListPvt,pcapvt);
|
|
}
|
|
pcapvt->cmd=cmdNone;
|
|
FASTUNLOCK(&lock);
|
|
}
|
|
status = ca_pend_event(.1);
|
|
if(status!=ECA_NORMAL && status!=ECA_TIMEOUT)
|
|
SEVCHK(status,"ca_pend_event");
|
|
}
|
|
}
|
|
|
|
static void myCallback(struct caMonitor *pcamonitor)
|
|
{
|
|
printf("myCallback: %s\n",pcamonitor->channame);
|
|
}
|
|
|
|
int testCaMonitor(char *name)
|
|
{
|
|
CAMONITOR *pcamonitor;
|
|
long status;
|
|
|
|
pcamonitor = calloc(1,sizeof(CAMONITOR));
|
|
pcamonitor->channame = calloc(1,strlen(name)+1);
|
|
pcamonitor->callback = myCallback;
|
|
strcpy(pcamonitor->channame,name);
|
|
status = caMonitorAdd(pcamonitor);
|
|
if(status) errMessage(status,"testCaMonitor error");
|
|
return(0);
|
|
}
|