- small improvements in drivers

This commit is contained in:
zolliker
2008-05-14 14:23:43 +00:00
parent f10767551e
commit d109dd026a
4 changed files with 158 additions and 30 deletions

View File

@ -141,14 +141,14 @@ static void HaakeParDef(void *object) {
EaseBase *eab = object; EaseBase *eab = object;
int reset = 0; int reset = 0;
ParName(""); ParFmt("%.2f"); ParTail("C"); ParName(""); ParFmt("%.2f"); ParTail("K");
ParFloat(&drv->t, PAR_NAN); ParFloat(&drv->t, PAR_NAN);
ParName("t2"); ParName("t2");
if (drv->with2sensors) { ParFmt("%.2f"); ParTail("C"); } if (drv->with2sensors) { ParFmt("%.2f"); ParTail("K"); }
ParFloat(&drv->t2, PAR_NAN); ParFloat(&drv->t2, PAR_NAN);
ParName("set"); ParFmt("%.2f"); ParTail("C"); ParName("set"); ParFmt("%.2f"); ParTail("K");
ParFloat(&drv->set, PAR_NAN); ParFloat(&drv->set, PAR_NAN);
ParName("running"); EaseUpdate(HAAKE_ON); ParName("running"); EaseUpdate(HAAKE_ON);
@ -175,7 +175,7 @@ static void HaakeParDef(void *object) {
EaseBasePar(drv); EaseBasePar(drv);
EaseSendPar(drv); EaseSendPar(drv);
EaseDrivPar(drv, "%.2f", "C"); EaseDrivPar(drv, "%.2f", "K");
ParStdDef(); ParStdDef();
EaseMsgPar(drv); EaseMsgPar(drv);
} }
@ -206,18 +206,18 @@ static long HaakeRead(long pc, void *object) {
EaseWrite(eab, "F1"); EaseWrite(eab, "F1");
return __LINE__; case __LINE__: /**********************************/ return __LINE__; case __LINE__: /**********************************/
drv->t = atof(eab->ans); drv->t = atof(eab->ans) + 273.15;
if (!drv->with2sensors) goto nof2; if (!drv->with2sensors) goto nof2;
EaseWrite(eab, "F2"); EaseWrite(eab, "F2");
return __LINE__; case __LINE__: /**********************************/ return __LINE__; case __LINE__: /**********************************/
drv->t2 = atof(eab->ans); drv->t2 = atof(eab->ans) + 273.15;
if (drv->t2 < -222) { if (drv->t2 < -222) {
drv->t2 = PAR_NAN; drv->t2 = PAR_NAN;
} }
nof2: nof2:
EaseWrite(eab, "S"); EaseWrite(eab, "S");
return __LINE__; case __LINE__: /**********************************/ return __LINE__; case __LINE__: /**********************************/
drv->set = atof(eab->ans); drv->set = atof(eab->ans) + 273.15;
skipGetSet: skipGetSet:
ParLog(drv); ParLog(drv);
@ -227,7 +227,7 @@ static long HaakeRead(long pc, void *object) {
static long HaakeStart(long pc, void *object) { static long HaakeStart(long pc, void *object) {
Haake *drv = ParCast(&haakeClass, object); Haake *drv = ParCast(&haakeClass, object);
EaseBase *eab = object; EaseBase *eab = object;
switch (pc) { default: /* FSM BEGIN *******************************/ switch (pc) { default: /* FSM BEGIN *******************************/
EaseWrite(eab, "V"); EaseWrite(eab, "V");
return __LINE__; case __LINE__: /**********************************/ return __LINE__; case __LINE__: /**********************************/
@ -239,6 +239,8 @@ static long HaakeStart(long pc, void *object) {
goto quit; goto quit;
} }
ParPrintf(drv, eStatus, "connected to haake thermostat %s", eab->version); ParPrintf(drv, eStatus, "connected to haake thermostat %s", eab->version);
EaseWrite(eab, "W TE K");
return __LINE__; case __LINE__: /**********************************/
FsmCall(HaakeRead); FsmCall(HaakeRead);
return __LINE__; case __LINE__: /**********************************/ return __LINE__; case __LINE__: /**********************************/
@ -256,7 +258,7 @@ static long HaakeSet(long pc, void *object) {
upd = EaseNextUpdate(drv); upd = EaseNextUpdate(drv);
switch (upd) { switch (upd) {
case EASE_RUN: case EASE_RUN:
snprintf(cmd, sizeof cmd, "w sw %.5g", drv->d.targetValue); snprintf(cmd, sizeof cmd, "w sw %.5g", drv->d.targetValue-273.17);
break; break;
case HAAKE_ON: case HAAKE_ON:
snprintf(cmd, sizeof cmd, "w ts%d", drv->running); snprintf(cmd, sizeof cmd, "w ts%d", drv->running);

122
itcdriv.c
View File

@ -38,6 +38,7 @@ Markus Zolliker, May 2005
#define ITC_PROP 4 #define ITC_PROP 4
#define ITC_INTEG 5 #define ITC_INTEG 5
#define ITC_DERIV 6 #define ITC_DERIV 6
#define ITC_MAXVOLT 7
typedef struct { typedef struct {
EaseDriv d; EaseDriv d;
@ -54,6 +55,13 @@ typedef struct {
float deriv; /* deriv. time / int. for pressure [sec] */ float deriv; /* deriv. time / int. for pressure [sec] */
float prop2; /* TESLATRON only: prop. for pressure [%/mbar] */ float prop2; /* TESLATRON only: prop. for pressure [%/mbar] */
float lambdaTarget; /* TESLATRON only: lambda stage target temperature */ float lambdaTarget; /* TESLATRON only: lambda stage target temperature */
float power;
float resist;
float htrVolt;
float maxVolt;
float maxPower;
int cntVolt;
int readMaxVolt;
int pidMode; int pidMode;
int sampleChan; int sampleChan;
int controlChan; int controlChan;
@ -167,6 +175,9 @@ static void ItcParDef(void *object) {
ParList(NULL); ParList(NULL);
ParInt(&drv->gasMode, 1); ParInt(&drv->gasMode, 1);
ParName("heaterMode");
ParInt(&drv->a, 0);
} else { } else {
ParName("progress"); ParName("progress");
ParAccess(usUser); ParEnum(progressList); ParAccess(usUser); ParEnum(progressList);
@ -187,6 +198,8 @@ static void ItcParDef(void *object) {
ParList(""); ParList("");
} }
EaseUpdate(ITC_SETGAS); ParSave(1); EaseUpdate(ITC_SETGAS); ParSave(1);
if (drv->setGas > 99.9) drv->setGas = 99.9;
if (drv->setGas < 0) drv->setGas = 0;
ParFloat(&drv->setGas, 20.0); ParFloat(&drv->setGas, 20.0);
ParName("travelTime"); ParFmt("%.0f"); ParTail("sec"); ParName("travelTime"); ParFmt("%.0f"); ParTail("sec");
@ -219,7 +232,39 @@ static void ItcParDef(void *object) {
if (drv->pidMode == 1) ParList(""); if (drv->pidMode == 1) ParList("");
EaseUpdate(ITC_DERIV); EaseUpdate(ITC_DERIV);
ParFloat(&drv->deriv, PAR_NAN); ParFloat(&drv->deriv, PAR_NAN);
ParName("maxPower");
ParFmt("%.4g"); ParTail("W");
EaseUpdate(ITC_MAXVOLT);
ParFloat(&drv->maxPower, PAR_NAN);
if (ParActionIs(PAR_SET) > 0) {
if (drv->maxPower < 0) {
drv->readMaxVolt = 1;
drv->maxPower = PAR_NAN;
drv->maxVolt = PAR_NAN;
} else {
drv->readMaxVolt = 0;
if (drv->resist < 0) {
drv->resist = 0;
}
drv->maxVolt = sqrt(drv->maxPower * drv->resist);
if (drv->maxVolt > 47.9) {
drv->maxVolt = 47.9;
}
}
}
ParName("resist");
ParFmt("%g"); ParAccess(usUser);
ParTail("Ohm"); ParList("");
ParFloat(&drv->resist, 80.0);
ParName("power");
ParFmt("%g"); ParTail("W");
ParFloat(&drv->power, PAR_NAN);
} else { } else {
ParName("lambdaTarget"); ParFmt("%.2f"); ParTail("K"); ParName("lambdaTarget"); ParFmt("%.2f"); ParTail("K");
if (drv->gasMode == 0) ParList(""); if (drv->gasMode == 0) ParList("");
ParAccess(usUser); ParSave(1); ParAccess(usUser); ParSave(1);
@ -348,7 +393,7 @@ static long ItcRead(long pc, void *object) {
int l; int l;
time_t now, delta; time_t now, delta;
char buf[4]; char buf[4];
float gas, band; float gas, band, v1, v2, h;
switch (pc) { default: /* FSM BEGIN *******************************/ switch (pc) { default: /* FSM BEGIN *******************************/
EaseWrite(eab, "X"); EaseWrite(eab, "X");
@ -384,7 +429,8 @@ static long ItcRead(long pc, void *object) {
if (drv->t[drv->controlChan] > drv->autoGasLimit + 1.0) { if (drv->t[drv->controlChan] > drv->autoGasLimit + 1.0) {
if (drv->a < 2) { if (drv->a < 2) {
drv->a |= 2; /* switch gas to auto */ drv->a |= 2; /* switch gas to auto */
ParPrintf(drv, eWarning, "switch to auto needle valve"); ParPrintf(drv, eWarning,
"needle valve switched to ITC control (AutoGas)");
} else { } else {
goto skip0; goto skip0;
} }
@ -392,8 +438,8 @@ static long ItcRead(long pc, void *object) {
if (drv->a >= 2) { if (drv->a >= 2) {
if (drv->t[drv->controlChan] < drv->autoGasLimit) { if (drv->t[drv->controlChan] < drv->autoGasLimit) {
drv->a &= 1; /* switch gas to manual */ drv->a &= 1; /* switch gas to manual */
ParPrintf(drv, eWarning, "switch to manual needle valve (%f %%)", ParPrintf(drv, eWarning,
drv->setGas); "needle valve switched to software control");
} else { } else {
goto skip0; goto skip0;
} }
@ -494,13 +540,57 @@ static long ItcRead(long pc, void *object) {
if (eab->syntax == TESLATRON) goto skipctrl; if (eab->syntax == TESLATRON) goto skipctrl;
if (EaseGetUpdate(drv, ITC_SETHTR)) goto skiphtr; if (EaseGetUpdate(drv, ITC_MAXVOLT)) goto skiphtr;
EaseWrite(eab, "R5"); /* read heater */ EaseWrite(eab, "R5"); /* read heater percent */
return __LINE__; case __LINE__: /**********************************/ return __LINE__; case __LINE__: /**********************************/
if (EaseGetUpdate(drv, ITC_SETHTR)) goto skiphtr; if (EaseGetUpdate(drv, ITC_MAXVOLT)) goto skiphtr;
drv->htr = OxiGet(eab, 1, NULL, drv->htr); drv->htr = OxiGet(eab, 1, NULL, drv->htr);
skiphtr:
if (drv->readMaxVolt == 0) {
drv->htrVolt = drv->htr * 0.01 * drv->maxVolt;
goto skiphtr;
}
EaseWrite(eab, "R6"); /* read heater voltage */
return __LINE__; case __LINE__: /**********************************/
drv->htrVolt = OxiGet(eab, 1, NULL, drv->htrVolt);
if (drv->readMaxVolt) {
h = drv->htr;
if (h > 1.0) {
v1 = 0.1 * (int)(drv->htrVolt * 1000 / (h + 0.099) - 0.5);
v2 = 0.1 * (int)(drv->htrVolt * 1000 / (h - 0.05) + 0.99);
if (drv->maxVolt > v2) {
drv->cntVolt++;
if (drv->cntVolt > drv->readMaxVolt) {
drv->maxVolt = v2;
drv->cntVolt = 0;
drv->readMaxVolt++;
}
} else if (drv->maxVolt < v1) {
drv->cntVolt--;
if (drv->cntVolt < -drv->readMaxVolt) {
drv->maxVolt = v1;
drv->cntVolt = 0;
drv->readMaxVolt++;
}
} else {
drv->cntVolt = 0;
}
}
}
if (drv->maxVolt != PAR_NAN) {
drv->htrVolt = h * 0.01 * drv->maxVolt;
}
skiphtr:
if (drv->resist <= 1) drv->resist = 80.0;
if (drv->maxVolt != PAR_NAN) {
drv->maxPower = drv->maxVolt * drv->maxVolt / drv->resist;
}
if (drv->htrVolt != PAR_NAN) {
drv->power = drv->htrVolt * drv->htrVolt / drv->resist;
}
if (EaseGetUpdate(drv, ITC_PROP)) goto skipprop; if (EaseGetUpdate(drv, ITC_PROP)) goto skipprop;
EaseWrite(eab, "R8"); /* read prop */ EaseWrite(eab, "R8"); /* read prop */
return __LINE__; case __LINE__: /**********************************/ return __LINE__; case __LINE__: /**********************************/
@ -556,11 +646,12 @@ static long ItcStart(long pc, void *object) {
} }
} }
ParPrintf(drv, eStatus, "connected to %s", eab->version); ParPrintf(drv, eStatus, "connected to %s", eab->version);
FsmCall(ItcRead);
return __LINE__; case __LINE__: /**********************************/
if (drv->controlChan == 0 && drv->h >= 1 && drv->h <= 3) { if (drv->controlChan == 0 && drv->h >= 1 && drv->h <= 3) {
drv->controlChan = drv->h; drv->controlChan = drv->h;
} }
FsmCall(ItcRead); drv->d.targetValue = drv->t[0];
return __LINE__; case __LINE__: /**********************************/
quit: quit:
return 0; } /* FSM END ********************************************/ return 0; } /* FSM END ********************************************/
@ -642,7 +733,9 @@ static long ItcSetGas(long pc, void *object) {
return __LINE__; case __LINE__: /**********************************/ return __LINE__; case __LINE__: /**********************************/
EaseWrite(eab, "R7"); /* read gas flow */ EaseWrite(eab, "R7"); /* read gas flow */
return __LINE__; case __LINE__: /**********************************/ return __LINE__; case __LINE__: /**********************************/
drv->setGas = OxiGet(eab, 1, NULL, drv->setGas); if (! EaseGetUpdate(drv, ITC_SETGAS)) {
drv->setGas = OxiGet(eab, 1, NULL, drv->setGas);
}
if (drv->a < 2) goto quit; if (drv->a < 2) goto quit;
snprintf(buf, sizeof buf, "A%d", drv->a); snprintf(buf, sizeof buf, "A%d", drv->a);
EaseWrite(eab, buf); EaseWrite(eab, buf);
@ -698,6 +791,7 @@ static long ItcSet(long pc, void *object) {
case ITC_PROP: OxiSet(eab, "P", drv->prop, 1); goto loop; case ITC_PROP: OxiSet(eab, "P", drv->prop, 1); goto loop;
case ITC_INTEG: OxiSet(eab, "I", drv->integ, 1); goto loop; case ITC_INTEG: OxiSet(eab, "I", drv->integ, 1); goto loop;
case ITC_DERIV: OxiSet(eab, "D", drv->deriv, 1); goto loop; case ITC_DERIV: OxiSet(eab, "D", drv->deriv, 1); goto loop;
case ITC_MAXVOLT:OxiSet(eab, "M", drv->maxVolt, 1); goto loop;
default: break; default: break;
} }
} }
@ -721,6 +815,10 @@ static int ItcInit(SConnection *con, int argc, char *argv[], int dynamic) {
ItcSet); ItcSet);
if (drv == NULL) return 0; if (drv == NULL) return 0;
drv->d.b.syntax = 0; drv->d.b.syntax = 0;
drv->cntVolt = 0;
drv->maxVolt = PAR_NAN;
drv->htrVolt = PAR_NAN;
drv->readMaxVolt = 1;
return 1; return 1;
} }
/*----------------------------------------------------------------------------*/ /*----------------------------------------------------------------------------*/

View File

@ -33,6 +33,7 @@ Markus Zolliker, July 2006
#define PID_FLAG 1 #define PID_FLAG 1
#define RDGRNG_FLAG 2 #define RDGRNG_FLAG 2
#define HTRRNG_FLAG 3 #define HTRRNG_FLAG 3
#define MAX_CHAN 3
typedef struct { typedef struct {
EaseDriv d; EaseDriv d;
@ -44,12 +45,15 @@ typedef struct {
float integ; float integ;
float deriv; float deriv;
float resist; /* Ohm */ float resist; /* Ohm */
float temp[MAX_CHAN];
int channel[MAX_CHAN];
int ighHeater; /* IGH heater range (-1 if output is direct) */ int ighHeater; /* IGH heater range (-1 if output is direct) */
int htrRange; int htrRange;
int currentEx; int currentEx;
int voltageEx; int voltageEx;
int range; int range;
int autoRange; int autoRange;
int index;
} Lsc370; } Lsc370;
static ParClass lsc370Class = { "LSC370", sizeof(Lsc370) }; static ParClass lsc370Class = { "LSC370", sizeof(Lsc370) };
@ -85,6 +89,8 @@ static void Lsc370ParDef(void *object) {
EaseBase *eab = object; EaseBase *eab = object;
float power, maxPower; float power, maxPower;
int iRng; int iRng;
int i;
static char *heaterList[]={"off", static char *heaterList[]={"off",
"30uA", "100uA", "300uA", "30uA", "100uA", "300uA",
"1mA", "3mA", "10mA", "30mA", "100mA", NULL }; "1mA", "3mA", "10mA", "30mA", "100mA", NULL };
@ -104,8 +110,11 @@ static void Lsc370ParDef(void *object) {
"2MegaOhm", "6MegaOhm", "20MegaOhm", "60MegaOhm", NULL }; "2MegaOhm", "6MegaOhm", "20MegaOhm", "60MegaOhm", NULL };
static char *offOn[]={"off", "on", NULL}; static char *offOn[]={"off", "on", NULL};
static char *tNames[]={"tsample", "tstill", "tmix"};
static char *cNames[]={"csample", "cstill", "cmix"};
ParName(""); ParTail("K"); ParName(""); ParTail("K");
ParFloat(&drv->t, PAR_NAN); ParFloat(&drv->temp[0], PAR_NAN);
ParName("set"); ParTail("K"); ParName("set"); ParTail("K");
ParFloat(&drv->set, PAR_NAN); ParFloat(&drv->set, PAR_NAN);
@ -113,6 +122,15 @@ static void Lsc370ParDef(void *object) {
ParName("htr"); ParTail("%"); ParName("htr"); ParTail("%");
ParFloat(&drv->htr, PAR_NAN); ParFloat(&drv->htr, PAR_NAN);
for (i = 0; i < MAX_CHAN; i++) {
if (drv->channel[i] > 0 && i > 0) {
ParName(tNames[i]); ParTail("K");
ParFloat(&drv->temp[i], PAR_NAN);
}
ParName(cNames[i]); ParAccess(usUser);
ParInt(&drv->channel[i], 0);
}
ParName("res"); ParTail("Ohm"); ParName("res"); ParTail("Ohm");
ParFloat(&drv->res, PAR_NAN); ParFloat(&drv->res, PAR_NAN);
@ -217,14 +235,21 @@ static long Lsc370Read(long pc, void *object) {
EaseBase *eab = object; EaseBase *eab = object;
int mode, exi, rng, autoR, eoff; int mode, exi, rng, autoR, eoff;
float x, y, z; float x, y, z;
char buf[16];
switch (pc) { default: /* FSM BEGIN *******************************/ switch (pc) { default: /* FSM BEGIN *******************************/
EaseWrite(eab, "RDGK?1"); drv->index = 0;
chanLoop:
snprintf(buf, sizeof buf, "RDGK?%d", drv->channel[drv->index]);
EaseWrite(eab, buf);
return __LINE__; case __LINE__: /**********************************/ return __LINE__; case __LINE__: /**********************************/
if (1 == sscanf(eab->ans, "%f", &x)) { if (1 == sscanf(eab->ans, "%f", &x)) {
drv->t = x; drv->temp[drv->index] = x;
} }
drv->index++;
if (drv->index < MAX_CHAN) goto chanLoop;
EaseWrite(eab, "RDGR?1"); EaseWrite(eab, "RDGR?1");
return __LINE__; case __LINE__: /**********************************/ return __LINE__; case __LINE__: /**********************************/
if (1 == sscanf(eab->ans, "%f", &x)) { if (1 == sscanf(eab->ans, "%f", &x)) {

View File

@ -11,6 +11,7 @@ is not changed, i.e. an existing errCode is not overwritten.
*/ */
#include <string.h> #include <string.h>
#include <math.h>
#include <stdio.h> #include <stdio.h>
#include <stdlib.h> #include <stdlib.h>
#include <assert.h> #include <assert.h>
@ -160,13 +161,15 @@ double OxiGet(EaseBase *eab, int dig, int *pdig, double old) {
void OxiSet(EaseBase *eab, char *cmd, double val, int dig) { void OxiSet(EaseBase *eab, char *cmd, double val, int dig) {
char buf[64]; char buf[64];
int l; double f;
if (eab->syntax <= 0) { if (eab->syntax > 0) {
snprintf(buf, sizeof(buf), "%s%.*f", cmd, dig, val); f = fabs(val);
} else { if (f < 1.0) f = 1.0;
snprintf(buf, sizeof(buf), "%s%f", cmd, val); dig = 5 - log10(f);
if (dig < 0) dig = 0;
} }
snprintf(buf, sizeof(buf), "%s%.*f", cmd, dig, val);
EaseWrite(eab, buf); EaseWrite(eab, buf);
} }