Merge commit 'v3.7-rc1' into stable/for-linus-3.7
[firefly-linux-kernel-4.4.55.git] / drivers / staging / comedi / drivers / adl_pci6208.c
1 /*
2     comedi/drivers/adl_pci6208.c
3
4     Hardware driver for ADLink 6208 series cards:
5         card         | voltage output    | current output
6         -------------+-------------------+---------------
7         PCI-6208V    |  8 channels       | -
8         PCI-6216V    | 16 channels       | -
9         PCI-6208A    |  8 channels       | 8 channels
10
11     COMEDI - Linux Control and Measurement Device Interface
12     Copyright (C) 2000 David A. Schleef <ds@schleef.org>
13
14     This program is free software; you can redistribute it and/or modify
15     it under the terms of the GNU General Public License as published by
16     the Free Software Foundation; either version 2 of the License, or
17     (at your option) any later version.
18
19     This program is distributed in the hope that it will be useful,
20     but WITHOUT ANY WARRANTY; without even the implied warranty of
21     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
22     GNU General Public License for more details.
23
24     You should have received a copy of the GNU General Public License
25     along with this program; if not, write to the Free Software
26     Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
27 */
28 /*
29 Driver: adl_pci6208
30 Description: ADLink PCI-6208/6216 Series Multi-channel Analog Output Cards
31 Devices: (ADLink) PCI-6208 [adl_pci6208]
32          (ADLink) PCI-6216 [adl_pci6216]
33 Author: nsyeow <nsyeow@pd.jaring.my>
34 Updated: Fri, 30 Jan 2004 14:44:27 +0800
35 Status: untested
36
37 Configuration Options: not applicable, uses PCI auto config
38
39 References:
40         - ni_660x.c
41         - adl_pci9111.c         copied the entire pci setup section
42         - adl_pci9118.c
43 */
44
45 #include "../comedidev.h"
46
47 /*
48  * ADLINK PCI Device ID's supported by this driver
49  */
50 #define PCI_DEVICE_ID_PCI6208           0x6208
51 #define PCI_DEVICE_ID_PCI6216           0x6216
52
53 /*
54  * PCI-6208/6216-GL register map
55  */
56 #define PCI6208_AO_CONTROL(x)           (0x00 + (2 * (x)))
57 #define PCI6208_AO_STATUS               0x00
58 #define PCI6208_AO_STATUS_DATA_SEND     (1 << 0)
59 #define PCI6208_DIO                     0x40
60 #define PCI6208_DIO_DO_MASK             (0x0f)
61 #define PCI6208_DIO_DO_SHIFT            (0)
62 #define PCI6208_DIO_DI_MASK             (0xf0)
63 #define PCI6208_DIO_DI_SHIFT            (4)
64
65 #define PCI6208_MAX_AO_CHANNELS         16
66
67 struct pci6208_board {
68         const char *name;
69         unsigned short dev_id;
70         int ao_chans;
71 };
72
73 static const struct pci6208_board pci6208_boards[] = {
74         {
75                 .name           = "adl_pci6208",
76                 .dev_id         = PCI_DEVICE_ID_PCI6208,
77                 .ao_chans       = 8,
78         }, {
79                 .name           = "adl_pci6216",
80                 .dev_id         = PCI_DEVICE_ID_PCI6216,
81                 .ao_chans       = 16,
82         },
83 };
84
85 struct pci6208_private {
86         unsigned int ao_readback[PCI6208_MAX_AO_CHANNELS];
87 };
88
89 static int pci6208_ao_winsn(struct comedi_device *dev,
90                             struct comedi_subdevice *s,
91                             struct comedi_insn *insn, unsigned int *data)
92 {
93         struct pci6208_private *devpriv = dev->private;
94         int chan = CR_CHAN(insn->chanspec);
95         unsigned long invert = 1 << (16 - 1);
96         unsigned long value = 0;
97         unsigned short status;
98         int i;
99
100         for (i = 0; i < insn->n; i++) {
101                 value = data[i] ^ invert;
102
103                 do {
104                         status = inw(dev->iobase + PCI6208_AO_STATUS);
105                 } while (status & PCI6208_AO_STATUS_DATA_SEND);
106
107                 outw(value, dev->iobase + PCI6208_AO_CONTROL(chan));
108         }
109         devpriv->ao_readback[chan] = value;
110
111         return insn->n;
112 }
113
114 static int pci6208_ao_rinsn(struct comedi_device *dev,
115                             struct comedi_subdevice *s,
116                             struct comedi_insn *insn, unsigned int *data)
117 {
118         struct pci6208_private *devpriv = dev->private;
119         int chan = CR_CHAN(insn->chanspec);
120         int i;
121
122         for (i = 0; i < insn->n; i++)
123                 data[i] = devpriv->ao_readback[chan];
124
125         return insn->n;
126 }
127
128 static int pci6208_di_insn_bits(struct comedi_device *dev,
129                                 struct comedi_subdevice *s,
130                                 struct comedi_insn *insn,
131                                 unsigned int *data)
132 {
133         unsigned int val;
134
135         val = inw(dev->iobase + PCI6208_DIO);
136         val = (val & PCI6208_DIO_DI_MASK) >> PCI6208_DIO_DI_SHIFT;
137
138         data[1] = val;
139
140         return insn->n;
141 }
142
143 static int pci6208_do_insn_bits(struct comedi_device *dev,
144                                 struct comedi_subdevice *s,
145                                 struct comedi_insn *insn,
146                                 unsigned int *data)
147 {
148         unsigned int mask = data[0];
149         unsigned int bits = data[1];
150
151         if (mask) {
152                 s->state &= ~mask;
153                 s->state |= (bits & mask);
154
155                 outw(s->state, dev->iobase + PCI6208_DIO);
156         }
157
158         data[1] = s->state;
159
160         return insn->n;
161 }
162
163 static const void *pci6208_find_boardinfo(struct comedi_device *dev,
164                                           struct pci_dev *pcidev)
165 {
166         const struct pci6208_board *boardinfo;
167         int i;
168
169         for (i = 0; i < ARRAY_SIZE(pci6208_boards); i++) {
170                 boardinfo = &pci6208_boards[i];
171                 if (boardinfo->dev_id == pcidev->device)
172                         return boardinfo;
173         }
174         return NULL;
175 }
176
177 static int pci6208_attach_pci(struct comedi_device *dev,
178                               struct pci_dev *pcidev)
179 {
180         const struct pci6208_board *boardinfo;
181         struct pci6208_private *devpriv;
182         struct comedi_subdevice *s;
183         unsigned int val;
184         int ret;
185
186         comedi_set_hw_dev(dev, &pcidev->dev);
187
188         boardinfo = pci6208_find_boardinfo(dev, pcidev);
189         if (!boardinfo)
190                 return -ENODEV;
191         dev->board_ptr = boardinfo;
192         dev->board_name = boardinfo->name;
193
194         ret = alloc_private(dev, sizeof(*devpriv));
195         if (ret < 0)
196                 return ret;
197         devpriv = dev->private;
198
199         ret = comedi_pci_enable(pcidev, dev->board_name);
200         if (ret)
201                 return ret;
202         dev->iobase = pci_resource_start(pcidev, 2);
203
204         ret = comedi_alloc_subdevices(dev, 3);
205         if (ret)
206                 return ret;
207
208         s = &dev->subdevices[0];
209         /* analog output subdevice */
210         s->type         = COMEDI_SUBD_AO;
211         s->subdev_flags = SDF_WRITABLE;
212         s->n_chan       = boardinfo->ao_chans;
213         s->maxdata      = 0xffff;
214         s->range_table  = &range_bipolar10;
215         s->insn_write   = pci6208_ao_winsn;
216         s->insn_read    = pci6208_ao_rinsn;
217
218         s = &dev->subdevices[1];
219         /* digital input subdevice */
220         s->type         = COMEDI_SUBD_DI;
221         s->subdev_flags = SDF_READABLE;
222         s->n_chan       = 4;
223         s->maxdata      = 1;
224         s->range_table  = &range_digital;
225         s->insn_bits    = pci6208_di_insn_bits;
226
227         s = &dev->subdevices[2];
228         /* digital output subdevice */
229         s->type         = COMEDI_SUBD_DO;
230         s->subdev_flags = SDF_WRITABLE;
231         s->n_chan       = 4;
232         s->maxdata      = 1;
233         s->range_table  = &range_digital;
234         s->insn_bits    = pci6208_do_insn_bits;
235
236         /*
237          * Get the read back signals from the digital outputs
238          * and save it as the initial state for the subdevice.
239          */
240         val = inw(dev->iobase + PCI6208_DIO);
241         val = (val & PCI6208_DIO_DO_MASK) >> PCI6208_DIO_DO_SHIFT;
242         s->state        = val;
243         s->io_bits      = 0x0f;
244
245         dev_info(dev->class_dev, "%s: %s, I/O base=0x%04lx\n",
246                 dev->driver->driver_name, dev->board_name, dev->iobase);
247
248         return 0;
249 }
250
251 static void pci6208_detach(struct comedi_device *dev)
252 {
253         struct pci_dev *pcidev = comedi_to_pci_dev(dev);
254
255         if (pcidev) {
256                 if (dev->iobase)
257                         comedi_pci_disable(pcidev);
258         }
259 }
260
261 static struct comedi_driver adl_pci6208_driver = {
262         .driver_name    = "adl_pci6208",
263         .module         = THIS_MODULE,
264         .attach_pci     = pci6208_attach_pci,
265         .detach         = pci6208_detach,
266 };
267
268 static int __devinit adl_pci6208_pci_probe(struct pci_dev *dev,
269                                            const struct pci_device_id *ent)
270 {
271         return comedi_pci_auto_config(dev, &adl_pci6208_driver);
272 }
273
274 static void __devexit adl_pci6208_pci_remove(struct pci_dev *dev)
275 {
276         comedi_pci_auto_unconfig(dev);
277 }
278
279 static DEFINE_PCI_DEVICE_TABLE(adl_pci6208_pci_table) = {
280         { PCI_DEVICE(PCI_VENDOR_ID_ADLINK, PCI_DEVICE_ID_PCI6208) },
281         { PCI_DEVICE(PCI_VENDOR_ID_ADLINK, PCI_DEVICE_ID_PCI6216) },
282         { 0 }
283 };
284 MODULE_DEVICE_TABLE(pci, adl_pci6208_pci_table);
285
286 static struct pci_driver adl_pci6208_pci_driver = {
287         .name           = "adl_pci6208",
288         .id_table       = adl_pci6208_pci_table,
289         .probe          = adl_pci6208_pci_probe,
290         .remove         = __devexit_p(adl_pci6208_pci_remove),
291 };
292 module_comedi_pci_driver(adl_pci6208_driver, adl_pci6208_pci_driver);
293
294 MODULE_AUTHOR("Comedi http://www.comedi.org");
295 MODULE_DESCRIPTION("Comedi low-level driver");
296 MODULE_LICENSE("GPL");