1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58#include <linux/module.h>
59#include <linux/delay.h>
60
61#include "../comedidev.h"
62
63
64#define ADQ12B_CTREG 0x00
65#define ADQ12B_CTREG_MSKP BIT(7)
66#define ADQ12B_CTREG_GTP BIT(6)
67#define ADQ12B_CTREG_RANGE(x) ((x) << 4)
68#define ADQ12B_CTREG_CHAN(x) ((x) << 0)
69#define ADQ12B_STINR 0x00
70#define ADQ12B_STINR_OUT2 BIT(7)
71#define ADQ12B_STINR_OUTP BIT(6)
72#define ADQ12B_STINR_EOC BIT(5)
73#define ADQ12B_STINR_IN_MASK (0x1f << 0)
74#define ADQ12B_OUTBR 0x04
75#define ADQ12B_ADLOW 0x08
76#define ADQ12B_ADHIG 0x09
77#define ADQ12B_TIMER_BASE 0x0c
78
79
80static const struct comedi_lrange range_adq12b_ai_bipolar = {
81 4, {
82 BIP_RANGE(5),
83 BIP_RANGE(2),
84 BIP_RANGE(1),
85 BIP_RANGE(0.5)
86 }
87};
88
89static const struct comedi_lrange range_adq12b_ai_unipolar = {
90 4, {
91 UNI_RANGE(5),
92 UNI_RANGE(2),
93 UNI_RANGE(1),
94 UNI_RANGE(0.5)
95 }
96};
97
98struct adq12b_private {
99 unsigned int last_ctreg;
100};
101
102static int adq12b_ai_eoc(struct comedi_device *dev,
103 struct comedi_subdevice *s,
104 struct comedi_insn *insn,
105 unsigned long context)
106{
107 unsigned char status;
108
109 status = inb(dev->iobase + ADQ12B_STINR);
110 if (status & ADQ12B_STINR_EOC)
111 return 0;
112 return -EBUSY;
113}
114
115static int adq12b_ai_insn_read(struct comedi_device *dev,
116 struct comedi_subdevice *s,
117 struct comedi_insn *insn,
118 unsigned int *data)
119{
120 struct adq12b_private *devpriv = dev->private;
121 unsigned int chan = CR_CHAN(insn->chanspec);
122 unsigned int range = CR_RANGE(insn->chanspec);
123 unsigned int val;
124 int ret;
125 int i;
126
127
128 val = ADQ12B_CTREG_RANGE(range) | ADQ12B_CTREG_CHAN(chan);
129 if (val != devpriv->last_ctreg) {
130 outb(val, dev->iobase + ADQ12B_CTREG);
131 devpriv->last_ctreg = val;
132 usleep_range(50, 100);
133 }
134
135 val = inb(dev->iobase + ADQ12B_ADLOW);
136
137 for (i = 0; i < insn->n; i++) {
138 ret = comedi_timeout(dev, s, insn, adq12b_ai_eoc, 0);
139 if (ret)
140 return ret;
141
142 val = inb(dev->iobase + ADQ12B_ADHIG) << 8;
143 val |= inb(dev->iobase + ADQ12B_ADLOW);
144
145 data[i] = val;
146 }
147
148 return insn->n;
149}
150
151static int adq12b_di_insn_bits(struct comedi_device *dev,
152 struct comedi_subdevice *s,
153 struct comedi_insn *insn, unsigned int *data)
154{
155
156 data[1] = (inb(dev->iobase + ADQ12B_STINR) & ADQ12B_STINR_IN_MASK);
157
158 return insn->n;
159}
160
161static int adq12b_do_insn_bits(struct comedi_device *dev,
162 struct comedi_subdevice *s,
163 struct comedi_insn *insn,
164 unsigned int *data)
165{
166 unsigned int mask;
167 unsigned int chan;
168 unsigned int val;
169
170 mask = comedi_dio_update_state(s, data);
171 if (mask) {
172 for (chan = 0; chan < 8; chan++) {
173 if ((mask >> chan) & 0x01) {
174 val = (s->state >> chan) & 0x01;
175 outb((val << 3) | chan,
176 dev->iobase + ADQ12B_OUTBR);
177 }
178 }
179 }
180
181 data[1] = s->state;
182
183 return insn->n;
184}
185
186static int adq12b_attach(struct comedi_device *dev, struct comedi_devconfig *it)
187{
188 struct adq12b_private *devpriv;
189 struct comedi_subdevice *s;
190 int ret;
191
192 ret = comedi_request_region(dev, it->options[0], 0x10);
193 if (ret)
194 return ret;
195
196 devpriv = comedi_alloc_devpriv(dev, sizeof(*devpriv));
197 if (!devpriv)
198 return -ENOMEM;
199
200 devpriv->last_ctreg = -1;
201
202 ret = comedi_alloc_subdevices(dev, 3);
203 if (ret)
204 return ret;
205
206
207 s = &dev->subdevices[0];
208 s->type = COMEDI_SUBD_AI;
209 if (it->options[2]) {
210 s->subdev_flags = SDF_READABLE | SDF_DIFF;
211 s->n_chan = 8;
212 } else {
213 s->subdev_flags = SDF_READABLE | SDF_GROUND;
214 s->n_chan = 16;
215 }
216 s->maxdata = 0xfff;
217 s->range_table = it->options[1] ? &range_adq12b_ai_unipolar
218 : &range_adq12b_ai_bipolar;
219 s->insn_read = adq12b_ai_insn_read;
220
221
222 s = &dev->subdevices[1];
223 s->type = COMEDI_SUBD_DI;
224 s->subdev_flags = SDF_READABLE;
225 s->n_chan = 5;
226 s->maxdata = 1;
227 s->range_table = &range_digital;
228 s->insn_bits = adq12b_di_insn_bits;
229
230
231 s = &dev->subdevices[2];
232 s->type = COMEDI_SUBD_DO;
233 s->subdev_flags = SDF_WRITABLE;
234 s->n_chan = 8;
235 s->maxdata = 1;
236 s->range_table = &range_digital;
237 s->insn_bits = adq12b_do_insn_bits;
238
239 return 0;
240}
241
242static struct comedi_driver adq12b_driver = {
243 .driver_name = "adq12b",
244 .module = THIS_MODULE,
245 .attach = adq12b_attach,
246 .detach = comedi_legacy_detach,
247};
248module_comedi_driver(adq12b_driver);
249
250MODULE_AUTHOR("Comedi http://www.comedi.org");
251MODULE_DESCRIPTION("Comedi low-level driver");
252MODULE_LICENSE("GPL");
253