Linux 2.6.31-rc6
[linux-2.6] / drivers / staging / comedi / drivers / acl7225b.c
1 /*
2  * comedi/drivers/acl7225b.c
3  * Driver for Adlink NuDAQ ACL-7225b and clones
4  * José Luis Sánchez
5  */
6 /*
7 Driver: acl7225b
8 Description: Adlink NuDAQ ACL-7225b & compatibles
9 Author: José Luis Sánchez (jsanchezv@teleline.es)
10 Status: testing
11 Devices: [Adlink] ACL-7225b (acl7225b), [ICP] P16R16DIO (p16r16dio)
12 */
13
14 #include "../comedidev.h"
15
16 #include <linux/ioport.h>
17
18 #define ACL7225_SIZE   8        /* Requires 8 ioports, but only 4 are used */
19 #define P16R16DIO_SIZE 4
20 #define ACL7225_RIO_LO 0        /* Relays input/output low byte (R0-R7) */
21 #define ACL7225_RIO_HI 1        /* Relays input/output high byte (R8-R15) */
22 #define ACL7225_DI_LO  2        /* Digital input low byte (DI0-DI7) */
23 #define ACL7225_DI_HI  3        /* Digital input high byte (DI8-DI15) */
24
25 static int acl7225b_attach(struct comedi_device *dev, struct comedi_devconfig * it);
26 static int acl7225b_detach(struct comedi_device *dev);
27
28 struct boardtype {
29         const char *name;       /*  driver name */
30         int io_range;           /*  len of I/O space */
31 };
32
33 static const struct boardtype boardtypes[] = {
34         {"acl7225b", ACL7225_SIZE,},
35         {"p16r16dio", P16R16DIO_SIZE,},
36 };
37
38 #define n_boardtypes (sizeof(boardtypes)/sizeof(struct boardtype))
39 #define this_board ((const struct boardtype *)dev->board_ptr)
40
41 static struct comedi_driver driver_acl7225b = {
42         .driver_name = "acl7225b",
43         .module = THIS_MODULE,
44         .attach = acl7225b_attach,
45         .detach = acl7225b_detach,
46         .board_name = &boardtypes[0].name,
47         .num_names = n_boardtypes,
48         .offset = sizeof(struct boardtype),
49 };
50
51 COMEDI_INITCLEANUP(driver_acl7225b);
52
53 static int acl7225b_do_insn(struct comedi_device *dev, struct comedi_subdevice * s,
54         struct comedi_insn *insn, unsigned int *data)
55 {
56         if (insn->n != 2)
57                 return -EINVAL;
58
59         if (data[0]) {
60                 s->state &= ~data[0];
61                 s->state |= (data[0] & data[1]);
62         }
63         if (data[0] & 0x00ff)
64                 outb(s->state & 0xff, dev->iobase + (unsigned long)s->private);
65         if (data[0] & 0xff00)
66                 outb((s->state >> 8),
67                         dev->iobase + (unsigned long)s->private + 1);
68
69         data[1] = s->state;
70
71         return 2;
72 }
73
74 static int acl7225b_di_insn(struct comedi_device *dev, struct comedi_subdevice * s,
75         struct comedi_insn *insn, unsigned int *data)
76 {
77         if (insn->n != 2)
78                 return -EINVAL;
79
80         data[1] = inb(dev->iobase + (unsigned long)s->private) |
81                 (inb(dev->iobase + (unsigned long)s->private + 1) << 8);
82
83         return 2;
84 }
85
86 static int acl7225b_attach(struct comedi_device *dev, struct comedi_devconfig * it)
87 {
88         struct comedi_subdevice *s;
89         int iobase, iorange;
90
91         iobase = it->options[0];
92         iorange = this_board->io_range;
93         printk("comedi%d: acl7225b: board=%s 0x%04x ", dev->minor,
94                 this_board->name, iobase);
95         if (!request_region(iobase, iorange, "acl7225b")) {
96                 printk("I/O port conflict\n");
97                 return -EIO;
98         }
99         dev->board_name = this_board->name;
100         dev->iobase = iobase;
101         dev->irq = 0;
102
103         if (alloc_subdevices(dev, 3) < 0)
104                 return -ENOMEM;
105
106         s = dev->subdevices + 0;
107         /* Relays outputs */
108         s->type = COMEDI_SUBD_DO;
109         s->subdev_flags = SDF_WRITABLE;
110         s->maxdata = 1;
111         s->n_chan = 16;
112         s->insn_bits = acl7225b_do_insn;
113         s->range_table = &range_digital;
114         s->private = (void *)ACL7225_RIO_LO;
115
116         s = dev->subdevices + 1;
117         /* Relays status */
118         s->type = COMEDI_SUBD_DI;
119         s->subdev_flags = SDF_READABLE;
120         s->maxdata = 1;
121         s->n_chan = 16;
122         s->insn_bits = acl7225b_di_insn;
123         s->range_table = &range_digital;
124         s->private = (void *)ACL7225_RIO_LO;
125
126         s = dev->subdevices + 2;
127         /* Isolated digital inputs */
128         s->type = COMEDI_SUBD_DI;
129         s->subdev_flags = SDF_READABLE;
130         s->maxdata = 1;
131         s->n_chan = 16;
132         s->insn_bits = acl7225b_di_insn;
133         s->range_table = &range_digital;
134         s->private = (void *)ACL7225_DI_LO;
135
136         printk("\n");
137
138         return 0;
139 }
140
141 static int acl7225b_detach(struct comedi_device *dev)
142 {
143         printk("comedi%d: acl7225b: remove\n", dev->minor);
144
145         if (dev->iobase)
146                 release_region(dev->iobase, this_board->io_range);
147
148         return 0;
149 }