- modified and improved various env. drivers
- implemented string array object
This commit is contained in:
zolliker
282
euro2kdriv.c
282
euro2kdriv.c
@ -1,7 +1,7 @@
|
||||
/*---------------------------------------------------------------------------
|
||||
euro2kdriv.c
|
||||
|
||||
Driver for the EuroTherm 2000 controllers (ModBus protocoll)
|
||||
Driver for the EuroTherm 2000 controllers (ModBus protocol)
|
||||
|
||||
Markus Zolliker, August 2005
|
||||
----------------------------------------------------------------------------*/
|
||||
@ -30,64 +30,273 @@ Markus Zolliker, August 2005
|
||||
#include "fsm.h"
|
||||
#include "initializer.h"
|
||||
|
||||
#define EURO2K_SET 1
|
||||
#define EURO2K_MODE 2
|
||||
|
||||
typedef enum {read_only, settable, to_set} Euro2kAccess;
|
||||
|
||||
typedef struct Euro2kPar {
|
||||
struct Euro2kPar *next;
|
||||
char *name;
|
||||
char *unit;
|
||||
char *fmt;
|
||||
int adr;
|
||||
ModBusType type; /* 0: float, 1: int, 2: time */
|
||||
Euro2kAccess set; /* 0: read-only; 1: settable; 2: to be set */
|
||||
float par;
|
||||
} Euro2kPar;
|
||||
|
||||
typedef struct {
|
||||
EaseDriv d;
|
||||
char *unit;
|
||||
int mode, manual;
|
||||
char *script;
|
||||
int warned;
|
||||
float temperature;
|
||||
float output;
|
||||
float setpoint;
|
||||
int adr;
|
||||
float par;
|
||||
Euro2kPar *pars, *readPar;
|
||||
} Euro2k;
|
||||
|
||||
static ParClass euro2kClass = { "EURO2K", sizeof(Euro2k) };
|
||||
|
||||
/*----------------------------------------------------------------------------*/
|
||||
static int Euro2kMakePar(void *object, void *userarg, int argc, char *argv[])
|
||||
{
|
||||
Euro2k *drv = ParCast(&euro2kClass, object);
|
||||
Euro2kPar *par, **last;
|
||||
int iarg;
|
||||
|
||||
assert(drv);
|
||||
if (argc < 1) goto Usage;
|
||||
last = &drv->pars;
|
||||
for (par = drv->pars; par != NULL; par = par->next) {
|
||||
if (strcasecmp(argv[0], par->name) == 0) {
|
||||
break;
|
||||
}
|
||||
last = &par->next;
|
||||
}
|
||||
if (par == NULL) {
|
||||
par = calloc(1, sizeof(Euro2kPar));
|
||||
if (par == NULL) return 0;
|
||||
*last = par;
|
||||
par->unit = NULL;
|
||||
par->fmt = NULL;
|
||||
} else {
|
||||
if (par->unit) {
|
||||
free(par->unit); par->unit=NULL;
|
||||
}
|
||||
if (par->fmt) {
|
||||
free(par->fmt); par->fmt=NULL;
|
||||
}
|
||||
}
|
||||
par->name = strdup(argv[0]);
|
||||
iarg = 1;
|
||||
if (strcasecmp(argv[iarg],"w") == 0) { /* writeable */
|
||||
par->set = settable;
|
||||
iarg++;
|
||||
} else {
|
||||
par->set = read_only;
|
||||
}
|
||||
par->type = modBusFloat;
|
||||
if (iarg>=argc) goto Usage;
|
||||
if (strcasecmp(argv[iarg],"int") == 0) {
|
||||
par->type = modBusInt; iarg++;
|
||||
par->fmt = "%.0f";
|
||||
} else if (strcasecmp(argv[iarg],"time") == 0) {
|
||||
par->type = modBusTime; iarg++;
|
||||
par->unit = "sec";
|
||||
par->fmt = "%.4g";
|
||||
} else {
|
||||
par->type = modBusFloat;
|
||||
}
|
||||
if (iarg >= argc) goto Usage;
|
||||
par->adr = atoi(argv[iarg]);
|
||||
iarg++;
|
||||
if (iarg < argc) {
|
||||
if (argv[iarg] && argv[iarg][0]) {
|
||||
par->unit = argv[iarg];
|
||||
}
|
||||
iarg++;
|
||||
if (iarg < argc) {
|
||||
if (argv[iarg] && argv[iarg][0]) {
|
||||
par->fmt = argv[iarg];
|
||||
}
|
||||
iarg++;
|
||||
if (iarg < argc) goto Usage;
|
||||
}
|
||||
}
|
||||
if (par->unit) par->unit = strdup(par->unit);
|
||||
if (par->fmt) par->fmt = strdup(par->fmt);
|
||||
ParInitPar(object, par->name);
|
||||
EaseParHasChanged();
|
||||
return 1;
|
||||
Usage:
|
||||
ParPrintf(object, eError, "Usage: %s makepar <name> [w] [int|time] adr [unit] [fmt]"
|
||||
, drv->d.b.p.name);
|
||||
return 0;
|
||||
}
|
||||
/*----------------------------------------------------------------------------*/
|
||||
void Euro2kParDef(void *object) {
|
||||
Euro2k *drv = ParCast(&euro2kClass, object);
|
||||
ParData *obj = object;
|
||||
Euro2kPar *par, *next;
|
||||
FILE *saveFile;
|
||||
char *w, *t, *u, *f;
|
||||
|
||||
ParName(""); ParTail("C");
|
||||
static char *modeList[]={"auto", "manual", NULL };
|
||||
|
||||
ParName(""); ParTail(drv->unit);
|
||||
ParFloat(&drv->temperature, PAR_NAN);
|
||||
|
||||
ParName("unit"); ParAccess(usUser); ParLogAs(NULL);
|
||||
ParStr(&drv->unit, "C");
|
||||
|
||||
ParName("mode"); ParEnum(modeList); ParList(0); EaseUpdate(EURO2K_MODE);
|
||||
ParInt(&drv->mode, 1);
|
||||
|
||||
ParName("manual"); ParEnum(modeList);
|
||||
ParInt(&drv->manual, 1);
|
||||
|
||||
ParName("output"); ParTail("%");
|
||||
ParFloat(&drv->output, PAR_NAN);
|
||||
|
||||
ParName("setpoint"); ParTail("C");
|
||||
ParName("set"); ParTail(drv->unit); EaseUpdate(EURO2K_SET);
|
||||
ParFloat(&drv->setpoint, PAR_NAN);
|
||||
|
||||
ParName("adr"); ParAccess(usUser); ParList(NULL);
|
||||
ParInt(&drv->adr, 0);
|
||||
ParName("task"); ParAccess(usUser); ParList(NULL); ParSave(1);
|
||||
ParStr(&drv->script, "0");
|
||||
|
||||
if (drv->adr > 0) {
|
||||
ParName("par"); ParList(NULL);
|
||||
ParFloat(&drv->par, PAR_NAN);
|
||||
saveFile = ParSaveFile();
|
||||
for (par = drv->pars; par != NULL; par = par->next) {
|
||||
if (par->adr > 0) {
|
||||
if (saveFile) {
|
||||
if (par->set) {
|
||||
w="w ";
|
||||
} else {
|
||||
w="";
|
||||
}
|
||||
if (par->type == modBusInt) {
|
||||
t = "int ";
|
||||
} else if (par->type == modBusTime) {
|
||||
t = "time ";
|
||||
} else {
|
||||
t = "";
|
||||
}
|
||||
if (par->unit) {
|
||||
u = par->unit;
|
||||
} else {
|
||||
u = "";
|
||||
}
|
||||
if (par->fmt) {
|
||||
f = par->fmt;
|
||||
} else {
|
||||
f = "";
|
||||
}
|
||||
fprintf(saveFile, " %s makepar %s %s%s%d \"%s\" \"%s\"\n", obj->name, par->name,
|
||||
w, t, par->adr, u, f);
|
||||
}
|
||||
ParName(par->name);
|
||||
if (par->unit) {
|
||||
ParTail(par->unit);
|
||||
} else {
|
||||
ParList(NULL);
|
||||
}
|
||||
if (par->fmt) {
|
||||
ParFmt(par->fmt);
|
||||
}
|
||||
if (par->set >= settable) {
|
||||
if (EaseUpdate(EURO2K_SET)) {
|
||||
par->set = to_set;
|
||||
}
|
||||
}
|
||||
ParFloat(&par->par, PAR_NAN);
|
||||
}
|
||||
}
|
||||
|
||||
ParName("makepar"); ParAccess(usUser); ParCmd(Euro2kMakePar, NULL);
|
||||
|
||||
EaseBasePar(drv);
|
||||
EaseDrivPar(drv, "%#.5g", "C");
|
||||
EaseDrivPar(drv, "%#.5g", drv->unit);
|
||||
ParStdDef();
|
||||
EaseMsgPar(drv);
|
||||
if (ParActionIs(PAR_KILL)) {
|
||||
next = drv->pars;
|
||||
for (par = next; par != NULL; par = next) {
|
||||
next= par->next;
|
||||
if (par->name) {
|
||||
free(par->name);
|
||||
par->name = NULL;
|
||||
}
|
||||
if (par->unit) {
|
||||
free(par->unit);
|
||||
par->unit = NULL;
|
||||
}
|
||||
if (par->fmt) {
|
||||
free(par->fmt);
|
||||
par->fmt = NULL;
|
||||
}
|
||||
free(par);
|
||||
}
|
||||
drv->pars = NULL;
|
||||
}
|
||||
}
|
||||
/*----------------------------------------------------------------------------*/
|
||||
static long Euro2kRead(long pc, void *object) {
|
||||
Euro2k *drv = ParCast(&euro2kClass, object);
|
||||
EaseBase *eab = object;
|
||||
Euro2kPar *par;
|
||||
Tcl_Interp *pTcl = NULL;
|
||||
char *p;
|
||||
int l;
|
||||
int l, m, iRet;
|
||||
float dif;
|
||||
char buf[4];
|
||||
|
||||
switch (pc) { default: /* FSM BEGIN *******************************/
|
||||
if (drv->script && drv->script[0] != '\0' && 0 != strcmp(drv->script, "0")) {
|
||||
pTcl = InterpGetTcl(pServ->pSics);
|
||||
iRet = Tcl_Eval(pTcl,drv->script);
|
||||
if (iRet == TCL_OK) {
|
||||
if (drv->warned > 0) drv->warned--;
|
||||
} else if (drv->warned<3) {
|
||||
drv->warned++;
|
||||
ParPrintf(drv, eError, "ERROR: %s in %s.task '%s'", pTcl->result, eab->p.name, drv->script);
|
||||
}
|
||||
}
|
||||
ModBusRequestValue(eab, 273); /* get manual or auto */
|
||||
return __LINE__; case __LINE__: /**********************************/
|
||||
m = ModBusGetValue(eab, modBusInt);
|
||||
if (m != drv->manual) { /* mode changed manually */
|
||||
drv->mode = m;
|
||||
}
|
||||
drv->manual= m;
|
||||
ModBusRequestFloats(eab, 1, 3);
|
||||
return __LINE__; case __LINE__: /**********************************/
|
||||
drv->temperature = ModBusGetFloat(eab, 1);
|
||||
drv->setpoint = ModBusGetFloat(eab, 2);
|
||||
if (!EaseGetUpdate(drv, EURO2K_SET)) {
|
||||
drv->setpoint = ModBusGetFloat(eab, 2);
|
||||
}
|
||||
drv->output = ModBusGetFloat(eab, 3);
|
||||
|
||||
if (drv->adr == 0) goto noPar;
|
||||
ModBusRequestFloats(eab, drv->adr, 3);
|
||||
par = drv->pars;
|
||||
loop:
|
||||
if (par == NULL) goto finish;
|
||||
if (par->adr == 0 || par->set == to_set) goto skipPar;
|
||||
ModBusRequestValue(eab, par->adr);
|
||||
drv->readPar = par;
|
||||
return __LINE__; case __LINE__: /**********************************/
|
||||
drv->par = ModBusGetFloat(eab, drv->adr);
|
||||
noPar:
|
||||
|
||||
par = drv->readPar;
|
||||
if (par->set != to_set) {
|
||||
par->par = ModBusGetValue(eab, par->type);
|
||||
}
|
||||
skipPar:
|
||||
par = par->next;
|
||||
goto loop;
|
||||
|
||||
finish:
|
||||
if (eab->p.verbose >= 3) {
|
||||
eab->p.verbose--;
|
||||
if (eab->p.verbose < 3) eab->p.verbose=0;
|
||||
}
|
||||
ParLog(drv);
|
||||
fsm_quit: return 0; } /* FSM END *********************************/
|
||||
}
|
||||
@ -95,13 +304,40 @@ static long Euro2kRead(long pc, void *object) {
|
||||
static long Euro2kSet(long pc, void *object) {
|
||||
Euro2k *drv = ParCast(&euro2kClass, object);
|
||||
EaseBase *eab = object;
|
||||
Euro2kPar *par;
|
||||
char *p;
|
||||
int l;
|
||||
int upd;
|
||||
char buf[4];
|
||||
|
||||
switch (pc) { default: /* FSM BEGIN *******************************/
|
||||
ModBusPutFloats(eab, 2, 1, &drv->d.targetValue);
|
||||
loop:
|
||||
upd = EaseNextUpdate(drv);
|
||||
if (upd == EASE_RUN) {
|
||||
drv->setpoint = drv->d.targetValue;
|
||||
goto run;
|
||||
}
|
||||
if (upd == EURO2K_MODE) goto mode;
|
||||
if (upd == EURO2K_SET) goto run;
|
||||
for (par = drv->pars; par != NULL; par = par->next) {
|
||||
if (par->set == to_set) {
|
||||
ModBusPutValue(eab, par->adr, par->type, par->par);
|
||||
par->set = settable;
|
||||
goto setIt;
|
||||
}
|
||||
}
|
||||
goto fsm_quit;
|
||||
run:
|
||||
ModBusPutFloats(eab, 2, 1, &drv->setpoint);
|
||||
return __LINE__; case __LINE__: /**********************************/
|
||||
if (drv->mode == 0) goto loop;
|
||||
drv->mode = 0;
|
||||
mode:
|
||||
drv->manual = drv->mode;
|
||||
ModBusPutValue(eab, 273, 1, drv->manual); /* set manual to 0 */
|
||||
setIt:
|
||||
return __LINE__; case __LINE__: /**********************************/
|
||||
goto loop;
|
||||
|
||||
fsm_quit: return 0; } /* FSM END *********************************/
|
||||
}
|
||||
@ -111,9 +347,9 @@ static long Euro2kStart(long pc, void *object) {
|
||||
EaseBase *eab = object;
|
||||
|
||||
switch (pc) { default: /* FSM BEGIN *******************************/
|
||||
ModBusRequestFloats(eab, 1, 1);
|
||||
ModBusRequestValue(eab, 1);
|
||||
return __LINE__; case __LINE__: /**********************************/
|
||||
if (0 == ModBusGetFloat(eab, 1)) {
|
||||
if (0 == ModBusGetValue(eab, modBusFloat)) {
|
||||
ParPrintf(drv, eError, "bad or no response on ModBus");
|
||||
goto quit;
|
||||
}
|
||||
@ -136,8 +372,10 @@ static int Euro2kInit(SConnection *con, int argc, char *argv[], int dynamic) {
|
||||
Euro2kParDef, ModBusHandler, Euro2kStart, NULL, Euro2kRead,
|
||||
Euro2kSet);
|
||||
if (drv == NULL) return 0;
|
||||
drv->pars = NULL;
|
||||
setRS232ReplyTerminator(drv->d.b.ser,"");
|
||||
setRS232SendTerminator(drv->d.b.ser,"");
|
||||
ParPrintf(drv, eValue, "Eurotherm 2xxx");
|
||||
return 1;
|
||||
}
|
||||
/*----------------------------------------------------------------------------*/
|
||||
|
||||
Reference in New Issue
Block a user