staging: comedi: pcmuio: fix possible NULL deref on detach
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / staging / comedi / drivers / rti802.c
1 /*
2 comedi/drivers/rti802.c
3 Hardware driver for Analog Devices RTI-802 board
4
5 COMEDI - Linux Control and Measurement Device Interface
6 Copyright (C) 1999 Anders Blomdell <anders.blomdell@control.lth.se>
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: rti802
25 Description: Analog Devices RTI-802
26 Author: Anders Blomdell <anders.blomdell@control.lth.se>
27 Devices: [Analog Devices] RTI-802 (rti802)
28 Status: works
29
30 Configuration Options:
31 [0] - i/o base
32 [1] - unused
33 [2] - dac#0 0=two's comp, 1=straight
34 [3] - dac#0 0=bipolar, 1=unipolar
35 [4] - dac#1 ...
36 ...
37 [17] - dac#7 ...
38 */
39
40 #include "../comedidev.h"
41
42 #include <linux/ioport.h>
43
44 #define RTI802_SIZE 4
45
46 #define RTI802_SELECT 0
47 #define RTI802_DATALOW 1
48 #define RTI802_DATAHIGH 2
49
50 struct rti802_private {
51 enum {
52 dac_2comp, dac_straight
53 } dac_coding[8];
54 const struct comedi_lrange *range_type_list[8];
55 unsigned int ao_readback[8];
56 };
57
58 static int rti802_ao_insn_read(struct comedi_device *dev,
59 struct comedi_subdevice *s,
60 struct comedi_insn *insn, unsigned int *data)
61 {
62 struct rti802_private *devpriv = dev->private;
63 int i;
64
65 for (i = 0; i < insn->n; i++)
66 data[i] = devpriv->ao_readback[CR_CHAN(insn->chanspec)];
67
68 return i;
69 }
70
71 static int rti802_ao_insn_write(struct comedi_device *dev,
72 struct comedi_subdevice *s,
73 struct comedi_insn *insn, unsigned int *data)
74 {
75 struct rti802_private *devpriv = dev->private;
76 int i, d;
77 int chan = CR_CHAN(insn->chanspec);
78
79 for (i = 0; i < insn->n; i++) {
80 d = devpriv->ao_readback[chan] = data[i];
81 if (devpriv->dac_coding[chan] == dac_2comp)
82 d ^= 0x800;
83 outb(chan, dev->iobase + RTI802_SELECT);
84 outb(d & 0xff, dev->iobase + RTI802_DATALOW);
85 outb(d >> 8, dev->iobase + RTI802_DATAHIGH);
86 }
87 return i;
88 }
89
90 static int rti802_attach(struct comedi_device *dev, struct comedi_devconfig *it)
91 {
92 struct rti802_private *devpriv;
93 struct comedi_subdevice *s;
94 int i;
95 int ret;
96
97 ret = comedi_request_region(dev, it->options[0], RTI802_SIZE);
98 if (ret)
99 return ret;
100
101 devpriv = kzalloc(sizeof(*devpriv), GFP_KERNEL);
102 if (!devpriv)
103 return -ENOMEM;
104 dev->private = devpriv;
105
106 ret = comedi_alloc_subdevices(dev, 1);
107 if (ret)
108 return ret;
109
110 s = &dev->subdevices[0];
111 /* ao subdevice */
112 s->type = COMEDI_SUBD_AO;
113 s->subdev_flags = SDF_WRITABLE;
114 s->maxdata = 0xfff;
115 s->n_chan = 8;
116 s->insn_read = rti802_ao_insn_read;
117 s->insn_write = rti802_ao_insn_write;
118 s->range_table_list = devpriv->range_type_list;
119
120 for (i = 0; i < 8; i++) {
121 devpriv->dac_coding[i] = (it->options[3 + 2 * i])
122 ? (dac_straight)
123 : (dac_2comp);
124 devpriv->range_type_list[i] = (it->options[2 + 2 * i])
125 ? &range_unipolar10 : &range_bipolar10;
126 }
127
128 return 0;
129 }
130
131 static struct comedi_driver rti802_driver = {
132 .driver_name = "rti802",
133 .module = THIS_MODULE,
134 .attach = rti802_attach,
135 .detach = comedi_legacy_detach,
136 };
137 module_comedi_driver(rti802_driver);
138
139 MODULE_AUTHOR("Comedi http://www.comedi.org");
140 MODULE_DESCRIPTION("Comedi low-level driver");
141 MODULE_LICENSE("GPL");