drivers/media/rc/lirc_dev.c

   1 /*
   2  * LIRC base driver
   3  *
   4  * by Artur Lipowski <alipowski@interia.pl>
   5  *
   6  *  This program is free software; you can redistribute it and/or modify
   7  *  it under the terms of the GNU General Public License as published by
   8  *  the Free Software Foundation; either version 2 of the License, or
   9  *  (at your option) any later version.
  10  *
  11  *  This program is distributed in the hope that it will be useful,
  12  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  13  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14  *  GNU General Public License for more details.
  15  *
  16  *  You should have received a copy of the GNU General Public License
  17  *  along with this program; if not, write to the Free Software
  18  *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  19  *
  20  */
  21
  22 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  23
  24 #include <linux/module.h>
  25 #include <linux/kernel.h>
  26 #include <linux/sched.h>
  27 #include <linux/errno.h>
  28 #include <linux/ioctl.h>
  29 #include <linux/fs.h>
  30 #include <linux/poll.h>
  31 #include <linux/completion.h>
  32 #include <linux/mutex.h>
  33 #include <linux/wait.h>
  34 #include <linux/unistd.h>
  35 #include <linux/kthread.h>
  36 #include <linux/bitops.h>
  37 #include <linux/device.h>
  38 #include <linux/cdev.h>
  39
  40 #include <media/rc-core.h>
  41 #include <media/lirc.h>
  42 #include <media/lirc_dev.h>
  43
  44 static bool debug;
  45
  46 #define IRCTL_DEV_NAME  "BaseRemoteCtl"
  47 #define NOPLUG          -1
  48 #define LOGHEAD         "lirc_dev (%s[%d]): "
  49
  50 static dev_t lirc_base_dev;
  51
  52 struct irctl {
  53         struct lirc_driver d;
  54         int attached;
  55         int open;
  56
  57         struct mutex irctl_lock;
  58         struct lirc_buffer *buf;
  59         unsigned int chunk_size;
  60
  61         struct cdev *cdev;
  62
  63         struct task_struct *task;
  64         long jiffies_to_wait;
  65 };
  66
  67 static DEFINE_MUTEX(lirc_dev_lock);
  68
  69 static struct irctl *irctls[MAX_IRCTL_DEVICES];
  70
  71 /* Only used for sysfs but defined to void otherwise */
  72 static struct class *lirc_class;
  73
  74 /*  helper function
  75  *  initializes the irctl structure
  76  */
  77 static void lirc_irctl_init(struct irctl *ir)
  78 {
  79         mutex_init(&ir->irctl_lock);
  80         ir->d.minor = NOPLUG;
  81 }
  82
  83 static void lirc_irctl_cleanup(struct irctl *ir)
  84 {
  85         device_destroy(lirc_class, MKDEV(MAJOR(lirc_base_dev), ir->d.minor));
  86
  87         if (ir->buf != ir->d.rbuf) {
  88                 lirc_buffer_free(ir->buf);
  89                 kfree(ir->buf);
  90         }
  91         ir->buf = NULL;
  92 }
  93
  94 /*  helper function
  95  *  reads key codes from driver and puts them into buffer
  96  *  returns 0 on success
  97  */
  98 static int lirc_add_to_buf(struct irctl *ir)
  99 {
 100         int res;
 101         int got_data = -1;
 102
 103         if (!ir->d.add_to_buf)
 104                 return 0;
 105
 106         /*
 107          * service the device as long as it is returning
 108          * data and we have space
 109          */
 110         do {
 111                 got_data++;
 112                 res = ir->d.add_to_buf(ir->d.data, ir->buf);
 113         } while (!res);
 114
 115         if (res == -ENODEV)
 116                 kthread_stop(ir->task);
 117
 118         return got_data ? 0 : res;
 119 }
 120
 121 /* main function of the polling thread
 122  */
 123 static int lirc_thread(void *irctl)
 124 {
 125         struct irctl *ir = irctl;
 126
 127         do {
 128                 if (ir->open) {
 129                         if (ir->jiffies_to_wait) {
 130                                 set_current_state(TASK_INTERRUPTIBLE);
 131                                 schedule_timeout(ir->jiffies_to_wait);
 132                         }
 133                         if (kthread_should_stop())
 134                                 break;
 135                         if (!lirc_add_to_buf(ir))
 136                                 wake_up_interruptible(&ir->buf->wait_poll);
 137                 } else {
 138                         set_current_state(TASK_INTERRUPTIBLE);
 139                         schedule();
 140                 }
 141         } while (!kthread_should_stop());
 142
 143         return 0;
 144 }
 145
 146
 147 static const struct file_operations lirc_dev_fops = {
 148         .owner          = THIS_MODULE,
 149         .read           = lirc_dev_fop_read,
 150         .write          = lirc_dev_fop_write,
 151         .poll           = lirc_dev_fop_poll,
 152         .unlocked_ioctl = lirc_dev_fop_ioctl,
 153 #ifdef CONFIG_COMPAT
 154         .compat_ioctl   = lirc_dev_fop_ioctl,
 155 #endif
 156         .open           = lirc_dev_fop_open,
 157         .release        = lirc_dev_fop_close,
 158         .llseek         = noop_llseek,
 159 };
 160
 161 static int lirc_cdev_add(struct irctl *ir)
 162 {
 163         int retval = -ENOMEM;
 164         struct lirc_driver *d = &ir->d;
 165         struct cdev *cdev;
 166
 167         cdev = kzalloc(sizeof(*cdev), GFP_KERNEL);
 168         if (!cdev)
 169                 goto err_out;
 170
 171         if (d->fops) {
 172                 cdev_init(cdev, d->fops);
 173                 cdev->owner = d->owner;
 174         } else {
 175                 cdev_init(cdev, &lirc_dev_fops);
 176                 cdev->owner = THIS_MODULE;
 177         }
 178         retval = kobject_set_name(&cdev->kobj, "lirc%d", d->minor);
 179         if (retval)
 180                 goto err_out;
 181
 182         retval = cdev_add(cdev, MKDEV(MAJOR(lirc_base_dev), d->minor), 1);
 183         if (retval) {
 184                 kobject_put(&cdev->kobj);
 185                 goto err_out;
 186         }
 187
 188         ir->cdev = cdev;
 189
 190         return 0;
 191
 192 err_out:
 193         kfree(cdev);
 194         return retval;
 195 }
 196
 197 static int lirc_allocate_buffer(struct irctl *ir)
 198 {
 199         int err = 0;
 200         int bytes_in_key;
 201         unsigned int chunk_size;
 202         unsigned int buffer_size;
 203         struct lirc_driver *d = &ir->d;
 204
 205         mutex_lock(&lirc_dev_lock);
 206
 207         bytes_in_key = BITS_TO_LONGS(d->code_length) +
 208                                                 (d->code_length % 8 ? 1 : 0);
 209         buffer_size = d->buffer_size ? d->buffer_size : BUFLEN / bytes_in_key;
 210         chunk_size  = d->chunk_size  ? d->chunk_size  : bytes_in_key;
 211
 212         if (d->rbuf) {
 213                 ir->buf = d->rbuf;
 214         } else {
 215                 ir->buf = kmalloc(sizeof(struct lirc_buffer), GFP_KERNEL);
 216                 if (!ir->buf) {
 217                         err = -ENOMEM;
 218                         goto out;
 219                 }
 220
 221                 err = lirc_buffer_init(ir->buf, chunk_size, buffer_size);
 222                 if (err) {
 223                         kfree(ir->buf);
 224                         goto out;
 225                 }
 226         }
 227         ir->chunk_size = ir->buf->chunk_size;
 228
 229 out:
 230         mutex_unlock(&lirc_dev_lock);
 231
 232         return err;
 233 }
 234
 235 static int lirc_allocate_driver(struct lirc_driver *d)
 236 {
 237         struct irctl *ir;
 238         int minor;
 239         int err;
 240
 241         if (!d) {
 242                 pr_err("driver pointer must be not NULL!\n");
 243                 return -EBADRQC;
 244         }
 245
 246         if (!d->dev) {
 247                 pr_err("dev pointer not filled in!\n");
 248                 return -EINVAL;
 249         }
 250
 251         if (MAX_IRCTL_DEVICES <= d->minor) {
 252                 dev_err(d->dev, "minor must be between 0 and %d!\n",
 253                                                 MAX_IRCTL_DEVICES - 1);
 254                 return -EBADRQC;
 255         }
 256
 257         if (1 > d->code_length || (BUFLEN * 8) < d->code_length) {
 258                 dev_err(d->dev, "code length must be less than %d bits\n",
 259                                                                 BUFLEN * 8);
 260                 return -EBADRQC;
 261         }
 262
 263         if (d->sample_rate) {
 264                 if (2 > d->sample_rate || HZ < d->sample_rate) {
 265                         dev_err(d->dev, "invalid %d sample rate\n",
 266                                                         d->sample_rate);
 267                         return -EBADRQC;
 268                 }
 269                 if (!d->add_to_buf) {
 270                         dev_err(d->dev, "add_to_buf not set\n");
 271                         return -EBADRQC;
 272                 }
 273         } else if (!d->rbuf && !(d->fops && d->fops->read &&
 274                                 d->fops->poll && d->fops->unlocked_ioctl)) {
 275                 dev_err(d->dev, "undefined read, poll, ioctl\n");
 276                 return -EBADRQC;
 277         }
 278
 279         mutex_lock(&lirc_dev_lock);
 280
 281         minor = d->minor;
 282
 283         if (minor < 0) {
 284                 /* find first free slot for driver */
 285                 for (minor = 0; minor < MAX_IRCTL_DEVICES; minor++)
 286                         if (!irctls[minor])
 287                                 break;
 288                 if (MAX_IRCTL_DEVICES == minor) {
 289                         dev_err(d->dev, "no free slots for drivers!\n");
 290                         err = -ENOMEM;
 291                         goto out_lock;
 292                 }
 293         } else if (irctls[minor]) {
 294                 dev_err(d->dev, "minor (%d) just registered!\n", minor);
 295                 err = -EBUSY;
 296                 goto out_lock;
 297         }
 298
 299         ir = kzalloc(sizeof(struct irctl), GFP_KERNEL);
 300         if (!ir) {
 301                 err = -ENOMEM;
 302                 goto out_lock;
 303         }
 304         lirc_irctl_init(ir);
 305         irctls[minor] = ir;
 306         d->minor = minor;
 307
 308         /* some safety check 8-) */
 309         d->name[sizeof(d->name)-1] = '\0';
 310
 311         if (d->features == 0)
 312                 d->features = LIRC_CAN_REC_LIRCCODE;
 313
 314         ir->d = *d;
 315
 316         device_create(lirc_class, ir->d.dev,
 317                       MKDEV(MAJOR(lirc_base_dev), ir->d.minor), NULL,
 318                       "lirc%u", ir->d.minor);
 319
 320         if (d->sample_rate) {
 321                 ir->jiffies_to_wait = HZ / d->sample_rate;
 322
 323                 /* try to fire up polling thread */
 324                 ir->task = kthread_run(lirc_thread, (void *)ir, "lirc_dev");
 325                 if (IS_ERR(ir->task)) {
 326                         dev_err(d->dev, "cannot run thread for minor = %d\n",
 327                                                                 d->minor);
 328                         err = -ECHILD;
 329                         goto out_sysfs;
 330                 }
 331         } else {
 332                 /* it means - wait for external event in task queue */
 333                 ir->jiffies_to_wait = 0;
 334         }
 335
 336         err = lirc_cdev_add(ir);
 337         if (err)
 338                 goto out_sysfs;
 339
 340         ir->attached = 1;
 341         mutex_unlock(&lirc_dev_lock);
 342
 343         dev_info(ir->d.dev, "lirc_dev: driver %s registered at minor = %d\n",
 344                  ir->d.name, ir->d.minor);
 345         return minor;
 346
 347 out_sysfs:
 348         device_destroy(lirc_class, MKDEV(MAJOR(lirc_base_dev), ir->d.minor));
 349 out_lock:
 350         mutex_unlock(&lirc_dev_lock);
 351
 352         return err;
 353 }
 354
 355 int lirc_register_driver(struct lirc_driver *d)
 356 {
 357         int minor, err = 0;
 358
 359         minor = lirc_allocate_driver(d);
 360         if (minor < 0)
 361                 return minor;
 362
 363         if (LIRC_CAN_REC(d->features)) {
 364                 err = lirc_allocate_buffer(irctls[minor]);
 365                 if (err)
 366                         lirc_unregister_driver(minor);
 367         }
 368
 369         return err ? err : minor;
 370 }
 371 EXPORT_SYMBOL(lirc_register_driver);
 372
 373 int lirc_unregister_driver(int minor)
 374 {
 375         struct irctl *ir;
 376         struct cdev *cdev;
 377
 378         if (minor < 0 || minor >= MAX_IRCTL_DEVICES) {
 379                 pr_err("minor (%d) must be between 0 and %d!\n",
 380                                         minor, MAX_IRCTL_DEVICES - 1);
 381                 return -EBADRQC;
 382         }
 383
 384         ir = irctls[minor];
 385         if (!ir) {
 386                 pr_err("failed to get irctl\n");
 387                 return -ENOENT;
 388         }
 389
 390         cdev = ir->cdev;
 391
 392         mutex_lock(&lirc_dev_lock);
 393
 394         if (ir->d.minor != minor) {
 395                 dev_err(ir->d.dev, "lirc_dev: minor %d device not registered\n",
 396                                                                         minor);
 397                 mutex_unlock(&lirc_dev_lock);
 398                 return -ENOENT;
 399         }
 400
 401         /* end up polling thread */
 402         if (ir->task)
 403                 kthread_stop(ir->task);
 404
 405         dev_dbg(ir->d.dev, "lirc_dev: driver %s unregistered from minor = %d\n",
 406                 ir->d.name, ir->d.minor);
 407
 408         ir->attached = 0;
 409         if (ir->open) {
 410                 dev_dbg(ir->d.dev, LOGHEAD "releasing opened driver\n",
 411                         ir->d.name, ir->d.minor);
 412                 wake_up_interruptible(&ir->buf->wait_poll);
 413                 mutex_lock(&ir->irctl_lock);
 414                 ir->d.set_use_dec(ir->d.data);
 415                 module_put(cdev->owner);
 416                 mutex_unlock(&ir->irctl_lock);
 417         } else {
 418                 lirc_irctl_cleanup(ir);
 419                 cdev_del(cdev);
 420                 kfree(cdev);
 421                 kfree(ir);
 422                 irctls[minor] = NULL;
 423         }
 424
 425         mutex_unlock(&lirc_dev_lock);
 426
 427         return 0;
 428 }
 429 EXPORT_SYMBOL(lirc_unregister_driver);
 430
 431 int lirc_dev_fop_open(struct inode *inode, struct file *file)
 432 {
 433         struct irctl *ir;
 434         struct cdev *cdev;
 435         int retval = 0;
 436
 437         if (iminor(inode) >= MAX_IRCTL_DEVICES) {
 438                 pr_err("open result for %d is -ENODEV\n", iminor(inode));
 439                 return -ENODEV;
 440         }
 441
 442         if (mutex_lock_interruptible(&lirc_dev_lock))
 443                 return -ERESTARTSYS;
 444
 445         ir = irctls[iminor(inode)];
 446         if (!ir) {
 447                 retval = -ENODEV;
 448                 goto error;
 449         }
 450
 451         dev_dbg(ir->d.dev, LOGHEAD "open called\n", ir->d.name, ir->d.minor);
 452
 453         if (ir->d.minor == NOPLUG) {
 454                 retval = -ENODEV;
 455                 goto error;
 456         }
 457
 458         if (ir->open) {
 459                 retval = -EBUSY;
 460                 goto error;
 461         }
 462
 463         if (ir->d.rdev) {
 464                 retval = rc_open(ir->d.rdev);
 465                 if (retval)
 466                         goto error;
 467         }
 468
 469         cdev = ir->cdev;
 470         if (try_module_get(cdev->owner)) {
 471                 ir->open++;
 472                 retval = ir->d.set_use_inc(ir->d.data);
 473
 474                 if (retval) {
 475                         module_put(cdev->owner);
 476                         ir->open--;
 477                 } else {
 478                         lirc_buffer_clear(ir->buf);
 479                 }
 480                 if (ir->task)
 481                         wake_up_process(ir->task);
 482         }
 483
 484 error:
 485         mutex_unlock(&lirc_dev_lock);
 486
 487         nonseekable_open(inode, file);
 488
 489         return retval;
 490 }
 491 EXPORT_SYMBOL(lirc_dev_fop_open);
 492
 493 int lirc_dev_fop_close(struct inode *inode, struct file *file)
 494 {
 495         struct irctl *ir = irctls[iminor(inode)];
 496         struct cdev *cdev;
 497         int ret;
 498
 499         if (!ir) {
 500                 pr_err("called with invalid irctl\n");
 501                 return -EINVAL;
 502         }
 503
 504         cdev = ir->cdev;
 505
 506         ret = mutex_lock_killable(&lirc_dev_lock);
 507         WARN_ON(ret);
 508
 509         rc_close(ir->d.rdev);
 510
 511         ir->open--;
 512         if (ir->attached) {
 513                 ir->d.set_use_dec(ir->d.data);
 514                 module_put(cdev->owner);
 515         } else {
 516                 lirc_irctl_cleanup(ir);
 517                 cdev_del(cdev);
 518                 irctls[ir->d.minor] = NULL;
 519                 kfree(cdev);
 520                 kfree(ir);
 521         }
 522
 523         if (!ret)
 524                 mutex_unlock(&lirc_dev_lock);
 525
 526         return 0;
 527 }
 528 EXPORT_SYMBOL(lirc_dev_fop_close);
 529
 530 unsigned int lirc_dev_fop_poll(struct file *file, poll_table *wait)
 531 {
 532         struct irctl *ir = irctls[iminor(file_inode(file))];
 533         unsigned int ret;
 534
 535         if (!ir) {
 536                 pr_err("called with invalid irctl\n");
 537                 return POLLERR;
 538         }
 539
 540         if (!ir->attached)
 541                 return POLLERR;
 542
 543         if (ir->buf) {
 544                 poll_wait(file, &ir->buf->wait_poll, wait);
 545
 546                 if (lirc_buffer_empty(ir->buf))
 547                         ret = 0;
 548                 else
 549                         ret = POLLIN | POLLRDNORM;
 550         } else
 551                 ret = POLLERR;
 552
 553         dev_dbg(ir->d.dev, LOGHEAD "poll result = %d\n",
 554                 ir->d.name, ir->d.minor, ret);
 555
 556         return ret;
 557 }
 558 EXPORT_SYMBOL(lirc_dev_fop_poll);
 559
 560 long lirc_dev_fop_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
 561 {
 562         __u32 mode;
 563         int result = 0;
 564         struct irctl *ir = irctls[iminor(file_inode(file))];
 565
 566         if (!ir) {
 567                 pr_err("no irctl found!\n");
 568                 return -ENODEV;
 569         }
 570
 571         dev_dbg(ir->d.dev, LOGHEAD "ioctl called (0x%x)\n",
 572                 ir->d.name, ir->d.minor, cmd);
 573
 574         if (ir->d.minor == NOPLUG || !ir->attached) {
 575                 dev_err(ir->d.dev, LOGHEAD "ioctl result = -ENODEV\n",
 576                         ir->d.name, ir->d.minor);
 577                 return -ENODEV;
 578         }
 579
 580         mutex_lock(&ir->irctl_lock);
 581
 582         switch (cmd) {
 583         case LIRC_GET_FEATURES:
 584                 result = put_user(ir->d.features, (__u32 __user *)arg);
 585                 break;
 586         case LIRC_GET_REC_MODE:
 587                 if (!(ir->d.features & LIRC_CAN_REC_MASK)) {
 588                         result = -ENOSYS;
 589                         break;
 590                 }
 591
 592                 result = put_user(LIRC_REC2MODE
 593                                   (ir->d.features & LIRC_CAN_REC_MASK),
 594                                   (__u32 __user *)arg);
 595                 break;
 596         case LIRC_SET_REC_MODE:
 597                 if (!(ir->d.features & LIRC_CAN_REC_MASK)) {
 598                         result = -ENOSYS;
 599                         break;
 600                 }
 601
 602                 result = get_user(mode, (__u32 __user *)arg);
 603                 if (!result && !(LIRC_MODE2REC(mode) & ir->d.features))
 604                         result = -EINVAL;
 605                 /*
 606                  * FIXME: We should actually set the mode somehow but
 607                  * for now, lirc_serial doesn't support mode changing either
 608                  */
 609                 break;
 610         case LIRC_GET_LENGTH:
 611                 result = put_user(ir->d.code_length, (__u32 __user *)arg);
 612                 break;
 613         case LIRC_GET_MIN_TIMEOUT:
 614                 if (!(ir->d.features & LIRC_CAN_SET_REC_TIMEOUT) ||
 615                     ir->d.min_timeout == 0) {
 616                         result = -ENOSYS;
 617                         break;
 618                 }
 619
 620                 result = put_user(ir->d.min_timeout, (__u32 __user *)arg);
 621                 break;
 622         case LIRC_GET_MAX_TIMEOUT:
 623                 if (!(ir->d.features & LIRC_CAN_SET_REC_TIMEOUT) ||
 624                     ir->d.max_timeout == 0) {
 625                         result = -ENOSYS;
 626                         break;
 627                 }
 628
 629                 result = put_user(ir->d.max_timeout, (__u32 __user *)arg);
 630                 break;
 631         default:
 632                 result = -EINVAL;
 633         }
 634
 635         mutex_unlock(&ir->irctl_lock);
 636
 637         return result;
 638 }
 639 EXPORT_SYMBOL(lirc_dev_fop_ioctl);
 640
 641 ssize_t lirc_dev_fop_read(struct file *file,
 642                           char __user *buffer,
 643                           size_t length,
 644                           loff_t *ppos)
 645 {
 646         struct irctl *ir = irctls[iminor(file_inode(file))];
 647         unsigned char *buf;
 648         int ret = 0, written = 0;
 649         DECLARE_WAITQUEUE(wait, current);
 650
 651         if (!ir) {
 652                 pr_err("called with invalid irctl\n");
 653                 return -ENODEV;
 654         }
 655
 656         dev_dbg(ir->d.dev, LOGHEAD "read called\n", ir->d.name, ir->d.minor);
 657
 658         buf = kzalloc(ir->chunk_size, GFP_KERNEL);
 659         if (!buf)
 660                 return -ENOMEM;
 661
 662         if (mutex_lock_interruptible(&ir->irctl_lock)) {
 663                 ret = -ERESTARTSYS;
 664                 goto out_unlocked;
 665         }
 666         if (!ir->attached) {
 667                 ret = -ENODEV;
 668                 goto out_locked;
 669         }
 670
 671         if (length % ir->chunk_size) {
 672                 ret = -EINVAL;
 673                 goto out_locked;
 674         }
 675
 676         /*
 677          * we add ourselves to the task queue before buffer check
 678          * to avoid losing scan code (in case when queue is awaken somewhere
 679          * between while condition checking and scheduling)
 680          */
 681         add_wait_queue(&ir->buf->wait_poll, &wait);
 682         set_current_state(TASK_INTERRUPTIBLE);
 683
 684         /*
 685          * while we didn't provide 'length' bytes, device is opened in blocking
 686          * mode and 'copy_to_user' is happy, wait for data.
 687          */
 688         while (written < length && ret == 0) {
 689                 if (lirc_buffer_empty(ir->buf)) {
 690                         /* According to the read(2) man page, 'written' can be
 691                          * returned as less than 'length', instead of blocking
 692                          * again, returning -EWOULDBLOCK, or returning
 693                          * -ERESTARTSYS */
 694                         if (written)
 695                                 break;
 696                         if (file->f_flags & O_NONBLOCK) {
 697                                 ret = -EWOULDBLOCK;
 698                                 break;
 699                         }
 700                         if (signal_pending(current)) {
 701                                 ret = -ERESTARTSYS;
 702                                 break;
 703                         }
 704
 705                         mutex_unlock(&ir->irctl_lock);
 706                         schedule();
 707                         set_current_state(TASK_INTERRUPTIBLE);
 708
 709                         if (mutex_lock_interruptible(&ir->irctl_lock)) {
 710                                 ret = -ERESTARTSYS;
 711                                 remove_wait_queue(&ir->buf->wait_poll, &wait);
 712                                 set_current_state(TASK_RUNNING);
 713                                 goto out_unlocked;
 714                         }
 715
 716                         if (!ir->attached) {
 717                                 ret = -ENODEV;
 718                                 break;
 719                         }
 720                 } else {
 721                         lirc_buffer_read(ir->buf, buf);
 722                         ret = copy_to_user((void __user *)buffer+written, buf,
 723                                            ir->buf->chunk_size);
 724                         if (!ret)
 725                                 written += ir->buf->chunk_size;
 726                         else
 727                                 ret = -EFAULT;
 728                 }
 729         }
 730
 731         remove_wait_queue(&ir->buf->wait_poll, &wait);
 732         set_current_state(TASK_RUNNING);
 733
 734 out_locked:
 735         mutex_unlock(&ir->irctl_lock);
 736
 737 out_unlocked:
 738         kfree(buf);
 739
 740         return ret ? ret : written;
 741 }
 742 EXPORT_SYMBOL(lirc_dev_fop_read);
 743
 744 void *lirc_get_pdata(struct file *file)
 745 {
 746         return irctls[iminor(file_inode(file))]->d.data;
 747 }
 748 EXPORT_SYMBOL(lirc_get_pdata);
 749
 750
 751 ssize_t lirc_dev_fop_write(struct file *file, const char __user *buffer,
 752                            size_t length, loff_t *ppos)
 753 {
 754         struct irctl *ir = irctls[iminor(file_inode(file))];
 755
 756         if (!ir) {
 757                 pr_err("called with invalid irctl\n");
 758                 return -ENODEV;
 759         }
 760
 761         if (!ir->attached)
 762                 return -ENODEV;
 763
 764         return -EINVAL;
 765 }
 766 EXPORT_SYMBOL(lirc_dev_fop_write);
 767
 768
 769 static int __init lirc_dev_init(void)
 770 {
 771         int retval;
 772
 773         lirc_class = class_create(THIS_MODULE, "lirc");
 774         if (IS_ERR(lirc_class)) {
 775                 pr_err("class_create failed\n");
 776                 return PTR_ERR(lirc_class);
 777         }
 778
 779         retval = alloc_chrdev_region(&lirc_base_dev, 0, MAX_IRCTL_DEVICES,
 780                                      IRCTL_DEV_NAME);
 781         if (retval) {
 782                 class_destroy(lirc_class);
 783                 pr_err("alloc_chrdev_region failed\n");
 784                 return retval;
 785         }
 786
 787
 788         pr_info("IR Remote Control driver registered, major %d\n",
 789                                                 MAJOR(lirc_base_dev));
 790
 791         return 0;
 792 }
 793
 794
 795
 796 static void __exit lirc_dev_exit(void)
 797 {
 798         class_destroy(lirc_class);
 799         unregister_chrdev_region(lirc_base_dev, MAX_IRCTL_DEVICES);
 800         pr_info("module unloaded\n");
 801 }
 802
 803 module_init(lirc_dev_init);
 804 module_exit(lirc_dev_exit);
 805
 806 MODULE_DESCRIPTION("LIRC base driver module");
 807 MODULE_AUTHOR("Artur Lipowski");
 808 MODULE_LICENSE("GPL");
 809
 810 module_param(debug, bool, S_IRUGO | S_IWUSR);
 811 MODULE_PARM_DESC(debug, "Enable debugging messages");