staging: comedi: adl_pci9111: fix incorrect irq passed to request_irq()
[firefly-linux-kernel-4.4.55.git] / drivers / staging / comedi / drivers / pcl724.c
1 /*
2     comedi/drivers/pcl724.c
3
4     Michal Dobes <dobes@tesnet.cz>
5
6     hardware driver for Advantech cards:
7      card:   PCL-724, PCL-722, PCL-731
8      driver: pcl724,  pcl722,  pcl731
9     and ADLink cards:
10      card:   ACL-7122, ACL-7124, PET-48DIO
11      driver: acl7122,  acl7124,  pet48dio
12
13     Options for PCL-724, PCL-731, ACL-7124 and PET-48DIO:
14      [0] - IO Base
15
16     Options for PCL-722 and ACL-7122:
17      [0] - IO Base
18      [1] - IRQ (0=disable IRQ) IRQ isn't supported at this time!
19      [2] -number of DIO:
20               0, 144: 144 DIO configuration
21               1,  96:  96 DIO configuration
22 */
23 /*
24 Driver: pcl724
25 Description: Advantech PCL-724, PCL-722, PCL-731 ADLink ACL-7122, ACL-7124,
26   PET-48DIO
27 Author: Michal Dobes <dobes@tesnet.cz>
28 Devices: [Advantech] PCL-724 (pcl724), PCL-722 (pcl722), PCL-731 (pcl731),
29   [ADLink] ACL-7122 (acl7122), ACL-7124 (acl7124), PET-48DIO (pet48dio)
30 Status: untested
31
32 This is driver for digital I/O boards PCL-722/724/731 with 144/24/48 DIO
33 and for digital I/O boards ACL-7122/7124/PET-48DIO with 144/24/48 DIO.
34 It need 8255.o for operations and only immediate mode is supported.
35 See the source for configuration details.
36 */
37 /*
38  * check_driver overrides:
39  *   struct comedi_insn
40  */
41
42 #include "../comedidev.h"
43
44 #include <linux/ioport.h>
45 #include <linux/delay.h>
46
47 #include "8255.h"
48
49 #define PCL722_SIZE    32
50 #define PCL722_96_SIZE 16
51 #define PCL724_SIZE     4
52 #define PCL731_SIZE     8
53 #define PET48_SIZE      2
54
55 #define SIZE_8255       4
56
57 /* #define PCL724_IRQ   1  no IRQ support now */
58
59 struct pcl724_board {
60
61         const char *name;       /*  board name */
62         int dio;                /*  num of DIO */
63         int numofports;         /*  num of 8255 subdevices */
64         unsigned int IRQbits;   /*  allowed interrupts */
65         unsigned int io_range;  /*  len of IO space */
66         char can_have96;
67         char is_pet48;
68 };
69
70 static int subdev_8255_cb(int dir, int port, int data, unsigned long arg)
71 {
72         unsigned long iobase = arg;
73
74         if (dir) {
75                 outb(data, iobase + port);
76                 return 0;
77         } else {
78                 return inb(iobase + port);
79         }
80 }
81
82 static int subdev_8255mapped_cb(int dir, int port, int data,
83                                 unsigned long iobase)
84 {
85         int movport = SIZE_8255 * (iobase >> 12);
86
87         iobase &= 0x0fff;
88
89         if (dir) {
90                 outb(port + movport, iobase);
91                 outb(data, iobase + 1);
92                 return 0;
93         } else {
94                 outb(port + movport, iobase);
95                 return inb(iobase + 1);
96         }
97 }
98
99 static int pcl724_attach(struct comedi_device *dev, struct comedi_devconfig *it)
100 {
101         const struct pcl724_board *board = comedi_board(dev);
102         struct comedi_subdevice *s;
103         unsigned int iorange;
104         int ret, i, n_subdevices;
105 #ifdef PCL724_IRQ
106         unsigned int irq;
107 #endif
108
109         iorange = board->io_range;
110         if ((board->can_have96) &&
111             ((it->options[1] == 1) || (it->options[1] == 96)))
112                 iorange = PCL722_96_SIZE; /* PCL-724 in 96 DIO configuration */
113         ret = comedi_request_region(dev, it->options[0], iorange);
114         if (ret)
115                 return ret;
116
117 #ifdef PCL724_IRQ
118         irq = 0;
119         if (board->IRQbits != 0) {      /* board support IRQ */
120                 irq = it->options[1];
121                 if (irq) {      /* we want to use IRQ */
122                         if (((1 << irq) & board->IRQbits) == 0) {
123                                 printk(KERN_WARNING
124                                        ", IRQ %u is out of allowed range, "
125                                        "DISABLING IT", irq);
126                                 irq = 0;        /* Bad IRQ */
127                         } else {
128                                 if (request_irq(irq, interrupt_pcl724, 0,
129                                                 dev->board_name, dev)) {
130                                         printk(KERN_WARNING
131                                                ", unable to allocate IRQ %u, "
132                                                "DISABLING IT", irq);
133                                         irq = 0;        /* Can't use IRQ */
134                                 } else {
135                                         printk(", irq=%u", irq);
136                                 }
137                         }
138                 }
139         }
140
141         dev->irq = irq;
142 #endif
143
144         printk("\n");
145
146         n_subdevices = board->numofports;
147         if ((board->can_have96) && ((it->options[1] == 1)
148                                          || (it->options[1] == 96)))
149                 n_subdevices = 4;       /*  PCL-724 in 96 DIO configuration */
150
151         ret = comedi_alloc_subdevices(dev, n_subdevices);
152         if (ret)
153                 return ret;
154
155         for (i = 0; i < dev->n_subdevices; i++) {
156                 s = &dev->subdevices[i];
157                 if (board->is_pet48) {
158                         subdev_8255_init(dev, s, subdev_8255mapped_cb,
159                                          (unsigned long)(dev->iobase +
160                                                          i * 0x1000));
161                 } else
162                         subdev_8255_init(dev, s, subdev_8255_cb,
163                                          (unsigned long)(dev->iobase +
164                                                          SIZE_8255 * i));
165         }
166
167         return 0;
168 }
169
170 static void pcl724_detach(struct comedi_device *dev)
171 {
172         int i;
173
174         for (i = 0; i < dev->n_subdevices; i++)
175                 comedi_spriv_free(dev, i);
176         comedi_legacy_detach(dev);
177 }
178
179 static const struct pcl724_board boardtypes[] = {
180         { "pcl724", 24, 1, 0x00fc, PCL724_SIZE, 0, 0, },
181         { "pcl722", 144, 6, 0x00fc, PCL722_SIZE, 1, 0, },
182         { "pcl731", 48, 2, 0x9cfc, PCL731_SIZE, 0, 0, },
183         { "acl7122", 144, 6, 0x9ee8, PCL722_SIZE, 1, 0, },
184         { "acl7124", 24, 1, 0x00fc, PCL724_SIZE, 0, 0, },
185         { "pet48dio", 48, 2, 0x9eb8, PET48_SIZE, 0, 1, },
186 };
187
188 static struct comedi_driver pcl724_driver = {
189         .driver_name    = "pcl724",
190         .module         = THIS_MODULE,
191         .attach         = pcl724_attach,
192         .detach         = pcl724_detach,
193         .board_name     = &boardtypes[0].name,
194         .num_names      = ARRAY_SIZE(boardtypes),
195         .offset         = sizeof(struct pcl724_board),
196 };
197 module_comedi_driver(pcl724_driver);
198
199 MODULE_AUTHOR("Comedi http://www.comedi.org");
200 MODULE_DESCRIPTION("Comedi low-level driver");
201 MODULE_LICENSE("GPL");