staging: comedi: pcmuio: fix possible NULL deref on detach
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / staging / comedi / drivers / adq12b.c
1 /*
2 comedi/drivers/adq12b.c
3 driver for MicroAxial ADQ12-B data acquisition and control card
4
5 COMEDI - Linux Control and Measurement Device Interface
6 Copyright (C) 2000 David A. Schleef <ds@schleef.org>
7
8 This program is free software; you can redistribute it and/or modify
9 it under the terms of the GNU General Public License as published by
10 the Free Software Foundation; either version 2 of the License, or
11 (at your option) any later version.
12
13 This program is distributed in the hope that it will be useful,
14 but WITHOUT ANY WARRANTY; without even the implied warranty of
15 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 GNU General Public License for more details.
17
18 You should have received a copy of the GNU General Public License
19 along with this program; if not, write to the Free Software
20 Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
21
22 */
23 /*
24 Driver: adq12b
25 Description: driver for MicroAxial ADQ12-B data acquisition and control card
26 Devices: [MicroAxial] ADQ12-B (adq12b)
27 Author: jeremy theler <thelerg@ib.cnea.gov.ar>
28 Updated: Thu, 21 Feb 2008 02:56:27 -0300
29 Status: works
30
31 Driver for the acquisition card ADQ12-B (without any add-on).
32
33 - Analog input is subdevice 0 (16 channels single-ended or 8 differential)
34 - Digital input is subdevice 1 (5 channels)
35 - Digital output is subdevice 1 (8 channels)
36 - The PACER is not supported in this version
37
38 If you do not specify any options, they will default to
39
40 # comedi_config /dev/comedi0 adq12b 0x300,0,0
41
42 option 1: I/O base address. The following table is provided as a help
43 of the hardware jumpers.
44
45 address jumper JADR
46 0x300 1 (factory default)
47 0x320 2
48 0x340 3
49 0x360 4
50 0x380 5
51 0x3A0 6
52
53 option 2: unipolar/bipolar ADC selection: 0 -> bipolar, 1 -> unipolar
54
55 selection comedi_config option JUB
56 bipolar 0 2-3 (factory default)
57 unipolar 1 1-2
58
59 option 3: single-ended/differential AI selection: 0 -> SE, 1 -> differential
60
61 selection comedi_config option JCHA JCHB
62 single-ended 0 1-2 1-2 (factory default)
63 differential 1 2-3 2-3
64
65 written by jeremy theler <thelerg@ib.cnea.gov.ar>
66
67 instituto balseiro
68 commission nacional de energia atomica
69 universidad nacional de cuyo
70 argentina
71
72 21-feb-2008
73 + changed supported devices string (missused the [] and ())
74
75 13-oct-2007
76 + first try
77
78
79 */
80
81 #include "../comedidev.h"
82
83 /* address scheme (page 2.17 of the manual) */
84 #define ADQ12B_SIZE 16
85
86 #define ADQ12B_CTREG 0x00
87 #define ADQ12B_STINR 0x00
88 #define ADQ12B_OUTBR 0x04
89 #define ADQ12B_ADLOW 0x08
90 #define ADQ12B_ADHIG 0x09
91 #define ADQ12B_CONT0 0x0c
92 #define ADQ12B_CONT1 0x0d
93 #define ADQ12B_CONT2 0x0e
94 #define ADQ12B_COWORD 0x0f
95
96 /* mask of the bit at STINR to check end of conversion */
97 #define ADQ12B_EOC 0x20
98
99 #define TIMEOUT 20
100
101 /* available ranges through the PGA gains */
102 static const struct comedi_lrange range_adq12b_ai_bipolar = { 4, {
103 BIP_RANGE(5),
104 BIP_RANGE(2),
105 BIP_RANGE(1),
106 BIP_RANGE(0.5)
107 }
108 };
109
110 static const struct comedi_lrange range_adq12b_ai_unipolar = { 4, {
111 UNI_RANGE(5),
112 UNI_RANGE(2),
113 UNI_RANGE(1),
114 UNI_RANGE
115 (0.5)
116 }
117 };
118
119 struct adq12b_private {
120 int unipolar; /* option 2 of comedi_config (1 is iobase) */
121 int differential; /* option 3 of comedi_config */
122 int last_channel;
123 int last_range;
124 unsigned int digital_state;
125 };
126
127 /*
128 * "instructions" read/write data in "one-shot" or "software-triggered"
129 * mode.
130 */
131
132 static int adq12b_ai_rinsn(struct comedi_device *dev,
133 struct comedi_subdevice *s, struct comedi_insn *insn,
134 unsigned int *data)
135 {
136 struct adq12b_private *devpriv = dev->private;
137 int n, i;
138 int range, channel;
139 unsigned char hi, lo, status;
140
141 /* change channel and range only if it is different from the previous */
142 range = CR_RANGE(insn->chanspec);
143 channel = CR_CHAN(insn->chanspec);
144 if (channel != devpriv->last_channel || range != devpriv->last_range) {
145 outb((range << 4) | channel, dev->iobase + ADQ12B_CTREG);
146 udelay(50); /* wait for the mux to settle */
147 }
148
149 /* trigger conversion */
150 status = inb(dev->iobase + ADQ12B_ADLOW);
151
152 /* convert n samples */
153 for (n = 0; n < insn->n; n++) {
154
155 /* wait for end of conversion */
156 i = 0;
157 do {
158 /* udelay(1); */
159 status = inb(dev->iobase + ADQ12B_STINR);
160 status = status & ADQ12B_EOC;
161 } while (status == 0 && ++i < TIMEOUT);
162 /* } while (++i < 10); */
163
164 /* read data */
165 hi = inb(dev->iobase + ADQ12B_ADHIG);
166 lo = inb(dev->iobase + ADQ12B_ADLOW);
167
168 /* printk("debug: chan=%d range=%d status=%d hi=%d lo=%d\n",
169 channel, range, status, hi, lo); */
170 data[n] = (hi << 8) | lo;
171
172 }
173
174 /* return the number of samples read/written */
175 return n;
176 }
177
178 static int adq12b_di_insn_bits(struct comedi_device *dev,
179 struct comedi_subdevice *s,
180 struct comedi_insn *insn, unsigned int *data)
181 {
182
183 /* only bits 0-4 have information about digital inputs */
184 data[1] = (inb(dev->iobase + ADQ12B_STINR) & (0x1f));
185
186 return insn->n;
187 }
188
189 static int adq12b_do_insn_bits(struct comedi_device *dev,
190 struct comedi_subdevice *s,
191 struct comedi_insn *insn, unsigned int *data)
192 {
193 struct adq12b_private *devpriv = dev->private;
194 int channel;
195
196 for (channel = 0; channel < 8; channel++)
197 if (((data[0] >> channel) & 0x01) != 0)
198 outb((((data[1] >> channel) & 0x01) << 3) | channel,
199 dev->iobase + ADQ12B_OUTBR);
200
201 /* store information to retrieve when asked for reading */
202 if (data[0]) {
203 devpriv->digital_state &= ~data[0];
204 devpriv->digital_state |= (data[0] & data[1]);
205 }
206
207 data[1] = devpriv->digital_state;
208
209 return insn->n;
210 }
211
212 static int adq12b_attach(struct comedi_device *dev, struct comedi_devconfig *it)
213 {
214 struct adq12b_private *devpriv;
215 struct comedi_subdevice *s;
216 int ret;
217
218 ret = comedi_request_region(dev, it->options[0], ADQ12B_SIZE);
219 if (ret)
220 return ret;
221
222 devpriv = kzalloc(sizeof(*devpriv), GFP_KERNEL);
223 if (!devpriv)
224 return -ENOMEM;
225 dev->private = devpriv;
226
227 devpriv->unipolar = it->options[1];
228 devpriv->differential = it->options[2];
229 devpriv->digital_state = 0;
230 /*
231 * initialize channel and range to -1 so we make sure we
232 * always write at least once to the CTREG in the instruction
233 */
234 devpriv->last_channel = -1;
235 devpriv->last_range = -1;
236
237 ret = comedi_alloc_subdevices(dev, 3);
238 if (ret)
239 return ret;
240
241 s = &dev->subdevices[0];
242 /* analog input subdevice */
243 s->type = COMEDI_SUBD_AI;
244 if (devpriv->differential) {
245 s->subdev_flags = SDF_READABLE | SDF_GROUND | SDF_DIFF;
246 s->n_chan = 8;
247 } else {
248 s->subdev_flags = SDF_READABLE | SDF_GROUND;
249 s->n_chan = 16;
250 }
251
252 if (devpriv->unipolar)
253 s->range_table = &range_adq12b_ai_unipolar;
254 else
255 s->range_table = &range_adq12b_ai_bipolar;
256
257 s->maxdata = 0xfff;
258
259 s->len_chanlist = 4; /* This is the maximum chanlist length that
260 the board can handle */
261 s->insn_read = adq12b_ai_rinsn;
262
263 s = &dev->subdevices[1];
264 /* digital input subdevice */
265 s->type = COMEDI_SUBD_DI;
266 s->subdev_flags = SDF_READABLE;
267 s->n_chan = 5;
268 s->maxdata = 1;
269 s->range_table = &range_digital;
270 s->insn_bits = adq12b_di_insn_bits;
271
272 s = &dev->subdevices[2];
273 /* digital output subdevice */
274 s->type = COMEDI_SUBD_DO;
275 s->subdev_flags = SDF_WRITABLE;
276 s->n_chan = 8;
277 s->maxdata = 1;
278 s->range_table = &range_digital;
279 s->insn_bits = adq12b_do_insn_bits;
280
281 return 0;
282 }
283
284 static struct comedi_driver adq12b_driver = {
285 .driver_name = "adq12b",
286 .module = THIS_MODULE,
287 .attach = adq12b_attach,
288 .detach = comedi_legacy_detach,
289 };
290 module_comedi_driver(adq12b_driver);
291
292 MODULE_AUTHOR("Comedi http://www.comedi.org");
293 MODULE_DESCRIPTION("Comedi low-level driver");
294 MODULE_LICENSE("GPL");