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#include <linux/module.h>
52#include <linux/interrupt.h>
53
54#include "../comedidev.h"
55
56#define PCL726_AO_MSB_REG(x) (0x00 + ((x) * 2))
57#define PCL726_AO_LSB_REG(x) (0x01 + ((x) * 2))
58#define PCL726_DO_MSB_REG 0x0c
59#define PCL726_DO_LSB_REG 0x0d
60#define PCL726_DI_MSB_REG 0x0e
61#define PCL726_DI_LSB_REG 0x0f
62
63#define PCL727_DI_MSB_REG 0x00
64#define PCL727_DI_LSB_REG 0x01
65#define PCL727_DO_MSB_REG 0x18
66#define PCL727_DO_LSB_REG 0x19
67
68static const struct comedi_lrange *const rangelist_726[] = {
69 &range_unipolar5,
70 &range_unipolar10,
71 &range_bipolar5,
72 &range_bipolar10,
73 &range_4_20mA,
74 &range_unknown
75};
76
77static const struct comedi_lrange *const rangelist_727[] = {
78 &range_unipolar5,
79 &range_unipolar10,
80 &range_bipolar5,
81 &range_4_20mA
82};
83
84static const struct comedi_lrange *const rangelist_728[] = {
85 &range_unipolar5,
86 &range_unipolar10,
87 &range_bipolar5,
88 &range_bipolar10,
89 &range_4_20mA,
90 &range_0_20mA
91};
92
93struct pcl726_board {
94 const char *name;
95 unsigned long io_len;
96 unsigned int irq_mask;
97 const struct comedi_lrange *const *ao_ranges;
98 int ao_num_ranges;
99 int ao_nchan;
100 unsigned int have_dio:1;
101 unsigned int is_pcl727:1;
102};
103
104static const struct pcl726_board pcl726_boards[] = {
105 {
106 .name = "pcl726",
107 .io_len = 0x10,
108 .ao_ranges = &rangelist_726[0],
109 .ao_num_ranges = ARRAY_SIZE(rangelist_726),
110 .ao_nchan = 6,
111 .have_dio = 1,
112 }, {
113 .name = "pcl727",
114 .io_len = 0x20,
115 .ao_ranges = &rangelist_727[0],
116 .ao_num_ranges = ARRAY_SIZE(rangelist_727),
117 .ao_nchan = 12,
118 .have_dio = 1,
119 .is_pcl727 = 1,
120 }, {
121 .name = "pcl728",
122 .io_len = 0x08,
123 .ao_num_ranges = ARRAY_SIZE(rangelist_728),
124 .ao_ranges = &rangelist_728[0],
125 .ao_nchan = 2,
126 }, {
127 .name = "acl6126",
128 .io_len = 0x10,
129 .irq_mask = 0x96e8,
130 .ao_num_ranges = ARRAY_SIZE(rangelist_726),
131 .ao_ranges = &rangelist_726[0],
132 .ao_nchan = 6,
133 .have_dio = 1,
134 }, {
135 .name = "acl6128",
136 .io_len = 0x08,
137 .ao_num_ranges = ARRAY_SIZE(rangelist_728),
138 .ao_ranges = &rangelist_728[0],
139 .ao_nchan = 2,
140 },
141};
142
143struct pcl726_private {
144 const struct comedi_lrange *rangelist[12];
145 unsigned int cmd_running:1;
146};
147
148static int pcl726_intr_insn_bits(struct comedi_device *dev,
149 struct comedi_subdevice *s,
150 struct comedi_insn *insn,
151 unsigned int *data)
152{
153 data[1] = 0;
154 return insn->n;
155}
156
157static int pcl726_intr_cmdtest(struct comedi_device *dev,
158 struct comedi_subdevice *s,
159 struct comedi_cmd *cmd)
160{
161 int err = 0;
162
163
164
165 err |= comedi_check_trigger_src(&cmd->start_src, TRIG_NOW);
166 err |= comedi_check_trigger_src(&cmd->scan_begin_src, TRIG_EXT);
167 err |= comedi_check_trigger_src(&cmd->convert_src, TRIG_FOLLOW);
168 err |= comedi_check_trigger_src(&cmd->scan_end_src, TRIG_COUNT);
169 err |= comedi_check_trigger_src(&cmd->stop_src, TRIG_NONE);
170
171 if (err)
172 return 1;
173
174
175
176
177
178
179 err |= comedi_check_trigger_arg_is(&cmd->start_arg, 0);
180 err |= comedi_check_trigger_arg_is(&cmd->scan_begin_arg, 0);
181 err |= comedi_check_trigger_arg_is(&cmd->convert_arg, 0);
182 err |= comedi_check_trigger_arg_is(&cmd->scan_end_arg,
183 cmd->chanlist_len);
184 err |= comedi_check_trigger_arg_is(&cmd->stop_arg, 0);
185
186 if (err)
187 return 3;
188
189
190
191
192
193 return 0;
194}
195
196static int pcl726_intr_cmd(struct comedi_device *dev,
197 struct comedi_subdevice *s)
198{
199 struct pcl726_private *devpriv = dev->private;
200
201 devpriv->cmd_running = 1;
202
203 return 0;
204}
205
206static int pcl726_intr_cancel(struct comedi_device *dev,
207 struct comedi_subdevice *s)
208{
209 struct pcl726_private *devpriv = dev->private;
210
211 devpriv->cmd_running = 0;
212
213 return 0;
214}
215
216static irqreturn_t pcl726_interrupt(int irq, void *d)
217{
218 struct comedi_device *dev = d;
219 struct comedi_subdevice *s = dev->read_subdev;
220 struct pcl726_private *devpriv = dev->private;
221
222 if (devpriv->cmd_running) {
223 pcl726_intr_cancel(dev, s);
224
225 comedi_buf_write_samples(s, &s->state, 1);
226 comedi_handle_events(dev, s);
227 }
228
229 return IRQ_HANDLED;
230}
231
232static int pcl726_ao_insn_write(struct comedi_device *dev,
233 struct comedi_subdevice *s,
234 struct comedi_insn *insn,
235 unsigned int *data)
236{
237 unsigned int chan = CR_CHAN(insn->chanspec);
238 unsigned int range = CR_RANGE(insn->chanspec);
239 int i;
240
241 for (i = 0; i < insn->n; i++) {
242 unsigned int val = data[i];
243
244 s->readback[chan] = val;
245
246
247 if (comedi_chan_range_is_bipolar(s, chan, range))
248 val = comedi_offset_munge(s, val);
249
250
251 outb((val >> 8) & 0xff, dev->iobase + PCL726_AO_MSB_REG(chan));
252 outb(val & 0xff, dev->iobase + PCL726_AO_LSB_REG(chan));
253 }
254
255 return insn->n;
256}
257
258static int pcl726_di_insn_bits(struct comedi_device *dev,
259 struct comedi_subdevice *s,
260 struct comedi_insn *insn,
261 unsigned int *data)
262{
263 const struct pcl726_board *board = dev->board_ptr;
264 unsigned int val;
265
266 if (board->is_pcl727) {
267 val = inb(dev->iobase + PCL727_DI_LSB_REG);
268 val |= (inb(dev->iobase + PCL727_DI_MSB_REG) << 8);
269 } else {
270 val = inb(dev->iobase + PCL726_DI_LSB_REG);
271 val |= (inb(dev->iobase + PCL726_DI_MSB_REG) << 8);
272 }
273
274 data[1] = val;
275
276 return insn->n;
277}
278
279static int pcl726_do_insn_bits(struct comedi_device *dev,
280 struct comedi_subdevice *s,
281 struct comedi_insn *insn,
282 unsigned int *data)
283{
284 const struct pcl726_board *board = dev->board_ptr;
285 unsigned long io = dev->iobase;
286 unsigned int mask;
287
288 mask = comedi_dio_update_state(s, data);
289 if (mask) {
290 if (board->is_pcl727) {
291 if (mask & 0x00ff)
292 outb(s->state & 0xff, io + PCL727_DO_LSB_REG);
293 if (mask & 0xff00)
294 outb((s->state >> 8), io + PCL727_DO_MSB_REG);
295 } else {
296 if (mask & 0x00ff)
297 outb(s->state & 0xff, io + PCL726_DO_LSB_REG);
298 if (mask & 0xff00)
299 outb((s->state >> 8), io + PCL726_DO_MSB_REG);
300 }
301 }
302
303 data[1] = s->state;
304
305 return insn->n;
306}
307
308static int pcl726_attach(struct comedi_device *dev,
309 struct comedi_devconfig *it)
310{
311 const struct pcl726_board *board = dev->board_ptr;
312 struct pcl726_private *devpriv;
313 struct comedi_subdevice *s;
314 int subdev;
315 int ret;
316 int i;
317
318 ret = comedi_request_region(dev, it->options[0], board->io_len);
319 if (ret)
320 return ret;
321
322 devpriv = comedi_alloc_devpriv(dev, sizeof(*devpriv));
323 if (!devpriv)
324 return -ENOMEM;
325
326
327
328
329
330 if (it->options[1] && (board->irq_mask & (1 << it->options[1]))) {
331 ret = request_irq(it->options[1], pcl726_interrupt, 0,
332 dev->board_name, dev);
333 if (ret == 0) {
334
335 dev->irq = it->options[1];
336 }
337 }
338
339
340 for (i = 0; i < 12; i++) {
341 unsigned int opt = it->options[2 + i];
342
343 if (opt < board->ao_num_ranges && i < board->ao_nchan)
344 devpriv->rangelist[i] = board->ao_ranges[opt];
345 else
346 devpriv->rangelist[i] = &range_unknown;
347 }
348
349 subdev = board->have_dio ? 3 : 1;
350 if (dev->irq)
351 subdev++;
352 ret = comedi_alloc_subdevices(dev, subdev);
353 if (ret)
354 return ret;
355
356 subdev = 0;
357
358
359 s = &dev->subdevices[subdev++];
360 s->type = COMEDI_SUBD_AO;
361 s->subdev_flags = SDF_WRITABLE | SDF_GROUND;
362 s->n_chan = board->ao_nchan;
363 s->maxdata = 0x0fff;
364 s->range_table_list = devpriv->rangelist;
365 s->insn_write = pcl726_ao_insn_write;
366
367 ret = comedi_alloc_subdev_readback(s);
368 if (ret)
369 return ret;
370
371 if (board->have_dio) {
372
373 s = &dev->subdevices[subdev++];
374 s->type = COMEDI_SUBD_DI;
375 s->subdev_flags = SDF_READABLE;
376 s->n_chan = 16;
377 s->maxdata = 1;
378 s->insn_bits = pcl726_di_insn_bits;
379 s->range_table = &range_digital;
380
381
382 s = &dev->subdevices[subdev++];
383 s->type = COMEDI_SUBD_DO;
384 s->subdev_flags = SDF_WRITABLE;
385 s->n_chan = 16;
386 s->maxdata = 1;
387 s->insn_bits = pcl726_do_insn_bits;
388 s->range_table = &range_digital;
389 }
390
391 if (dev->irq) {
392
393 s = &dev->subdevices[subdev++];
394 dev->read_subdev = s;
395 s->type = COMEDI_SUBD_DI;
396 s->subdev_flags = SDF_READABLE | SDF_CMD_READ;
397 s->n_chan = 1;
398 s->maxdata = 1;
399 s->range_table = &range_digital;
400 s->insn_bits = pcl726_intr_insn_bits;
401 s->len_chanlist = 1;
402 s->do_cmdtest = pcl726_intr_cmdtest;
403 s->do_cmd = pcl726_intr_cmd;
404 s->cancel = pcl726_intr_cancel;
405 }
406
407 return 0;
408}
409
410static struct comedi_driver pcl726_driver = {
411 .driver_name = "pcl726",
412 .module = THIS_MODULE,
413 .attach = pcl726_attach,
414 .detach = comedi_legacy_detach,
415 .board_name = &pcl726_boards[0].name,
416 .num_names = ARRAY_SIZE(pcl726_boards),
417 .offset = sizeof(struct pcl726_board),
418};
419module_comedi_driver(pcl726_driver);
420
421MODULE_AUTHOR("Comedi http://www.comedi.org");
422MODULE_DESCRIPTION("Comedi driver for Advantech PCL-726 & compatibles");
423MODULE_LICENSE("GPL");
424
