148 lines
4.4 KiB
C
148 lines
4.4 KiB
C
/*---------------------------------------------------------------------------
|
|
euro2kdriv.c
|
|
|
|
Driver for the EuroTherm 2000 controllers (ModBus protocoll)
|
|
|
|
Markus Zolliker, August 2005
|
|
----------------------------------------------------------------------------*/
|
|
#include <string.h>
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <assert.h>
|
|
#include <sys/time.h>
|
|
#include <math.h>
|
|
#include <tcl.h>
|
|
#include <fortify.h>
|
|
#include <sics.h>
|
|
#include <splitter.h>
|
|
#include <obpar.h>
|
|
#include <devexec.h>
|
|
#include <nserver.h>
|
|
#include <interrupt.h>
|
|
#include <emon.h>
|
|
#include <evcontroller.h>
|
|
#include <evcontroller.i>
|
|
#include <servlog.h>
|
|
#include <sicsvar.h>
|
|
#include <evdriver.i>
|
|
#include <rs232controller.h>
|
|
#include "modbus.h"
|
|
#include "fsm.h"
|
|
#include "initializer.h"
|
|
|
|
typedef struct {
|
|
EaseDriv d;
|
|
float temperature;
|
|
float output;
|
|
float setpoint;
|
|
int adr;
|
|
float par;
|
|
} Euro2k;
|
|
|
|
static ParClass euro2kClass = { "EURO2K", sizeof(Euro2k) };
|
|
|
|
/*----------------------------------------------------------------------------*/
|
|
void Euro2kParDef(void *object) {
|
|
Euro2k *drv = ParCast(&euro2kClass, object);
|
|
|
|
ParName(""); ParTail("C");
|
|
ParFloat(&drv->temperature, PAR_NAN);
|
|
|
|
ParName("output"); ParTail("%");
|
|
ParFloat(&drv->output, PAR_NAN);
|
|
|
|
ParName("setpoint"); ParTail("C");
|
|
ParFloat(&drv->setpoint, PAR_NAN);
|
|
|
|
ParName("adr"); ParAccess(usUser); ParList(NULL);
|
|
ParInt(&drv->adr, 0);
|
|
|
|
if (drv->adr > 0) {
|
|
ParName("par"); ParList(NULL);
|
|
ParFloat(&drv->par, PAR_NAN);
|
|
}
|
|
|
|
EaseBasePar(drv);
|
|
EaseDrivPar(drv, "%#.5g", "C");
|
|
ParStdDef();
|
|
EaseMsgPar(drv);
|
|
}
|
|
/*----------------------------------------------------------------------------*/
|
|
static long Euro2kRead(long pc, void *object) {
|
|
Euro2k *drv = ParCast(&euro2kClass, object);
|
|
EaseBase *eab = object;
|
|
char *p;
|
|
int l;
|
|
char buf[4];
|
|
|
|
switch (pc) { default: /* FSM BEGIN *******************************/
|
|
ModBusRequestFloats(eab, 1, 3);
|
|
return __LINE__; case __LINE__: /**********************************/
|
|
drv->temperature = ModBusGetFloat(eab, 1);
|
|
drv->setpoint = ModBusGetFloat(eab, 2);
|
|
drv->output = ModBusGetFloat(eab, 3);
|
|
|
|
if (drv->adr == 0) goto noPar;
|
|
ModBusRequestFloats(eab, drv->adr, 3);
|
|
return __LINE__; case __LINE__: /**********************************/
|
|
drv->par = ModBusGetFloat(eab, drv->adr);
|
|
noPar:
|
|
|
|
ParLog(drv);
|
|
fsm_quit: return 0; } /* FSM END *********************************/
|
|
}
|
|
/*----------------------------------------------------------------------------*/
|
|
static long Euro2kSet(long pc, void *object) {
|
|
Euro2k *drv = ParCast(&euro2kClass, object);
|
|
EaseBase *eab = object;
|
|
char *p;
|
|
int l;
|
|
char buf[4];
|
|
|
|
switch (pc) { default: /* FSM BEGIN *******************************/
|
|
ModBusPutFloats(eab, 2, 1, &drv->d.targetValue);
|
|
return __LINE__; case __LINE__: /**********************************/
|
|
|
|
fsm_quit: return 0; } /* FSM END *********************************/
|
|
}
|
|
/*----------------------------------------------------------------------------*/
|
|
static long Euro2kStart(long pc, void *object) {
|
|
Euro2k *drv = ParCast(&euro2kClass, object);
|
|
EaseBase *eab = object;
|
|
|
|
switch (pc) { default: /* FSM BEGIN *******************************/
|
|
ModBusRequestFloats(eab, 1, 1);
|
|
return __LINE__; case __LINE__: /**********************************/
|
|
if (0 == ModBusGetFloat(eab, 1)) {
|
|
ParPrintf(drv, eError, "bad or no response on ModBus");
|
|
goto quit;
|
|
}
|
|
ParPrintf(drv, eStatus, "connected to euro2k");
|
|
FsmCall(Euro2kRead);
|
|
return __LINE__; case __LINE__: /**********************************/
|
|
|
|
quit:
|
|
return 0; } /* FSM END ********************************************/
|
|
}
|
|
/*----------------------------------------------------------------------------*/
|
|
static int Euro2kInit(SConnection *con, int argc, char *argv[], int dynamic) {
|
|
/* args:
|
|
MakeObject objectname euro2k <rs232>
|
|
<host> <port>
|
|
*/
|
|
Euro2k *drv;
|
|
|
|
drv = EaseMakeDriv(con, &euro2kClass, argc, argv, dynamic, 7,
|
|
Euro2kParDef, ModBusHandler, Euro2kStart, NULL, Euro2kRead,
|
|
Euro2kSet);
|
|
if (drv == NULL) return 0;
|
|
setRS232ReplyTerminator(drv->d.b.ser,"");
|
|
setRS232SendTerminator(drv->d.b.ser,"");
|
|
return 1;
|
|
}
|
|
/*----------------------------------------------------------------------------*/
|
|
void Euro2kStartup(void) {
|
|
ParMakeClass(&euro2kClass, EaseDrivClass());
|
|
MakeDriver("EURO2K", Euro2kInit, 0);
|
|
}
|