kstmApp/src/devAdcPi.c
author Heinz Junkes <junkes@fhi-berlin.mpg.de>
Tue, 19 Jan 2016 10:54:27 +0100
changeset 2 3b3af1ff2783
permissions -rw-r--r--
add driver abd device support for adcPi
Ignore whitespace changes - Everywhere: Within whitespace: At end of lines:
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