forked from Minki/linux
Staging: comedi: add adq12b driver
driver for MicroAxial ADQ12-B data acquisition and control card From: Jeremy Theler <thelerg@ib.cnea.gov.ar> Cc: David Schleef <ds@schleef.org> Cc: Frank Mori Hess <fmhess@users.sourceforge.net> Cc: Ian Abbott <abbotti@mev.co.uk> Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
This commit is contained in:
Jeremy Theler
Greg Kroah-Hartman
parent
8cb9b9fb97
commit
27b3f921f1
394
drivers/staging/comedi/drivers/adq12b.c
Normal file
394
drivers/staging/comedi/drivers/adq12b.c
Normal file
@ -0,0 +1,394 @@
|
|||||||
|
/*
|
||||||
|
comedi/drivers/adq12b.c
|
||||||
|
driver for MicroAxial ADQ12-B data acquisition and control card
|
||||||
|
|
||||||
|
COMEDI - Linux Control and Measurement Device Interface
|
||||||
|
Copyright (C) 2000 David A. Schleef <ds@schleef.org>
|
||||||
|
|
||||||
|
This program is free software; you can redistribute it and/or modify
|
||||||
|
it under the terms of the GNU General Public License as published by
|
||||||
|
the Free Software Foundation; either version 2 of the License, or
|
||||||
|
(at your option) any later version.
|
||||||
|
|
||||||
|
This program is distributed in the hope that it will be useful,
|
||||||
|
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||||
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||||
|
GNU General Public License for more details.
|
||||||
|
|
||||||
|
You should have received a copy of the GNU General Public License
|
||||||
|
along with this program; if not, write to the Free Software
|
||||||
|
Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
|
||||||
|
|
||||||
|
*/
|
||||||
|
/*
|
||||||
|
Driver: adq12b
|
||||||
|
Description: driver for MicroAxial ADQ12-B data acquisition and control card
|
||||||
|
Devices: [MicroAxial] ADQ12-B (adq12b)
|
||||||
|
Author: jeremy theler <thelerg@ib.cnea.gov.ar>
|
||||||
|
Updated: Thu, 21 Feb 2008 02:56:27 -0300
|
||||||
|
Status: works
|
||||||
|
|
||||||
|
Driver for the acquisition card ADQ12-B (without any add-on).
|
||||||
|
|
||||||
|
- Analog input is subdevice 0 (16 channels single-ended or 8 differential)
|
||||||
|
- Digital input is subdevice 1 (5 channels)
|
||||||
|
- Digital output is subdevice 1 (8 channels)
|
||||||
|
- The PACER is not supported in this version
|
||||||
|
|
||||||
|
If you do not specify any options, they will default to
|
||||||
|
|
||||||
|
# comedi_config /dev/comedi0 adq12b 0x300,0,0
|
||||||
|
|
||||||
|
option 1: I/O base address. The following table is provided as a help
|
||||||
|
of the hardware jumpers.
|
||||||
|
|
||||||
|
address jumper JADR
|
||||||
|
0x300 1 (factory default)
|
||||||
|
0x320 2
|
||||||
|
0x340 3
|
||||||
|
0x360 4
|
||||||
|
0x380 5
|
||||||
|
0x3A0 6
|
||||||
|
|
||||||
|
option 2: unipolar/bipolar ADC selection: 0 -> bipolar, 1 -> unipolar
|
||||||
|
|
||||||
|
selection comedi_config option JUB
|
||||||
|
bipolar 0 2-3 (factory default)
|
||||||
|
unipolar 1 1-2
|
||||||
|
|
||||||
|
option 3: single-ended/differential AI selection: 0 -> SE, 1 -> differential
|
||||||
|
|
||||||
|
selection comedi_config option JCHA JCHB
|
||||||
|
single-ended 0 1-2 1-2 (factory default)
|
||||||
|
differential 1 2-3 2-3
|
||||||
|
|
||||||
|
|
||||||
|
written by jeremy theler <thelerg@ib.cnea.gov.ar>
|
||||||
|
|
||||||
|
instituto balseiro
|
||||||
|
comision nacional de energia atomica
|
||||||
|
universidad nacional de cuyo
|
||||||
|
argentina
|
||||||
|
|
||||||
|
21-feb-2008
|
||||||
|
+ changed supported devices string (missused the [] and ())
|
||||||
|
|
||||||
|
13-oct-2007
|
||||||
|
+ first try
|
||||||
|
|
||||||
|
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include "../comedidev.h"
|
||||||
|
|
||||||
|
// address scheme (page 2.17 of the manual)
|
||||||
|
#define ADQ12B_SIZE 16
|
||||||
|
|
||||||
|
#define ADQ12B_CTREG 0x00
|
||||||
|
#define ADQ12B_STINR 0x00
|
||||||
|
#define ADQ12B_OUTBR 0x04
|
||||||
|
#define ADQ12B_ADLOW 0x08
|
||||||
|
#define ADQ12B_ADHIG 0x09
|
||||||
|
#define ADQ12B_CONT0 0x0c
|
||||||
|
#define ADQ12B_CONT1 0x0d
|
||||||
|
#define ADQ12B_CONT2 0x0e
|
||||||
|
#define ADQ12B_COWORD 0x0f
|
||||||
|
|
||||||
|
// mask of the bit at STINR to check end of conversion
|
||||||
|
#define ADQ12B_EOC 0x20
|
||||||
|
|
||||||
|
#define TIMEOUT 20
|
||||||
|
|
||||||
|
// available ranges through the PGA gains
|
||||||
|
static const comedi_lrange range_adq12b_ai_bipolar = { 4, {
|
||||||
|
BIP_RANGE( 5 ),
|
||||||
|
BIP_RANGE( 2 ),
|
||||||
|
BIP_RANGE( 1 ),
|
||||||
|
BIP_RANGE( 0.5 )
|
||||||
|
}};
|
||||||
|
|
||||||
|
static const comedi_lrange range_adq12b_ai_unipolar = { 4, {
|
||||||
|
UNI_RANGE( 5 ),
|
||||||
|
UNI_RANGE( 2 ),
|
||||||
|
UNI_RANGE( 1 ),
|
||||||
|
UNI_RANGE( 0.5 )
|
||||||
|
}};
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
typedef struct adq12b_board_struct{
|
||||||
|
const char *name;
|
||||||
|
int ai_se_chans;
|
||||||
|
int ai_diff_chans;
|
||||||
|
int ai_bits;
|
||||||
|
int di_chans;
|
||||||
|
int do_chans;
|
||||||
|
}adq12b_board;
|
||||||
|
|
||||||
|
static const adq12b_board adq12b_boards[] = {
|
||||||
|
{
|
||||||
|
name: "adq12b",
|
||||||
|
ai_se_chans: 16,
|
||||||
|
ai_diff_chans: 8,
|
||||||
|
ai_bits: 12,
|
||||||
|
di_chans: 5,
|
||||||
|
do_chans: 8
|
||||||
|
}
|
||||||
|
// potentially, more adq-based deviced will be added
|
||||||
|
/*,
|
||||||
|
name: "adq12b",
|
||||||
|
ai_chans: 16, // this is just for reference, hardcoded again later
|
||||||
|
ai_bits: 12,
|
||||||
|
di_chans: 8,
|
||||||
|
do_chans: 5
|
||||||
|
}*/
|
||||||
|
};
|
||||||
|
|
||||||
|
#define thisboard ((const adq12b_board *)dev->board_ptr)
|
||||||
|
|
||||||
|
typedef struct{
|
||||||
|
int unipolar; /* option 2 of comedi_config (1 is iobase) */
|
||||||
|
int differential; /* option 3 of comedi_config */
|
||||||
|
int last_channel;
|
||||||
|
int last_range;
|
||||||
|
lsampl_t digital_state;
|
||||||
|
}adq12b_private;
|
||||||
|
|
||||||
|
#define devpriv ((adq12b_private *)dev->private)
|
||||||
|
|
||||||
|
/*
|
||||||
|
* The comedi_driver structure tells the Comedi core module
|
||||||
|
* which functions to call to configure/deconfigure (attach/detach)
|
||||||
|
* the board, and also about the kernel module that contains
|
||||||
|
* the device code.
|
||||||
|
*/
|
||||||
|
static int adq12b_attach(comedi_device *dev,comedi_devconfig *it);
|
||||||
|
static int adq12b_detach(comedi_device *dev);
|
||||||
|
static comedi_driver driver_adq12b={
|
||||||
|
driver_name: "adq12b",
|
||||||
|
module: THIS_MODULE,
|
||||||
|
attach: adq12b_attach,
|
||||||
|
detach: adq12b_detach,
|
||||||
|
board_name: &adq12b_boards[0].name,
|
||||||
|
offset: sizeof(adq12b_board),
|
||||||
|
num_names: sizeof(adq12b_boards) / sizeof(adq12b_board),
|
||||||
|
};
|
||||||
|
|
||||||
|
static int adq12b_ai_rinsn(comedi_device *dev,comedi_subdevice *s,comedi_insn *insn,lsampl_t *data);
|
||||||
|
static int adq12b_di_insn_bits(comedi_device *dev,comedi_subdevice *s, comedi_insn *insn,lsampl_t *data);
|
||||||
|
static int adq12b_do_insn_bits(comedi_device *dev,comedi_subdevice *s, comedi_insn *insn,lsampl_t *data);
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Attach is called by the Comedi core to configure the driver
|
||||||
|
* for a particular board. If you specified a board_name array
|
||||||
|
* in the driver structure, dev->board_ptr contains that
|
||||||
|
* address.
|
||||||
|
*/
|
||||||
|
static int adq12b_attach(comedi_device *dev,comedi_devconfig *it)
|
||||||
|
{
|
||||||
|
comedi_subdevice *s;
|
||||||
|
unsigned long iobase;
|
||||||
|
int unipolar, differential;
|
||||||
|
|
||||||
|
iobase = it->options[0];
|
||||||
|
unipolar = it->options[1];
|
||||||
|
differential = it->options[2];
|
||||||
|
|
||||||
|
printk("comedi%d: adq12b called with options base=0x%03lx, %s and %s\n",dev->minor, iobase, (unipolar==1)?"unipolar":"bipolar", (differential==1)?"differential":"single-ended");
|
||||||
|
|
||||||
|
/* if no address was specified, try the default 0x300 */
|
||||||
|
if (iobase == 0) {
|
||||||
|
printk("comedi%d: adq12b warning: I/O base address not specified. Trying the default 0x300.\n", dev->minor);
|
||||||
|
iobase = 0x300;
|
||||||
|
}
|
||||||
|
|
||||||
|
printk("comedi%d: adq12b: 0x%04lx ", dev->minor, iobase);
|
||||||
|
if (!request_region(iobase, ADQ12B_SIZE, "adq12b")) {
|
||||||
|
printk("I/O port conflict\n");
|
||||||
|
return -EIO;
|
||||||
|
}
|
||||||
|
dev->iobase = iobase;
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Initialize dev->board_name. Note that we can use the "thisboard"
|
||||||
|
* macro now, since we just initialized it in the last line.
|
||||||
|
*/
|
||||||
|
dev->board_name = thisboard->name;
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Allocate the private structure area. alloc_private() is a
|
||||||
|
* convenient macro defined in comedidev.h.
|
||||||
|
*/
|
||||||
|
if(alloc_private(dev, sizeof(adq12b_private)) < 0)
|
||||||
|
return -ENOMEM;
|
||||||
|
|
||||||
|
/* fill in devpriv structure */
|
||||||
|
devpriv->unipolar = unipolar;
|
||||||
|
devpriv->differential = differential;
|
||||||
|
devpriv->digital_state = 0;
|
||||||
|
/* initialize channel and range to -1 so we make sure we always write
|
||||||
|
at least once to the CTREG in the instruction */
|
||||||
|
devpriv->last_channel = -1;
|
||||||
|
devpriv->last_range = -1;
|
||||||
|
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Allocate the subdevice structures. alloc_subdevice() is a
|
||||||
|
* convenient macro defined in comedidev.h.
|
||||||
|
*/
|
||||||
|
if(alloc_subdevices(dev, 3)<0)
|
||||||
|
return -ENOMEM;
|
||||||
|
|
||||||
|
s = dev->subdevices+0;
|
||||||
|
/* analog input subdevice */
|
||||||
|
s->type = COMEDI_SUBD_AI;
|
||||||
|
if (differential) {
|
||||||
|
s->subdev_flags = SDF_READABLE|SDF_GROUND|SDF_DIFF;
|
||||||
|
s->n_chan = thisboard->ai_diff_chans;
|
||||||
|
} else {
|
||||||
|
s->subdev_flags = SDF_READABLE|SDF_GROUND;
|
||||||
|
s->n_chan = thisboard->ai_se_chans;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (unipolar) {
|
||||||
|
s->range_table = &range_adq12b_ai_unipolar;
|
||||||
|
} else {
|
||||||
|
s->range_table = &range_adq12b_ai_bipolar;
|
||||||
|
}
|
||||||
|
|
||||||
|
s->maxdata = (1 << thisboard->ai_bits)-1;
|
||||||
|
|
||||||
|
|
||||||
|
s->len_chanlist = 4; /* This is the maximum chanlist length that
|
||||||
|
the board can handle */
|
||||||
|
s->insn_read = adq12b_ai_rinsn;
|
||||||
|
|
||||||
|
|
||||||
|
s = dev->subdevices+1;
|
||||||
|
/* digital input subdevice */
|
||||||
|
s->type = COMEDI_SUBD_DI;
|
||||||
|
s->subdev_flags = SDF_READABLE;
|
||||||
|
s->n_chan=thisboard->di_chans;
|
||||||
|
s->maxdata = 1;
|
||||||
|
s->range_table = &range_digital;
|
||||||
|
s->insn_bits = adq12b_di_insn_bits;
|
||||||
|
|
||||||
|
s = dev->subdevices+2;
|
||||||
|
/* digital output subdevice */
|
||||||
|
s->type = COMEDI_SUBD_DO;
|
||||||
|
s->subdev_flags = SDF_WRITABLE;
|
||||||
|
s->n_chan = thisboard->do_chans;
|
||||||
|
s->maxdata = 1;
|
||||||
|
s->range_table = &range_digital;
|
||||||
|
s->insn_bits = adq12b_do_insn_bits;
|
||||||
|
|
||||||
|
|
||||||
|
printk("attached\n");
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
/*
|
||||||
|
* _detach is called to deconfigure a device. It should deallocate
|
||||||
|
* resources.
|
||||||
|
* This function is also called when _attach() fails, so it should be
|
||||||
|
* careful not to release resources that were not necessarily
|
||||||
|
* allocated by _attach(). dev->private and dev->subdevices are
|
||||||
|
* deallocated automatically by the core.
|
||||||
|
*/
|
||||||
|
static int adq12b_detach(comedi_device *dev)
|
||||||
|
{
|
||||||
|
if (dev->iobase)
|
||||||
|
release_region(dev->iobase, ADQ12B_SIZE);
|
||||||
|
|
||||||
|
kfree(devpriv);
|
||||||
|
|
||||||
|
printk("comedi%d: adq12b: removed\n",dev->minor);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
* "instructions" read/write data in "one-shot" or "software-triggered"
|
||||||
|
* mode.
|
||||||
|
*/
|
||||||
|
|
||||||
|
static int adq12b_ai_rinsn(comedi_device *dev,comedi_subdevice *s,comedi_insn *insn,lsampl_t *data)
|
||||||
|
{
|
||||||
|
int n, i;
|
||||||
|
int range, channel;
|
||||||
|
unsigned char hi, lo, status;
|
||||||
|
|
||||||
|
/* change channel and range only if it is different from the previous */
|
||||||
|
range = CR_RANGE(insn->chanspec);
|
||||||
|
channel = CR_CHAN(insn->chanspec);
|
||||||
|
if (channel != devpriv->last_channel || range != devpriv->last_range) {
|
||||||
|
outb((range << 4) | channel, dev->iobase + ADQ12B_CTREG);
|
||||||
|
comedi_udelay(50); /* wait for the mux to settle */
|
||||||
|
}
|
||||||
|
|
||||||
|
/* trigger conversion */
|
||||||
|
status = inb(dev->iobase + ADQ12B_ADLOW);
|
||||||
|
|
||||||
|
/* convert n samples */
|
||||||
|
for(n=0; n < insn->n; n++){
|
||||||
|
|
||||||
|
/* wait for end of convertion */
|
||||||
|
i = 0;
|
||||||
|
do {
|
||||||
|
// comedi_udelay(1);
|
||||||
|
status = inb(dev->iobase + ADQ12B_STINR);
|
||||||
|
status = status & ADQ12B_EOC;
|
||||||
|
} while (status == 0 && ++i < TIMEOUT);
|
||||||
|
// } while (++i < 10);
|
||||||
|
|
||||||
|
/* read data */
|
||||||
|
hi = inb(dev->iobase + ADQ12B_ADHIG);
|
||||||
|
lo = inb(dev->iobase + ADQ12B_ADLOW);
|
||||||
|
|
||||||
|
//rt_printk("debug: chan=%d range=%d status=%d hi=%d lo=%d\n", channel, range, status, hi, lo);
|
||||||
|
data[n] = (hi << 8) | lo;
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
/* return the number of samples read/written */
|
||||||
|
return n;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
static int adq12b_di_insn_bits(comedi_device *dev,comedi_subdevice *s, comedi_insn *insn,lsampl_t *data)
|
||||||
|
{
|
||||||
|
|
||||||
|
/* only bits 0-4 have information about digital inputs */
|
||||||
|
data[1] = (inb(dev->iobase+ADQ12B_STINR) & (0x1f));
|
||||||
|
|
||||||
|
return 2;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
static int adq12b_do_insn_bits(comedi_device *dev,comedi_subdevice *s, comedi_insn *insn,lsampl_t *data)
|
||||||
|
{
|
||||||
|
int channel;
|
||||||
|
|
||||||
|
for (channel = 0; channel < 8; channel++)
|
||||||
|
if (((data[0]>>channel) & 0x01) != 0)
|
||||||
|
outb((((data[1]>>channel)&0x01)<<3) | channel, dev->iobase + ADQ12B_OUTBR);
|
||||||
|
|
||||||
|
/* store information to retrieve when asked for reading */
|
||||||
|
if (data[0]) {
|
||||||
|
devpriv->digital_state &= ~data[0];
|
||||||
|
devpriv->digital_state |= (data[0]&data[1]);
|
||||||
|
}
|
||||||
|
|
||||||
|
data[1] = devpriv->digital_state;
|
||||||
|
|
||||||
|
return 2;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
/*
|
||||||
|
* A convenient macro that defines init_module() and cleanup_module(),
|
||||||
|
* as necessary.
|
||||||
|
*/
|
||||||
|
COMEDI_INITCLEANUP(driver_adq12b);
|
||||||
Loading…
Reference in New Issue
Block a user