author | Heinz Junkes <junkes@fhi-berlin.mpg.de> |
Tue, 19 Jan 2016 10:54:27 +0100 | |
changeset 2 | 3b3af1ff2783 |
permissions | -rw-r--r-- |
2
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
1 |
/** @brief device support adcPi |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
2 |
* |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
3 |
*/ |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
4 |
#include <stdio.h> |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
5 |
#include <stdlib.h> |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
6 |
#include <devSup.h> |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
7 |
#include <recGbl.h> |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
8 |
#include <alarm.h> |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
9 |
#include <errlog.h> |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
10 |
#include <aiRecord.h> |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
11 |
#include <epicsExport.h> |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
12 |
#include "drvAdcPi.h" |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
13 |
|
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
14 |
typedef struct { |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
15 |
adcPiCard* card; |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
16 |
int signal; |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
17 |
} adcPiAiPrivate; |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
18 |
|
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
19 |
long adcPiInitRecordAi (aiRecord *record); |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
20 |
long adcPiReadAi (aiRecord *record); |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
21 |
long adcPiSpecialLinconvAi (aiRecord *record, int after); |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
22 |
|
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
23 |
struct { |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
24 |
long number; |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
25 |
DEVSUPFUN report; |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
26 |
DEVSUPFUN init; |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
27 |
DEVSUPFUN init_record; |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
28 |
DEVSUPFUN get_ioint_info; |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
29 |
DEVSUPFUN read_ai; |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
30 |
DEVSUPFUN special_linconv; |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
31 |
} adcPiAi = { |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
32 |
6, |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
33 |
NULL, |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
34 |
NULL, |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
35 |
adcPiInitRecordAi, |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
36 |
NULL, |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
37 |
adcPiReadAi, |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
38 |
adcPiSpecialLinconvAi |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
39 |
}; |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
40 |
epicsExportAddress (dset, adcPiAi); |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
41 |
|
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
42 |
/** @brief init record |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
43 |
* |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
44 |
*/ |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
45 |
long adcPiInitRecordAi (aiRecord *record) |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
46 |
{ |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
47 |
adcPiAiPrivate *priv; |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
48 |
epicsUInt16 initval; |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
49 |
adcPiCard* card; |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
50 |
int signal; |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
51 |
|
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
52 |
if (record->inp.type != VME_IO) { |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
53 |
errlogSevPrintf (errlogFatal, "adcPiInitRecordAi %s: illegal INP link type\n", record->name); |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
54 |
return -1; |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
55 |
} |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
56 |
|
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
57 |
card = adcPiOpen (record->inp.value.vmeio.card); |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
58 |
if (!card) { |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
59 |
errlogSevPrintf (errlogFatal, "adcPiInitRecordAi %s: invalid card number %d\n", record->name, record->inp.value.vmeio.card); |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
60 |
return S_dev_noDevice; |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
61 |
} |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
62 |
|
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
63 |
signal = record->inp.value.vmeio.signal; |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
64 |
if (signal < 0 || signal >= ADC_PI_MAX_CHANNEL) { |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
65 |
errlogSevPrintf (errlogFatal, "adcPiInitRecordAi %s: invalid signal number %d\n", record->name, signal); |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
66 |
return S_dev_badSignalNumber; |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
67 |
} |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
68 |
|
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
69 |
priv = (adcPiAiPrivate*) malloc (sizeof (adcPiAiPrivate)); |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
70 |
if (!priv) { |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
71 |
errlogSevPrintf (errlogFatal, "adcPiInitRecordAi %s: out of memory\n", record->name); |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
72 |
return S_dev_noMemory; |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
73 |
} |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
74 |
|
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
75 |
priv->card = card; |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
76 |
priv->signal = signal; |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
77 |
record->dpvt = priv; |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
78 |
|
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
79 |
// printf(" priv at @%p [%d]\n", priv, sizeof (adcPiAiPrivate) ); |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
80 |
|
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
81 |
adcPiSpecialLinconvAi (record, TRUE); |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
82 |
adcPiGet (card, signal, &initval); |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
83 |
|
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
84 |
record->rval = initval; |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
85 |
return 0; |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
86 |
} |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
87 |
|
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
88 |
long adcPiReadAi (aiRecord *record) |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
89 |
{ |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
90 |
adcPiAiPrivate *priv = (adcPiAiPrivate*) record->dpvt; |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
91 |
int status; |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
92 |
|
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
93 |
// printf("ReadAi: priv at @%p [%d]\n", priv, sizeof (adcPiAiPrivate) ); |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
94 |
|
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
95 |
if (!priv) { |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
96 |
recGblSetSevr (record, UDF_ALARM, INVALID_ALARM); |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
97 |
errlogSevPrintf (errlogFatal, "adcPiReadAi %s: record not initialized correctly\n", record->name); |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
98 |
return -1; |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
99 |
} |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
100 |
unsigned short value; |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
101 |
status = adcPiGet (priv->card, priv->signal, &value); |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
102 |
if (status) { |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
103 |
errlogSevPrintf (errlogFatal, "adcPiReadAi %s: adcPiGet failes: error code 0x%x\n", record->name, status); |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
104 |
recGblSetSevr (record, READ_ALARM, INVALID_ALARM); |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
105 |
} |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
106 |
record->rval = value; |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
107 |
return status; // 2 do not convert |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
108 |
} |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
109 |
|
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
110 |
long adcPiSpecialLinconvAi (aiRecord *record, int after) |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
111 |
{ |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
112 |
if (after) { |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
113 |
// printf(" In convert ....\n"); |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
114 |
// Check/Check ... |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
115 |
// MAX_CODE_12BIT / 2048 Volt |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
116 |
//record->eoff = ( 8191 * record->egul - -8192 * record->eguf) / (8191 - 8192); |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
117 |
record->eoff = 0; |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
118 |
record->eslo = 0.000250; // 205 uV (record->eguf - record->egul)/ (8191 - 8192); |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
119 |
} |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
120 |
return 0; |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
121 |
} |
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
122 |
|
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
123 |
|
3b3af1ff2783
add driver abd device support for adcPi
Heinz Junkes <junkes@fhi-berlin.mpg.de>
parents:
diff
changeset
|
124 |