Staging: comedi: add pcl724 driver
For Advantech cards: PCL-724, PCL-722, PCL-731 ADLink ACL-7122, ACL-7124, PET-48DIO From: Michal Dobes <dobes@tesnet.cz> 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:
Michal Dobes
committed by
Greg Kroah-Hartman
Greg Kroah-Hartman
parent
bb71f8b315
commit
b3c1e463b7
220
drivers/staging/comedi/drivers/pcl724.c
Normal file
220
drivers/staging/comedi/drivers/pcl724.c
Normal file
@@ -0,0 +1,220 @@
|
||||
/*
|
||||
comedi/drivers/pcl724.c
|
||||
|
||||
Michal Dobes <dobes@tesnet.cz>
|
||||
|
||||
hardware driver for Advantech cards:
|
||||
card: PCL-724, PCL-722, PCL-731
|
||||
driver: pcl724, pcl722, pcl731
|
||||
and ADLink cards:
|
||||
card: ACL-7122, ACL-7124, PET-48DIO
|
||||
driver: acl7122, acl7124, pet48dio
|
||||
|
||||
Options for PCL-724, PCL-731, ACL-7124 and PET-48DIO:
|
||||
[0] - IO Base
|
||||
|
||||
Options for PCL-722 and ACL-7122:
|
||||
[0] - IO Base
|
||||
[1] - IRQ (0=disable IRQ) IRQ isn't supported at this time!
|
||||
[2] -number of DIO:
|
||||
0, 144: 144 DIO configuration
|
||||
1, 96: 96 DIO configuration
|
||||
*/
|
||||
/*
|
||||
Driver: pcl724
|
||||
Description: Advantech PCL-724, PCL-722, PCL-731 ADLink ACL-7122, ACL-7124,
|
||||
PET-48DIO
|
||||
Author: Michal Dobes <dobes@tesnet.cz>
|
||||
Devices: [Advantech] PCL-724 (pcl724), PCL-722 (pcl722), PCL-731 (pcl731),
|
||||
[ADLink] ACL-7122 (acl7122), ACL-7124 (acl7124), PET-48DIO (pet48dio)
|
||||
Status: untested
|
||||
|
||||
This is driver for digital I/O boards PCL-722/724/731 with 144/24/48 DIO
|
||||
and for digital I/O boards ACL-7122/7124/PET-48DIO with 144/24/48 DIO.
|
||||
It need 8255.o for operations and only immediate mode is supported.
|
||||
See the source for configuration details.
|
||||
*/
|
||||
/*
|
||||
* check_driver overrides:
|
||||
* comedi_insn
|
||||
*/
|
||||
|
||||
#include "../comedidev.h"
|
||||
|
||||
#include <linux/ioport.h>
|
||||
#include <linux/delay.h>
|
||||
|
||||
#include "8255.h"
|
||||
|
||||
#define PCL722_SIZE 32
|
||||
#define PCL722_96_SIZE 16
|
||||
#define PCL724_SIZE 4
|
||||
#define PCL731_SIZE 8
|
||||
#define PET48_SIZE 2
|
||||
|
||||
#define SIZE_8255 4
|
||||
|
||||
// #define PCL724_IRQ 1 /* no IRQ support now */
|
||||
|
||||
static int pcl724_attach(comedi_device * dev, comedi_devconfig * it);
|
||||
static int pcl724_detach(comedi_device * dev);
|
||||
|
||||
typedef struct {
|
||||
const char *name; // board name
|
||||
int dio; // num of DIO
|
||||
int numofports; // num of 8255 subdevices
|
||||
unsigned int IRQbits; // allowed interrupts
|
||||
unsigned int io_range; // len of IO space
|
||||
char can_have96;
|
||||
char is_pet48;
|
||||
} boardtype;
|
||||
|
||||
static const boardtype boardtypes[] = {
|
||||
{"pcl724", 24, 1, 0x00fc, PCL724_SIZE, 0, 0,},
|
||||
{"pcl722", 144, 6, 0x00fc, PCL722_SIZE, 1, 0,},
|
||||
{"pcl731", 48, 2, 0x9cfc, PCL731_SIZE, 0, 0,},
|
||||
{"acl7122", 144, 6, 0x9ee8, PCL722_SIZE, 1, 0,},
|
||||
{"acl7124", 24, 1, 0x00fc, PCL724_SIZE, 0, 0,},
|
||||
{"pet48dio", 48, 2, 0x9eb8, PET48_SIZE, 0, 1,},
|
||||
};
|
||||
|
||||
#define n_boardtypes (sizeof(boardtypes)/sizeof(boardtype))
|
||||
#define this_board ((const boardtype *)dev->board_ptr)
|
||||
|
||||
static comedi_driver driver_pcl724 = {
|
||||
driver_name:"pcl724",
|
||||
module:THIS_MODULE,
|
||||
attach:pcl724_attach,
|
||||
detach:pcl724_detach,
|
||||
board_name:&boardtypes[0].name,
|
||||
num_names:n_boardtypes,
|
||||
offset:sizeof(boardtype),
|
||||
};
|
||||
|
||||
COMEDI_INITCLEANUP(driver_pcl724);
|
||||
|
||||
static int subdev_8255_cb(int dir, int port, int data, unsigned long arg)
|
||||
{
|
||||
unsigned long iobase = arg;
|
||||
|
||||
if (dir) {
|
||||
outb(data, iobase + port);
|
||||
return 0;
|
||||
} else {
|
||||
return inb(iobase + port);
|
||||
}
|
||||
}
|
||||
|
||||
static int subdev_8255mapped_cb(int dir, int port, int data,
|
||||
unsigned long iobase)
|
||||
{
|
||||
int movport = SIZE_8255 * (iobase >> 12);
|
||||
|
||||
iobase &= 0x0fff;
|
||||
|
||||
if (dir) {
|
||||
outb(port + movport, iobase);
|
||||
outb(data, iobase + 1);
|
||||
return 0;
|
||||
} else {
|
||||
outb(port + movport, iobase);
|
||||
return inb(iobase + 1);
|
||||
}
|
||||
}
|
||||
|
||||
static int pcl724_attach(comedi_device * dev, comedi_devconfig * it)
|
||||
{
|
||||
unsigned long iobase;
|
||||
unsigned int iorange;
|
||||
int ret, i, n_subdevices;
|
||||
#ifdef PCL724_IRQ
|
||||
unsigned int irq;
|
||||
#endif
|
||||
|
||||
iobase = it->options[0];
|
||||
iorange = this_board->io_range;
|
||||
if ((this_board->can_have96) && ((it->options[1] == 1)
|
||||
|| (it->options[1] == 96)))
|
||||
iorange = PCL722_96_SIZE; // PCL-724 in 96 DIO configuration
|
||||
printk("comedi%d: pcl724: board=%s, 0x%03lx ", dev->minor,
|
||||
this_board->name, iobase);
|
||||
if (!request_region(iobase, iorange, "pcl724")) {
|
||||
printk("I/O port conflict\n");
|
||||
return -EIO;
|
||||
}
|
||||
|
||||
dev->iobase = iobase;
|
||||
|
||||
dev->board_name = this_board->name;
|
||||
|
||||
#ifdef PCL724_IRQ
|
||||
irq = 0;
|
||||
if (this_board->IRQbits != 0) { /* board support IRQ */
|
||||
irq = it->options[1];
|
||||
if (irq) { /* we want to use IRQ */
|
||||
if (((1 << irq) & this_board->IRQbits) == 0) {
|
||||
rt_printk
|
||||
(", IRQ %u is out of allowed range, DISABLING IT",
|
||||
irq);
|
||||
irq = 0; /* Bad IRQ */
|
||||
} else {
|
||||
if (comedi_request_irq(irq, interrupt_pcl724, 0,
|
||||
"pcl724", dev)) {
|
||||
rt_printk
|
||||
(", unable to allocate IRQ %u, DISABLING IT",
|
||||
irq);
|
||||
irq = 0; /* Can't use IRQ */
|
||||
} else {
|
||||
rt_printk(", irq=%u", irq);
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
dev->irq = irq;
|
||||
#endif
|
||||
|
||||
printk("\n");
|
||||
|
||||
n_subdevices = this_board->numofports;
|
||||
if ((this_board->can_have96) && ((it->options[1] == 1)
|
||||
|| (it->options[1] == 96)))
|
||||
n_subdevices = 4; // PCL-724 in 96 DIO configuration
|
||||
|
||||
if ((ret = alloc_subdevices(dev, n_subdevices)) < 0)
|
||||
return ret;
|
||||
|
||||
for (i = 0; i < dev->n_subdevices; i++) {
|
||||
if (this_board->is_pet48) {
|
||||
subdev_8255_init(dev, dev->subdevices + i,
|
||||
subdev_8255mapped_cb,
|
||||
(unsigned long)(dev->iobase + i * 0x1000));
|
||||
} else
|
||||
subdev_8255_init(dev, dev->subdevices + i,
|
||||
subdev_8255_cb,
|
||||
(unsigned long)(dev->iobase + SIZE_8255 * i));
|
||||
};
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int pcl724_detach(comedi_device * dev)
|
||||
{
|
||||
int i;
|
||||
|
||||
// printk("comedi%d: pcl724: remove\n",dev->minor);
|
||||
|
||||
for (i = 0; i < dev->n_subdevices; i++) {
|
||||
subdev_8255_cleanup(dev, dev->subdevices + i);
|
||||
}
|
||||
|
||||
#ifdef PCL724_IRQ
|
||||
if (dev->irq) {
|
||||
comedi_free_irq(dev->irq, dev);
|
||||
}
|
||||
#endif
|
||||
|
||||
release_region(dev->iobase, this_board->io_range);
|
||||
|
||||
return 0;
|
||||
}
|
||||
Reference in New Issue
Block a user