Staging: comedi: add aio_aio12_8 driver
Diver for Acces I/O Products PC-104 AIO12-8 Analog I/O Board From: Pablo Mejia <pablo.mejia@cctechnol.com> 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:
Pablo Mejia
Greg Kroah-Hartman
parent
ebd127c3f1
commit
7623199aa4
|
|
@ -0,0 +1,226 @@
|
||||||
|
/*
|
||||||
|
|
||||||
|
comedi/drivers/aio_aio12_8.c
|
||||||
|
|
||||||
|
Driver for Acces I/O Products PC-104 AIO12-8 Analog I/O Board
|
||||||
|
Copyright (C) 2006 C&C Technologies, Inc.
|
||||||
|
|
||||||
|
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: aio_aio12_8
|
||||||
|
Description: Acces I/O Products PC-104 AIO12-8 Analog I/O Board
|
||||||
|
Author: Pablo Mejia <pablo.mejia@cctechnol.com>
|
||||||
|
Devices:
|
||||||
|
[Acces I/O] PC-104 AIO12-8
|
||||||
|
Status: experimental
|
||||||
|
|
||||||
|
Configuration Options:
|
||||||
|
[0] - I/O port base address
|
||||||
|
|
||||||
|
Notes:
|
||||||
|
|
||||||
|
Only synchronous operations are supported.
|
||||||
|
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include "../comedidev.h"
|
||||||
|
#include <linux/ioport.h>
|
||||||
|
#include "8255.h"
|
||||||
|
|
||||||
|
#define AIO12_8_STATUS 0x00
|
||||||
|
#define AIO12_8_INTERRUPT 0x01
|
||||||
|
#define AIO12_8_ADC 0x02
|
||||||
|
#define AIO12_8_DAC_0 0x04
|
||||||
|
#define AIO12_8_DAC_1 0x06
|
||||||
|
#define AIO12_8_DAC_2 0x08
|
||||||
|
#define AIO12_8_DAC_3 0x0A
|
||||||
|
#define AIO12_8_COUNTER_0 0x0C
|
||||||
|
#define AIO12_8_COUNTER_1 0x0D
|
||||||
|
#define AIO12_8_COUNTER_2 0x0E
|
||||||
|
#define AIO12_8_COUNTER_CONTROL 0x0F
|
||||||
|
#define AIO12_8_DIO_0 0x10
|
||||||
|
#define AIO12_8_DIO_1 0x11
|
||||||
|
#define AIO12_8_DIO_2 0x12
|
||||||
|
#define AIO12_8_DIO_STATUS 0x13
|
||||||
|
#define AIO12_8_DIO_CONTROL 0x14
|
||||||
|
#define AIO12_8_ADC_TRIGGER_CONTROL 0x15
|
||||||
|
#define AIO12_8_TRIGGER 0x16
|
||||||
|
#define AIO12_8_POWER 0x17
|
||||||
|
|
||||||
|
#define STATUS_ADC_EOC 0x80
|
||||||
|
|
||||||
|
#define ADC_MODE_NORMAL 0x00
|
||||||
|
#define ADC_MODE_INTERNAL_CLOCK 0x40
|
||||||
|
#define ADC_MODE_STANDBY 0x80
|
||||||
|
#define ADC_MODE_POWERDOWN 0xC0
|
||||||
|
|
||||||
|
#define DAC_ENABLE 0x18
|
||||||
|
|
||||||
|
typedef struct {
|
||||||
|
const char *name;
|
||||||
|
} board_type;
|
||||||
|
|
||||||
|
static const board_type board_types[] = {
|
||||||
|
{
|
||||||
|
name: "aio_aio12_8"},
|
||||||
|
};
|
||||||
|
|
||||||
|
#define thisboard ((const board_type *) dev->board_ptr)
|
||||||
|
|
||||||
|
typedef struct {
|
||||||
|
lsampl_t ao_readback[4];
|
||||||
|
} aio12_8_private;
|
||||||
|
|
||||||
|
#define devpriv ((aio12_8_private *) dev->private)
|
||||||
|
|
||||||
|
static int aio_aio12_8_ai_read(comedi_device * dev, comedi_subdevice * s,
|
||||||
|
comedi_insn * insn, lsampl_t * data)
|
||||||
|
{
|
||||||
|
int n;
|
||||||
|
unsigned char control =
|
||||||
|
ADC_MODE_NORMAL |
|
||||||
|
(CR_RANGE(insn->chanspec) << 3) | CR_CHAN(insn->chanspec);
|
||||||
|
|
||||||
|
//read status to clear EOC latch
|
||||||
|
inb(dev->iobase + AIO12_8_STATUS);
|
||||||
|
|
||||||
|
for (n = 0; n < insn->n; n++) {
|
||||||
|
int timeout = 5;
|
||||||
|
|
||||||
|
// Setup and start conversion
|
||||||
|
outb(control, dev->iobase + AIO12_8_ADC);
|
||||||
|
|
||||||
|
// Wait for conversion to complete
|
||||||
|
while (timeout &&
|
||||||
|
!(inb(dev->iobase + AIO12_8_STATUS) & STATUS_ADC_EOC)) {
|
||||||
|
timeout--;
|
||||||
|
printk("timeout %d\n", timeout);
|
||||||
|
comedi_udelay(1);
|
||||||
|
}
|
||||||
|
if (timeout == 0) {
|
||||||
|
comedi_error(dev, "ADC timeout");
|
||||||
|
return -EIO;
|
||||||
|
}
|
||||||
|
|
||||||
|
data[n] = inw(dev->iobase + AIO12_8_ADC) & 0x0FFF;
|
||||||
|
}
|
||||||
|
return n;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int aio_aio12_8_ao_read(comedi_device * dev, comedi_subdevice * s,
|
||||||
|
comedi_insn * insn, lsampl_t * data)
|
||||||
|
{
|
||||||
|
int i;
|
||||||
|
int val = devpriv->ao_readback[CR_CHAN(insn->chanspec)];
|
||||||
|
|
||||||
|
for (i = 0; i < insn->n; i++)
|
||||||
|
data[i] = val;
|
||||||
|
return insn->n;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int aio_aio12_8_ao_write(comedi_device * dev, comedi_subdevice * s,
|
||||||
|
comedi_insn * insn, lsampl_t * data)
|
||||||
|
{
|
||||||
|
int i;
|
||||||
|
int chan = CR_CHAN(insn->chanspec);
|
||||||
|
unsigned long port = dev->iobase + AIO12_8_DAC_0 + (2 * chan);
|
||||||
|
|
||||||
|
//enable DACs
|
||||||
|
outb(0x01, dev->iobase + DAC_ENABLE);
|
||||||
|
|
||||||
|
for (i = 0; i < insn->n; i++) {
|
||||||
|
outb(data[i] & 0xFF, port); // LSB
|
||||||
|
outb((data[i] >> 8) & 0x0F, port + 1); // MSB
|
||||||
|
devpriv->ao_readback[chan] = data[i];
|
||||||
|
}
|
||||||
|
return insn->n;
|
||||||
|
}
|
||||||
|
|
||||||
|
static const comedi_lrange range_aio_aio12_8 = {
|
||||||
|
4,
|
||||||
|
{
|
||||||
|
UNI_RANGE(5),
|
||||||
|
BIP_RANGE(5),
|
||||||
|
UNI_RANGE(10),
|
||||||
|
BIP_RANGE(10),
|
||||||
|
}
|
||||||
|
};
|
||||||
|
|
||||||
|
static int aio_aio12_8_attach(comedi_device * dev, comedi_devconfig * it)
|
||||||
|
{
|
||||||
|
int iobase;
|
||||||
|
comedi_subdevice *s;
|
||||||
|
|
||||||
|
iobase = it->options[0];
|
||||||
|
if (!request_region(iobase, 24, "aio_aio12_8")) {
|
||||||
|
printk("I/O port conflict");
|
||||||
|
return -EIO;
|
||||||
|
}
|
||||||
|
|
||||||
|
dev->board_name = thisboard->name;
|
||||||
|
|
||||||
|
dev->iobase = iobase;
|
||||||
|
|
||||||
|
if (alloc_private(dev, sizeof(aio12_8_private)) < 0)
|
||||||
|
return -ENOMEM;
|
||||||
|
|
||||||
|
if (alloc_subdevices(dev, 3) < 0)
|
||||||
|
return -ENOMEM;
|
||||||
|
|
||||||
|
s = &dev->subdevices[0];
|
||||||
|
s->type = COMEDI_SUBD_AI;
|
||||||
|
s->subdev_flags = SDF_READABLE | SDF_GROUND | SDF_DIFF;
|
||||||
|
s->n_chan = 8;
|
||||||
|
s->maxdata = (1 << 12) - 1;
|
||||||
|
s->range_table = &range_aio_aio12_8;
|
||||||
|
s->insn_read = aio_aio12_8_ai_read;
|
||||||
|
|
||||||
|
s = &dev->subdevices[1];
|
||||||
|
s->type = COMEDI_SUBD_AO;
|
||||||
|
s->subdev_flags = SDF_WRITABLE | SDF_GROUND | SDF_DIFF;
|
||||||
|
s->n_chan = 4;
|
||||||
|
s->maxdata = (1 << 12) - 1;
|
||||||
|
s->range_table = &range_aio_aio12_8;
|
||||||
|
s->insn_read = aio_aio12_8_ao_read;
|
||||||
|
s->insn_write = aio_aio12_8_ao_write;
|
||||||
|
|
||||||
|
s = &dev->subdevices[2];
|
||||||
|
subdev_8255_init(dev, s, NULL, dev->iobase + AIO12_8_DIO_0);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int aio_aio12_8_detach(comedi_device * dev)
|
||||||
|
{
|
||||||
|
subdev_8255_cleanup(dev, &dev->subdevices[2]);
|
||||||
|
if (dev->iobase)
|
||||||
|
release_region(dev->iobase, 24);
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static comedi_driver driver_aio_aio12_8 = {
|
||||||
|
driver_name:"aio_aio12_8",
|
||||||
|
module:THIS_MODULE,
|
||||||
|
attach:aio_aio12_8_attach,
|
||||||
|
detach:aio_aio12_8_detach,
|
||||||
|
board_name:&board_types[0].name,
|
||||||
|
num_names:1,
|
||||||
|
offset:sizeof(board_type),
|
||||||
|
};
|
||||||
|
|
||||||
|
COMEDI_INITCLEANUP(driver_aio_aio12_8);
|
||||||
Loading…
Reference in New Issue