141 lines
4.0 KiB
C
141 lines
4.0 KiB
C
/*---------------------------------------------------------------------------
|
|
linadriv.c
|
|
|
|
Driver for the Lock IN Amplifier SIGNAL RECOVERY Model 7265
|
|
|
|
Markus Zolliker, Oct 2006
|
|
----------------------------------------------------------------------------*/
|
|
#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 "linahdl.h"
|
|
#include "fsm.h"
|
|
#include "initializer.h"
|
|
|
|
typedef struct {
|
|
EaseDriv d;
|
|
float x, y;
|
|
} Lina;
|
|
|
|
static ParClass linaClass = { "LINA", sizeof(Lina) };
|
|
|
|
/*----------------------------------------------------------------------------*/
|
|
static void LinaParDef(void *object) {
|
|
Lina *drv = ParCast(&linaClass, object);
|
|
EaseBase *eab = object;
|
|
|
|
ParName(""); ParTail("units");
|
|
ParFloat(&drv->x, PAR_NAN);
|
|
|
|
ParName("x"); ParTail("");
|
|
ParFloat(&drv->x, PAR_NAN);
|
|
|
|
ParName("y"); ParTail("");
|
|
ParFloat(&drv->y, PAR_NAN);
|
|
|
|
EaseBasePar(drv);
|
|
EaseSendPar(drv);
|
|
/*
|
|
EaseDrivPar(drv, "%.5g", "K");
|
|
*/
|
|
ParStdDef();
|
|
EaseMsgPar(drv);
|
|
}
|
|
/*----------------------------------------------------------------------------*/
|
|
static long LinaRead(long pc, void *object) {
|
|
Lina *drv = ParCast(&linaClass, object);
|
|
EaseBase *eab = object;
|
|
char *p;
|
|
|
|
switch (pc) { default: /* FSM BEGIN *******************************/
|
|
EaseWrite(eab, "XY.");
|
|
return __LINE__; case __LINE__: /**********************************/
|
|
p = strchr(eab->ans, ',');
|
|
if (p) {
|
|
*p='\0';
|
|
p++;
|
|
drv->x = atof(eab->ans);
|
|
drv->y = atof(p);
|
|
}
|
|
ParLog(drv);
|
|
fsm_quit: return 0; } /* FSM END *********************************/
|
|
}
|
|
/*----------------------------------------------------------------------------*/
|
|
static long LinaStart(long pc, void *object) {
|
|
Lina *drv = ParCast(&linaClass, object);
|
|
EaseBase *eab = object;
|
|
|
|
switch (pc) { default: /* FSM BEGIN *******************************/
|
|
EaseWrite(eab, "ID");
|
|
return __LINE__; case __LINE__: /**********************************/
|
|
if (0 != strncmp(eab->version, "7265", 4)) {
|
|
snprintf(eab->msg, sizeof eab->msg, "unknown lock in amplifier version: %s",
|
|
eab->version);
|
|
ParPrintf(drv, eError, "ERROR: %s", eab->msg);
|
|
EaseStop(eab);
|
|
goto quit;
|
|
}
|
|
ParPrintf(drv, eStatus, "connected to %s", eab->version);
|
|
FsmCall(LinaRead);
|
|
return __LINE__; case __LINE__: /**********************************/
|
|
|
|
quit:
|
|
return 0; } /* FSM END ********************************************/
|
|
}
|
|
/*----------------------------------------------------------------------------*/
|
|
static long LinaSet(long pc, void *object) {
|
|
Lina *drv = ParCast(&linaClass, object);
|
|
EaseBase *eab = object;
|
|
char cmd[32];
|
|
int upd;
|
|
|
|
switch (pc) { default: /* FSM BEGIN *******************************/
|
|
/*
|
|
snprintf(cmd, sizeof cmd, "SETP %.5g;SETP?", drv->d.targetValue);
|
|
EaseWrite(eab, cmd);
|
|
*/
|
|
quit:
|
|
return 0; } /* FSM END ********************************************/
|
|
}
|
|
/*----------------------------------------------------------------------------*/
|
|
static int LinaInit(SConnection *con, int argc, char *argv[], int dynamic) {
|
|
/* args:
|
|
MakeObject objectname lina <rs232>
|
|
MakeObject objectname lina <host> <port>
|
|
*/
|
|
Lina *drv;
|
|
|
|
drv = EaseMakeDriv(con, &linaClass, argc, argv, dynamic, 7,
|
|
LinaParDef, LinaHandler, LinaStart, NULL, LinaRead,
|
|
LinaSet);
|
|
if (drv == NULL) return 0;
|
|
/*
|
|
setRS232ReplyTerminator(drv->d.b.ser,"\n");
|
|
setRS232SendTerminator(drv->d.b.ser,"\n");
|
|
*/
|
|
return 1;
|
|
}
|
|
/*----------------------------------------------------------------------------*/
|
|
void LinaStartup(void) {
|
|
ParMakeClass(&linaClass, EaseDrivClass());
|
|
MakeDriver("LINA", LinaInit, 0, "Lock in amplifier SIGNAL RECOVERY Model 7265");
|
|
}
|