Add the rt linux 4.1.3-rt3 as base
[kvmfornfv.git] / kernel / drivers / staging / comedi / drivers / dyna_pci10xx.c
1 /*
2  * comedi/drivers/dyna_pci10xx.c
3  * Copyright (C) 2011 Prashant Shah, pshah.mumbai@gmail.com
4  *
5  * This program is free software; you can redistribute it and/or modify
6  * it under the terms of the GNU General Public License as published by
7  * the Free Software Foundation; either version 2 of the License, or
8  * (at your option) any later version.
9  *
10  * This program is distributed in the hope that it will be useful,
11  * but WITHOUT ANY WARRANTY; without even the implied warranty of
12  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
13  * GNU General Public License for more details.
14  */
15
16 /*
17  * Driver: dyna_pci10xx
18  * Description: Dynalog India PCI DAQ Cards, http://www.dynalogindia.com/
19  * Devices: [Dynalog] PCI-1050 (dyna_pci1050)
20  * Author: Prashant Shah <pshah.mumbai@gmail.com>
21  * Status: Stable
22  *
23  * Developed at Automation Labs, Chemical Dept., IIT Bombay, India.
24  * Prof. Kannan Moudgalya <kannan@iitb.ac.in>
25  * http://www.iitb.ac.in
26  *
27  * Notes :
28  * - Dynalog India Pvt. Ltd. does not have a registered PCI Vendor ID and
29  *   they are using the PLX Technlogies Vendor ID since that is the PCI Chip
30  *   used in the card.
31  * - Dynalog India Pvt. Ltd. has provided the internal register specification
32  *   for their cards in their manuals.
33  */
34
35 #include <linux/module.h>
36 #include <linux/delay.h>
37 #include <linux/mutex.h>
38
39 #include "../comedi_pci.h"
40
41 #define READ_TIMEOUT 50
42
43 static const struct comedi_lrange range_pci1050_ai = {
44         3, {
45                 BIP_RANGE(10),
46                 BIP_RANGE(5),
47                 UNI_RANGE(10)
48         }
49 };
50
51 static const char range_codes_pci1050_ai[] = { 0x00, 0x10, 0x30 };
52
53 struct dyna_pci10xx_private {
54         struct mutex mutex;
55         unsigned long BADR3;
56 };
57
58 static int dyna_pci10xx_ai_eoc(struct comedi_device *dev,
59                                struct comedi_subdevice *s,
60                                struct comedi_insn *insn,
61                                unsigned long context)
62 {
63         unsigned int status;
64
65         status = inw_p(dev->iobase);
66         if (status & (1 << 15))
67                 return 0;
68         return -EBUSY;
69 }
70
71 static int dyna_pci10xx_insn_read_ai(struct comedi_device *dev,
72                                      struct comedi_subdevice *s,
73                                      struct comedi_insn *insn,
74                                      unsigned int *data)
75 {
76         struct dyna_pci10xx_private *devpriv = dev->private;
77         int n;
78         u16 d = 0;
79         int ret = 0;
80         unsigned int chan, range;
81
82         /* get the channel number and range */
83         chan = CR_CHAN(insn->chanspec);
84         range = range_codes_pci1050_ai[CR_RANGE((insn->chanspec))];
85
86         mutex_lock(&devpriv->mutex);
87         /* convert n samples */
88         for (n = 0; n < insn->n; n++) {
89                 /* trigger conversion */
90                 smp_mb();
91                 outw_p(0x0000 + range + chan, dev->iobase + 2);
92                 udelay(10);
93
94                 ret = comedi_timeout(dev, s, insn, dyna_pci10xx_ai_eoc, 0);
95                 if (ret)
96                         break;
97
98                 /* read data */
99                 d = inw_p(dev->iobase);
100                 /* mask the first 4 bits - EOC bits */
101                 d &= 0x0FFF;
102                 data[n] = d;
103         }
104         mutex_unlock(&devpriv->mutex);
105
106         /* return the number of samples read/written */
107         return ret ? ret : n;
108 }
109
110 /* analog output callback */
111 static int dyna_pci10xx_insn_write_ao(struct comedi_device *dev,
112                                       struct comedi_subdevice *s,
113                                       struct comedi_insn *insn,
114                                       unsigned int *data)
115 {
116         struct dyna_pci10xx_private *devpriv = dev->private;
117         int n;
118         unsigned int chan, range;
119
120         chan = CR_CHAN(insn->chanspec);
121         range = range_codes_pci1050_ai[CR_RANGE((insn->chanspec))];
122
123         mutex_lock(&devpriv->mutex);
124         for (n = 0; n < insn->n; n++) {
125                 smp_mb();
126                 /* trigger conversion and write data */
127                 outw_p(data[n], dev->iobase);
128                 udelay(10);
129         }
130         mutex_unlock(&devpriv->mutex);
131         return n;
132 }
133
134 /* digital input bit interface */
135 static int dyna_pci10xx_di_insn_bits(struct comedi_device *dev,
136                                      struct comedi_subdevice *s,
137                                      struct comedi_insn *insn,
138                                      unsigned int *data)
139 {
140         struct dyna_pci10xx_private *devpriv = dev->private;
141         u16 d = 0;
142
143         mutex_lock(&devpriv->mutex);
144         smp_mb();
145         d = inw_p(devpriv->BADR3);
146         udelay(10);
147
148         /* on return the data[0] contains output and data[1] contains input */
149         data[1] = d;
150         data[0] = s->state;
151         mutex_unlock(&devpriv->mutex);
152         return insn->n;
153 }
154
155 static int dyna_pci10xx_do_insn_bits(struct comedi_device *dev,
156                                      struct comedi_subdevice *s,
157                                      struct comedi_insn *insn,
158                                      unsigned int *data)
159 {
160         struct dyna_pci10xx_private *devpriv = dev->private;
161
162         mutex_lock(&devpriv->mutex);
163         if (comedi_dio_update_state(s, data)) {
164                 smp_mb();
165                 outw_p(s->state, devpriv->BADR3);
166                 udelay(10);
167         }
168
169         data[1] = s->state;
170         mutex_unlock(&devpriv->mutex);
171
172         return insn->n;
173 }
174
175 static int dyna_pci10xx_auto_attach(struct comedi_device *dev,
176                                     unsigned long context_unused)
177 {
178         struct pci_dev *pcidev = comedi_to_pci_dev(dev);
179         struct dyna_pci10xx_private *devpriv;
180         struct comedi_subdevice *s;
181         int ret;
182
183         devpriv = comedi_alloc_devpriv(dev, sizeof(*devpriv));
184         if (!devpriv)
185                 return -ENOMEM;
186
187         ret = comedi_pci_enable(dev);
188         if (ret)
189                 return ret;
190         dev->iobase = pci_resource_start(pcidev, 2);
191         devpriv->BADR3 = pci_resource_start(pcidev, 3);
192
193         mutex_init(&devpriv->mutex);
194
195         ret = comedi_alloc_subdevices(dev, 4);
196         if (ret)
197                 return ret;
198
199         /* analog input */
200         s = &dev->subdevices[0];
201         s->type = COMEDI_SUBD_AI;
202         s->subdev_flags = SDF_READABLE | SDF_GROUND | SDF_DIFF;
203         s->n_chan = 16;
204         s->maxdata = 0x0FFF;
205         s->range_table = &range_pci1050_ai;
206         s->len_chanlist = 16;
207         s->insn_read = dyna_pci10xx_insn_read_ai;
208
209         /* analog output */
210         s = &dev->subdevices[1];
211         s->type = COMEDI_SUBD_AO;
212         s->subdev_flags = SDF_WRITABLE;
213         s->n_chan = 16;
214         s->maxdata = 0x0FFF;
215         s->range_table = &range_unipolar10;
216         s->len_chanlist = 16;
217         s->insn_write = dyna_pci10xx_insn_write_ao;
218
219         /* digital input */
220         s = &dev->subdevices[2];
221         s->type = COMEDI_SUBD_DI;
222         s->subdev_flags = SDF_READABLE;
223         s->n_chan = 16;
224         s->maxdata = 1;
225         s->range_table = &range_digital;
226         s->len_chanlist = 16;
227         s->insn_bits = dyna_pci10xx_di_insn_bits;
228
229         /* digital output */
230         s = &dev->subdevices[3];
231         s->type = COMEDI_SUBD_DO;
232         s->subdev_flags = SDF_WRITABLE;
233         s->n_chan = 16;
234         s->maxdata = 1;
235         s->range_table = &range_digital;
236         s->len_chanlist = 16;
237         s->state = 0;
238         s->insn_bits = dyna_pci10xx_do_insn_bits;
239
240         return 0;
241 }
242
243 static void dyna_pci10xx_detach(struct comedi_device *dev)
244 {
245         struct dyna_pci10xx_private *devpriv = dev->private;
246
247         comedi_pci_detach(dev);
248         if (devpriv)
249                 mutex_destroy(&devpriv->mutex);
250 }
251
252 static struct comedi_driver dyna_pci10xx_driver = {
253         .driver_name    = "dyna_pci10xx",
254         .module         = THIS_MODULE,
255         .auto_attach    = dyna_pci10xx_auto_attach,
256         .detach         = dyna_pci10xx_detach,
257 };
258
259 static int dyna_pci10xx_pci_probe(struct pci_dev *dev,
260                                   const struct pci_device_id *id)
261 {
262         return comedi_pci_auto_config(dev, &dyna_pci10xx_driver,
263                                       id->driver_data);
264 }
265
266 static const struct pci_device_id dyna_pci10xx_pci_table[] = {
267         { PCI_DEVICE(PCI_VENDOR_ID_PLX, 0x1050) },
268         { 0 }
269 };
270 MODULE_DEVICE_TABLE(pci, dyna_pci10xx_pci_table);
271
272 static struct pci_driver dyna_pci10xx_pci_driver = {
273         .name           = "dyna_pci10xx",
274         .id_table       = dyna_pci10xx_pci_table,
275         .probe          = dyna_pci10xx_pci_probe,
276         .remove         = comedi_pci_auto_unconfig,
277 };
278 module_comedi_pci_driver(dyna_pci10xx_driver, dyna_pci10xx_pci_driver);
279
280 MODULE_LICENSE("GPL");
281 MODULE_AUTHOR("Prashant Shah <pshah.mumbai@gmail.com>");
282 MODULE_DESCRIPTION("Comedi based drivers for Dynalog PCI DAQ cards");