.

lsc370driv.c

@@ -30,21 +30,80 @@ Markus Zolliker, July 2006
 #include "fsm.h"
 #include "initializer.h"
 
+#define PID_FLAG 1
+#define RDGRNG_FLAG 2
+#define HTRRNG_FLAG 3
+
 typedef struct {
   EaseDriv d;
   float t;
   float htr;
   float set;
   float res;
+  float prop;
+  float integ;
+  float deriv;
+  float resist; /* Ohm */
+  int ighHeater;  /* IGH heater range (-1 if output is direct) */
+  int htrRange;
+  int currentEx;
+  int voltageEx;
+  int range;
+  int autoRange;
 } Lsc370;
 
 static ParClass lsc370Class = { "LSC370", sizeof(Lsc370) };
 
+/*----------------------------------------------------------------------------*/
+static float Lsc370Power(Lsc370 *drv, float percent) {
+  float power;  /* mW */
+  float current; /* A */
+  float voltage; /* V */
+  
+  if (drv->htrRange == 0 || drv->ighHeater == 0) {
+    power = 0;
+  } else if (drv->ighHeater > 0) {
+    current = pow(10, drv->htrRange * 0.5 - 5) * percent / 100;
+    voltage = current * 500;
+    if (voltage > 10) voltage = 10;
+    power = pow(10, drv->ighHeater) * 0.0002 * voltage / 10;
+  } else {
+    current = pow(10, drv->htrRange * 0.5 - 5) * percent / 100;
+    voltage = current * drv->resist;
+    if (voltage > 10) {
+      power = 10 * 10 / drv->resist * 1e3;
+    } else {
+      power = current * voltage * 1e3;
+    }
+  }
+  return power;
+}
+
 /*----------------------------------------------------------------------------*/
 static void Lsc370ParDef(void *object) {
   Lsc370 *drv = ParCast(&lsc370Class, object);
   EaseBase *eab = object;
-
+  float power, maxPower;
+  int iRng;
+  static char *heaterList[]={"off",
+    "30uA", "100uA", "300uA",
+    "1mA", "3mA", "10mA", "30mA", "100mA", NULL };
+  static char *currentList[]={"off",
+    "1pA", "3pA", "10pA", "30pA", "100pA", "300pA",
+    "1nA", "3nA", "10nA", "30nA", "100nA", "300nA",
+    "1uA", "3uA", "10uA", "30uA", "100uA", "300uA",
+    "1mA", "3mA", "10mA", "30mA", NULL };
+  static char *voltageList[]={"off",
+    "2uV", "6uV", "20uV", "60uV", "200uV", "600uV",
+    "2mV", "6mV", "20mV", "60mV", "200mV", "600mV",
+    NULL };
+  static char *rangeList[]={"auto",
+    "2mOhm", "6mOhm", "20mOhm", "60mOhm", "200mOhm", "600mOhm",
+    "2Ohm",  "6Ohm",  "20Ohm",  "60Ohm",  "200Ohm", " 600Ohm",
+    "2kOhm", "6kOhm", "20kOhm", "60kOhm", "200kOhm", "600kOhm",
+    "2MegaOhm", "6MegaOhm", "20MegaOhm", "60MegaOhm", NULL };
+  static char *offOn[]={"off", "on", NULL};
+  
   ParName(""); ParTail("K");
   ParFloat(&drv->t, PAR_NAN);
   
@@ -57,6 +116,95 @@ static void Lsc370ParDef(void *object) {
   ParName("res"); ParTail("Ohm");
   ParFloat(&drv->res, PAR_NAN);
 
+  ParName("prop"); ParTail("(gain)");
+  EaseUpdate(PID_FLAG); ParFmt("%.3f");
+  ParFloat(&drv->prop, PAR_NAN);
+
+  ParName("integ"); ParTail("sec");
+  EaseUpdate(PID_FLAG); ParFmt("%.0f");
+  ParFloat(&drv->integ, PAR_NAN);
+
+  ParName("deriv"); ParTail("sec");
+  EaseUpdate(PID_FLAG); ParFmt("%.0f");
+  ParFloat(&drv->deriv, PAR_NAN);
+
+  ParName("resist"); ParTail("Ohm"); ParAccess(usUser);
+  ParFloat(&drv->resist, 500.0);
+  
+  ParName("ighHeater"); ParAccess(usUser);
+  ParInt(&drv->ighHeater, -1);
+
+  ParName("currentEx");
+  EaseUpdate(RDGRNG_FLAG); ParEnum(currentList);
+  if (drv->currentEx > 0) ParList(NULL);
+  ParInt(&drv->currentEx, PAR_NAN);
+  if (ParActionIs(PAR_SET) > 0) {
+    if (drv->currentEx > 22) {
+      drv->currentEx = 22;
+    } else if (drv->currentEx <= 0) {
+      drv->currentEx = 0;
+    } else {
+      drv->voltageEx = 0;
+    }
+  }
+  
+  ParName("voltageEx");
+  EaseUpdate(RDGRNG_FLAG); ParEnum(voltageList);
+  if (drv->voltageEx > 0) ParList(NULL);
+  ParInt(&drv->voltageEx, PAR_NAN);
+  if (ParActionIs(PAR_SET) > 0) {
+    if (drv->voltageEx > 12) {
+      drv->voltageEx = 12;
+    } else if (drv->voltageEx <= 0) {
+      drv->voltageEx = 0;
+    } else {
+      drv->currentEx = 0;
+    }
+  }
+  
+  ParName("range");
+  EaseUpdate(RDGRNG_FLAG); ParEnum(rangeList);
+  if (drv->autoRange == 0) ParList(NULL);
+  ParInt(&drv->range, PAR_NAN);
+  if (ParActionIs(PAR_SET) > 0) {
+    if (drv->range > 22) {
+      drv->range = 22;
+      drv->autoRange = 0;
+    } else if (drv->range <= 0) {
+      drv->autoRange = 1;
+      drv->range = 0;
+    }
+  }
+  
+  ParName("autoRange");
+  EaseUpdate(RDGRNG_FLAG); ParEnum(offOn);
+  ParList(NULL);
+  ParInt(&drv->autoRange, PAR_NAN);
+  if (ParActionIs(PAR_SET) > 0) {
+    if (drv->autoRange) {
+      drv->autoRange = 1;
+    }
+  }
+  
+  ParName("htrRange");
+  EaseUpdate(HTRRNG_FLAG); ParEnum(heaterList); ParList(NULL);
+  ParInt(&drv->htrRange, PAR_NAN);
+  if (ParActionIs(PAR_SET) > 0) {
+    if (drv->htrRange > 8) {
+      drv->htrRange = 8;
+     } else if (drv->htrRange <= 0) {
+      drv->htrRange = 0;
+    }
+  }
+  
+  ParName("maxPower"); ParTail("mW");
+  power = Lsc370Power(drv, 100.0);
+  ParFloat(&power, 0.0);
+  
+  ParName("power"); ParTail("mW");
+  power = Lsc370Power(drv, drv->htr);
+  ParFloat(&power, 0.0);
+    
   EaseBasePar(drv);
   EaseSendPar(drv);
   EaseDrivPar(drv, "%.5g", "K");
@@ -67,22 +215,75 @@ static void Lsc370ParDef(void *object) {
 static long Lsc370Read(long pc, void *object) {
   Lsc370 *drv = ParCast(&lsc370Class, object);
   EaseBase *eab = object;
+  int mode, exi, rng, autoR, eoff;
+  float x, y, z;
   
   switch (pc) { default: /* FSM BEGIN *******************************/
     EaseWrite(eab, "RDGK?1");
   return __LINE__; case __LINE__: /**********************************/
-    drv->t = atof(eab->ans);
+    
+    if (1 == sscanf(eab->ans, "%f", &x)) {
+      drv->t = x;
+    }
     EaseWrite(eab, "RDGR?1");
   return __LINE__; case __LINE__: /**********************************/
-    drv->res = atof(eab->ans);
+    if (1 == sscanf(eab->ans, "%f", &x)) {
+      drv->res = x;
+    }
     EaseWrite(eab, "HTR?");
   return __LINE__; case __LINE__: /**********************************/
-    drv->htr = atof(eab->ans);
+    if (1 == sscanf(eab->ans, "%f", &x)) {
+      drv->htr = x;
+    }
     EaseWrite(eab, "SETP?");
   return __LINE__; case __LINE__: /**********************************/
-    drv->set = atof(eab->ans);
-
-  skipGetSet:    
+    if (1 == sscanf(eab->ans, "%f", &x)) {
+      if (drv->set != x && !EaseGetUpdate(drv, EASE_RUN)) {
+        drv->d.targetValue = x;
+      }
+      drv->set = x;
+    }
+    if (EaseGetUpdate(drv, PID_FLAG)) goto skipPid;
+    EaseWrite(eab, "PID?");
+  return __LINE__; case __LINE__: /**********************************/
+    if (EaseGetUpdate(drv, PID_FLAG)) goto skipPid;
+    if (3 == sscanf(eab->ans, "%f,%f,%f", &x, &y, &z)) {
+      drv->prop = x;
+      drv->integ = y;
+      drv->deriv = z;
+    }
+  skipPid:
+  
+    if (EaseGetUpdate(drv, HTRRNG_FLAG)) goto skipHtrRng;
+    EaseWrite(eab, "HTRRNG?");
+  return __LINE__; case __LINE__: /**********************************/
+    if (EaseGetUpdate(drv, HTRRNG_FLAG)) goto skipHtrRng;
+    if (1 == sscanf(eab->ans, "%d", &rng)) {
+      drv->htrRange = rng;
+    }
+  skipHtrRng:
+  
+    if (EaseGetUpdate(drv, RDGRNG_FLAG)) goto skipRdgRng;
+    EaseWrite(eab, "RDGRNG?1");
+  return __LINE__; case __LINE__: /**********************************/
+    if (EaseGetUpdate(drv, RDGRNG_FLAG)) goto skipRdgRng;
+    if (5 == sscanf(eab->ans, "%d,%d,%d,%d,%d", &mode, &exi, &rng, &autoR, &eoff)) {
+      if (eoff) {
+        drv->currentEx = 0;
+        drv->voltageEx = 0;
+      } else if (mode) {
+        drv->currentEx = exi;
+        drv->voltageEx = 0;
+      } else {
+        drv->voltageEx = exi;
+        drv->currentEx = 0;
+      }
+      drv->range = rng;
+      drv->autoRange = autoR;
+    }    
+  skipRdgRng:
+  
+  
     ParLog(drv);
   fsm_quit: return 0; } /* FSM END *********************************/
 }
@@ -112,19 +313,76 @@ static long Lsc370Start(long pc, void *object) {
 static long Lsc370Set(long pc, void *object) {
   Lsc370 *drv = ParCast(&lsc370Class, object);
   EaseBase *eab = object;
-  char cmd[32];
-  int upd;
+  char cmd[128];
+  int upd, mode, exi, eoff;
   
   switch (pc) { default: /* FSM BEGIN *******************************/
-    upd = EaseNextUpdate(drv);
-    if (upd != EASE_RUN) goto quit;
     EaseWrite(eab, "MODE 1;MODE?"); /* remote mode */
   return __LINE__; case __LINE__: /**********************************/
+  loop:
+    upd = EaseNextUpdate(drv);
+    if (upd == EASE_RUN) goto run;
+    if (upd == HTRRNG_FLAG) goto htrrng;
+    if (upd == PID_FLAG) goto pid;
+    if (upd == RDGRNG_FLAG) goto rdgrng;
+    goto finish;
+    
+  run:
     snprintf(cmd, sizeof cmd, "SETP %.5g;SETP?", drv->d.targetValue);
     EaseWrite(eab, cmd);
   return __LINE__; case __LINE__: /**********************************/
+    /* fall through */
+
+  htrrng:
+    snprintf(cmd, sizeof cmd, "CSET 1,1,1,1,1,8,%g;CSET?", drv->resist);
+    EaseWrite(eab, cmd);
+  return __LINE__; case __LINE__: /**********************************/
+
+    snprintf(cmd, sizeof cmd, "HTRRNG %d;HTRRNG?", drv->htrRange);
+    EaseWrite(eab, cmd);
+  return __LINE__; case __LINE__: /**********************************/
+    goto loop;
+    
+  pid:
+    snprintf(cmd, sizeof cmd, "PID %.5g,%.5g,%.5g;PID?", drv->prop, drv->integ, drv->deriv);
+    EaseWrite(eab, cmd);
+  return __LINE__; case __LINE__: /**********************************/
+    goto loop;
+
+  rdgrng:
+    if (drv->voltageEx > 0) {
+      mode = 0;
+      drv->currentEx = 0;
+      exi = drv->voltageEx;
+      eoff = 0;
+    } else if (drv->currentEx > 0) {
+      mode = 1;
+      drv->voltageEx = 0;
+      exi = drv->currentEx;
+      eoff = 0;
+    } else {
+      mode = 0;
+      exi = 5;
+      eoff = 1;
+    }
+    if (drv->range <= 0) {
+      if (drv->autoRange) {
+        drv->range = 13;
+      } else {
+        drv->range = 1;
+      }
+    }
+    if (drv->autoRange) drv->autoRange = 1;
+    snprintf(cmd, sizeof cmd, "RDGRNG 1,%d,%d,%d,%d,%d;RDGRNG?1",
+      mode, exi, drv->range, drv->autoRange, eoff);
+    EaseWrite(eab, cmd);
+  return __LINE__; case __LINE__: /**********************************/
+    goto loop;
+    
+  finish:  
     EaseWrite(eab, "MODE 0;MODE?"); /* local mode */
-  quit:
+  return __LINE__; case __LINE__: /**********************************/
+    
   return 0; } /* FSM END ********************************************/
 }
 /*----------------------------------------------------------------------------*/
@@ -139,6 +397,7 @@ static int Lsc370Init(SConnection *con, int argc, char *argv[], int dynamic) {
                     Lsc370ParDef, LscHandler, Lsc370Start, NULL, Lsc370Read,
                     Lsc370Set);
   if (drv == NULL) return 0;
+  drv->htrRange = 0;
   setRS232ReplyTerminator(drv->d.b.ser,"\n");
   setRS232SendTerminator(drv->d.b.ser,"\n");
   return 1;