146 lines
3.7 KiB
C
146 lines
3.7 KiB
C
/*---------------------------------------------------------------------------
|
|
ilmdriv.c
|
|
|
|
Driver for the Oxford Instruments ILM503/ILM4 temperature controller
|
|
and for the Oxford lambda controller
|
|
|
|
Markus Zolliker, Sept 2004
|
|
----------------------------------------------------------------------------*/
|
|
#include <string.h>
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <assert.h>
|
|
#include <sys/time.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 "oicom.h"
|
|
#include "fsm.h"
|
|
|
|
typedef struct {
|
|
Eve eve;
|
|
float lev2, lev3;
|
|
int cod1, cod2, cod3;
|
|
} IlmDriv;
|
|
|
|
char *fmts[10]={"unused", "%.1f\t%% N2", "%.1f\t%% He","%.1f\t%% He","",
|
|
"","","","","error"};
|
|
|
|
/*----------------------------------------------------------------------------*/
|
|
#define A EVE_ACTPAR
|
|
#define L EVE_LOGPAR
|
|
#define S EVE_EVE_SAVEPAR
|
|
|
|
void IlmPars(IlmDriv *me, EveParArg *arg) {
|
|
EveFloatPar(arg, "chan2", &me->lev2, fmts[me->cod2],
|
|
usInternal, (me->cod2 > 0) * A + L);
|
|
EveFloatPar(arg, "chan3", &me->lev2, fmts[me->cod3],
|
|
usInternal, (me->cod3 > 0) * A + L);
|
|
EveStdParEnd(arg, fmts[me->cod1], A+L);
|
|
}
|
|
/*----------------------------------------------------------------------------*/
|
|
void IlmStatus(IlmDriv *me) {
|
|
char *ans;
|
|
int *code;
|
|
Eve *eve=&me->eve;
|
|
int i;
|
|
|
|
if (eve->state != readState) return;
|
|
ans=eve->ans;
|
|
code=&eve->errCode;
|
|
if (ans[0] != 'X' || ans[4] != 'S' || ans[11] != 'R') {
|
|
EvePrintf(eve, eError, "illegal status response");
|
|
*code = EVE_FAULT;
|
|
return;
|
|
}
|
|
for (i=1; i<3; i++) {
|
|
if (ans[i]<'0' || ans[i] > '9') ans[i]='9';
|
|
}
|
|
me->cod1 = ans[1]-'0';
|
|
me->cod2 = ans[2]-'0';
|
|
me->cod3 = ans[3]-'0';
|
|
return;
|
|
}
|
|
/*----------------------------------------------------------------------------*/
|
|
static int IlmRead(long pc, IlmDriv *me) {
|
|
Eve *eve=&me->eve;
|
|
|
|
FSM_BEGIN
|
|
EveWrite(eve, "X");
|
|
FSM_NEXT
|
|
IlmStatus(me); /* check for errors */
|
|
EveWrite(eve, "R1"); /* read sensor 1 */
|
|
FSM_NEXT
|
|
me->eve.value = OiGetFlt(eve, 1, NULL);
|
|
if (me->cod2 == 0) goto skip2;
|
|
EveWrite(eve, "R2"); /* read sensor 1 */
|
|
FSM_NEXT
|
|
me->lev2 = OiGetFlt(eve, 1, NULL);
|
|
|
|
skip2:
|
|
if (me->cod3 == 0) goto skip3;
|
|
EveWrite(eve, "R3"); /* read sensor 1 */
|
|
FSM_NEXT
|
|
me->lev3 = OiGetFlt(eve, 1, NULL);
|
|
|
|
skip3:
|
|
FSM_END
|
|
}
|
|
/*----------------------------------------------------------------------------*/
|
|
static int IlmStart(long pc, IlmDriv *me) {
|
|
Eve *eve=&me->eve;
|
|
|
|
FSM_BEGIN
|
|
EveWrite(eve, "V");
|
|
FSM_NEXT
|
|
if (0 == strncmp(eve->version, "ILM", 3)) {
|
|
me->eve.syntax = 0;
|
|
} else {
|
|
EvePrintf(eve, eError, "unknown level meter version: %s", eve->version);
|
|
goto quit;
|
|
}
|
|
EvePrintf(eve, eStatus, "connected to %s", eve->version);
|
|
FSM_CALL(IlmRead);
|
|
|
|
quit:
|
|
FSM_END
|
|
}
|
|
/*------------------------------------------------------------------------*/
|
|
pEVControl IlmMakeEVC(SConnection *pCon, int argc, char *argv[]) {
|
|
/* args:
|
|
temperature ilm <rs232>
|
|
<host> <port>
|
|
*/
|
|
Eve *eve;
|
|
pEVControl evc;
|
|
IlmDriv *me = NULL;
|
|
|
|
evc = MakeEveEVC(argc, argv, calloc(1, sizeof *me), pCon);
|
|
if (!evc) return NULL;
|
|
|
|
me = evc->pDriv->pPrivate;
|
|
eve=&me->eve;
|
|
|
|
eve->run = NULL; /* no run possible */
|
|
eve->read = (FsmFunc)IlmRead;
|
|
eve->pardef = (EveParDef)IlmPars;
|
|
eve->todo = (FsmFunc)IlmStart;
|
|
eve->task = FsmStartTask(me, (FsmHandler)OiHandler, (FsmFunc)EveIdle);
|
|
|
|
evc->pEnvir->IsInTolerance = EveAlwaysOk;
|
|
|
|
return evc;
|
|
}
|