597 lines
17 KiB
C
597 lines
17 KiB
C
/* recAo.c */
|
||
/* base/src/rec $Id$ */
|
||
|
||
/* recAo.c - Record Support Routines for Analog Output records */
|
||
/*
|
||
* Original Author: Bob Dalesio
|
||
* Current Author: Marty Kraimer
|
||
* Date: 7-14-89
|
||
*
|
||
* Experimental Physics and Industrial Control System (EPICS)
|
||
*
|
||
* Copyright 1991, the Regents of the University of California,
|
||
* and the University of Chicago Board of Governors.
|
||
*
|
||
* This software was produced under U.S. Government contracts:
|
||
* (W-7405-ENG-36) at the Los Alamos National Laboratory,
|
||
* and (W-31-109-ENG-38) at Argonne National Laboratory.
|
||
*
|
||
* Initial development by:
|
||
* The Controls and Automation Group (AT-8)
|
||
* Ground Test Accelerator
|
||
* Accelerator Technology Division
|
||
* Los Alamos National Laboratory
|
||
*
|
||
* Co-developed with
|
||
* The Controls and Computing Group
|
||
* Accelerator Systems Division
|
||
* Advanced Photon Source
|
||
* Argonne National Laboratory
|
||
*
|
||
* Modification Log:
|
||
* -----------------
|
||
* .01 09-26-88 lrd interface the Ziomek085 card
|
||
* .02 12-12-88 lrd lock record on entry unlock on exit
|
||
* .03 12-15-88 lrd Process the forward scan link
|
||
* .04 12-23-88 lrd Alarm on locked MAX_LOCKED times
|
||
* .05 01-13-89 lrd deleted db_write_ao
|
||
* .06 01-20-89 lrd fixed vx includes
|
||
* .07 03-03-89 lrd mods for closed loop/supervisory control
|
||
* .08 03-17-89 lrd add read_ao routine and call at initialization
|
||
* .09 03-23-89 lrd convert AB readbacks
|
||
* .10 03-29-89 lrd make hardware errors MAJOR
|
||
* remove hw severity spec from database
|
||
* .11 04-06-89 lrd remove signal conversions
|
||
* .12 05-03-89 lrd removed process mask from arg list
|
||
* .13 05-08-89 lrd fixed init to unlock on return condition
|
||
* .14 05-25-89 lrd added rate of change add incremental/absolute
|
||
* .15 01-31-90 lrd add plc_flag to ab_aodriver
|
||
* .16 03-21-90 lrd add db_post_events for RVAL and RBV
|
||
* .17 04-11-90 lrd make locals static
|
||
* .18 07-27-90 lrd implement the output to a database record
|
||
* .19 10-10-90 mrk extensible record and device support
|
||
* .20 09-25-91 jba added breakpoint table conversion
|
||
* .21 11-11-91 jba Moved set and reset of alarm stat and sevr to macros
|
||
* .22 02-05-92 jba Changed function arguments from paddr to precord
|
||
* .23 02-28-92 jba Changed get_precision,get_graphic_double,get_control_double
|
||
* .24 02-28-92 jba ANSI C changes
|
||
* .25 04-10-92 jba pact now used to test for asyn processing, not status
|
||
* .26 04-18-92 jba removed process from dev init_record parms
|
||
* .27 06-02-92 jba changed graphic/control limits for hihi,high,low,lolo
|
||
* .28 07-15-92 jba changed VALID_ALARM to INVALID alarm
|
||
* .29 07-16-92 jba added invalid alrm fwd lnk test & chngd fwd lnk to macro
|
||
* .30 07-21-92 jba changed alarm limits for non val related fields
|
||
* .31 08-06-92 jba New algorithm for calculating analog alarms
|
||
* .32 08-19-92 jba Added simulation processing
|
||
* .33 08-19-92 jba Added code for invalid alarm output action
|
||
* .34 10-15-93 jba modified oroc test to work on the mv162
|
||
* .35 03-03-94 mrk Added aslo and aoff
|
||
* .36 03-29-94 mcn Fast links. Moved omsl and dol.type check
|
||
* out of fetch_value.
|
||
*/
|
||
|
||
#include <vxWorks.h>
|
||
#include <types.h>
|
||
#include <stdioLib.h>
|
||
#include <lstLib.h>
|
||
#include <string.h>
|
||
|
||
#include <alarm.h>
|
||
#include <cvtTable.h>
|
||
#include <dbDefs.h>
|
||
#include <dbAccess.h>
|
||
#include <dbFldTypes.h>
|
||
#include <devSup.h>
|
||
#include <errMdef.h>
|
||
#include <special.h>
|
||
#include <recSup.h>
|
||
#define GEN_SIZE_OFFSET
|
||
#include <aoRecord.h>
|
||
#undef GEN_SIZE_OFFSET
|
||
#include <menuIvoa.h>
|
||
|
||
/* Create RSET - Record Support Entry Table*/
|
||
#define report NULL
|
||
#define initialize NULL
|
||
static long init_record();
|
||
static long process();
|
||
static long special();
|
||
static long get_value();
|
||
#define cvt_dbaddr NULL
|
||
#define get_array_info NULL
|
||
#define put_array_info NULL
|
||
static long get_units();
|
||
static long get_precision();
|
||
#define get_enum_str NULL
|
||
#define get_enum_strs NULL
|
||
#define put_enum_str NULL
|
||
static long get_graphic_double();
|
||
static long get_control_double();
|
||
static long get_alarm_double();
|
||
|
||
struct rset aoRSET={
|
||
RSETNUMBER,
|
||
report,
|
||
initialize,
|
||
init_record,
|
||
process,
|
||
special,
|
||
get_value,
|
||
cvt_dbaddr,
|
||
get_array_info,
|
||
put_array_info,
|
||
get_units,
|
||
get_precision,
|
||
get_enum_str,
|
||
get_enum_strs,
|
||
put_enum_str,
|
||
get_graphic_double,
|
||
get_control_double,
|
||
get_alarm_double };
|
||
|
||
struct aodset { /* analog input dset */
|
||
long number;
|
||
DEVSUPFUN dev_report;
|
||
DEVSUPFUN init;
|
||
DEVSUPFUN init_record; /*returns: (0,2)=>(success,success no convert)*/
|
||
DEVSUPFUN get_ioint_info;
|
||
DEVSUPFUN write_ao;/*(0)=>(success ) */
|
||
DEVSUPFUN special_linconv;
|
||
};
|
||
|
||
|
||
/* the following definitions must match those in choiceRec.ascii */
|
||
#define OUTPUT_FULL 0
|
||
#define OUTPUT_INCREMENTAL 1
|
||
|
||
static void alarm();
|
||
static void fetch_value();
|
||
static void convert();
|
||
static void monitor();
|
||
static long writeValue();
|
||
|
||
static long init_record(pao,pass)
|
||
struct aoRecord *pao;
|
||
int pass;
|
||
{
|
||
struct aodset *pdset;
|
||
long status=0;
|
||
double value;
|
||
|
||
if (pass==0) return(0);
|
||
|
||
/* ao.siml must be a CONSTANT or a PV_LINK or a DB_LINK */
|
||
if (pao->siml.type == CONSTANT) {
|
||
recGblInitConstantLink(&pao->siml,DBF_USHORT,&pao->simm);
|
||
}
|
||
|
||
if(!(pdset = (struct aodset *)(pao->dset))) {
|
||
recGblRecordError(S_dev_noDSET,(void *)pao,"ao: init_record");
|
||
return(S_dev_noDSET);
|
||
}
|
||
/* get the initial value if dol is a constant*/
|
||
if (pao->dol.type == CONSTANT) {
|
||
if(recGblInitConstantLink(&pao->dol,DBF_DOUBLE,&pao->val))
|
||
pao->udf = FALSE;
|
||
}
|
||
|
||
/* must have write_ao function defined */
|
||
if ((pdset->number < 6) || (pdset->write_ao ==NULL)) {
|
||
recGblRecordError(S_dev_missingSup,(void *)pao,"ao: init_record");
|
||
return(S_dev_missingSup);
|
||
}
|
||
pao->init = TRUE;
|
||
|
||
if (pdset->init_record) {
|
||
status=(*pdset->init_record)(pao);
|
||
switch(status){
|
||
case(0): /* convert */
|
||
value = pao->rval + pao->roff;
|
||
if(pao->aslo!=0.0) value *= pao->aslo;
|
||
if(pao->aoff!=0.0) value += pao->aoff;
|
||
if (pao->linr == 0){
|
||
; /*do nothing*/
|
||
}else if (pao->linr == 1){
|
||
value = value*pao->eslo + pao->egul;
|
||
}else{
|
||
if(cvtRawToEngBpt(&value,pao->linr,pao->init,
|
||
(void *)&pao->pbrk,&pao->lbrk)!=0) break;
|
||
}
|
||
pao->val = value;
|
||
pao->udf=FALSE;
|
||
break;
|
||
case(2): /* no convert */
|
||
break;
|
||
default:
|
||
recGblRecordError(S_dev_badInitRet,(void *)pao,"ao: init_record");
|
||
return(S_dev_badInitRet);
|
||
break;
|
||
}
|
||
}
|
||
pao->oval = pao->pval = pao->val;
|
||
return(0);
|
||
}
|
||
|
||
static long process(pao)
|
||
struct aoRecord *pao;
|
||
{
|
||
struct aodset *pdset = (struct aodset *)(pao->dset);
|
||
long status=0;
|
||
unsigned char pact=pao->pact;
|
||
double value;
|
||
|
||
if ((pdset==NULL) || (pdset->write_ao==NULL)) {
|
||
pao->pact=TRUE;
|
||
recGblRecordError(S_dev_missingSup,(void *)pao,"write_ao");
|
||
return(S_dev_missingSup);
|
||
}
|
||
|
||
/* fetch value and convert*/
|
||
if (pao->pact == FALSE) {
|
||
if ((pao->dol.type != CONSTANT) &&
|
||
(pao->omsl == CLOSED_LOOP)) {
|
||
|
||
fetch_value(pao, &value);
|
||
}
|
||
else {
|
||
value = pao->val;
|
||
}
|
||
convert(pao, &value);
|
||
}
|
||
|
||
/* check for alarms */
|
||
alarm(pao);
|
||
|
||
if (pao->nsev < INVALID_ALARM )
|
||
status=writeValue(pao); /* write the new value */
|
||
else {
|
||
switch (pao->ivoa) {
|
||
case (menuIvoaContinue_normally) :
|
||
status=writeValue(pao); /* write the new value */
|
||
break;
|
||
case (menuIvoaDon_t_drive_outputs) :
|
||
break;
|
||
case (menuIvoaSet_output_to_IVOV) :
|
||
if(pao->pact == FALSE){
|
||
pao->val=pao->ivov;
|
||
value=pao->ivov;
|
||
convert(pao,&value);
|
||
}
|
||
status=writeValue(pao); /* write the new value */
|
||
break;
|
||
default :
|
||
status=-1;
|
||
recGblRecordError(S_db_badField,(void *)pao,
|
||
"ao:process Illegal IVOA field");
|
||
}
|
||
}
|
||
|
||
/* check if device support set pact */
|
||
if ( !pact && pao->pact ) return(0);
|
||
pao->pact = TRUE;
|
||
|
||
recGblGetTimeStamp(pao);
|
||
|
||
/* check event list */
|
||
monitor(pao);
|
||
|
||
/* process the forward scan link record */
|
||
recGblFwdLink(pao);
|
||
|
||
pao->init=FALSE;
|
||
pao->pact=FALSE;
|
||
return(status);
|
||
}
|
||
|
||
static long special(paddr,after)
|
||
struct dbAddr *paddr;
|
||
int after;
|
||
{
|
||
struct aoRecord *pao = (struct aoRecord *)(paddr->precord);
|
||
struct aodset *pdset = (struct aodset *) (pao->dset);
|
||
int special_type = paddr->special;
|
||
|
||
switch(special_type) {
|
||
case(SPC_LINCONV):
|
||
if(pdset->number<6 ) {
|
||
recGblDbaddrError(S_db_noMod,paddr,"ao: special");
|
||
return(S_db_noMod);
|
||
}
|
||
pao->init=TRUE;
|
||
if(!(pdset->special_linconv)) return(0);
|
||
return((*pdset->special_linconv)(pao,after));
|
||
default:
|
||
recGblDbaddrError(S_db_badChoice,paddr,"ao: special");
|
||
return(S_db_badChoice);
|
||
}
|
||
}
|
||
|
||
static long get_value(pao,pvdes)
|
||
struct aoRecord *pao;
|
||
struct valueDes *pvdes;
|
||
{
|
||
pvdes->field_type = DBF_DOUBLE;
|
||
pvdes->no_elements=1;
|
||
(double *)(pvdes->pvalue) = &pao->val;
|
||
return(0);
|
||
}
|
||
|
||
static long get_units(paddr,units)
|
||
struct dbAddr *paddr;
|
||
char *units;
|
||
{
|
||
struct aoRecord *pao=(struct aoRecord *)paddr->precord;
|
||
|
||
strncpy(units,pao->egu,DB_UNITS_SIZE);
|
||
return(0);
|
||
}
|
||
|
||
static long get_precision(paddr,precision)
|
||
struct dbAddr *paddr;
|
||
long *precision;
|
||
{
|
||
struct aoRecord *pao=(struct aoRecord *)paddr->precord;
|
||
|
||
*precision = pao->prec;
|
||
if(paddr->pfield == (void *)&pao->val
|
||
|| paddr->pfield == (void *)&pao->oval
|
||
|| paddr->pfield == (void *)&pao->pval) return(0);
|
||
recGblGetPrec(paddr,precision);
|
||
return(0);
|
||
}
|
||
|
||
static long get_graphic_double(paddr,pgd)
|
||
struct dbAddr *paddr;
|
||
struct dbr_grDouble *pgd;
|
||
{
|
||
struct aoRecord *pao=(struct aoRecord *)paddr->precord;
|
||
|
||
if(paddr->pfield==(void *)&pao->val
|
||
|| paddr->pfield==(void *)&pao->hihi
|
||
|| paddr->pfield==(void *)&pao->high
|
||
|| paddr->pfield==(void *)&pao->low
|
||
|| paddr->pfield==(void *)&pao->lolo
|
||
|| paddr->pfield==(void *)&pao->oval
|
||
|| paddr->pfield==(void *)&pao->pval){
|
||
pgd->upper_disp_limit = pao->hopr;
|
||
pgd->lower_disp_limit = pao->lopr;
|
||
} else recGblGetGraphicDouble(paddr,pgd);
|
||
return(0);
|
||
}
|
||
|
||
static long get_control_double(paddr,pcd)
|
||
struct dbAddr *paddr;
|
||
struct dbr_ctrlDouble *pcd;
|
||
{
|
||
struct aoRecord *pao=(struct aoRecord *)paddr->precord;
|
||
|
||
if(paddr->pfield==(void *)&pao->val
|
||
|| paddr->pfield==(void *)&pao->hihi
|
||
|| paddr->pfield==(void *)&pao->high
|
||
|| paddr->pfield==(void *)&pao->low
|
||
|| paddr->pfield==(void *)&pao->lolo
|
||
|| paddr->pfield==(void *)&pao->oval
|
||
|| paddr->pfield==(void *)&pao->pval){
|
||
pcd->upper_ctrl_limit = pao->drvh;
|
||
pcd->lower_ctrl_limit = pao->drvl;
|
||
} else recGblGetControlDouble(paddr,pcd);
|
||
return(0);
|
||
}
|
||
static long get_alarm_double(paddr,pad)
|
||
struct dbAddr *paddr;
|
||
struct dbr_alDouble *pad;
|
||
{
|
||
struct aoRecord *pao=(struct aoRecord *)paddr->precord;
|
||
|
||
if(paddr->pfield==(void *)&pao->val){
|
||
pad->upper_alarm_limit = pao->hihi;
|
||
pad->upper_warning_limit = pao->high;
|
||
pad->lower_warning_limit = pao->low;
|
||
pad->lower_alarm_limit = pao->lolo;
|
||
} else recGblGetAlarmDouble(paddr,pad);
|
||
return(0);
|
||
}
|
||
|
||
static void alarm(pao)
|
||
struct aoRecord *pao;
|
||
{
|
||
double val;
|
||
float hyst, lalm, hihi, high, low, lolo;
|
||
unsigned short hhsv, llsv, hsv, lsv;
|
||
|
||
if(pao->udf == TRUE ){
|
||
recGblSetSevr(pao,UDF_ALARM,INVALID_ALARM);
|
||
return;
|
||
}
|
||
hihi = pao->hihi; lolo = pao->lolo; high = pao->high; low = pao->low;
|
||
hhsv = pao->hhsv; llsv = pao->llsv; hsv = pao->hsv; lsv = pao->lsv;
|
||
val = pao->val; hyst = pao->hyst; lalm = pao->lalm;
|
||
|
||
/* alarm condition hihi */
|
||
if (hhsv && (val >= hihi || ((lalm==hihi) && (val >= hihi-hyst)))){
|
||
if (recGblSetSevr(pao,HIHI_ALARM,pao->hhsv)) pao->lalm = hihi;
|
||
return;
|
||
}
|
||
|
||
/* alarm condition lolo */
|
||
if (llsv && (val <= lolo || ((lalm==lolo) && (val <= lolo+hyst)))){
|
||
if (recGblSetSevr(pao,LOLO_ALARM,pao->llsv)) pao->lalm = lolo;
|
||
return;
|
||
}
|
||
|
||
/* alarm condition high */
|
||
if (hsv && (val >= high || ((lalm==high) && (val >= high-hyst)))){
|
||
if (recGblSetSevr(pao,HIGH_ALARM,pao->hsv)) pao->lalm = high;
|
||
return;
|
||
}
|
||
|
||
/* alarm condition low */
|
||
if (lsv && (val <= low || ((lalm==low) && (val <= low+hyst)))){
|
||
if (recGblSetSevr(pao,LOW_ALARM,pao->lsv)) pao->lalm = low;
|
||
return;
|
||
}
|
||
|
||
/* we get here only if val is out of alarm by at least hyst */
|
||
pao->lalm = val;
|
||
return;
|
||
}
|
||
|
||
static void fetch_value(pao,pvalue)
|
||
struct aoRecord *pao;
|
||
double *pvalue;
|
||
{
|
||
short save_pact;
|
||
long status;
|
||
|
||
save_pact = pao->pact;
|
||
pao->pact = TRUE;
|
||
|
||
/* don't allow dbputs to val field */
|
||
pao->val=pao->pval;
|
||
|
||
status = dbGetLink(&pao->dol,DBR_DOUBLE,pvalue,0,0);
|
||
pao->pact = save_pact;
|
||
|
||
if (status) {
|
||
recGblSetSevr(pao,LINK_ALARM,INVALID_ALARM);
|
||
return;
|
||
}
|
||
|
||
if (pao->oif == OUTPUT_INCREMENTAL)
|
||
*pvalue += pao->val;
|
||
|
||
return;
|
||
}
|
||
|
||
static void convert(pao,pvalue)
|
||
struct aoRecord *pao;
|
||
double *pvalue;
|
||
{
|
||
double value;
|
||
|
||
value=*pvalue;
|
||
/* check drive limits */
|
||
if(pao->drvh > pao->drvl) {
|
||
if (value > pao->drvh) value = pao->drvh;
|
||
else if (value < pao->drvl) value = pao->drvl;
|
||
}
|
||
pao->val = value;
|
||
pao->pval = value;
|
||
pao->udf = FALSE;
|
||
|
||
/* now set value equal to desired output value */
|
||
/* apply the output rate of change */
|
||
if ( (pao->oroc) != 0.0 ){/*must be defined and >0*/
|
||
float diff;
|
||
|
||
diff = value - pao->oval;
|
||
if (diff < 0){
|
||
if (pao->oroc < -diff) value = pao->oval - pao->oroc;
|
||
}else if (pao->oroc < diff) value = pao->oval + pao->oroc;
|
||
}
|
||
if(pao->oval==value) pao->omod = FALSE; else pao->omod = TRUE;
|
||
pao->oval = value;
|
||
|
||
/* convert */
|
||
if (pao->linr == 0) {
|
||
; /* do nothing*/
|
||
} else if (pao->linr == 1){
|
||
if (pao->eslo == 0.0) value = 0;
|
||
else {
|
||
value = (value - pao->egul) / pao->eslo;
|
||
}
|
||
}else{
|
||
if(cvtEngToRawBpt(&value,pao->linr,pao->init,(void *)&pao->pbrk,&pao->lbrk)!=0){
|
||
recGblSetSevr(pao,SOFT_ALARM,INVALID_ALARM);
|
||
return;
|
||
}
|
||
}
|
||
if(pao->aoff!=0.0) value -= pao->aoff;
|
||
if(pao->aslo!=0.0) value /= pao->aslo;
|
||
if (value >= 0.0) pao->rval = value + 0.5;
|
||
else pao->rval = value - 0.5;
|
||
pao->rval -= pao->roff;
|
||
return;
|
||
}
|
||
|
||
|
||
static void monitor(pao)
|
||
struct aoRecord *pao;
|
||
{
|
||
unsigned short monitor_mask;
|
||
double delta;
|
||
|
||
monitor_mask = recGblResetAlarms(pao);
|
||
/* check for value change */
|
||
delta = pao->mlst - pao->val;
|
||
if(delta<0.0) delta = -delta;
|
||
if (delta > pao->mdel) {
|
||
/* post events for value change */
|
||
monitor_mask |= DBE_VALUE;
|
||
/* update last value monitored */
|
||
pao->mlst = pao->val;
|
||
}
|
||
/* check for archive change */
|
||
delta = pao->alst - pao->val;
|
||
if(delta<0.0) delta = -delta;
|
||
if (delta > pao->adel) {
|
||
/* post events on value field for archive change */
|
||
monitor_mask |= DBE_LOG;
|
||
/* update last archive value monitored */
|
||
pao->alst = pao->val;
|
||
}
|
||
|
||
|
||
/* send out monitors connected to the value field */
|
||
if (monitor_mask){
|
||
db_post_events(pao,&pao->val,monitor_mask);
|
||
}
|
||
if(pao->omod) monitor_mask |= (DBE_VALUE|DBE_LOG);
|
||
if(monitor_mask) {
|
||
pao->omod = FALSE;
|
||
db_post_events(pao,&pao->oval,monitor_mask);
|
||
if(pao->oraw != pao->rval) {
|
||
db_post_events(pao,&pao->rval,
|
||
monitor_mask|DBE_VALUE|DBE_LOG);
|
||
pao->oraw = pao->rval;
|
||
}
|
||
if(pao->orbv != pao->rbv) {
|
||
db_post_events(pao,&pao->rbv,
|
||
monitor_mask|DBE_VALUE|DBE_LOG);
|
||
pao->orbv = pao->rbv;
|
||
}
|
||
}
|
||
return;
|
||
}
|
||
|
||
static long writeValue(pao)
|
||
struct aoRecord *pao;
|
||
{
|
||
long status;
|
||
struct aodset *pdset = (struct aodset *) (pao->dset);
|
||
|
||
if (pao->pact == TRUE){
|
||
status=(*pdset->write_ao)(pao);
|
||
return(status);
|
||
}
|
||
|
||
status = dbGetLink(&pao->siml,DBR_USHORT,&(pao->simm),0,0);
|
||
if (status)
|
||
return(status);
|
||
|
||
if (pao->simm == NO){
|
||
status=(*pdset->write_ao)(pao);
|
||
return(status);
|
||
}
|
||
if (pao->simm == YES){
|
||
status = dbPutLink(&(pao->siol),DBR_DOUBLE,&(pao->oval),1);
|
||
} else {
|
||
status=-1;
|
||
recGblSetSevr(pao,SOFT_ALARM,INVALID_ALARM);
|
||
return(status);
|
||
}
|
||
recGblSetSevr(pao,SIMM_ALARM,pao->sims);
|
||
|
||
return(status);
|
||
}
|