]> git.ipfire.org Git - thirdparty/linux.git/blame - drivers/staging/comedi/comedi_fops.c
projects / thirdparty / linux.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
Staging: comedi: drivers.c sparse cleanup
[thirdparty/linux.git] / drivers / staging / comedi / comedi_fops.c
CommitLineData
ed9eccbe
DS		 1/*
2 comedi/comedi_fops.c
3 comedi kernel module
4
5 COMEDI - Linux Control and Measurement Device Interface
6 Copyright (C) 1997-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#undef DEBUG
25
26#define __NO_VERSION__
27#include "comedi_fops.h"
28#include "comedi_compat32.h"
29
30#include <linux/module.h>
31#include <linux/errno.h>
32#include <linux/kernel.h>
33#include <linux/sched.h>
34#include <linux/fcntl.h>
35#include <linux/delay.h>
36#include <linux/ioport.h>
37#include <linux/mm.h>
38#include <linux/slab.h>
39#include <linux/kmod.h>
40#include <linux/poll.h>
41#include <linux/init.h>
42#include <linux/device.h>
43#include <linux/vmalloc.h>
44#include <linux/fs.h>
45#include "comedidev.h"
46#include <linux/cdev.h>
883db3d9 47#include <linux/stat.h>
ed9eccbe 48
476b8477
GKH		 49#include <linux/io.h>
50#include <linux/uaccess.h>
ed9eccbe 51
242e7ad9 52#include "internal.h"
ed9eccbe
DS		 53
54MODULE_AUTHOR("http://www.comedi.org");
55MODULE_DESCRIPTION("Comedi core module");
56MODULE_LICENSE("GPL");
57
58#ifdef CONFIG_COMEDI_DEBUG
59int comedi_debug;
18736438 60EXPORT_SYMBOL(comedi_debug);
ed9eccbe
DS		 61module_param(comedi_debug, int, 0644);
62#endif
63
6a9d7a21
IA		 64int comedi_autoconfig = 1;
65module_param(comedi_autoconfig, bool, 0444);
66
6705b68d 67int comedi_num_legacy_minors;
1dd33ab8
BP		 68module_param(comedi_num_legacy_minors, int, 0444);
69
ed9eccbe 70static DEFINE_SPINLOCK(comedi_file_info_table_lock);
476b8477 71static struct comedi_device_file_info
0a85b6f0 72*comedi_file_info_table[COMEDI_NUM_MINORS];
476b8477 73
0a85b6f0
MT		 74static int do_devconfig_ioctl(struct comedi_device *dev,
75 struct comedi_devconfig *arg);
71b5f4f1 76static int do_bufconfig_ioctl(struct comedi_device *dev, void *arg);
0a85b6f0
MT		 77static int do_devinfo_ioctl(struct comedi_device *dev,
78 struct comedi_devinfo *arg, struct file *file);
79static int do_subdinfo_ioctl(struct comedi_device *dev,
80 struct comedi_subdinfo *arg, void *file);
81static int do_chaninfo_ioctl(struct comedi_device *dev,
82 struct comedi_chaninfo *arg);
71b5f4f1
BP		 83static int do_bufinfo_ioctl(struct comedi_device *dev, void *arg);
84static int do_cmd_ioctl(struct comedi_device *dev, void *arg, void *file);
0a85b6f0
MT		 85static int do_lock_ioctl(struct comedi_device *dev, unsigned int arg,
86 void *file);
87static int do_unlock_ioctl(struct comedi_device *dev, unsigned int arg,
88 void *file);
89static int do_cancel_ioctl(struct comedi_device *dev, unsigned int arg,
90 void *file);
71b5f4f1
BP		 91static int do_cmdtest_ioctl(struct comedi_device *dev, void *arg, void *file);
92static int do_insnlist_ioctl(struct comedi_device *dev, void *arg, void *file);
93static int do_insn_ioctl(struct comedi_device *dev, void *arg, void *file);
0a85b6f0
MT		 94static int do_poll_ioctl(struct comedi_device *dev, unsigned int subd,
95 void *file);
71b5f4f1 96
0a85b6f0
MT		 97extern void do_become_nonbusy(struct comedi_device *dev,
98 struct comedi_subdevice *s);
34c43922 99static int do_cancel(struct comedi_device *dev, struct comedi_subdevice *s);
ed9eccbe
DS		 100
101static int comedi_fasync(int fd, struct file *file, int on);
102
71b5f4f1 103static int is_device_busy(struct comedi_device *dev);
883db3d9
FMH		 104static int resize_async_buffer(struct comedi_device *dev,
105 struct comedi_subdevice *s,
106 struct comedi_async *async, unsigned new_size);
107
108/* declarations for sysfs attribute files */
109static struct device_attribute dev_attr_max_read_buffer_kb;
110static struct device_attribute dev_attr_read_buffer_kb;
111static struct device_attribute dev_attr_max_write_buffer_kb;
112static struct device_attribute dev_attr_write_buffer_kb;
ed9eccbe 113
ed9eccbe 114static long comedi_unlocked_ioctl(struct file *file, unsigned int cmd,
476b8477 115 unsigned long arg)
ed9eccbe
DS		 116{
117 const unsigned minor = iminor(file->f_dentry->d_inode);
476b8477
GKH		 118 struct comedi_device_file_info *dev_file_info =
119 comedi_get_device_file_info(minor);
71b5f4f1 120 struct comedi_device *dev;
ed9eccbe
DS		 121 int rc;
122
53b670a7
FMH		 123 if (dev_file_info == NULL || dev_file_info->device == NULL)
124 return -ENODEV;
125 dev = dev_file_info->device;
126
ed9eccbe
DS		 127 mutex_lock(&dev->mutex);
128
129 /* Device config is special, because it must work on
130 * an unconfigured device. */
131 if (cmd == COMEDI_DEVCONFIG) {
132 rc = do_devconfig_ioctl(dev, (void *)arg);
133 goto done;
134 }
135
136 if (!dev->attached) {
137 DPRINTK("no driver configured on /dev/comedi%i\n", dev->minor);
138 rc = -ENODEV;
139 goto done;
140 }
141
142 switch (cmd) {
143 case COMEDI_BUFCONFIG:
144 rc = do_bufconfig_ioctl(dev, (void *)arg);
145 break;
146 case COMEDI_DEVINFO:
147 rc = do_devinfo_ioctl(dev, (void *)arg, file);
148 break;
149 case COMEDI_SUBDINFO:
150 rc = do_subdinfo_ioctl(dev, (void *)arg, file);
151 break;
152 case COMEDI_CHANINFO:
153 rc = do_chaninfo_ioctl(dev, (void *)arg);
154 break;
155 case COMEDI_RANGEINFO:
156 rc = do_rangeinfo_ioctl(dev, (void *)arg);
157 break;
158 case COMEDI_BUFINFO:
159 rc = do_bufinfo_ioctl(dev, (void *)arg);
160 break;
161 case COMEDI_LOCK:
162 rc = do_lock_ioctl(dev, arg, file);
163 break;
164 case COMEDI_UNLOCK:
165 rc = do_unlock_ioctl(dev, arg, file);
166 break;
167 case COMEDI_CANCEL:
168 rc = do_cancel_ioctl(dev, arg, file);
169 break;
170 case COMEDI_CMD:
171 rc = do_cmd_ioctl(dev, (void *)arg, file);
172 break;
173 case COMEDI_CMDTEST:
174 rc = do_cmdtest_ioctl(dev, (void *)arg, file);
175 break;
176 case COMEDI_INSNLIST:
177 rc = do_insnlist_ioctl(dev, (void *)arg, file);
178 break;
179 case COMEDI_INSN:
180 rc = do_insn_ioctl(dev, (void *)arg, file);
181 break;
182 case COMEDI_POLL:
183 rc = do_poll_ioctl(dev, arg, file);
184 break;
185 default:
186 rc = -ENOTTY;
187 break;
188 }
189
476b8477 190done:
ed9eccbe
DS		 191 mutex_unlock(&dev->mutex);
192 return rc;
193}
194
195/*
196 COMEDI_DEVCONFIG
197 device config ioctl
198
199 arg:
200 pointer to devconfig structure
201
202 reads:
203 devconfig structure at arg
204
205 writes:
206 none
207*/
0a85b6f0
MT		 208static int do_devconfig_ioctl(struct comedi_device *dev,
209 struct comedi_devconfig *arg)
ed9eccbe 210{
0707bb04 211 struct comedi_devconfig it;
ed9eccbe
DS		 212 int ret;
213 unsigned char *aux_data = NULL;
214 int aux_len;
215
216 if (!capable(CAP_SYS_ADMIN))
217 return -EPERM;
218
219 if (arg == NULL) {
220 if (is_device_busy(dev))
221 return -EBUSY;
476b8477 222 if (dev->attached) {
ed9eccbe
DS		 223 struct module *driver_module = dev->driver->module;
224 comedi_device_detach(dev);
225 module_put(driver_module);
226 }
227 return 0;
228 }
229
0707bb04 230 if (copy_from_user(&it, arg, sizeof(struct comedi_devconfig)))
ed9eccbe
DS		 231 return -EFAULT;
232
233 it.board_name[COMEDI_NAMELEN - 1] = 0;
234
235 if (comedi_aux_data(it.options, 0) &&
476b8477 236 it.options[COMEDI_DEVCONF_AUX_DATA_LENGTH]) {
ed9eccbe
DS		 237 int bit_shift;
238 aux_len = it.options[COMEDI_DEVCONF_AUX_DATA_LENGTH];
239 if (aux_len < 0)
240 return -EFAULT;
241
242 aux_data = vmalloc(aux_len);
243 if (!aux_data)
244 return -ENOMEM;
245
246 if (copy_from_user(aux_data,
476b8477 247 comedi_aux_data(it.options, 0), aux_len)) {
ed9eccbe
DS		 248 vfree(aux_data);
249 return -EFAULT;
250 }
251 it.options[COMEDI_DEVCONF_AUX_DATA_LO] =
476b8477 252 (unsigned long)aux_data;
ed9eccbe
DS		 253 if (sizeof(void *) > sizeof(int)) {
254 bit_shift = sizeof(int) * 8;
255 it.options[COMEDI_DEVCONF_AUX_DATA_HI] =
476b8477 256 ((unsigned long)aux_data) >> bit_shift;
ed9eccbe
DS		 257 } else
258 it.options[COMEDI_DEVCONF_AUX_DATA_HI] = 0;
259 }
260
261 ret = comedi_device_attach(dev, &it);
476b8477
GKH		 262 if (ret == 0) {
263 if (!try_module_get(dev->driver->module)) {
ed9eccbe
DS		 264 comedi_device_detach(dev);
265 return -ENOSYS;
266 }
267 }
268
269 if (aux_data)
270 vfree(aux_data);
271
272 return ret;
273}
274
275/*
276 COMEDI_BUFCONFIG
277 buffer configuration ioctl
278
279 arg:
280 pointer to bufconfig structure
281
282 reads:
283 bufconfig at arg
284
285 writes:
286 modified bufconfig at arg
287
288*/
71b5f4f1 289static int do_bufconfig_ioctl(struct comedi_device *dev, void *arg)
ed9eccbe 290{
be6aba4a 291 struct comedi_bufconfig bc;
d163679c 292 struct comedi_async *async;
34c43922 293 struct comedi_subdevice *s;
883db3d9 294 int retval = 0;
ed9eccbe 295
be6aba4a 296 if (copy_from_user(&bc, arg, sizeof(struct comedi_bufconfig)))
ed9eccbe
DS		 297 return -EFAULT;
298
299 if (bc.subdevice >= dev->n_subdevices || bc.subdevice < 0)
300 return -EINVAL;
301
302 s = dev->subdevices + bc.subdevice;
303 async = s->async;
304
305 if (!async) {
306 DPRINTK("subdevice does not have async capability\n");
307 bc.size = 0;
308 bc.maximum_size = 0;
309 goto copyback;
310 }
311
312 if (bc.maximum_size) {
313 if (!capable(CAP_SYS_ADMIN))
314 return -EPERM;
315
316 async->max_bufsize = bc.maximum_size;
317 }
318
319 if (bc.size) {
883db3d9
FMH		 320 retval = resize_async_buffer(dev, s, async, bc.size);
321 if (retval < 0)
322 return retval;
ed9eccbe
DS		 323 }
324
325 bc.size = async->prealloc_bufsz;
326 bc.maximum_size = async->max_bufsize;
327
476b8477 328copyback:
be6aba4a 329 if (copy_to_user(arg, &bc, sizeof(struct comedi_bufconfig)))
ed9eccbe
DS		 330 return -EFAULT;
331
332 return 0;
333}
334
335/*
336 COMEDI_DEVINFO
337 device info ioctl
338
339 arg:
340 pointer to devinfo structure
341
342 reads:
343 none
344
345 writes:
346 devinfo structure
347
348*/
0a85b6f0
MT		 349static int do_devinfo_ioctl(struct comedi_device *dev,
350 struct comedi_devinfo *arg, struct file *file)
ed9eccbe 351{
063db04b 352 struct comedi_devinfo devinfo;
ed9eccbe 353 const unsigned minor = iminor(file->f_dentry->d_inode);
476b8477
GKH		 354 struct comedi_device_file_info *dev_file_info =
355 comedi_get_device_file_info(minor);
34c43922 356 struct comedi_subdevice *read_subdev =
476b8477 357 comedi_get_read_subdevice(dev_file_info);
34c43922 358 struct comedi_subdevice *write_subdev =
476b8477 359 comedi_get_write_subdevice(dev_file_info);
ed9eccbe
DS		 360
361 memset(&devinfo, 0, sizeof(devinfo));
362
363 /* fill devinfo structure */
364 devinfo.version_code = COMEDI_VERSION_CODE;
365 devinfo.n_subdevs = dev->n_subdevices;
366 memcpy(devinfo.driver_name, dev->driver->driver_name, COMEDI_NAMELEN);
367 memcpy(devinfo.board_name, dev->board_name, COMEDI_NAMELEN);
368
476b8477 369 if (read_subdev)
ed9eccbe 370 devinfo.read_subdevice = read_subdev - dev->subdevices;
476b8477 371 else
ed9eccbe 372 devinfo.read_subdevice = -1;
476b8477
GKH		 373
374 if (write_subdev)
ed9eccbe 375 devinfo.write_subdevice = write_subdev - dev->subdevices;
476b8477 376 else
ed9eccbe 377 devinfo.write_subdevice = -1;
ed9eccbe 378
063db04b 379 if (copy_to_user(arg, &devinfo, sizeof(struct comedi_devinfo)))
ed9eccbe
DS		 380 return -EFAULT;
381
382 return 0;
383}
384
385/*
386 COMEDI_SUBDINFO
387 subdevice info ioctl
388
389 arg:
390 pointer to array of subdevice info structures
391
392 reads:
393 none
394
395 writes:
396 array of subdevice info structures at arg
397
398*/
0a85b6f0
MT		 399static int do_subdinfo_ioctl(struct comedi_device *dev,
400 struct comedi_subdinfo *arg, void *file)
ed9eccbe
DS		 401{
402 int ret, i;
bd52efbb 403 struct comedi_subdinfo *tmp, *us;
34c43922 404 struct comedi_subdevice *s;
ed9eccbe 405
0a85b6f0
MT		 406 tmp =
407 kcalloc(dev->n_subdevices, sizeof(struct comedi_subdinfo),
408 GFP_KERNEL);
ed9eccbe
DS		 409 if (!tmp)
410 return -ENOMEM;
411
412 /* fill subdinfo structs */
413 for (i = 0; i < dev->n_subdevices; i++) {
414 s = dev->subdevices + i;
415 us = tmp + i;
416
417 us->type = s->type;
418 us->n_chan = s->n_chan;
419 us->subd_flags = s->subdev_flags;
420 if (comedi_get_subdevice_runflags(s) & SRF_RUNNING)
421 us->subd_flags |= SDF_RUNNING;
422#define TIMER_nanosec 5 /* backwards compatibility */
423 us->timer_type = TIMER_nanosec;
424 us->len_chanlist = s->len_chanlist;
425 us->maxdata = s->maxdata;
426 if (s->range_table) {
427 us->range_type =
476b8477 428 (i << 24) | (0 << 16) | (s->range_table->length);
ed9eccbe
DS		 429 } else {
430 us->range_type = 0; /* XXX */
431 }
432 us->flags = s->flags;
433
434 if (s->busy)
435 us->subd_flags |= SDF_BUSY;
436 if (s->busy == file)
437 us->subd_flags |= SDF_BUSY_OWNER;
438 if (s->lock)
439 us->subd_flags |= SDF_LOCKED;
440 if (s->lock == file)
441 us->subd_flags |= SDF_LOCK_OWNER;
442 if (!s->maxdata && s->maxdata_list)
443 us->subd_flags |= SDF_MAXDATA;
444 if (s->flaglist)
445 us->subd_flags |= SDF_FLAGS;
446 if (s->range_table_list)
447 us->subd_flags |= SDF_RANGETYPE;
448 if (s->do_cmd)
449 us->subd_flags |= SDF_CMD;
450
451 if (s->insn_bits != &insn_inval)
452 us->insn_bits_support = COMEDI_SUPPORTED;
453 else
454 us->insn_bits_support = COMEDI_UNSUPPORTED;
455
456 us->settling_time_0 = s->settling_time_0;
457 }
458
459 ret = copy_to_user(arg, tmp,
bd52efbb 460 dev->n_subdevices * sizeof(struct comedi_subdinfo));
ed9eccbe
DS		 461
462 kfree(tmp);
463
464 return ret ? -EFAULT : 0;
465}
466
467/*
468 COMEDI_CHANINFO
469 subdevice info ioctl
470
471 arg:
472 pointer to chaninfo structure
473
474 reads:
475 chaninfo structure at arg
476
477 writes:
478 arrays at elements of chaninfo structure
479
480*/
0a85b6f0
MT		 481static int do_chaninfo_ioctl(struct comedi_device *dev,
482 struct comedi_chaninfo *arg)
ed9eccbe 483{
34c43922 484 struct comedi_subdevice *s;
a18b416d 485 struct comedi_chaninfo it;
ed9eccbe 486
a18b416d 487 if (copy_from_user(&it, arg, sizeof(struct comedi_chaninfo)))
ed9eccbe
DS		 488 return -EFAULT;
489
490 if (it.subdev >= dev->n_subdevices)
491 return -EINVAL;
492 s = dev->subdevices + it.subdev;
493
494 if (it.maxdata_list) {
495 if (s->maxdata || !s->maxdata_list)
496 return -EINVAL;
497 if (copy_to_user(it.maxdata_list, s->maxdata_list,
790c5541 498 s->n_chan * sizeof(unsigned int)))
ed9eccbe
DS		 499 return -EFAULT;
500 }
501
502 if (it.flaglist) {
503 if (!s->flaglist)
504 return -EINVAL;
505 if (copy_to_user(it.flaglist, s->flaglist,
476b8477 506 s->n_chan * sizeof(unsigned int)))
ed9eccbe
DS		 507 return -EFAULT;
508 }
509
510 if (it.rangelist) {
511 int i;
512
513 if (!s->range_table_list)
514 return -EINVAL;
515 for (i = 0; i < s->n_chan; i++) {
516 int x;
517
518 x = (dev->minor << 28) | (it.subdev << 24) | (i << 16) |
476b8477 519 (s->range_table_list[i]->length);
ed9eccbe
DS		 520 put_user(x, it.rangelist + i);
521 }
476b8477
GKH		 522#if 0
523 if (copy_to_user(it.rangelist, s->range_type_list,
0a85b6f0 524 s->n_chan * sizeof(unsigned int)))
476b8477
GKH		 525 return -EFAULT;
526#endif
ed9eccbe
DS		 527 }
528
529 return 0;
530}
531
532 /*
533 COMEDI_BUFINFO
534 buffer information ioctl
535
536 arg:
537 pointer to bufinfo structure
538
539 reads:
540 bufinfo at arg
541
542 writes:
543 modified bufinfo at arg
544
545 */
71b5f4f1 546static int do_bufinfo_ioctl(struct comedi_device *dev, void *arg)
ed9eccbe 547{
9aa5339a 548 struct comedi_bufinfo bi;
34c43922 549 struct comedi_subdevice *s;
d163679c 550 struct comedi_async *async;
ed9eccbe 551
9aa5339a 552 if (copy_from_user(&bi, arg, sizeof(struct comedi_bufinfo)))
ed9eccbe
DS		 553 return -EFAULT;
554
555 if (bi.subdevice >= dev->n_subdevices || bi.subdevice < 0)
556 return -EINVAL;
557
558 s = dev->subdevices + bi.subdevice;
559 async = s->async;
560
561 if (!async) {
562 DPRINTK("subdevice does not have async capability\n");
563 bi.buf_write_ptr = 0;
564 bi.buf_read_ptr = 0;
565 bi.buf_write_count = 0;
566 bi.buf_read_count = 0;
567 goto copyback;
568 }
569
570 if (bi.bytes_read && (s->subdev_flags & SDF_CMD_READ)) {
571 bi.bytes_read = comedi_buf_read_alloc(async, bi.bytes_read);
572 comedi_buf_read_free(async, bi.bytes_read);
573
574 if (!(comedi_get_subdevice_runflags(s) & (SRF_ERROR |
476b8477
GKH		 575 SRF_RUNNING))
576 && async->buf_write_count == async->buf_read_count) {
ed9eccbe
DS		 577 do_become_nonbusy(dev, s);
578 }
579 }
580
581 if (bi.bytes_written && (s->subdev_flags & SDF_CMD_WRITE)) {
582 bi.bytes_written =
476b8477 583 comedi_buf_write_alloc(async, bi.bytes_written);
ed9eccbe
DS		 584 comedi_buf_write_free(async, bi.bytes_written);
585 }
586
587 bi.buf_write_count = async->buf_write_count;
588 bi.buf_write_ptr = async->buf_write_ptr;
589 bi.buf_read_count = async->buf_read_count;
590 bi.buf_read_ptr = async->buf_read_ptr;
591
476b8477 592copyback:
9aa5339a 593 if (copy_to_user(arg, &bi, sizeof(struct comedi_bufinfo)))
ed9eccbe
DS		 594 return -EFAULT;
595
596 return 0;
597}
598
0a85b6f0
MT		 599static int parse_insn(struct comedi_device *dev, struct comedi_insn *insn,
600 unsigned int *data, void *file);
ed9eccbe 601/*
20617f22
PDP		 602 * COMEDI_INSNLIST
603 * synchronous instructions
ed9eccbe 604 *
20617f22
PDP		 605 * arg:
606 * pointer to sync cmd structure
ed9eccbe 607 *
20617f22
PDP		 608 * reads:
609 * sync cmd struct at arg
610 * instruction list
611 * data (for writes)
ed9eccbe 612 *
20617f22
PDP		 613 * writes:
614 * data (for reads)
ed9eccbe
DS		 615 */
616/* arbitrary limits */
617#define MAX_SAMPLES 256
71b5f4f1 618static int do_insnlist_ioctl(struct comedi_device *dev, void *arg, void *file)
ed9eccbe 619{
da613f4f 620 struct comedi_insnlist insnlist;
90035c08 621 struct comedi_insn *insns = NULL;
790c5541 622 unsigned int *data = NULL;
ed9eccbe
DS		 623 int i = 0;
624 int ret = 0;
625
da613f4f 626 if (copy_from_user(&insnlist, arg, sizeof(struct comedi_insnlist)))
ed9eccbe
DS		 627 return -EFAULT;
628
790c5541 629 data = kmalloc(sizeof(unsigned int) * MAX_SAMPLES, GFP_KERNEL);
ed9eccbe
DS		 630 if (!data) {
631 DPRINTK("kmalloc failed\n");
632 ret = -ENOMEM;
633 goto error;
634 }
635
0a85b6f0
MT		 636 insns =
637 kmalloc(sizeof(struct comedi_insn) * insnlist.n_insns, GFP_KERNEL);
ed9eccbe
DS		 638 if (!insns) {
639 DPRINTK("kmalloc failed\n");
640 ret = -ENOMEM;
641 goto error;
642 }
643
644 if (copy_from_user(insns, insnlist.insns,
90035c08 645 sizeof(struct comedi_insn) * insnlist.n_insns)) {
ed9eccbe
DS		 646 DPRINTK("copy_from_user failed\n");
647 ret = -EFAULT;
648 goto error;
649 }
650
651 for (i = 0; i < insnlist.n_insns; i++) {
652 if (insns[i].n > MAX_SAMPLES) {
653 DPRINTK("number of samples too large\n");
654 ret = -EINVAL;
655 goto error;
656 }
657 if (insns[i].insn & INSN_MASK_WRITE) {
658 if (copy_from_user(data, insns[i].data,
790c5541 659 insns[i].n * sizeof(unsigned int))) {
ed9eccbe
DS		 660 DPRINTK("copy_from_user failed\n");
661 ret = -EFAULT;
662 goto error;
663 }
664 }
665 ret = parse_insn(dev, insns + i, data, file);
666 if (ret < 0)
667 goto error;
668 if (insns[i].insn & INSN_MASK_READ) {
669 if (copy_to_user(insns[i].data, data,
790c5541 670 insns[i].n * sizeof(unsigned int))) {
ed9eccbe
DS		 671 DPRINTK("copy_to_user failed\n");
672 ret = -EFAULT;
673 goto error;
674 }
675 }
676 if (need_resched())
677 schedule();
678 }
679
476b8477
GKH		 680error:
681 kfree(insns);
682 kfree(data);
ed9eccbe
DS		 683
684 if (ret < 0)
685 return ret;
686 return i;
687}
688
0a85b6f0
MT		 689static int check_insn_config_length(struct comedi_insn *insn,
690 unsigned int *data)
ed9eccbe 691{
476b8477
GKH		 692 if (insn->n < 1)
693 return -EINVAL;
ed9eccbe
DS		 694
695 switch (data[0]) {
696 case INSN_CONFIG_DIO_OUTPUT:
697 case INSN_CONFIG_DIO_INPUT:
698 case INSN_CONFIG_DISARM:
699 case INSN_CONFIG_RESET:
700 if (insn->n == 1)
701 return 0;
702 break;
703 case INSN_CONFIG_ARM:
704 case INSN_CONFIG_DIO_QUERY:
705 case INSN_CONFIG_BLOCK_SIZE:
706 case INSN_CONFIG_FILTER:
707 case INSN_CONFIG_SERIAL_CLOCK:
708 case INSN_CONFIG_BIDIRECTIONAL_DATA:
709 case INSN_CONFIG_ALT_SOURCE:
710 case INSN_CONFIG_SET_COUNTER_MODE:
711 case INSN_CONFIG_8254_READ_STATUS:
712 case INSN_CONFIG_SET_ROUTING:
713 case INSN_CONFIG_GET_ROUTING:
714 case INSN_CONFIG_GET_PWM_STATUS:
715 case INSN_CONFIG_PWM_SET_PERIOD:
716 case INSN_CONFIG_PWM_GET_PERIOD:
717 if (insn->n == 2)
718 return 0;
719 break;
720 case INSN_CONFIG_SET_GATE_SRC:
721 case INSN_CONFIG_GET_GATE_SRC:
722 case INSN_CONFIG_SET_CLOCK_SRC:
723 case INSN_CONFIG_GET_CLOCK_SRC:
724 case INSN_CONFIG_SET_OTHER_SRC:
725 case INSN_CONFIG_GET_COUNTER_STATUS:
726 case INSN_CONFIG_PWM_SET_H_BRIDGE:
727 case INSN_CONFIG_PWM_GET_H_BRIDGE:
728 case INSN_CONFIG_GET_HARDWARE_BUFFER_SIZE:
729 if (insn->n == 3)
730 return 0;
731 break;
732 case INSN_CONFIG_PWM_OUTPUT:
733 case INSN_CONFIG_ANALOG_TRIG:
734 if (insn->n == 5)
735 return 0;
736 break;
0a85b6f0
MT		 737 /* by default we allow the insn since we don't have checks for
738 * all possible cases yet */
ed9eccbe 739 default:
3fffdf20
MR		 740 printk(KERN_WARNING
741 "comedi: no check for data length of config insn id "
0a85b6f0
MT		 742 "%i is implemented.\n"
743 " Add a check to %s in %s.\n"
744 " Assuming n=%i is correct.\n", data[0], __func__,
745 __FILE__, insn->n);
ed9eccbe
DS		 746 return 0;
747 break;
748 }
749 return -EINVAL;
750}
751
0a85b6f0
MT		 752static int parse_insn(struct comedi_device *dev, struct comedi_insn *insn,
753 unsigned int *data, void *file)
ed9eccbe 754{
34c43922 755 struct comedi_subdevice *s;
ed9eccbe
DS		 756 int ret = 0;
757 int i;
758
759 if (insn->insn & INSN_MASK_SPECIAL) {
760 /* a non-subdevice instruction */
761
762 switch (insn->insn) {
763 case INSN_GTOD:
764 {
765 struct timeval tv;
766
767 if (insn->n != 2) {
768 ret = -EINVAL;
769 break;
770 }
771
772 do_gettimeofday(&tv);
773 data[0] = tv.tv_sec;
774 data[1] = tv.tv_usec;
775 ret = 2;
776
777 break;
778 }
779 case INSN_WAIT:
780 if (insn->n != 1 || data[0] >= 100000) {
781 ret = -EINVAL;
782 break;
783 }
784 udelay(data[0] / 1000);
785 ret = 1;
786 break;
787 case INSN_INTTRIG:
788 if (insn->n != 1) {
789 ret = -EINVAL;
790 break;
791 }
792 if (insn->subdev >= dev->n_subdevices) {
793 DPRINTK("%d not usable subdevice\n",
794 insn->subdev);
795 ret = -EINVAL;
796 break;
797 }
798 s = dev->subdevices + insn->subdev;
799 if (!s->async) {
800 DPRINTK("no async\n");
801 ret = -EINVAL;
802 break;
803 }
804 if (!s->async->inttrig) {
805 DPRINTK("no inttrig\n");
806 ret = -EAGAIN;
807 break;
808 }
809 ret = s->async->inttrig(dev, s, insn->data[0]);
810 if (ret >= 0)
811 ret = 1;
812 break;
813 default:
814 DPRINTK("invalid insn\n");
815 ret = -EINVAL;
816 break;
817 }
818 } else {
819 /* a subdevice instruction */
790c5541 820 unsigned int maxdata;
ed9eccbe
DS		 821
822 if (insn->subdev >= dev->n_subdevices) {
823 DPRINTK("subdevice %d out of range\n", insn->subdev);
824 ret = -EINVAL;
825 goto out;
826 }
827 s = dev->subdevices + insn->subdev;
828
829 if (s->type == COMEDI_SUBD_UNUSED) {
830 DPRINTK("%d not usable subdevice\n", insn->subdev);
831 ret = -EIO;
832 goto out;
833 }
834
835 /* are we locked? (ioctl lock) */
836 if (s->lock && s->lock != file) {
837 DPRINTK("device locked\n");
838 ret = -EACCES;
839 goto out;
840 }
841
0fd0ca75 842 ret = comedi_check_chanlist(s, 1, &insn->chanspec);
476b8477 843 if (ret < 0) {
ed9eccbe
DS		 844 ret = -EINVAL;
845 DPRINTK("bad chanspec\n");
846 goto out;
847 }
848
849 if (s->busy) {
850 ret = -EBUSY;
851 goto out;
852 }
853 /* This looks arbitrary. It is. */
854 s->busy = &parse_insn;
855 switch (insn->insn) {
856 case INSN_READ:
857 ret = s->insn_read(dev, s, insn, data);
858 break;
859 case INSN_WRITE:
860 maxdata = s->maxdata_list
476b8477
GKH		 861 ? s->maxdata_list[CR_CHAN(insn->chanspec)]
862 : s->maxdata;
ed9eccbe
DS		 863 for (i = 0; i < insn->n; ++i) {
864 if (data[i] > maxdata) {
865 ret = -EINVAL;
866 DPRINTK("bad data value(s)\n");
867 break;
868 }
869 }
870 if (ret == 0)
871 ret = s->insn_write(dev, s, insn, data);
872 break;
873 case INSN_BITS:
874 if (insn->n != 2) {
875 ret = -EINVAL;
876 break;
877 }
878 ret = s->insn_bits(dev, s, insn, data);
879 break;
880 case INSN_CONFIG:
881 ret = check_insn_config_length(insn, data);
882 if (ret)
883 break;
884 ret = s->insn_config(dev, s, insn, data);
885 break;
886 default:
887 ret = -EINVAL;
888 break;
889 }
890
891 s->busy = NULL;
892 }
893
476b8477 894out:
ed9eccbe
DS		 895 return ret;
896}
897
898/*
20617f22
PDP		 899 * COMEDI_INSN
900 * synchronous instructions
ed9eccbe 901 *
20617f22
PDP		 902 * arg:
903 * pointer to insn
ed9eccbe 904 *
20617f22
PDP		 905 * reads:
906 * struct comedi_insn struct at arg
907 * data (for writes)
ed9eccbe 908 *
20617f22
PDP		 909 * writes:
910 * data (for reads)
ed9eccbe 911 */
71b5f4f1 912static int do_insn_ioctl(struct comedi_device *dev, void *arg, void *file)
ed9eccbe 913{
90035c08 914 struct comedi_insn insn;
790c5541 915 unsigned int *data = NULL;
ed9eccbe
DS		 916 int ret = 0;
917
790c5541 918 data = kmalloc(sizeof(unsigned int) * MAX_SAMPLES, GFP_KERNEL);
ed9eccbe
DS		 919 if (!data) {
920 ret = -ENOMEM;
921 goto error;
922 }
923
90035c08 924 if (copy_from_user(&insn, arg, sizeof(struct comedi_insn))) {
ed9eccbe
DS		 925 ret = -EFAULT;
926 goto error;
927 }
928
929 /* This is where the behavior of insn and insnlist deviate. */
930 if (insn.n > MAX_SAMPLES)
931 insn.n = MAX_SAMPLES;
932 if (insn.insn & INSN_MASK_WRITE) {
0a85b6f0
MT		 933 if (copy_from_user
934 (data, insn.data, insn.n * sizeof(unsigned int))) {
ed9eccbe
DS		 935 ret = -EFAULT;
936 goto error;
937 }
938 }
939 ret = parse_insn(dev, &insn, data, file);
940 if (ret < 0)
941 goto error;
942 if (insn.insn & INSN_MASK_READ) {
0a85b6f0
MT		 943 if (copy_to_user
944 (insn.data, data, insn.n * sizeof(unsigned int))) {
ed9eccbe
DS		 945 ret = -EFAULT;
946 goto error;
947 }
948 }
949 ret = insn.n;
950
476b8477
GKH		 951error:
952 kfree(data);
ed9eccbe
DS		 953
954 return ret;
955}
956
181bd67b
GKH		 957static void comedi_set_subdevice_runflags(struct comedi_subdevice *s,
958 unsigned mask, unsigned bits)
959{
960 unsigned long flags;
961
962 spin_lock_irqsave(&s->spin_lock, flags);
963 s->runflags &= ~mask;
964 s->runflags |= (bits & mask);
965 spin_unlock_irqrestore(&s->spin_lock, flags);
966}
967
ed9eccbe
DS		 968/*
969 COMEDI_CMD
970 command ioctl
971
972 arg:
973 pointer to cmd structure
974
975 reads:
976 cmd structure at arg
977 channel/range list
978
979 writes:
980 modified cmd structure at arg
981
982*/
71b5f4f1 983static int do_cmd_ioctl(struct comedi_device *dev, void *arg, void *file)
ed9eccbe 984{
ea6d0d4c 985 struct comedi_cmd user_cmd;
34c43922 986 struct comedi_subdevice *s;
d163679c 987 struct comedi_async *async;
ed9eccbe
DS		 988 int ret = 0;
989 unsigned int *chanlist_saver = NULL;
990
ea6d0d4c 991 if (copy_from_user(&user_cmd, arg, sizeof(struct comedi_cmd))) {
ed9eccbe
DS		 992 DPRINTK("bad cmd address\n");
993 return -EFAULT;
994 }
476b8477 995 /* save user's chanlist pointer so it can be restored later */
ed9eccbe
DS		 996 chanlist_saver = user_cmd.chanlist;
997
998 if (user_cmd.subdev >= dev->n_subdevices) {
999 DPRINTK("%d no such subdevice\n", user_cmd.subdev);
1000 return -ENODEV;
1001 }
1002
1003 s = dev->subdevices + user_cmd.subdev;
1004 async = s->async;
1005
1006 if (s->type == COMEDI_SUBD_UNUSED) {
1007 DPRINTK("%d not valid subdevice\n", user_cmd.subdev);
1008 return -EIO;
1009 }
1010
1011 if (!s->do_cmd || !s->do_cmdtest || !s->async) {
1012 DPRINTK("subdevice %i does not support commands\n",
1013 user_cmd.subdev);
1014 return -EIO;
1015 }
1016
1017 /* are we locked? (ioctl lock) */
1018 if (s->lock && s->lock != file) {
1019 DPRINTK("subdevice locked\n");
1020 return -EACCES;
1021 }
1022
1023 /* are we busy? */
1024 if (s->busy) {
1025 DPRINTK("subdevice busy\n");
1026 return -EBUSY;
1027 }
1028 s->busy = file;
1029
1030 /* make sure channel/gain list isn't too long */
1031 if (user_cmd.chanlist_len > s->len_chanlist) {
1032 DPRINTK("channel/gain list too long %u > %d\n",
1033 user_cmd.chanlist_len, s->len_chanlist);
1034 ret = -EINVAL;
1035 goto cleanup;
1036 }
1037
1038 /* make sure channel/gain list isn't too short */
1039 if (user_cmd.chanlist_len < 1) {
1040 DPRINTK("channel/gain list too short %u < 1\n",
1041 user_cmd.chanlist_len);
1042 ret = -EINVAL;
1043 goto cleanup;
1044 }
1045
476b8477 1046 kfree(async->cmd.chanlist);
ed9eccbe
DS		 1047 async->cmd = user_cmd;
1048 async->cmd.data = NULL;
1049 /* load channel/gain list */
1050 async->cmd.chanlist =
476b8477 1051 kmalloc(async->cmd.chanlist_len * sizeof(int), GFP_KERNEL);
ed9eccbe
DS		 1052 if (!async->cmd.chanlist) {
1053 DPRINTK("allocation failed\n");
1054 ret = -ENOMEM;
1055 goto cleanup;
1056 }
1057
1058 if (copy_from_user(async->cmd.chanlist, user_cmd.chanlist,
476b8477 1059 async->cmd.chanlist_len * sizeof(int))) {
ed9eccbe
DS		 1060 DPRINTK("fault reading chanlist\n");
1061 ret = -EFAULT;
1062 goto cleanup;
1063 }
1064
1065 /* make sure each element in channel/gain list is valid */
0fd0ca75 1066 ret = comedi_check_chanlist(s, async->cmd.chanlist_len, async->cmd.chanlist);
476b8477 1067 if (ret < 0) {
ed9eccbe
DS		 1068 DPRINTK("bad chanlist\n");
1069 goto cleanup;
1070 }
1071
1072 ret = s->do_cmdtest(dev, s, &async->cmd);
1073
1074 if (async->cmd.flags & TRIG_BOGUS || ret) {
1075 DPRINTK("test returned %d\n", ret);
1076 user_cmd = async->cmd;
476b8477 1077 /* restore chanlist pointer before copying back */
ed9eccbe
DS		 1078 user_cmd.chanlist = chanlist_saver;
1079 user_cmd.data = NULL;
ea6d0d4c 1080 if (copy_to_user(arg, &user_cmd, sizeof(struct comedi_cmd))) {
ed9eccbe
DS		 1081 DPRINTK("fault writing cmd\n");
1082 ret = -EFAULT;
1083 goto cleanup;
1084 }
1085 ret = -EAGAIN;
1086 goto cleanup;
1087 }
1088
1089 if (!async->prealloc_bufsz) {
1090 ret = -ENOMEM;
1091 DPRINTK("no buffer (?)\n");
1092 goto cleanup;
1093 }
1094
1095 comedi_reset_async_buf(async);
1096
1097 async->cb_mask =
476b8477
GKH		 1098 COMEDI_CB_EOA | COMEDI_CB_BLOCK | COMEDI_CB_ERROR |
1099 COMEDI_CB_OVERFLOW;
1100 if (async->cmd.flags & TRIG_WAKE_EOS)
ed9eccbe 1101 async->cb_mask |= COMEDI_CB_EOS;
ed9eccbe
DS		 1102
1103 comedi_set_subdevice_runflags(s, ~0, SRF_USER | SRF_RUNNING);
1104
ed9eccbe
DS		 1105 ret = s->do_cmd(dev, s);
1106 if (ret == 0)
1107 return 0;
1108
476b8477 1109cleanup:
ed9eccbe
DS		 1110 do_become_nonbusy(dev, s);
1111
1112 return ret;
1113}
1114
1115/*
1116 COMEDI_CMDTEST
1117 command testing ioctl
1118
1119 arg:
1120 pointer to cmd structure
1121
1122 reads:
1123 cmd structure at arg
1124 channel/range list
1125
1126 writes:
1127 modified cmd structure at arg
1128
1129*/
71b5f4f1 1130static int do_cmdtest_ioctl(struct comedi_device *dev, void *arg, void *file)
ed9eccbe 1131{
ea6d0d4c 1132 struct comedi_cmd user_cmd;
34c43922 1133 struct comedi_subdevice *s;
ed9eccbe
DS		 1134 int ret = 0;
1135 unsigned int *chanlist = NULL;
1136 unsigned int *chanlist_saver = NULL;
1137
ea6d0d4c 1138 if (copy_from_user(&user_cmd, arg, sizeof(struct comedi_cmd))) {
ed9eccbe
DS		 1139 DPRINTK("bad cmd address\n");
1140 return -EFAULT;
1141 }
476b8477 1142 /* save user's chanlist pointer so it can be restored later */
ed9eccbe
DS		 1143 chanlist_saver = user_cmd.chanlist;
1144
1145 if (user_cmd.subdev >= dev->n_subdevices) {
1146 DPRINTK("%d no such subdevice\n", user_cmd.subdev);
1147 return -ENODEV;
1148 }
1149
1150 s = dev->subdevices + user_cmd.subdev;
1151 if (s->type == COMEDI_SUBD_UNUSED) {
1152 DPRINTK("%d not valid subdevice\n", user_cmd.subdev);
1153 return -EIO;
1154 }
1155
1156 if (!s->do_cmd || !s->do_cmdtest) {
1157 DPRINTK("subdevice %i does not support commands\n",
1158 user_cmd.subdev);
1159 return -EIO;
1160 }
1161
1162 /* make sure channel/gain list isn't too long */
1163 if (user_cmd.chanlist_len > s->len_chanlist) {
1164 DPRINTK("channel/gain list too long %d > %d\n",
1165 user_cmd.chanlist_len, s->len_chanlist);
1166 ret = -EINVAL;
1167 goto cleanup;
1168 }
1169
1170 /* load channel/gain list */
1171 if (user_cmd.chanlist) {
1172 chanlist =
476b8477 1173 kmalloc(user_cmd.chanlist_len * sizeof(int), GFP_KERNEL);
ed9eccbe
DS		 1174 if (!chanlist) {
1175 DPRINTK("allocation failed\n");
1176 ret = -ENOMEM;
1177 goto cleanup;
1178 }
1179
1180 if (copy_from_user(chanlist, user_cmd.chanlist,
476b8477 1181 user_cmd.chanlist_len * sizeof(int))) {
ed9eccbe
DS		 1182 DPRINTK("fault reading chanlist\n");
1183 ret = -EFAULT;
1184 goto cleanup;
1185 }
1186
1187 /* make sure each element in channel/gain list is valid */
0fd0ca75 1188 ret = comedi_check_chanlist(s, user_cmd.chanlist_len, chanlist);
476b8477 1189 if (ret < 0) {
ed9eccbe
DS		 1190 DPRINTK("bad chanlist\n");
1191 goto cleanup;
1192 }
1193
1194 user_cmd.chanlist = chanlist;
1195 }
1196
1197 ret = s->do_cmdtest(dev, s, &user_cmd);
1198
476b8477 1199 /* restore chanlist pointer before copying back */
ed9eccbe
DS		 1200 user_cmd.chanlist = chanlist_saver;
1201
ea6d0d4c 1202 if (copy_to_user(arg, &user_cmd, sizeof(struct comedi_cmd))) {
ed9eccbe
DS		 1203 DPRINTK("bad cmd address\n");
1204 ret = -EFAULT;
1205 goto cleanup;
1206 }
476b8477
GKH		 1207cleanup:
1208 kfree(chanlist);
ed9eccbe
DS		 1209
1210 return ret;
1211}
1212
1213/*
1214 COMEDI_LOCK
1215 lock subdevice
1216
1217 arg:
1218 subdevice number
1219
1220 reads:
1221 none
1222
1223 writes:
1224 none
1225
1226*/
1227
0a85b6f0
MT		 1228static int do_lock_ioctl(struct comedi_device *dev, unsigned int arg,
1229 void *file)
ed9eccbe
DS		 1230{
1231 int ret = 0;
1232 unsigned long flags;
34c43922 1233 struct comedi_subdevice *s;
ed9eccbe
DS		 1234
1235 if (arg >= dev->n_subdevices)
1236 return -EINVAL;
1237 s = dev->subdevices + arg;
1238
5f74ea14 1239 spin_lock_irqsave(&s->spin_lock, flags);
476b8477 1240 if (s->busy || s->lock)
ed9eccbe 1241 ret = -EBUSY;
476b8477 1242 else
ed9eccbe 1243 s->lock = file;
5f74ea14 1244 spin_unlock_irqrestore(&s->spin_lock, flags);
ed9eccbe
DS		 1245
1246 if (ret < 0)
1247 return ret;
1248
1249#if 0
1250 if (s->lock_f)
1251 ret = s->lock_f(dev, s);
1252#endif
1253
1254 return ret;
1255}
1256
1257/*
1258 COMEDI_UNLOCK
1259 unlock subdevice
1260
1261 arg:
1262 subdevice number
1263
1264 reads:
1265 none
1266
1267 writes:
1268 none
1269
1270 This function isn't protected by the semaphore, since
1271 we already own the lock.
1272*/
0a85b6f0
MT		 1273static int do_unlock_ioctl(struct comedi_device *dev, unsigned int arg,
1274 void *file)
ed9eccbe 1275{
34c43922 1276 struct comedi_subdevice *s;
ed9eccbe
DS		 1277
1278 if (arg >= dev->n_subdevices)
1279 return -EINVAL;
1280 s = dev->subdevices + arg;
1281
1282 if (s->busy)
1283 return -EBUSY;
1284
1285 if (s->lock && s->lock != file)
1286 return -EACCES;
1287
1288 if (s->lock == file) {
1289#if 0
1290 if (s->unlock)
1291 s->unlock(dev, s);
1292#endif
1293
1294 s->lock = NULL;
1295 }
1296
1297 return 0;
1298}
1299
1300/*
1301 COMEDI_CANCEL
1302 cancel acquisition ioctl
1303
1304 arg:
1305 subdevice number
1306
1307 reads:
1308 nothing
1309
1310 writes:
1311 nothing
1312
1313*/
0a85b6f0
MT		 1314static int do_cancel_ioctl(struct comedi_device *dev, unsigned int arg,
1315 void *file)
ed9eccbe 1316{
34c43922 1317 struct comedi_subdevice *s;
ed9eccbe
DS		 1318
1319 if (arg >= dev->n_subdevices)
1320 return -EINVAL;
1321 s = dev->subdevices + arg;
1322 if (s->async == NULL)
1323 return -EINVAL;
1324
1325 if (s->lock && s->lock != file)
1326 return -EACCES;
1327
1328 if (!s->busy)
1329 return 0;
1330
1331 if (s->busy != file)
1332 return -EBUSY;
1333
1334 return do_cancel(dev, s);
1335}
1336
1337/*
1338 COMEDI_POLL ioctl
1339 instructs driver to synchronize buffers
1340
1341 arg:
1342 subdevice number
1343
1344 reads:
1345 nothing
1346
1347 writes:
1348 nothing
1349
1350*/
0a85b6f0
MT		 1351static int do_poll_ioctl(struct comedi_device *dev, unsigned int arg,
1352 void *file)
ed9eccbe 1353{
34c43922 1354 struct comedi_subdevice *s;
ed9eccbe
DS		 1355
1356 if (arg >= dev->n_subdevices)
1357 return -EINVAL;
1358 s = dev->subdevices + arg;
1359
1360 if (s->lock && s->lock != file)
1361 return -EACCES;
1362
1363 if (!s->busy)
1364 return 0;
1365
1366 if (s->busy != file)
1367 return -EBUSY;
1368
1369 if (s->poll)
1370 return s->poll(dev, s);
1371
1372 return -EINVAL;
1373}
1374
34c43922 1375static int do_cancel(struct comedi_device *dev, struct comedi_subdevice *s)
ed9eccbe
DS		 1376{
1377 int ret = 0;
1378
1379 if ((comedi_get_subdevice_runflags(s) & SRF_RUNNING) && s->cancel)
1380 ret = s->cancel(dev, s);
1381
1382 do_become_nonbusy(dev, s);
1383
1384 return ret;
1385}
1386
1387void comedi_unmap(struct vm_area_struct *area)
1388{
d163679c 1389 struct comedi_async *async;
71b5f4f1 1390 struct comedi_device *dev;
ed9eccbe
DS		 1391
1392 async = area->vm_private_data;
1393 dev = async->subdevice->device;
1394
1395 mutex_lock(&dev->mutex);
1396 async->mmap_count--;
1397 mutex_unlock(&dev->mutex);
1398}
1399
1400static struct vm_operations_struct comedi_vm_ops = {
0a85b6f0 1401 .close = comedi_unmap,
ed9eccbe
DS		 1402};
1403
1404static int comedi_mmap(struct file *file, struct vm_area_struct *vma)
1405{
1406 const unsigned minor = iminor(file->f_dentry->d_inode);
476b8477
GKH		 1407 struct comedi_device_file_info *dev_file_info =
1408 comedi_get_device_file_info(minor);
71b5f4f1 1409 struct comedi_device *dev = dev_file_info->device;
d163679c 1410 struct comedi_async *async = NULL;
ed9eccbe
DS		 1411 unsigned long start = vma->vm_start;
1412 unsigned long size;
1413 int n_pages;
1414 int i;
1415 int retval;
34c43922 1416 struct comedi_subdevice *s;
ed9eccbe
DS		 1417
1418 mutex_lock(&dev->mutex);
1419 if (!dev->attached) {
1420 DPRINTK("no driver configured on comedi%i\n", dev->minor);
1421 retval = -ENODEV;
1422 goto done;
1423 }
476b8477 1424 if (vma->vm_flags & VM_WRITE)
ed9eccbe 1425 s = comedi_get_write_subdevice(dev_file_info);
476b8477 1426 else
ed9eccbe 1427 s = comedi_get_read_subdevice(dev_file_info);
476b8477 1428
ed9eccbe
DS		 1429 if (s == NULL) {
1430 retval = -EINVAL;
1431 goto done;
1432 }
1433 async = s->async;
1434 if (async == NULL) {
1435 retval = -EINVAL;
1436 goto done;
1437 }
1438
1439 if (vma->vm_pgoff != 0) {
1440 DPRINTK("comedi: mmap() offset must be 0.\n");
1441 retval = -EINVAL;
1442 goto done;
1443 }
1444
1445 size = vma->vm_end - vma->vm_start;
1446 if (size > async->prealloc_bufsz) {
1447 retval = -EFAULT;
1448 goto done;
1449 }
1450 if (size & (~PAGE_MASK)) {
1451 retval = -EFAULT;
1452 goto done;
1453 }
1454
1455 n_pages = size >> PAGE_SHIFT;
1456 for (i = 0; i < n_pages; ++i) {
1457 if (remap_pfn_range(vma, start,
0a85b6f0
MT		 1458 page_to_pfn(virt_to_page
1459 (async->buf_page_list
1460 [i].virt_addr)), PAGE_SIZE,
1461 PAGE_SHARED)) {
ed9eccbe
DS		 1462 retval = -EAGAIN;
1463 goto done;
1464 }
1465 start += PAGE_SIZE;
1466 }
1467
1468 vma->vm_ops = &comedi_vm_ops;
1469 vma->vm_private_data = async;
1470
1471 async->mmap_count++;
1472
1473 retval = 0;
476b8477 1474done:
ed9eccbe
DS		 1475 mutex_unlock(&dev->mutex);
1476 return retval;
1477}
1478
0a85b6f0 1479static unsigned int comedi_poll(struct file *file, poll_table * wait)
ed9eccbe
DS		 1480{
1481 unsigned int mask = 0;
1482 const unsigned minor = iminor(file->f_dentry->d_inode);
476b8477
GKH		 1483 struct comedi_device_file_info *dev_file_info =
1484 comedi_get_device_file_info(minor);
71b5f4f1 1485 struct comedi_device *dev = dev_file_info->device;
34c43922
BP		 1486 struct comedi_subdevice *read_subdev;
1487 struct comedi_subdevice *write_subdev;
ed9eccbe
DS		 1488
1489 mutex_lock(&dev->mutex);
1490 if (!dev->attached) {
1491 DPRINTK("no driver configured on comedi%i\n", dev->minor);
1492 mutex_unlock(&dev->mutex);
1493 return 0;
1494 }
1495
1496 mask = 0;
1497 read_subdev = comedi_get_read_subdevice(dev_file_info);
1498 if (read_subdev) {
1499 poll_wait(file, &read_subdev->async->wait_head, wait);
1500 if (!read_subdev->busy
476b8477
GKH		 1501 || comedi_buf_read_n_available(read_subdev->async) > 0
1502 || !(comedi_get_subdevice_runflags(read_subdev) &
1503 SRF_RUNNING)) {
ed9eccbe
DS		 1504 mask |= POLLIN | POLLRDNORM;
1505 }
1506 }
1507 write_subdev = comedi_get_write_subdevice(dev_file_info);
1508 if (write_subdev) {
1509 poll_wait(file, &write_subdev->async->wait_head, wait);
476b8477
GKH		 1510 comedi_buf_write_alloc(write_subdev->async,
1511 write_subdev->async->prealloc_bufsz);
ed9eccbe 1512 if (!write_subdev->busy
476b8477
GKH		 1513 || !(comedi_get_subdevice_runflags(write_subdev) &
1514 SRF_RUNNING)
1515 || comedi_buf_write_n_allocated(write_subdev->async) >=
1516 bytes_per_sample(write_subdev->async->subdevice)) {
ed9eccbe
DS		 1517 mask |= POLLOUT | POLLWRNORM;
1518 }
1519 }
1520
1521 mutex_unlock(&dev->mutex);
1522 return mask;
1523}
1524
1525static ssize_t comedi_write(struct file *file, const char *buf, size_t nbytes,
6705b68d 1526 loff_t *offset)
ed9eccbe 1527{
34c43922 1528 struct comedi_subdevice *s;
d163679c 1529 struct comedi_async *async;
ed9eccbe
DS		 1530 int n, m, count = 0, retval = 0;
1531 DECLARE_WAITQUEUE(wait, current);
1532 const unsigned minor = iminor(file->f_dentry->d_inode);
476b8477
GKH		 1533 struct comedi_device_file_info *dev_file_info =
1534 comedi_get_device_file_info(minor);
71b5f4f1 1535 struct comedi_device *dev = dev_file_info->device;
ed9eccbe
DS		 1536
1537 if (!dev->attached) {
1538 DPRINTK("no driver configured on comedi%i\n", dev->minor);
1539 retval = -ENODEV;
1540 goto done;
1541 }
1542
1543 s = comedi_get_write_subdevice(dev_file_info);
1544 if (s == NULL) {
1545 retval = -EIO;
1546 goto done;
1547 }
1548 async = s->async;
1549
1550 if (!nbytes) {
1551 retval = 0;
1552 goto done;
1553 }
1554 if (!s->busy) {
1555 retval = 0;
1556 goto done;
1557 }
1558 if (s->busy != file) {
1559 retval = -EACCES;
1560 goto done;
1561 }
1562 add_wait_queue(&async->wait_head, &wait);
1563 while (nbytes > 0 && !retval) {
1564 set_current_state(TASK_INTERRUPTIBLE);
1565
1566 n = nbytes;
1567
1568 m = n;
476b8477 1569 if (async->buf_write_ptr + m > async->prealloc_bufsz)
ed9eccbe 1570 m = async->prealloc_bufsz - async->buf_write_ptr;
ed9eccbe 1571 comedi_buf_write_alloc(async, async->prealloc_bufsz);
476b8477 1572 if (m > comedi_buf_write_n_allocated(async))
ed9eccbe 1573 m = comedi_buf_write_n_allocated(async);
ed9eccbe
DS		 1574 if (m < n)
1575 n = m;
1576
1577 if (n == 0) {
1578 if (!(comedi_get_subdevice_runflags(s) & SRF_RUNNING)) {
1579 if (comedi_get_subdevice_runflags(s) &
476b8477 1580 SRF_ERROR) {
ed9eccbe
DS		 1581 retval = -EPIPE;
1582 } else {
1583 retval = 0;
1584 }
1585 do_become_nonbusy(dev, s);
1586 break;
1587 }
1588 if (file->f_flags & O_NONBLOCK) {
1589 retval = -EAGAIN;
1590 break;
1591 }
1592 if (signal_pending(current)) {
1593 retval = -ERESTARTSYS;
1594 break;
1595 }
1596 schedule();
476b8477 1597 if (!s->busy)
ed9eccbe 1598 break;
ed9eccbe
DS		 1599 if (s->busy != file) {
1600 retval = -EACCES;
1601 break;
1602 }
1603 continue;
1604 }
1605
1606 m = copy_from_user(async->prealloc_buf + async->buf_write_ptr,
476b8477 1607 buf, n);
ed9eccbe
DS		 1608 if (m) {
1609 n -= m;
1610 retval = -EFAULT;
1611 }
1612 comedi_buf_write_free(async, n);
1613
1614 count += n;
1615 nbytes -= n;
1616
1617 buf += n;
1618 break; /* makes device work like a pipe */
1619 }
1620 set_current_state(TASK_RUNNING);
1621 remove_wait_queue(&async->wait_head, &wait);
1622
1623done:
476b8477 1624 return count ? count : retval;
ed9eccbe
DS		 1625}
1626
1627static ssize_t comedi_read(struct file *file, char *buf, size_t nbytes,
6705b68d 1628 loff_t *offset)
ed9eccbe 1629{
34c43922 1630 struct comedi_subdevice *s;
d163679c 1631 struct comedi_async *async;
ed9eccbe
DS		 1632 int n, m, count = 0, retval = 0;
1633 DECLARE_WAITQUEUE(wait, current);
1634 const unsigned minor = iminor(file->f_dentry->d_inode);
476b8477
GKH		 1635 struct comedi_device_file_info *dev_file_info =
1636 comedi_get_device_file_info(minor);
71b5f4f1 1637 struct comedi_device *dev = dev_file_info->device;
ed9eccbe
DS		 1638
1639 if (!dev->attached) {
1640 DPRINTK("no driver configured on comedi%i\n", dev->minor);
1641 retval = -ENODEV;
1642 goto done;
1643 }
1644
1645 s = comedi_get_read_subdevice(dev_file_info);
1646 if (s == NULL) {
1647 retval = -EIO;
1648 goto done;
1649 }
1650 async = s->async;
1651 if (!nbytes) {
1652 retval = 0;
1653 goto done;
1654 }
1655 if (!s->busy) {
1656 retval = 0;
1657 goto done;
1658 }
1659 if (s->busy != file) {
1660 retval = -EACCES;
1661 goto done;
1662 }
1663
1664 add_wait_queue(&async->wait_head, &wait);
1665 while (nbytes > 0 && !retval) {
1666 set_current_state(TASK_INTERRUPTIBLE);
1667
1668 n = nbytes;
1669
1670 m = comedi_buf_read_n_available(async);
476b8477
GKH		 1671 /* printk("%d available\n",m); */
1672 if (async->buf_read_ptr + m > async->prealloc_bufsz)
ed9eccbe 1673 m = async->prealloc_bufsz - async->buf_read_ptr;
476b8477 1674 /* printk("%d contiguous\n",m); */
ed9eccbe
DS		 1675 if (m < n)
1676 n = m;
1677
1678 if (n == 0) {
1679 if (!(comedi_get_subdevice_runflags(s) & SRF_RUNNING)) {
1680 do_become_nonbusy(dev, s);
1681 if (comedi_get_subdevice_runflags(s) &
476b8477 1682 SRF_ERROR) {
ed9eccbe
DS		 1683 retval = -EPIPE;
1684 } else {
1685 retval = 0;
1686 }
1687 break;
1688 }
1689 if (file->f_flags & O_NONBLOCK) {
1690 retval = -EAGAIN;
1691 break;
1692 }
1693 if (signal_pending(current)) {
1694 retval = -ERESTARTSYS;
1695 break;
1696 }
1697 schedule();
1698 if (!s->busy) {
1699 retval = 0;
1700 break;
1701 }
1702 if (s->busy != file) {
1703 retval = -EACCES;
1704 break;
1705 }
1706 continue;
1707 }
1708 m = copy_to_user(buf, async->prealloc_buf +
476b8477 1709 async->buf_read_ptr, n);
ed9eccbe
DS		 1710 if (m) {
1711 n -= m;
1712 retval = -EFAULT;
1713 }
1714
1715 comedi_buf_read_alloc(async, n);
1716 comedi_buf_read_free(async, n);
1717
1718 count += n;
1719 nbytes -= n;
1720
1721 buf += n;
1722 break; /* makes device work like a pipe */
1723 }
1724 if (!(comedi_get_subdevice_runflags(s) & (SRF_ERROR | SRF_RUNNING)) &&
476b8477 1725 async->buf_read_count - async->buf_write_count == 0) {
ed9eccbe
DS		 1726 do_become_nonbusy(dev, s);
1727 }
1728 set_current_state(TASK_RUNNING);
1729 remove_wait_queue(&async->wait_head, &wait);
1730
1731done:
476b8477 1732 return count ? count : retval;
ed9eccbe
DS		 1733}
1734
1735/*
1736 This function restores a subdevice to an idle state.
1737 */
34c43922 1738void do_become_nonbusy(struct comedi_device *dev, struct comedi_subdevice *s)
ed9eccbe 1739{
d163679c 1740 struct comedi_async *async = s->async;
ed9eccbe
DS		 1741
1742 comedi_set_subdevice_runflags(s, SRF_RUNNING, 0);
ed9eccbe
DS		 1743 if (async) {
1744 comedi_reset_async_buf(async);
1745 async->inttrig = NULL;
1746 } else {
476b8477
GKH		 1747 printk(KERN_ERR
1748 "BUG: (?) do_become_nonbusy called with async=0\n");
ed9eccbe
DS		 1749 }
1750
1751 s->busy = NULL;
1752}
1753
1754static int comedi_open(struct inode *inode, struct file *file)
1755{
ed9eccbe 1756 const unsigned minor = iminor(inode);
476b8477
GKH		 1757 struct comedi_device_file_info *dev_file_info =
1758 comedi_get_device_file_info(minor);
0a85b6f0
MT		 1759 struct comedi_device *dev =
1760 dev_file_info ? dev_file_info->device : NULL;
97920071 1761
ed9eccbe
DS		 1762 if (dev == NULL) {
1763 DPRINTK("invalid minor number\n");
1764 return -ENODEV;
1765 }
1766
1767 /* This is slightly hacky, but we want module autoloading
1768 * to work for root.
1769 * case: user opens device, attached -> ok
1770 * case: user opens device, unattached, in_request_module=0 -> autoload
1771 * case: user opens device, unattached, in_request_module=1 -> fail
1772 * case: root opens device, attached -> ok
1773 * case: root opens device, unattached, in_request_module=1 -> ok
1774 * (typically called from modprobe)
1775 * case: root opens device, unattached, in_request_module=0 -> autoload
1776 *
1777 * The last could be changed to "-> ok", which would deny root
1778 * autoloading.
1779 */
1780 mutex_lock(&dev->mutex);
1781 if (dev->attached)
1782 goto ok;
a8f80e8f 1783 if (!capable(CAP_NET_ADMIN) && dev->in_request_module) {
ed9eccbe
DS		 1784 DPRINTK("in request module\n");
1785 mutex_unlock(&dev->mutex);
1786 return -ENODEV;
1787 }
a8f80e8f 1788 if (capable(CAP_NET_ADMIN) && dev->in_request_module)
ed9eccbe
DS		 1789 goto ok;
1790
1791 dev->in_request_module = 1;
1792
ed9eccbe
DS		 1793#ifdef CONFIG_KMOD
1794 mutex_unlock(&dev->mutex);
56d92c60 1795 request_module("char-major-%i-%i", COMEDI_MAJOR, dev->minor);
ed9eccbe
DS		 1796 mutex_lock(&dev->mutex);
1797#endif
1798
1799 dev->in_request_module = 0;
1800
a8f80e8f
EP		 1801 if (!dev->attached && !capable(CAP_NET_ADMIN)) {
1802 DPRINTK("not attached and not CAP_NET_ADMIN\n");
ed9eccbe
DS		 1803 mutex_unlock(&dev->mutex);
1804 return -ENODEV;
1805 }
1806ok:
1807 __module_get(THIS_MODULE);
1808
1809 if (dev->attached) {
1810 if (!try_module_get(dev->driver->module)) {
1811 module_put(THIS_MODULE);
1812 mutex_unlock(&dev->mutex);
1813 return -ENOSYS;
1814 }
1815 }
1816
476b8477 1817 if (dev->attached && dev->use_count == 0 && dev->open)
ed9eccbe 1818 dev->open(dev);
ed9eccbe
DS		 1819
1820 dev->use_count++;
1821
1822 mutex_unlock(&dev->mutex);
1823
1824 return 0;
1825}
1826
1827static int comedi_close(struct inode *inode, struct file *file)
1828{
1829 const unsigned minor = iminor(inode);
476b8477
GKH		 1830 struct comedi_device_file_info *dev_file_info =
1831 comedi_get_device_file_info(minor);
71b5f4f1 1832 struct comedi_device *dev = dev_file_info->device;
34c43922 1833 struct comedi_subdevice *s = NULL;
ed9eccbe
DS		 1834 int i;
1835
1836 mutex_lock(&dev->mutex);
1837
1838 if (dev->subdevices) {
1839 for (i = 0; i < dev->n_subdevices; i++) {
1840 s = dev->subdevices + i;
1841
476b8477 1842 if (s->busy == file)
ed9eccbe 1843 do_cancel(dev, s);
476b8477 1844 if (s->lock == file)
ed9eccbe 1845 s->lock = NULL;
ed9eccbe
DS		 1846 }
1847 }
476b8477 1848 if (dev->attached && dev->use_count == 1 && dev->close)
ed9eccbe 1849 dev->close(dev);
ed9eccbe
DS		 1850
1851 module_put(THIS_MODULE);
476b8477 1852 if (dev->attached)
ed9eccbe 1853 module_put(dev->driver->module);
ed9eccbe
DS		 1854
1855 dev->use_count--;
1856
1857 mutex_unlock(&dev->mutex);
1858
476b8477 1859 if (file->f_flags & FASYNC)
ed9eccbe 1860 comedi_fasync(-1, file, 0);
ed9eccbe
DS		 1861
1862 return 0;
1863}
1864
1865static int comedi_fasync(int fd, struct file *file, int on)
1866{
1867 const unsigned minor = iminor(file->f_dentry->d_inode);
476b8477
GKH		 1868 struct comedi_device_file_info *dev_file_info =
1869 comedi_get_device_file_info(minor);
1870
71b5f4f1 1871 struct comedi_device *dev = dev_file_info->device;
ed9eccbe
DS		 1872
1873 return fasync_helper(fd, file, on, &dev->async_queue);
1874}
1875
1876const struct file_operations comedi_fops = {
0a85b6f0 1877 .owner = THIS_MODULE,
0a85b6f0 1878 .unlocked_ioctl = comedi_unlocked_ioctl,
0a85b6f0 1879 .compat_ioctl = comedi_compat_ioctl,
0a85b6f0
MT		 1880 .open = comedi_open,
1881 .release = comedi_close,
1882 .read = comedi_read,
1883 .write = comedi_write,
1884 .mmap = comedi_mmap,
1885 .poll = comedi_poll,
1886 .fasync = comedi_fasync,
ed9eccbe
DS		 1887};
1888
476b8477 1889struct class *comedi_class;
ed9eccbe
DS		 1890static struct cdev comedi_cdev;
1891
1892static void comedi_cleanup_legacy_minors(void)
1893{
1894 unsigned i;
476b8477 1895
1dd33ab8 1896 for (i = 0; i < comedi_num_legacy_minors; i++)
ed9eccbe 1897 comedi_free_board_minor(i);
ed9eccbe
DS		 1898}
1899
1900static int __init comedi_init(void)
1901{
1902 int i;
1903 int retval;
1904
476b8477
GKH		 1905 printk(KERN_INFO "comedi: version " COMEDI_RELEASE
1906 " - http://www.comedi.org\n");
ed9eccbe 1907
a3cb729e
FMH		 1908 if (comedi_num_legacy_minors < 0 ||
1909 comedi_num_legacy_minors > COMEDI_NUM_BOARD_MINORS) {
1910 printk(KERN_ERR "comedi: error: invalid value for module "
1911 "parameter \"comedi_num_legacy_minors\". Valid values "
1912 "are 0 through %i.\n", COMEDI_NUM_BOARD_MINORS);
1913 return -EINVAL;
1914 }
1915
1916 /*
1917 * comedi is unusable if both comedi_autoconfig and
1918 * comedi_num_legacy_minors are zero, so we might as well adjust the
1919 * defaults in that case
1920 */
1921 if (comedi_autoconfig == 0 && comedi_num_legacy_minors == 0)
1922 comedi_num_legacy_minors = 16;
1923
476b8477
GKH		 1924 memset(comedi_file_info_table, 0,
1925 sizeof(struct comedi_device_file_info *) * COMEDI_NUM_MINORS);
ed9eccbe
DS		 1926
1927 retval = register_chrdev_region(MKDEV(COMEDI_MAJOR, 0),
476b8477 1928 COMEDI_NUM_MINORS, "comedi");
ed9eccbe
DS		 1929 if (retval)
1930 return -EIO;
1931 cdev_init(&comedi_cdev, &comedi_fops);
1932 comedi_cdev.owner = THIS_MODULE;
1933 kobject_set_name(&comedi_cdev.kobj, "comedi");
1934 if (cdev_add(&comedi_cdev, MKDEV(COMEDI_MAJOR, 0), COMEDI_NUM_MINORS)) {
1935 unregister_chrdev_region(MKDEV(COMEDI_MAJOR, 0),
476b8477 1936 COMEDI_NUM_MINORS);
ed9eccbe
DS		 1937 return -EIO;
1938 }
1939 comedi_class = class_create(THIS_MODULE, "comedi");
1940 if (IS_ERR(comedi_class)) {
3fffdf20 1941 printk(KERN_ERR "comedi: failed to create class");
ed9eccbe
DS		 1942 cdev_del(&comedi_cdev);
1943 unregister_chrdev_region(MKDEV(COMEDI_MAJOR, 0),
476b8477 1944 COMEDI_NUM_MINORS);
ed9eccbe
DS		 1945 return PTR_ERR(comedi_class);
1946 }
1947
1948 /* XXX requires /proc interface */
1949 comedi_proc_init();
1950
476b8477 1951 /* create devices files for legacy/manual use */
1dd33ab8 1952 for (i = 0; i < comedi_num_legacy_minors; i++) {
ed9eccbe
DS		 1953 int minor;
1954 minor = comedi_alloc_board_minor(NULL);
476b8477 1955 if (minor < 0) {
ed9eccbe
DS		 1956 comedi_cleanup_legacy_minors();
1957 cdev_del(&comedi_cdev);
1958 unregister_chrdev_region(MKDEV(COMEDI_MAJOR, 0),
476b8477 1959 COMEDI_NUM_MINORS);
ed9eccbe
DS		 1960 return minor;
1961 }
1962 }
1963
ed9eccbe
DS		 1964 return 0;
1965}
1966
1967static void __exit comedi_cleanup(void)
1968{
1969 int i;
1970
1971 comedi_cleanup_legacy_minors();
476b8477 1972 for (i = 0; i < COMEDI_NUM_MINORS; ++i)
ed9eccbe 1973 BUG_ON(comedi_file_info_table[i]);
476b8477 1974
ed9eccbe
DS		 1975 class_destroy(comedi_class);
1976 cdev_del(&comedi_cdev);
1977 unregister_chrdev_region(MKDEV(COMEDI_MAJOR, 0), COMEDI_NUM_MINORS);
1978
1979 comedi_proc_cleanup();
ed9eccbe
DS		 1980}
1981
1982module_init(comedi_init);
1983module_exit(comedi_cleanup);
1984
71b5f4f1 1985void comedi_error(const struct comedi_device *dev, const char *s)
ed9eccbe 1986{
3fffdf20
MR		 1987 printk(KERN_ERR "comedi%d: %s: %s\n", dev->minor,
1988 dev->driver->driver_name, s);
ed9eccbe 1989}
18736438 1990EXPORT_SYMBOL(comedi_error);
ed9eccbe 1991
34c43922 1992void comedi_event(struct comedi_device *dev, struct comedi_subdevice *s)
ed9eccbe 1993{
d163679c 1994 struct comedi_async *async = s->async;
ed9eccbe
DS		 1995 unsigned runflags = 0;
1996 unsigned runflags_mask = 0;
1997
476b8477 1998 /* DPRINTK("comedi_event 0x%x\n",mask); */
ed9eccbe
DS		 1999
2000 if ((comedi_get_subdevice_runflags(s) & SRF_RUNNING) == 0)
2001 return;
2002
0a85b6f0
MT		 2003 if (s->
2004 async->events & (COMEDI_CB_EOA | COMEDI_CB_ERROR |
2005 COMEDI_CB_OVERFLOW)) {
ed9eccbe
DS		 2006 runflags_mask |= SRF_RUNNING;
2007 }
2008 /* remember if an error event has occured, so an error
2009 * can be returned the next time the user does a read() */
2010 if (s->async->events & (COMEDI_CB_ERROR | COMEDI_CB_OVERFLOW)) {
2011 runflags_mask |= SRF_ERROR;
2012 runflags |= SRF_ERROR;
2013 }
2014 if (runflags_mask) {
2015 /*sets SRF_ERROR and SRF_RUNNING together atomically */
2016 comedi_set_subdevice_runflags(s, runflags_mask, runflags);
2017 }
2018
2019 if (async->cb_mask & s->async->events) {
2020 if (comedi_get_subdevice_runflags(s) & SRF_USER) {
fcea1154 2021 wake_up_interruptible(&async->wait_head);
6705b68d 2022 if (s->subdev_flags & SDF_CMD_READ)
0a85b6f0 2023 kill_fasync(&dev->async_queue, SIGIO, POLL_IN);
6705b68d 2024 if (s->subdev_flags & SDF_CMD_WRITE)
0a85b6f0 2025 kill_fasync(&dev->async_queue, SIGIO, POLL_OUT);
ed9eccbe
DS		 2026 } else {
2027 if (async->cb_func)
2028 async->cb_func(s->async->events, async->cb_arg);
ed9eccbe
DS		 2029 }
2030 }
2031 s->async->events = 0;
2032}
18736438 2033EXPORT_SYMBOL(comedi_event);
ed9eccbe 2034
34c43922 2035unsigned comedi_get_subdevice_runflags(struct comedi_subdevice *s)
ed9eccbe
DS		 2036{
2037 unsigned long flags;
2038 unsigned runflags;
2039
5f74ea14 2040 spin_lock_irqsave(&s->spin_lock, flags);
ed9eccbe 2041 runflags = s->runflags;
5f74ea14 2042 spin_unlock_irqrestore(&s->spin_lock, flags);
ed9eccbe
DS		 2043 return runflags;
2044}
18736438 2045EXPORT_SYMBOL(comedi_get_subdevice_runflags);
ed9eccbe 2046
71b5f4f1 2047static int is_device_busy(struct comedi_device *dev)
ed9eccbe 2048{
34c43922 2049 struct comedi_subdevice *s;
ed9eccbe
DS		 2050 int i;
2051
2052 if (!dev->attached)
2053 return 0;
2054
2055 for (i = 0; i < dev->n_subdevices; i++) {
2056 s = dev->subdevices + i;
2057 if (s->busy)
2058 return 1;
2059 if (s->async && s->async->mmap_count)
2060 return 1;
2061 }
2062
2063 return 0;
2064}
2065
71b5f4f1 2066void comedi_device_init(struct comedi_device *dev)
ed9eccbe 2067{
71b5f4f1 2068 memset(dev, 0, sizeof(struct comedi_device));
ed9eccbe
DS		 2069 spin_lock_init(&dev->spinlock);
2070 mutex_init(&dev->mutex);
2071 dev->minor = -1;
2072}
2073
71b5f4f1 2074void comedi_device_cleanup(struct comedi_device *dev)
ed9eccbe 2075{
476b8477
GKH		 2076 if (dev == NULL)
2077 return;
ed9eccbe
DS		 2078 mutex_lock(&dev->mutex);
2079 comedi_device_detach(dev);
2080 mutex_unlock(&dev->mutex);
2081 mutex_destroy(&dev->mutex);
2082}
2083
2084int comedi_alloc_board_minor(struct device *hardware_device)
2085{
2086 unsigned long flags;
2087 struct comedi_device_file_info *info;
0bfbbe8f 2088 struct device *csdev;
ed9eccbe 2089 unsigned i;
883db3d9 2090 int retval;
ed9eccbe
DS		 2091
2092 info = kzalloc(sizeof(struct comedi_device_file_info), GFP_KERNEL);
476b8477
GKH		 2093 if (info == NULL)
2094 return -ENOMEM;
71b5f4f1 2095 info->device = kzalloc(sizeof(struct comedi_device), GFP_KERNEL);
476b8477 2096 if (info->device == NULL) {
ed9eccbe
DS		 2097 kfree(info);
2098 return -ENOMEM;
2099 }
2100 comedi_device_init(info->device);
5f74ea14 2101 spin_lock_irqsave(&comedi_file_info_table_lock, flags);
476b8477
GKH		 2102 for (i = 0; i < COMEDI_NUM_BOARD_MINORS; ++i) {
2103 if (comedi_file_info_table[i] == NULL) {
ed9eccbe
DS		 2104 comedi_file_info_table[i] = info;
2105 break;
2106 }
2107 }
5f74ea14 2108 spin_unlock_irqrestore(&comedi_file_info_table_lock, flags);
476b8477 2109 if (i == COMEDI_NUM_BOARD_MINORS) {
ed9eccbe
DS		 2110 comedi_device_cleanup(info->device);
2111 kfree(info->device);
2112 kfree(info);
0a85b6f0 2113 printk(KERN_ERR
20617f22 2114
0a85b6f0 2115 "comedi: error: ran out of minor numbers for board device files.\n");
ed9eccbe
DS		 2116 return -EBUSY;
2117 }
2118 info->device->minor = i;
2119 csdev = COMEDI_DEVICE_CREATE(comedi_class, NULL,
476b8477
GKH		 2120 MKDEV(COMEDI_MAJOR, i), NULL,
2121 hardware_device, "comedi%i", i);
2122 if (!IS_ERR(csdev))
ed9eccbe 2123 info->device->class_dev = csdev;
883db3d9
FMH		 2124 dev_set_drvdata(csdev, info);
2125 retval = device_create_file(csdev, &dev_attr_max_read_buffer_kb);
2126 if (retval) {
0a85b6f0
MT		 2127 printk(KERN_ERR
2128 "comedi: failed to create sysfs attribute file \"%s\".\n",
2129 dev_attr_max_read_buffer_kb.attr.name);
883db3d9
FMH		 2130 comedi_free_board_minor(i);
2131 return retval;
2132 }
2133 retval = device_create_file(csdev, &dev_attr_read_buffer_kb);
2134 if (retval) {
0a85b6f0
MT		 2135 printk(KERN_ERR
2136 "comedi: failed to create sysfs attribute file \"%s\".\n",
2137 dev_attr_read_buffer_kb.attr.name);
883db3d9
FMH		 2138 comedi_free_board_minor(i);
2139 return retval;
2140 }
2141 retval = device_create_file(csdev, &dev_attr_max_write_buffer_kb);
2142 if (retval) {
0a85b6f0
MT		 2143 printk(KERN_ERR
2144 "comedi: failed to create sysfs attribute file \"%s\".\n",
2145 dev_attr_max_write_buffer_kb.attr.name);
883db3d9
FMH		 2146 comedi_free_board_minor(i);
2147 return retval;
2148 }
2149 retval = device_create_file(csdev, &dev_attr_write_buffer_kb);
2150 if (retval) {
0a85b6f0
MT		 2151 printk(KERN_ERR
2152 "comedi: failed to create sysfs attribute file \"%s\".\n",
2153 dev_attr_write_buffer_kb.attr.name);
883db3d9
FMH		 2154 comedi_free_board_minor(i);
2155 return retval;
2156 }
ed9eccbe
DS		 2157 return i;
2158}
2159
2160void comedi_free_board_minor(unsigned minor)
2161{
2162 unsigned long flags;
2163 struct comedi_device_file_info *info;
2164
2165 BUG_ON(minor >= COMEDI_NUM_BOARD_MINORS);
5f74ea14 2166 spin_lock_irqsave(&comedi_file_info_table_lock, flags);
ed9eccbe
DS		 2167 info = comedi_file_info_table[minor];
2168 comedi_file_info_table[minor] = NULL;
5f74ea14 2169 spin_unlock_irqrestore(&comedi_file_info_table_lock, flags);
ed9eccbe 2170
476b8477 2171 if (info) {
71b5f4f1 2172 struct comedi_device *dev = info->device;
476b8477
GKH		 2173 if (dev) {
2174 if (dev->class_dev) {
2175 device_destroy(comedi_class,
2176 MKDEV(COMEDI_MAJOR, dev->minor));
ed9eccbe
DS		 2177 }
2178 comedi_device_cleanup(dev);
2179 kfree(dev);
2180 }
2181 kfree(info);
2182 }
2183}
2184
883db3d9
FMH		 2185int comedi_alloc_subdevice_minor(struct comedi_device *dev,
2186 struct comedi_subdevice *s)
ed9eccbe
DS		 2187{
2188 unsigned long flags;
2189 struct comedi_device_file_info *info;
0bfbbe8f 2190 struct device *csdev;
ed9eccbe 2191 unsigned i;
883db3d9 2192 int retval;
ed9eccbe
DS		 2193
2194 info = kmalloc(sizeof(struct comedi_device_file_info), GFP_KERNEL);
476b8477
GKH		 2195 if (info == NULL)
2196 return -ENOMEM;
ed9eccbe
DS		 2197 info->device = dev;
2198 info->read_subdevice = s;
2199 info->write_subdevice = s;
5f74ea14 2200 spin_lock_irqsave(&comedi_file_info_table_lock, flags);
4c41f3ae 2201 for (i = COMEDI_FIRST_SUBDEVICE_MINOR; i < COMEDI_NUM_MINORS; ++i) {
476b8477 2202 if (comedi_file_info_table[i] == NULL) {
ed9eccbe
DS		 2203 comedi_file_info_table[i] = info;
2204 break;
2205 }
2206 }
5f74ea14 2207 spin_unlock_irqrestore(&comedi_file_info_table_lock, flags);
476b8477 2208 if (i == COMEDI_NUM_MINORS) {
ed9eccbe 2209 kfree(info);
0a85b6f0
MT		 2210 printk(KERN_ERR
2211 "comedi: error: ran out of minor numbers for board device files.\n");
ed9eccbe
DS		 2212 return -EBUSY;
2213 }
2214 s->minor = i;
2215 csdev = COMEDI_DEVICE_CREATE(comedi_class, dev->class_dev,
476b8477
GKH		 2216 MKDEV(COMEDI_MAJOR, i), NULL, NULL,
2217 "comedi%i_subd%i", dev->minor,
2218 (int)(s - dev->subdevices));
2219 if (!IS_ERR(csdev))
ed9eccbe 2220 s->class_dev = csdev;
883db3d9
FMH		 2221 dev_set_drvdata(csdev, info);
2222 retval = device_create_file(csdev, &dev_attr_max_read_buffer_kb);
2223 if (retval) {
0a85b6f0
MT		 2224 printk(KERN_ERR
2225 "comedi: failed to create sysfs attribute file \"%s\".\n",
2226 dev_attr_max_read_buffer_kb.attr.name);
883db3d9
FMH		 2227 comedi_free_subdevice_minor(s);
2228 return retval;
2229 }
2230 retval = device_create_file(csdev, &dev_attr_read_buffer_kb);
2231 if (retval) {
0a85b6f0
MT		 2232 printk(KERN_ERR
2233 "comedi: failed to create sysfs attribute file \"%s\".\n",
2234 dev_attr_read_buffer_kb.attr.name);
883db3d9
FMH		 2235 comedi_free_subdevice_minor(s);
2236 return retval;
2237 }
2238 retval = device_create_file(csdev, &dev_attr_max_write_buffer_kb);
2239 if (retval) {
0a85b6f0
MT		 2240 printk(KERN_ERR
2241 "comedi: failed to create sysfs attribute file \"%s\".\n",
2242 dev_attr_max_write_buffer_kb.attr.name);
883db3d9
FMH		 2243 comedi_free_subdevice_minor(s);
2244 return retval;
2245 }
2246 retval = device_create_file(csdev, &dev_attr_write_buffer_kb);
2247 if (retval) {
0a85b6f0
MT		 2248 printk(KERN_ERR
2249 "comedi: failed to create sysfs attribute file \"%s\".\n",
2250 dev_attr_write_buffer_kb.attr.name);
883db3d9
FMH		 2251 comedi_free_subdevice_minor(s);
2252 return retval;
2253 }
ed9eccbe
DS		 2254 return i;
2255}
2256
34c43922 2257void comedi_free_subdevice_minor(struct comedi_subdevice *s)
ed9eccbe
DS		 2258{
2259 unsigned long flags;
2260 struct comedi_device_file_info *info;
2261
476b8477
GKH		 2262 if (s == NULL)
2263 return;
2264 if (s->minor < 0)
2265 return;
ed9eccbe
DS		 2266
2267 BUG_ON(s->minor >= COMEDI_NUM_MINORS);
2268 BUG_ON(s->minor < COMEDI_FIRST_SUBDEVICE_MINOR);
2269
5f74ea14 2270 spin_lock_irqsave(&comedi_file_info_table_lock, flags);
ed9eccbe
DS		 2271 info = comedi_file_info_table[s->minor];
2272 comedi_file_info_table[s->minor] = NULL;
5f74ea14 2273 spin_unlock_irqrestore(&comedi_file_info_table_lock, flags);
ed9eccbe 2274
476b8477 2275 if (s->class_dev) {
ed9eccbe
DS		 2276 device_destroy(comedi_class, MKDEV(COMEDI_MAJOR, s->minor));
2277 s->class_dev = NULL;
2278 }
2279 kfree(info);
2280}
2281
2282struct comedi_device_file_info *comedi_get_device_file_info(unsigned minor)
2283{
2284 unsigned long flags;
2285 struct comedi_device_file_info *info;
2286
2287 BUG_ON(minor >= COMEDI_NUM_MINORS);
5f74ea14 2288 spin_lock_irqsave(&comedi_file_info_table_lock, flags);
ed9eccbe 2289 info = comedi_file_info_table[minor];
5f74ea14 2290 spin_unlock_irqrestore(&comedi_file_info_table_lock, flags);
ed9eccbe
DS		 2291 return info;
2292}
18736438 2293EXPORT_SYMBOL_GPL(comedi_get_device_file_info);
883db3d9
FMH		 2294
2295static int resize_async_buffer(struct comedi_device *dev,
2296 struct comedi_subdevice *s,
2297 struct comedi_async *async, unsigned new_size)
2298{
2299 int retval;
2300
2301 if (new_size > async->max_bufsize)
2302 return -EPERM;
2303
2304 if (s->busy) {
2305 DPRINTK("subdevice is busy, cannot resize buffer\n");
2306 return -EBUSY;
2307 }
2308 if (async->mmap_count) {
2309 DPRINTK("subdevice is mmapped, cannot resize buffer\n");
2310 return -EBUSY;
2311 }
2312
2313 if (!async->prealloc_buf)
2314 return -EINVAL;
2315
2316 /* make sure buffer is an integral number of pages
0a85b6f0 2317 * (we round up) */
883db3d9
FMH		 2318 new_size = (new_size + PAGE_SIZE - 1) & PAGE_MASK;
2319
2320 retval = comedi_buf_alloc(dev, s, new_size);
2321 if (retval < 0)
2322 return retval;
2323
2324 if (s->buf_change) {
2325 retval = s->buf_change(dev, s, new_size);
2326 if (retval < 0)
2327 return retval;
2328 }
2329
2330 DPRINTK("comedi%i subd %d buffer resized to %i bytes\n",
b8b5cd9f 2331 dev->minor, (int)(s - dev->subdevices), async->prealloc_bufsz);
883db3d9
FMH		 2332 return 0;
2333}
2334
2335/* sysfs attribute files */
2336
2337static const unsigned bytes_per_kibi = 1024;
2338
2339static ssize_t show_max_read_buffer_kb(struct device *dev,
2340 struct device_attribute *attr, char *buf)
2341{
2342 ssize_t retval;
2343 struct comedi_device_file_info *info = dev_get_drvdata(dev);
2344 unsigned max_buffer_size_kb = 0;
2345 struct comedi_subdevice *const read_subdevice =
0a85b6f0 2346 comedi_get_read_subdevice(info);
883db3d9
FMH		 2347
2348 mutex_lock(&info->device->mutex);
2349 if (read_subdevice &&
2350 (read_subdevice->subdev_flags & SDF_CMD_READ) &&
2351 read_subdevice->async) {
2352 max_buffer_size_kb = read_subdevice->async->max_bufsize /
0a85b6f0 2353 bytes_per_kibi;
883db3d9 2354 }
0a85b6f0 2355 retval = snprintf(buf, PAGE_SIZE, "%i\n", max_buffer_size_kb);
883db3d9
FMH		 2356 mutex_unlock(&info->device->mutex);
2357
2358 return retval;
2359}
2360
2361static ssize_t store_max_read_buffer_kb(struct device *dev,
2362 struct device_attribute *attr,
2363 const char *buf, size_t count)
2364{
2365 struct comedi_device_file_info *info = dev_get_drvdata(dev);
2366 unsigned long new_max_size_kb;
2367 uint64_t new_max_size;
2368 struct comedi_subdevice *const read_subdevice =
0a85b6f0 2369 comedi_get_read_subdevice(info);
883db3d9
FMH		 2370
2371 if (strict_strtoul(buf, 10, &new_max_size_kb))
2372 return -EINVAL;
0a85b6f0 2373 if (new_max_size_kb != (uint32_t) new_max_size_kb)
883db3d9 2374 return -EINVAL;
0a85b6f0
MT		 2375 new_max_size = ((uint64_t) new_max_size_kb) * bytes_per_kibi;
2376 if (new_max_size != (uint32_t) new_max_size)
883db3d9
FMH		 2377 return -EINVAL;
2378
2379 mutex_lock(&info->device->mutex);
2380 if (read_subdevice == NULL ||
2381 (read_subdevice->subdev_flags & SDF_CMD_READ) == 0 ||
2382 read_subdevice->async == NULL) {
2383 mutex_unlock(&info->device->mutex);
2384 return -EINVAL;
2385 }
2386 read_subdevice->async->max_bufsize = new_max_size;
2387 mutex_unlock(&info->device->mutex);
2388
2389 return count;
2390}
2391
2392static struct device_attribute dev_attr_max_read_buffer_kb = {
2393 .attr = {
0a85b6f0
MT		 2394 .name = "max_read_buffer_kb",
2395 .mode = S_IRUGO | S_IWUSR},
883db3d9
FMH		 2396 .show = &show_max_read_buffer_kb,
2397 .store = &store_max_read_buffer_kb
2398};
2399
2400static ssize_t show_read_buffer_kb(struct device *dev,
2401 struct device_attribute *attr, char *buf)
2402{
2403 ssize_t retval;
2404 struct comedi_device_file_info *info = dev_get_drvdata(dev);
2405 unsigned buffer_size_kb = 0;
2406 struct comedi_subdevice *const read_subdevice =
0a85b6f0 2407 comedi_get_read_subdevice(info);
883db3d9
FMH		 2408
2409 mutex_lock(&info->device->mutex);
2410 if (read_subdevice &&
0a85b6f0
MT		 2411 (read_subdevice->subdev_flags & SDF_CMD_READ) &&
2412 read_subdevice->async) {
883db3d9 2413 buffer_size_kb = read_subdevice->async->prealloc_bufsz /
0a85b6f0 2414 bytes_per_kibi;
883db3d9 2415 }
0a85b6f0 2416 retval = snprintf(buf, PAGE_SIZE, "%i\n", buffer_size_kb);
883db3d9
FMH		 2417 mutex_unlock(&info->device->mutex);
2418
2419 return retval;
2420}
2421
2422static ssize_t store_read_buffer_kb(struct device *dev,
2423 struct device_attribute *attr,
2424 const char *buf, size_t count)
2425{
2426 struct comedi_device_file_info *info = dev_get_drvdata(dev);
2427 unsigned long new_size_kb;
2428 uint64_t new_size;
2429 int retval;
2430 struct comedi_subdevice *const read_subdevice =
0a85b6f0 2431 comedi_get_read_subdevice(info);
883db3d9
FMH		 2432
2433 if (strict_strtoul(buf, 10, &new_size_kb))
2434 return -EINVAL;
0a85b6f0 2435 if (new_size_kb != (uint32_t) new_size_kb)
883db3d9 2436 return -EINVAL;
0a85b6f0
MT		 2437 new_size = ((uint64_t) new_size_kb) * bytes_per_kibi;
2438 if (new_size != (uint32_t) new_size)
883db3d9
FMH		 2439 return -EINVAL;
2440
2441 mutex_lock(&info->device->mutex);
2442 if (read_subdevice == NULL ||
2443 (read_subdevice->subdev_flags & SDF_CMD_READ) == 0 ||
2444 read_subdevice->async == NULL) {
2445 mutex_unlock(&info->device->mutex);
2446 return -EINVAL;
2447 }
2448 retval = resize_async_buffer(info->device, read_subdevice,
2449 read_subdevice->async, new_size);
2450 mutex_unlock(&info->device->mutex);
2451
2452 if (retval < 0)
2453 return retval;
2454 return count;
2455}
2456
2457static struct device_attribute dev_attr_read_buffer_kb = {
2458 .attr = {
0a85b6f0
MT		 2459 .name = "read_buffer_kb",
2460 .mode = S_IRUGO | S_IWUSR | S_IWGRP},
883db3d9
FMH		 2461 .show = &show_read_buffer_kb,
2462 .store = &store_read_buffer_kb
2463};
2464
2465static ssize_t show_max_write_buffer_kb(struct device *dev,
2466 struct device_attribute *attr,
2467 char *buf)
2468{
2469 ssize_t retval;
2470 struct comedi_device_file_info *info = dev_get_drvdata(dev);
2471 unsigned max_buffer_size_kb = 0;
2472 struct comedi_subdevice *const write_subdevice =
0a85b6f0 2473 comedi_get_write_subdevice(info);
883db3d9
FMH		 2474
2475 mutex_lock(&info->device->mutex);
2476 if (write_subdevice &&
2477 (write_subdevice->subdev_flags & SDF_CMD_WRITE) &&
2478 write_subdevice->async) {
2479 max_buffer_size_kb = write_subdevice->async->max_bufsize /
0a85b6f0 2480 bytes_per_kibi;
883db3d9 2481 }
0a85b6f0 2482 retval = snprintf(buf, PAGE_SIZE, "%i\n", max_buffer_size_kb);
883db3d9
FMH		 2483 mutex_unlock(&info->device->mutex);
2484
2485 return retval;
2486}
2487
2488static ssize_t store_max_write_buffer_kb(struct device *dev,
2489 struct device_attribute *attr,
2490 const char *buf, size_t count)
2491{
2492 struct comedi_device_file_info *info = dev_get_drvdata(dev);
2493 unsigned long new_max_size_kb;
2494 uint64_t new_max_size;
2495 struct comedi_subdevice *const write_subdevice =
0a85b6f0 2496 comedi_get_write_subdevice(info);
883db3d9
FMH		 2497
2498 if (strict_strtoul(buf, 10, &new_max_size_kb))
2499 return -EINVAL;
0a85b6f0 2500 if (new_max_size_kb != (uint32_t) new_max_size_kb)
883db3d9 2501 return -EINVAL;
0a85b6f0
MT		 2502 new_max_size = ((uint64_t) new_max_size_kb) * bytes_per_kibi;
2503 if (new_max_size != (uint32_t) new_max_size)
883db3d9
FMH		 2504 return -EINVAL;
2505
2506 mutex_lock(&info->device->mutex);
2507 if (write_subdevice == NULL ||
2508 (write_subdevice->subdev_flags & SDF_CMD_WRITE) == 0 ||
2509 write_subdevice->async == NULL) {
2510 mutex_unlock(&info->device->mutex);
2511 return -EINVAL;
2512 }
2513 write_subdevice->async->max_bufsize = new_max_size;
2514 mutex_unlock(&info->device->mutex);
2515
2516 return count;
2517}
2518
2519static struct device_attribute dev_attr_max_write_buffer_kb = {
2520 .attr = {
0a85b6f0
MT		 2521 .name = "max_write_buffer_kb",
2522 .mode = S_IRUGO | S_IWUSR},
883db3d9
FMH		 2523 .show = &show_max_write_buffer_kb,
2524 .store = &store_max_write_buffer_kb
2525};
2526
2527static ssize_t show_write_buffer_kb(struct device *dev,
2528 struct device_attribute *attr, char *buf)
2529{
2530 ssize_t retval;
2531 struct comedi_device_file_info *info = dev_get_drvdata(dev);
2532 unsigned buffer_size_kb = 0;
2533 struct comedi_subdevice *const write_subdevice =
0a85b6f0 2534 comedi_get_write_subdevice(info);
883db3d9
FMH		 2535
2536 mutex_lock(&info->device->mutex);
2537 if (write_subdevice &&
2538 (write_subdevice->subdev_flags & SDF_CMD_WRITE) &&
2539 write_subdevice->async) {
2540 buffer_size_kb = write_subdevice->async->prealloc_bufsz /
0a85b6f0 2541 bytes_per_kibi;
883db3d9 2542 }
0a85b6f0 2543 retval = snprintf(buf, PAGE_SIZE, "%i\n", buffer_size_kb);
883db3d9
FMH		 2544 mutex_unlock(&info->device->mutex);
2545
2546 return retval;
2547}
2548
2549static ssize_t store_write_buffer_kb(struct device *dev,
2550 struct device_attribute *attr,
2551 const char *buf, size_t count)
2552{
2553 struct comedi_device_file_info *info = dev_get_drvdata(dev);
2554 unsigned long new_size_kb;
2555 uint64_t new_size;
2556 int retval;
2557 struct comedi_subdevice *const write_subdevice =
0a85b6f0 2558 comedi_get_write_subdevice(info);
883db3d9
FMH		 2559
2560 if (strict_strtoul(buf, 10, &new_size_kb))
2561 return -EINVAL;
0a85b6f0 2562 if (new_size_kb != (uint32_t) new_size_kb)
883db3d9 2563 return -EINVAL;
0a85b6f0
MT		 2564 new_size = ((uint64_t) new_size_kb) * bytes_per_kibi;
2565 if (new_size != (uint32_t) new_size)
883db3d9
FMH		 2566 return -EINVAL;
2567
2568 mutex_lock(&info->device->mutex);
2569 if (write_subdevice == NULL ||
2570 (write_subdevice->subdev_flags & SDF_CMD_WRITE) == 0 ||
2571 write_subdevice->async == NULL) {
2572 mutex_unlock(&info->device->mutex);
2573 return -EINVAL;
2574 }
2575 retval = resize_async_buffer(info->device, write_subdevice,
0a85b6f0 2576 write_subdevice->async, new_size);
883db3d9
FMH		 2577 mutex_unlock(&info->device->mutex);
2578
2579 if (retval < 0)
2580 return retval;
2581 return count;
2582}
2583
2584static struct device_attribute dev_attr_write_buffer_kb = {
2585 .attr = {
0a85b6f0
MT		 2586 .name = "write_buffer_kb",
2587 .mode = S_IRUGO | S_IWUSR | S_IWGRP},
883db3d9
FMH		 2588 .show = &show_write_buffer_kb,
2589 .store = &store_write_buffer_kb
2590};
A mirror of Linus' kernel repository