staging: comedi: propogate error code from comedi_alloc_subdevices
[deliverable/linux.git] / drivers / staging / comedi / drivers / comedi_parport.c
CommitLineData
241ab6ad
DS
1/*
2 comedi/drivers/comedi_parport.c
3 hardware driver for standard parallel port
4
5 COMEDI - Linux Control and Measurement Device Interface
6 Copyright (C) 1998,2001 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/*
24Driver: comedi_parport
25Description: Standard PC parallel port
26Author: ds
27Status: works in immediate mode
28Devices: [standard] parallel port (comedi_parport)
29Updated: Tue, 30 Apr 2002 21:11:45 -0700
30
31A cheap and easy way to get a few more digital I/O lines. Steal
32additional parallel ports from old computers or your neighbors'
33computers.
34
35Option list:
36 0: I/O port base for the parallel port.
37 1: IRQ
38
39Parallel Port Lines:
40
41pin subdev chan aka
42--- ------ ---- ---
431 2 0 strobe
442 0 0 data 0
453 0 1 data 1
464 0 2 data 2
475 0 3 data 3
486 0 4 data 4
497 0 5 data 5
508 0 6 data 6
519 0 7 data 7
5210 1 3 acknowledge
5311 1 4 busy
5412 1 2 output
5513 1 1 printer selected
5614 2 1 auto LF
5715 1 0 error
5816 2 2 init
5917 2 3 select printer
6018-25 ground
61
62Notes:
63
64Subdevices 0 is digital I/O, subdevice 1 is digital input, and
65subdevice 2 is digital output. Unlike other Comedi devices,
66subdevice 0 defaults to output.
67
68Pins 13 and 14 are inverted once by Comedi and once by the
69hardware, thus cancelling the effect.
70
71Pin 1 is a strobe, thus acts like one. There's no way in software
72to change this, at least on a standard parallel port.
73
74Subdevice 3 pretends to be a digital input subdevice, but it always
75returns 0 when read. However, if you run a command with
76scan_begin_src=TRIG_EXT, it uses pin 10 as a external triggering
77pin, which can be used to wake up tasks.
78*/
79/*
80 see http://www.beyondlogic.org/ for information.
81 or http://www.linux-magazin.de/ausgabe/1999/10/IO/io.html
82 */
83
84#include "../comedidev.h"
70265d24 85#include <linux/interrupt.h>
241ab6ad
DS
86#include <linux/ioport.h>
87
88#define PARPORT_SIZE 3
89
90#define PARPORT_A 0
91#define PARPORT_B 1
92#define PARPORT_C 2
93
652dd4e7 94struct parport_private {
241ab6ad
DS
95 unsigned int a_data;
96 unsigned int c_data;
97 int enable_irq;
652dd4e7
GKH
98};
99#define devpriv ((struct parport_private *)(dev->private))
241ab6ad 100
34c43922 101static int parport_insn_a(struct comedi_device *dev, struct comedi_subdevice *s,
90035c08 102 struct comedi_insn *insn, unsigned int *data)
241ab6ad
DS
103{
104 if (data[0]) {
105 devpriv->a_data &= ~data[0];
106 devpriv->a_data |= (data[0] & data[1]);
107
108 outb(devpriv->a_data, dev->iobase + PARPORT_A);
109 }
110
111 data[1] = inb(dev->iobase + PARPORT_A);
112
113 return 2;
114}
115
0a85b6f0
MT
116static int parport_insn_config_a(struct comedi_device *dev,
117 struct comedi_subdevice *s,
90035c08 118 struct comedi_insn *insn, unsigned int *data)
241ab6ad
DS
119{
120 if (data[0]) {
121 s->io_bits = 0xff;
122 devpriv->c_data &= ~(1 << 5);
123 } else {
124 s->io_bits = 0;
125 devpriv->c_data |= (1 << 5);
126 }
127 outb(devpriv->c_data, dev->iobase + PARPORT_C);
128
129 return 1;
130}
131
34c43922 132static int parport_insn_b(struct comedi_device *dev, struct comedi_subdevice *s,
90035c08 133 struct comedi_insn *insn, unsigned int *data)
241ab6ad
DS
134{
135 if (data[0]) {
652dd4e7
GKH
136 /* should writes be ignored? */
137 /* anyone??? */
241ab6ad
DS
138 }
139
140 data[1] = (inb(dev->iobase + PARPORT_B) >> 3);
141
142 return 2;
143}
144
34c43922 145static int parport_insn_c(struct comedi_device *dev, struct comedi_subdevice *s,
90035c08 146 struct comedi_insn *insn, unsigned int *data)
241ab6ad
DS
147{
148 data[0] &= 0x0f;
149 if (data[0]) {
150 devpriv->c_data &= ~data[0];
151 devpriv->c_data |= (data[0] & data[1]);
152
153 outb(devpriv->c_data, dev->iobase + PARPORT_C);
154 }
155
156 data[1] = devpriv->c_data & 0xf;
157
158 return 2;
159}
160
0a85b6f0
MT
161static int parport_intr_insn(struct comedi_device *dev,
162 struct comedi_subdevice *s,
90035c08 163 struct comedi_insn *insn, unsigned int *data)
241ab6ad
DS
164{
165 if (insn->n < 1)
166 return -EINVAL;
167
168 data[1] = 0;
169 return 2;
170}
171
0a85b6f0
MT
172static int parport_intr_cmdtest(struct comedi_device *dev,
173 struct comedi_subdevice *s,
ea6d0d4c 174 struct comedi_cmd *cmd)
241ab6ad
DS
175{
176 int err = 0;
177 int tmp;
178
179 /* step 1 */
180
181 tmp = cmd->start_src;
182 cmd->start_src &= TRIG_NOW;
183 if (!cmd->start_src || tmp != cmd->start_src)
184 err++;
185
186 tmp = cmd->scan_begin_src;
187 cmd->scan_begin_src &= TRIG_EXT;
188 if (!cmd->scan_begin_src || tmp != cmd->scan_begin_src)
189 err++;
190
191 tmp = cmd->convert_src;
192 cmd->convert_src &= TRIG_FOLLOW;
193 if (!cmd->convert_src || tmp != cmd->convert_src)
194 err++;
195
196 tmp = cmd->scan_end_src;
197 cmd->scan_end_src &= TRIG_COUNT;
198 if (!cmd->scan_end_src || tmp != cmd->scan_end_src)
199 err++;
200
201 tmp = cmd->stop_src;
202 cmd->stop_src &= TRIG_NONE;
203 if (!cmd->stop_src || tmp != cmd->stop_src)
204 err++;
205
206 if (err)
207 return 1;
208
209 /* step 2: ignored */
210
211 if (err)
212 return 2;
213
214 /* step 3: */
215
216 if (cmd->start_arg != 0) {
217 cmd->start_arg = 0;
218 err++;
219 }
220 if (cmd->scan_begin_arg != 0) {
221 cmd->scan_begin_arg = 0;
222 err++;
223 }
224 if (cmd->convert_arg != 0) {
225 cmd->convert_arg = 0;
226 err++;
227 }
228 if (cmd->scan_end_arg != 1) {
229 cmd->scan_end_arg = 1;
230 err++;
231 }
232 if (cmd->stop_arg != 0) {
233 cmd->stop_arg = 0;
234 err++;
235 }
236
237 if (err)
238 return 3;
239
240 /* step 4: ignored */
241
242 if (err)
243 return 4;
244
245 return 0;
246}
247
0a85b6f0
MT
248static int parport_intr_cmd(struct comedi_device *dev,
249 struct comedi_subdevice *s)
241ab6ad
DS
250{
251 devpriv->c_data |= 0x10;
252 outb(devpriv->c_data, dev->iobase + PARPORT_C);
253
254 devpriv->enable_irq = 1;
255
256 return 0;
257}
258
0a85b6f0
MT
259static int parport_intr_cancel(struct comedi_device *dev,
260 struct comedi_subdevice *s)
241ab6ad 261{
652dd4e7 262 printk(KERN_DEBUG "parport_intr_cancel()\n");
241ab6ad
DS
263
264 devpriv->c_data &= ~0x10;
265 outb(devpriv->c_data, dev->iobase + PARPORT_C);
266
267 devpriv->enable_irq = 0;
268
269 return 0;
270}
271
70265d24 272static irqreturn_t parport_interrupt(int irq, void *d)
241ab6ad 273{
71b5f4f1 274 struct comedi_device *dev = d;
34c43922 275 struct comedi_subdevice *s = dev->subdevices + 3;
241ab6ad
DS
276
277 if (!devpriv->enable_irq) {
652dd4e7 278 printk(KERN_ERR "comedi_parport: bogus irq, ignored\n");
241ab6ad
DS
279 return IRQ_NONE;
280 }
281
282 comedi_buf_put(s->async, 0);
283 s->async->events |= COMEDI_CB_BLOCK | COMEDI_CB_EOS;
284
285 comedi_event(dev, s);
286 return IRQ_HANDLED;
287}
288
0a85b6f0
MT
289static int parport_attach(struct comedi_device *dev,
290 struct comedi_devconfig *it)
241ab6ad
DS
291{
292 int ret;
293 unsigned int irq;
294 unsigned long iobase;
34c43922 295 struct comedi_subdevice *s;
241ab6ad
DS
296
297 iobase = it->options[0];
652dd4e7 298 printk(KERN_INFO "comedi%d: parport: 0x%04lx ", dev->minor, iobase);
241ab6ad 299 if (!request_region(iobase, PARPORT_SIZE, "parport (comedi)")) {
8487d0e9 300 printk(KERN_ERR "I/O port conflict\n");
241ab6ad
DS
301 return -EIO;
302 }
303 dev->iobase = iobase;
304
305 irq = it->options[1];
306 if (irq) {
8487d0e9 307 printk(KERN_INFO " irq=%u", irq);
5f74ea14
GKH
308 ret = request_irq(irq, parport_interrupt, 0, "comedi_parport",
309 dev);
241ab6ad 310 if (ret < 0) {
8487d0e9 311 printk(KERN_ERR " irq not available\n");
241ab6ad
DS
312 return -EINVAL;
313 }
314 dev->irq = irq;
315 }
316 dev->board_name = "parport";
317
2f0b9d08 318 ret = comedi_alloc_subdevices(dev, 4);
8b6c5694 319 if (ret)
241ab6ad 320 return ret;
8b6c5694 321
652dd4e7
GKH
322 ret = alloc_private(dev, sizeof(struct parport_private));
323 if (ret < 0)
241ab6ad
DS
324 return ret;
325
326 s = dev->subdevices + 0;
327 s->type = COMEDI_SUBD_DIO;
328 s->subdev_flags = SDF_READABLE | SDF_WRITABLE;
329 s->n_chan = 8;
330 s->maxdata = 1;
331 s->range_table = &range_digital;
332 s->insn_bits = parport_insn_a;
333 s->insn_config = parport_insn_config_a;
334
335 s = dev->subdevices + 1;
336 s->type = COMEDI_SUBD_DI;
337 s->subdev_flags = SDF_READABLE;
338 s->n_chan = 5;
339 s->maxdata = 1;
340 s->range_table = &range_digital;
341 s->insn_bits = parport_insn_b;
342
343 s = dev->subdevices + 2;
344 s->type = COMEDI_SUBD_DO;
345 s->subdev_flags = SDF_WRITABLE;
346 s->n_chan = 4;
347 s->maxdata = 1;
348 s->range_table = &range_digital;
349 s->insn_bits = parport_insn_c;
350
351 s = dev->subdevices + 3;
352 if (irq) {
353 dev->read_subdev = s;
354 s->type = COMEDI_SUBD_DI;
355 s->subdev_flags = SDF_READABLE | SDF_CMD_READ;
356 s->n_chan = 1;
357 s->maxdata = 1;
358 s->range_table = &range_digital;
359 s->insn_bits = parport_intr_insn;
360 s->do_cmdtest = parport_intr_cmdtest;
361 s->do_cmd = parport_intr_cmd;
362 s->cancel = parport_intr_cancel;
363 } else {
364 s->type = COMEDI_SUBD_UNUSED;
365 }
366
367 devpriv->a_data = 0;
368 outb(devpriv->a_data, dev->iobase + PARPORT_A);
369 devpriv->c_data = 0;
370 outb(devpriv->c_data, dev->iobase + PARPORT_C);
371
8487d0e9 372 printk(KERN_INFO "\n");
241ab6ad
DS
373 return 1;
374}
375
484ecc95 376static void parport_detach(struct comedi_device *dev)
241ab6ad 377{
241ab6ad
DS
378 if (dev->iobase)
379 release_region(dev->iobase, PARPORT_SIZE);
241ab6ad 380 if (dev->irq)
5f74ea14 381 free_irq(dev->irq, dev);
241ab6ad 382}
90f703d3 383
bfba5e78
HS
384static struct comedi_driver parport_driver = {
385 .driver_name = "comedi_parport",
386 .module = THIS_MODULE,
387 .attach = parport_attach,
388 .detach = parport_detach,
389};
390module_comedi_driver(parport_driver);
391
90f703d3
AT
392MODULE_AUTHOR("Comedi http://www.comedi.org");
393MODULE_DESCRIPTION("Comedi low-level driver");
394MODULE_LICENSE("GPL");
This page took 0.334512 seconds and 5 git commands to generate.