132cf86f6SMauro Carvalho Chehab /* 232cf86f6SMauro Carvalho Chehab * LIRC base driver 332cf86f6SMauro Carvalho Chehab * 432cf86f6SMauro Carvalho Chehab * by Artur Lipowski <alipowski@interia.pl> 532cf86f6SMauro Carvalho Chehab * 632cf86f6SMauro Carvalho Chehab * This program is free software; you can redistribute it and/or modify 732cf86f6SMauro Carvalho Chehab * it under the terms of the GNU General Public License as published by 832cf86f6SMauro Carvalho Chehab * the Free Software Foundation; either version 2 of the License, or 932cf86f6SMauro Carvalho Chehab * (at your option) any later version. 1032cf86f6SMauro Carvalho Chehab * 1132cf86f6SMauro Carvalho Chehab * This program is distributed in the hope that it will be useful, 1232cf86f6SMauro Carvalho Chehab * but WITHOUT ANY WARRANTY; without even the implied warranty of 1332cf86f6SMauro Carvalho Chehab * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 1432cf86f6SMauro Carvalho Chehab * GNU General Public License for more details. 1532cf86f6SMauro Carvalho Chehab * 1632cf86f6SMauro Carvalho Chehab * You should have received a copy of the GNU General Public License 1732cf86f6SMauro Carvalho Chehab * along with this program; if not, write to the Free Software 1832cf86f6SMauro Carvalho Chehab * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA 1932cf86f6SMauro Carvalho Chehab * 2032cf86f6SMauro Carvalho Chehab */ 2132cf86f6SMauro Carvalho Chehab 2232cf86f6SMauro Carvalho Chehab #include <linux/module.h> 2332cf86f6SMauro Carvalho Chehab #include <linux/kernel.h> 2432cf86f6SMauro Carvalho Chehab #include <linux/sched.h> 2532cf86f6SMauro Carvalho Chehab #include <linux/errno.h> 2632cf86f6SMauro Carvalho Chehab #include <linux/ioctl.h> 2732cf86f6SMauro Carvalho Chehab #include <linux/fs.h> 2832cf86f6SMauro Carvalho Chehab #include <linux/poll.h> 2932cf86f6SMauro Carvalho Chehab #include <linux/completion.h> 3032cf86f6SMauro Carvalho Chehab #include <linux/mutex.h> 3132cf86f6SMauro Carvalho Chehab #include <linux/wait.h> 3232cf86f6SMauro Carvalho Chehab #include <linux/unistd.h> 3332cf86f6SMauro Carvalho Chehab #include <linux/kthread.h> 3432cf86f6SMauro Carvalho Chehab #include <linux/bitops.h> 3532cf86f6SMauro Carvalho Chehab #include <linux/device.h> 3632cf86f6SMauro Carvalho Chehab #include <linux/cdev.h> 3732cf86f6SMauro Carvalho Chehab 3832cf86f6SMauro Carvalho Chehab #include <media/lirc.h> 3932cf86f6SMauro Carvalho Chehab #include <media/lirc_dev.h> 4032cf86f6SMauro Carvalho Chehab 4190ab5ee9SRusty Russell static bool debug; 4232cf86f6SMauro Carvalho Chehab 4332cf86f6SMauro Carvalho Chehab #define IRCTL_DEV_NAME "BaseRemoteCtl" 4432cf86f6SMauro Carvalho Chehab #define NOPLUG -1 4532cf86f6SMauro Carvalho Chehab #define LOGHEAD "lirc_dev (%s[%d]): " 4632cf86f6SMauro Carvalho Chehab 4732cf86f6SMauro Carvalho Chehab static dev_t lirc_base_dev; 4832cf86f6SMauro Carvalho Chehab 4932cf86f6SMauro Carvalho Chehab struct irctl { 5032cf86f6SMauro Carvalho Chehab struct lirc_driver d; 5132cf86f6SMauro Carvalho Chehab int attached; 5232cf86f6SMauro Carvalho Chehab int open; 5332cf86f6SMauro Carvalho Chehab 5432cf86f6SMauro Carvalho Chehab struct mutex irctl_lock; 5532cf86f6SMauro Carvalho Chehab struct lirc_buffer *buf; 5632cf86f6SMauro Carvalho Chehab unsigned int chunk_size; 5732cf86f6SMauro Carvalho Chehab 588de111e2SJarod Wilson struct cdev *cdev; 598de111e2SJarod Wilson 6032cf86f6SMauro Carvalho Chehab struct task_struct *task; 6132cf86f6SMauro Carvalho Chehab long jiffies_to_wait; 6232cf86f6SMauro Carvalho Chehab }; 6332cf86f6SMauro Carvalho Chehab 6432cf86f6SMauro Carvalho Chehab static DEFINE_MUTEX(lirc_dev_lock); 6532cf86f6SMauro Carvalho Chehab 6632cf86f6SMauro Carvalho Chehab static struct irctl *irctls[MAX_IRCTL_DEVICES]; 6732cf86f6SMauro Carvalho Chehab 6832cf86f6SMauro Carvalho Chehab /* Only used for sysfs but defined to void otherwise */ 6932cf86f6SMauro Carvalho Chehab static struct class *lirc_class; 7032cf86f6SMauro Carvalho Chehab 7132cf86f6SMauro Carvalho Chehab /* helper function 7232cf86f6SMauro Carvalho Chehab * initializes the irctl structure 7332cf86f6SMauro Carvalho Chehab */ 7432cf86f6SMauro Carvalho Chehab static void lirc_irctl_init(struct irctl *ir) 7532cf86f6SMauro Carvalho Chehab { 7632cf86f6SMauro Carvalho Chehab mutex_init(&ir->irctl_lock); 7732cf86f6SMauro Carvalho Chehab ir->d.minor = NOPLUG; 7832cf86f6SMauro Carvalho Chehab } 7932cf86f6SMauro Carvalho Chehab 8032cf86f6SMauro Carvalho Chehab static void lirc_irctl_cleanup(struct irctl *ir) 8132cf86f6SMauro Carvalho Chehab { 8232cf86f6SMauro Carvalho Chehab dev_dbg(ir->d.dev, LOGHEAD "cleaning up\n", ir->d.name, ir->d.minor); 8332cf86f6SMauro Carvalho Chehab 8432cf86f6SMauro Carvalho Chehab device_destroy(lirc_class, MKDEV(MAJOR(lirc_base_dev), ir->d.minor)); 8532cf86f6SMauro Carvalho Chehab 8632cf86f6SMauro Carvalho Chehab if (ir->buf != ir->d.rbuf) { 8732cf86f6SMauro Carvalho Chehab lirc_buffer_free(ir->buf); 8832cf86f6SMauro Carvalho Chehab kfree(ir->buf); 8932cf86f6SMauro Carvalho Chehab } 9032cf86f6SMauro Carvalho Chehab ir->buf = NULL; 9132cf86f6SMauro Carvalho Chehab } 9232cf86f6SMauro Carvalho Chehab 9332cf86f6SMauro Carvalho Chehab /* helper function 9432cf86f6SMauro Carvalho Chehab * reads key codes from driver and puts them into buffer 9532cf86f6SMauro Carvalho Chehab * returns 0 on success 9632cf86f6SMauro Carvalho Chehab */ 9732cf86f6SMauro Carvalho Chehab static int lirc_add_to_buf(struct irctl *ir) 9832cf86f6SMauro Carvalho Chehab { 9932cf86f6SMauro Carvalho Chehab if (ir->d.add_to_buf) { 10032cf86f6SMauro Carvalho Chehab int res = -ENODATA; 10132cf86f6SMauro Carvalho Chehab int got_data = 0; 10232cf86f6SMauro Carvalho Chehab 10332cf86f6SMauro Carvalho Chehab /* 10432cf86f6SMauro Carvalho Chehab * service the device as long as it is returning 10532cf86f6SMauro Carvalho Chehab * data and we have space 10632cf86f6SMauro Carvalho Chehab */ 10732cf86f6SMauro Carvalho Chehab get_data: 10832cf86f6SMauro Carvalho Chehab res = ir->d.add_to_buf(ir->d.data, ir->buf); 10932cf86f6SMauro Carvalho Chehab if (res == 0) { 11032cf86f6SMauro Carvalho Chehab got_data++; 11132cf86f6SMauro Carvalho Chehab goto get_data; 11232cf86f6SMauro Carvalho Chehab } 11332cf86f6SMauro Carvalho Chehab 11432cf86f6SMauro Carvalho Chehab if (res == -ENODEV) 11532cf86f6SMauro Carvalho Chehab kthread_stop(ir->task); 11632cf86f6SMauro Carvalho Chehab 11732cf86f6SMauro Carvalho Chehab return got_data ? 0 : res; 11832cf86f6SMauro Carvalho Chehab } 11932cf86f6SMauro Carvalho Chehab 12032cf86f6SMauro Carvalho Chehab return 0; 12132cf86f6SMauro Carvalho Chehab } 12232cf86f6SMauro Carvalho Chehab 12332cf86f6SMauro Carvalho Chehab /* main function of the polling thread 12432cf86f6SMauro Carvalho Chehab */ 12532cf86f6SMauro Carvalho Chehab static int lirc_thread(void *irctl) 12632cf86f6SMauro Carvalho Chehab { 12732cf86f6SMauro Carvalho Chehab struct irctl *ir = irctl; 12832cf86f6SMauro Carvalho Chehab 12932cf86f6SMauro Carvalho Chehab dev_dbg(ir->d.dev, LOGHEAD "poll thread started\n", 13032cf86f6SMauro Carvalho Chehab ir->d.name, ir->d.minor); 13132cf86f6SMauro Carvalho Chehab 13232cf86f6SMauro Carvalho Chehab do { 13332cf86f6SMauro Carvalho Chehab if (ir->open) { 13432cf86f6SMauro Carvalho Chehab if (ir->jiffies_to_wait) { 13532cf86f6SMauro Carvalho Chehab set_current_state(TASK_INTERRUPTIBLE); 13632cf86f6SMauro Carvalho Chehab schedule_timeout(ir->jiffies_to_wait); 13732cf86f6SMauro Carvalho Chehab } 13832cf86f6SMauro Carvalho Chehab if (kthread_should_stop()) 13932cf86f6SMauro Carvalho Chehab break; 14032cf86f6SMauro Carvalho Chehab if (!lirc_add_to_buf(ir)) 14132cf86f6SMauro Carvalho Chehab wake_up_interruptible(&ir->buf->wait_poll); 14232cf86f6SMauro Carvalho Chehab } else { 14332cf86f6SMauro Carvalho Chehab set_current_state(TASK_INTERRUPTIBLE); 14432cf86f6SMauro Carvalho Chehab schedule(); 14532cf86f6SMauro Carvalho Chehab } 14632cf86f6SMauro Carvalho Chehab } while (!kthread_should_stop()); 14732cf86f6SMauro Carvalho Chehab 14832cf86f6SMauro Carvalho Chehab dev_dbg(ir->d.dev, LOGHEAD "poll thread ended\n", 14932cf86f6SMauro Carvalho Chehab ir->d.name, ir->d.minor); 15032cf86f6SMauro Carvalho Chehab 15132cf86f6SMauro Carvalho Chehab return 0; 15232cf86f6SMauro Carvalho Chehab } 15332cf86f6SMauro Carvalho Chehab 15432cf86f6SMauro Carvalho Chehab 15532cf86f6SMauro Carvalho Chehab static struct file_operations lirc_dev_fops = { 15632cf86f6SMauro Carvalho Chehab .owner = THIS_MODULE, 15732cf86f6SMauro Carvalho Chehab .read = lirc_dev_fop_read, 15832cf86f6SMauro Carvalho Chehab .write = lirc_dev_fop_write, 15932cf86f6SMauro Carvalho Chehab .poll = lirc_dev_fop_poll, 16032cf86f6SMauro Carvalho Chehab .unlocked_ioctl = lirc_dev_fop_ioctl, 16132cf86f6SMauro Carvalho Chehab #ifdef CONFIG_COMPAT 16232cf86f6SMauro Carvalho Chehab .compat_ioctl = lirc_dev_fop_ioctl, 16332cf86f6SMauro Carvalho Chehab #endif 16432cf86f6SMauro Carvalho Chehab .open = lirc_dev_fop_open, 16532cf86f6SMauro Carvalho Chehab .release = lirc_dev_fop_close, 16632cf86f6SMauro Carvalho Chehab .llseek = noop_llseek, 16732cf86f6SMauro Carvalho Chehab }; 16832cf86f6SMauro Carvalho Chehab 16932cf86f6SMauro Carvalho Chehab static int lirc_cdev_add(struct irctl *ir) 17032cf86f6SMauro Carvalho Chehab { 1718de111e2SJarod Wilson int retval = -ENOMEM; 17232cf86f6SMauro Carvalho Chehab struct lirc_driver *d = &ir->d; 1738de111e2SJarod Wilson struct cdev *cdev; 1748de111e2SJarod Wilson 1758de111e2SJarod Wilson cdev = kzalloc(sizeof(*cdev), GFP_KERNEL); 1768de111e2SJarod Wilson if (!cdev) 1778de111e2SJarod Wilson goto err_out; 17832cf86f6SMauro Carvalho Chehab 17932cf86f6SMauro Carvalho Chehab if (d->fops) { 18032cf86f6SMauro Carvalho Chehab cdev_init(cdev, d->fops); 18132cf86f6SMauro Carvalho Chehab cdev->owner = d->owner; 18232cf86f6SMauro Carvalho Chehab } else { 18332cf86f6SMauro Carvalho Chehab cdev_init(cdev, &lirc_dev_fops); 18432cf86f6SMauro Carvalho Chehab cdev->owner = THIS_MODULE; 18532cf86f6SMauro Carvalho Chehab } 186b395cbacSVasiliy Kulikov retval = kobject_set_name(&cdev->kobj, "lirc%d", d->minor); 187b395cbacSVasiliy Kulikov if (retval) 1888de111e2SJarod Wilson goto err_out; 18932cf86f6SMauro Carvalho Chehab 19032cf86f6SMauro Carvalho Chehab retval = cdev_add(cdev, MKDEV(MAJOR(lirc_base_dev), d->minor), 1); 1918de111e2SJarod Wilson if (retval) { 19232cf86f6SMauro Carvalho Chehab kobject_put(&cdev->kobj); 1938de111e2SJarod Wilson goto err_out; 1948de111e2SJarod Wilson } 19532cf86f6SMauro Carvalho Chehab 1968de111e2SJarod Wilson ir->cdev = cdev; 1978de111e2SJarod Wilson 1988de111e2SJarod Wilson return 0; 1998de111e2SJarod Wilson 2008de111e2SJarod Wilson err_out: 2018de111e2SJarod Wilson kfree(cdev); 20232cf86f6SMauro Carvalho Chehab return retval; 20332cf86f6SMauro Carvalho Chehab } 20432cf86f6SMauro Carvalho Chehab 20532cf86f6SMauro Carvalho Chehab int lirc_register_driver(struct lirc_driver *d) 20632cf86f6SMauro Carvalho Chehab { 20732cf86f6SMauro Carvalho Chehab struct irctl *ir; 20832cf86f6SMauro Carvalho Chehab int minor; 20932cf86f6SMauro Carvalho Chehab int bytes_in_key; 21032cf86f6SMauro Carvalho Chehab unsigned int chunk_size; 21132cf86f6SMauro Carvalho Chehab unsigned int buffer_size; 21232cf86f6SMauro Carvalho Chehab int err; 21332cf86f6SMauro Carvalho Chehab 21432cf86f6SMauro Carvalho Chehab if (!d) { 21532cf86f6SMauro Carvalho Chehab printk(KERN_ERR "lirc_dev: lirc_register_driver: " 21632cf86f6SMauro Carvalho Chehab "driver pointer must be not NULL!\n"); 21732cf86f6SMauro Carvalho Chehab err = -EBADRQC; 21832cf86f6SMauro Carvalho Chehab goto out; 21932cf86f6SMauro Carvalho Chehab } 22032cf86f6SMauro Carvalho Chehab 22132cf86f6SMauro Carvalho Chehab if (!d->dev) { 22232cf86f6SMauro Carvalho Chehab printk(KERN_ERR "%s: dev pointer not filled in!\n", __func__); 22332cf86f6SMauro Carvalho Chehab err = -EINVAL; 22432cf86f6SMauro Carvalho Chehab goto out; 22532cf86f6SMauro Carvalho Chehab } 22632cf86f6SMauro Carvalho Chehab 22732cf86f6SMauro Carvalho Chehab if (MAX_IRCTL_DEVICES <= d->minor) { 22832cf86f6SMauro Carvalho Chehab dev_err(d->dev, "lirc_dev: lirc_register_driver: " 22932cf86f6SMauro Carvalho Chehab "\"minor\" must be between 0 and %d (%d)!\n", 23032cf86f6SMauro Carvalho Chehab MAX_IRCTL_DEVICES - 1, d->minor); 23132cf86f6SMauro Carvalho Chehab err = -EBADRQC; 23232cf86f6SMauro Carvalho Chehab goto out; 23332cf86f6SMauro Carvalho Chehab } 23432cf86f6SMauro Carvalho Chehab 23532cf86f6SMauro Carvalho Chehab if (1 > d->code_length || (BUFLEN * 8) < d->code_length) { 23632cf86f6SMauro Carvalho Chehab dev_err(d->dev, "lirc_dev: lirc_register_driver: " 23732cf86f6SMauro Carvalho Chehab "code length in bits for minor (%d) " 23832cf86f6SMauro Carvalho Chehab "must be less than %d!\n", 23932cf86f6SMauro Carvalho Chehab d->minor, BUFLEN * 8); 24032cf86f6SMauro Carvalho Chehab err = -EBADRQC; 24132cf86f6SMauro Carvalho Chehab goto out; 24232cf86f6SMauro Carvalho Chehab } 24332cf86f6SMauro Carvalho Chehab 24432cf86f6SMauro Carvalho Chehab dev_dbg(d->dev, "lirc_dev: lirc_register_driver: sample_rate: %d\n", 24532cf86f6SMauro Carvalho Chehab d->sample_rate); 24632cf86f6SMauro Carvalho Chehab if (d->sample_rate) { 24732cf86f6SMauro Carvalho Chehab if (2 > d->sample_rate || HZ < d->sample_rate) { 24832cf86f6SMauro Carvalho Chehab dev_err(d->dev, "lirc_dev: lirc_register_driver: " 24932cf86f6SMauro Carvalho Chehab "sample_rate must be between 2 and %d!\n", HZ); 25032cf86f6SMauro Carvalho Chehab err = -EBADRQC; 25132cf86f6SMauro Carvalho Chehab goto out; 25232cf86f6SMauro Carvalho Chehab } 25332cf86f6SMauro Carvalho Chehab if (!d->add_to_buf) { 25432cf86f6SMauro Carvalho Chehab dev_err(d->dev, "lirc_dev: lirc_register_driver: " 25532cf86f6SMauro Carvalho Chehab "add_to_buf cannot be NULL when " 25632cf86f6SMauro Carvalho Chehab "sample_rate is set\n"); 25732cf86f6SMauro Carvalho Chehab err = -EBADRQC; 25832cf86f6SMauro Carvalho Chehab goto out; 25932cf86f6SMauro Carvalho Chehab } 26032cf86f6SMauro Carvalho Chehab } else if (!(d->fops && d->fops->read) && !d->rbuf) { 26132cf86f6SMauro Carvalho Chehab dev_err(d->dev, "lirc_dev: lirc_register_driver: " 26232cf86f6SMauro Carvalho Chehab "fops->read and rbuf cannot all be NULL!\n"); 26332cf86f6SMauro Carvalho Chehab err = -EBADRQC; 26432cf86f6SMauro Carvalho Chehab goto out; 26532cf86f6SMauro Carvalho Chehab } else if (!d->rbuf) { 26632cf86f6SMauro Carvalho Chehab if (!(d->fops && d->fops->read && d->fops->poll && 26732cf86f6SMauro Carvalho Chehab d->fops->unlocked_ioctl)) { 26832cf86f6SMauro Carvalho Chehab dev_err(d->dev, "lirc_dev: lirc_register_driver: " 26932cf86f6SMauro Carvalho Chehab "neither read, poll nor unlocked_ioctl can be NULL!\n"); 27032cf86f6SMauro Carvalho Chehab err = -EBADRQC; 27132cf86f6SMauro Carvalho Chehab goto out; 27232cf86f6SMauro Carvalho Chehab } 27332cf86f6SMauro Carvalho Chehab } 27432cf86f6SMauro Carvalho Chehab 27532cf86f6SMauro Carvalho Chehab mutex_lock(&lirc_dev_lock); 27632cf86f6SMauro Carvalho Chehab 27732cf86f6SMauro Carvalho Chehab minor = d->minor; 27832cf86f6SMauro Carvalho Chehab 27932cf86f6SMauro Carvalho Chehab if (minor < 0) { 28032cf86f6SMauro Carvalho Chehab /* find first free slot for driver */ 28132cf86f6SMauro Carvalho Chehab for (minor = 0; minor < MAX_IRCTL_DEVICES; minor++) 28232cf86f6SMauro Carvalho Chehab if (!irctls[minor]) 28332cf86f6SMauro Carvalho Chehab break; 28432cf86f6SMauro Carvalho Chehab if (MAX_IRCTL_DEVICES == minor) { 28532cf86f6SMauro Carvalho Chehab dev_err(d->dev, "lirc_dev: lirc_register_driver: " 28632cf86f6SMauro Carvalho Chehab "no free slots for drivers!\n"); 28732cf86f6SMauro Carvalho Chehab err = -ENOMEM; 28832cf86f6SMauro Carvalho Chehab goto out_lock; 28932cf86f6SMauro Carvalho Chehab } 29032cf86f6SMauro Carvalho Chehab } else if (irctls[minor]) { 29132cf86f6SMauro Carvalho Chehab dev_err(d->dev, "lirc_dev: lirc_register_driver: " 29232cf86f6SMauro Carvalho Chehab "minor (%d) just registered!\n", minor); 29332cf86f6SMauro Carvalho Chehab err = -EBUSY; 29432cf86f6SMauro Carvalho Chehab goto out_lock; 29532cf86f6SMauro Carvalho Chehab } 29632cf86f6SMauro Carvalho Chehab 29732cf86f6SMauro Carvalho Chehab ir = kzalloc(sizeof(struct irctl), GFP_KERNEL); 29832cf86f6SMauro Carvalho Chehab if (!ir) { 29932cf86f6SMauro Carvalho Chehab err = -ENOMEM; 30032cf86f6SMauro Carvalho Chehab goto out_lock; 30132cf86f6SMauro Carvalho Chehab } 30232cf86f6SMauro Carvalho Chehab lirc_irctl_init(ir); 30332cf86f6SMauro Carvalho Chehab irctls[minor] = ir; 30432cf86f6SMauro Carvalho Chehab d->minor = minor; 30532cf86f6SMauro Carvalho Chehab 30632cf86f6SMauro Carvalho Chehab if (d->sample_rate) { 30732cf86f6SMauro Carvalho Chehab ir->jiffies_to_wait = HZ / d->sample_rate; 30832cf86f6SMauro Carvalho Chehab } else { 30932cf86f6SMauro Carvalho Chehab /* it means - wait for external event in task queue */ 31032cf86f6SMauro Carvalho Chehab ir->jiffies_to_wait = 0; 31132cf86f6SMauro Carvalho Chehab } 31232cf86f6SMauro Carvalho Chehab 31332cf86f6SMauro Carvalho Chehab /* some safety check 8-) */ 31432cf86f6SMauro Carvalho Chehab d->name[sizeof(d->name)-1] = '\0'; 31532cf86f6SMauro Carvalho Chehab 31632cf86f6SMauro Carvalho Chehab bytes_in_key = BITS_TO_LONGS(d->code_length) + 31732cf86f6SMauro Carvalho Chehab (d->code_length % 8 ? 1 : 0); 31832cf86f6SMauro Carvalho Chehab buffer_size = d->buffer_size ? d->buffer_size : BUFLEN / bytes_in_key; 31932cf86f6SMauro Carvalho Chehab chunk_size = d->chunk_size ? d->chunk_size : bytes_in_key; 32032cf86f6SMauro Carvalho Chehab 32132cf86f6SMauro Carvalho Chehab if (d->rbuf) { 32232cf86f6SMauro Carvalho Chehab ir->buf = d->rbuf; 32332cf86f6SMauro Carvalho Chehab } else { 32432cf86f6SMauro Carvalho Chehab ir->buf = kmalloc(sizeof(struct lirc_buffer), GFP_KERNEL); 32532cf86f6SMauro Carvalho Chehab if (!ir->buf) { 32632cf86f6SMauro Carvalho Chehab err = -ENOMEM; 32732cf86f6SMauro Carvalho Chehab goto out_lock; 32832cf86f6SMauro Carvalho Chehab } 32932cf86f6SMauro Carvalho Chehab err = lirc_buffer_init(ir->buf, chunk_size, buffer_size); 33032cf86f6SMauro Carvalho Chehab if (err) { 33132cf86f6SMauro Carvalho Chehab kfree(ir->buf); 33232cf86f6SMauro Carvalho Chehab goto out_lock; 33332cf86f6SMauro Carvalho Chehab } 33432cf86f6SMauro Carvalho Chehab } 33532cf86f6SMauro Carvalho Chehab ir->chunk_size = ir->buf->chunk_size; 33632cf86f6SMauro Carvalho Chehab 33732cf86f6SMauro Carvalho Chehab if (d->features == 0) 33832cf86f6SMauro Carvalho Chehab d->features = LIRC_CAN_REC_LIRCCODE; 33932cf86f6SMauro Carvalho Chehab 34032cf86f6SMauro Carvalho Chehab ir->d = *d; 34132cf86f6SMauro Carvalho Chehab 34232cf86f6SMauro Carvalho Chehab device_create(lirc_class, ir->d.dev, 34332cf86f6SMauro Carvalho Chehab MKDEV(MAJOR(lirc_base_dev), ir->d.minor), NULL, 34432cf86f6SMauro Carvalho Chehab "lirc%u", ir->d.minor); 34532cf86f6SMauro Carvalho Chehab 34632cf86f6SMauro Carvalho Chehab if (d->sample_rate) { 34732cf86f6SMauro Carvalho Chehab /* try to fire up polling thread */ 34832cf86f6SMauro Carvalho Chehab ir->task = kthread_run(lirc_thread, (void *)ir, "lirc_dev"); 34932cf86f6SMauro Carvalho Chehab if (IS_ERR(ir->task)) { 35032cf86f6SMauro Carvalho Chehab dev_err(d->dev, "lirc_dev: lirc_register_driver: " 35132cf86f6SMauro Carvalho Chehab "cannot run poll thread for minor = %d\n", 35232cf86f6SMauro Carvalho Chehab d->minor); 35332cf86f6SMauro Carvalho Chehab err = -ECHILD; 35432cf86f6SMauro Carvalho Chehab goto out_sysfs; 35532cf86f6SMauro Carvalho Chehab } 35632cf86f6SMauro Carvalho Chehab } 35732cf86f6SMauro Carvalho Chehab 35832cf86f6SMauro Carvalho Chehab err = lirc_cdev_add(ir); 35932cf86f6SMauro Carvalho Chehab if (err) 36032cf86f6SMauro Carvalho Chehab goto out_sysfs; 36132cf86f6SMauro Carvalho Chehab 36232cf86f6SMauro Carvalho Chehab ir->attached = 1; 36332cf86f6SMauro Carvalho Chehab mutex_unlock(&lirc_dev_lock); 36432cf86f6SMauro Carvalho Chehab 36532cf86f6SMauro Carvalho Chehab dev_info(ir->d.dev, "lirc_dev: driver %s registered at minor = %d\n", 36632cf86f6SMauro Carvalho Chehab ir->d.name, ir->d.minor); 36732cf86f6SMauro Carvalho Chehab return minor; 36832cf86f6SMauro Carvalho Chehab 36932cf86f6SMauro Carvalho Chehab out_sysfs: 37032cf86f6SMauro Carvalho Chehab device_destroy(lirc_class, MKDEV(MAJOR(lirc_base_dev), ir->d.minor)); 37132cf86f6SMauro Carvalho Chehab out_lock: 37232cf86f6SMauro Carvalho Chehab mutex_unlock(&lirc_dev_lock); 37332cf86f6SMauro Carvalho Chehab out: 37432cf86f6SMauro Carvalho Chehab return err; 37532cf86f6SMauro Carvalho Chehab } 37632cf86f6SMauro Carvalho Chehab EXPORT_SYMBOL(lirc_register_driver); 37732cf86f6SMauro Carvalho Chehab 37832cf86f6SMauro Carvalho Chehab int lirc_unregister_driver(int minor) 37932cf86f6SMauro Carvalho Chehab { 38032cf86f6SMauro Carvalho Chehab struct irctl *ir; 38132cf86f6SMauro Carvalho Chehab struct cdev *cdev; 38232cf86f6SMauro Carvalho Chehab 38332cf86f6SMauro Carvalho Chehab if (minor < 0 || minor >= MAX_IRCTL_DEVICES) { 38432cf86f6SMauro Carvalho Chehab printk(KERN_ERR "lirc_dev: %s: minor (%d) must be between " 38532cf86f6SMauro Carvalho Chehab "0 and %d!\n", __func__, minor, MAX_IRCTL_DEVICES - 1); 38632cf86f6SMauro Carvalho Chehab return -EBADRQC; 38732cf86f6SMauro Carvalho Chehab } 38832cf86f6SMauro Carvalho Chehab 38932cf86f6SMauro Carvalho Chehab ir = irctls[minor]; 39032cf86f6SMauro Carvalho Chehab if (!ir) { 39132cf86f6SMauro Carvalho Chehab printk(KERN_ERR "lirc_dev: %s: failed to get irctl struct " 39232cf86f6SMauro Carvalho Chehab "for minor %d!\n", __func__, minor); 39332cf86f6SMauro Carvalho Chehab return -ENOENT; 39432cf86f6SMauro Carvalho Chehab } 39532cf86f6SMauro Carvalho Chehab 3968de111e2SJarod Wilson cdev = ir->cdev; 39732cf86f6SMauro Carvalho Chehab 39832cf86f6SMauro Carvalho Chehab mutex_lock(&lirc_dev_lock); 39932cf86f6SMauro Carvalho Chehab 40032cf86f6SMauro Carvalho Chehab if (ir->d.minor != minor) { 40132cf86f6SMauro Carvalho Chehab printk(KERN_ERR "lirc_dev: %s: minor (%d) device not " 40232cf86f6SMauro Carvalho Chehab "registered!\n", __func__, minor); 40332cf86f6SMauro Carvalho Chehab mutex_unlock(&lirc_dev_lock); 40432cf86f6SMauro Carvalho Chehab return -ENOENT; 40532cf86f6SMauro Carvalho Chehab } 40632cf86f6SMauro Carvalho Chehab 40732cf86f6SMauro Carvalho Chehab /* end up polling thread */ 40832cf86f6SMauro Carvalho Chehab if (ir->task) 40932cf86f6SMauro Carvalho Chehab kthread_stop(ir->task); 41032cf86f6SMauro Carvalho Chehab 41132cf86f6SMauro Carvalho Chehab dev_dbg(ir->d.dev, "lirc_dev: driver %s unregistered from minor = %d\n", 41232cf86f6SMauro Carvalho Chehab ir->d.name, ir->d.minor); 41332cf86f6SMauro Carvalho Chehab 41432cf86f6SMauro Carvalho Chehab ir->attached = 0; 41532cf86f6SMauro Carvalho Chehab if (ir->open) { 41632cf86f6SMauro Carvalho Chehab dev_dbg(ir->d.dev, LOGHEAD "releasing opened driver\n", 41732cf86f6SMauro Carvalho Chehab ir->d.name, ir->d.minor); 41832cf86f6SMauro Carvalho Chehab wake_up_interruptible(&ir->buf->wait_poll); 41932cf86f6SMauro Carvalho Chehab mutex_lock(&ir->irctl_lock); 42032cf86f6SMauro Carvalho Chehab ir->d.set_use_dec(ir->d.data); 42132cf86f6SMauro Carvalho Chehab module_put(cdev->owner); 42232cf86f6SMauro Carvalho Chehab mutex_unlock(&ir->irctl_lock); 42332cf86f6SMauro Carvalho Chehab } else { 42432cf86f6SMauro Carvalho Chehab lirc_irctl_cleanup(ir); 42532cf86f6SMauro Carvalho Chehab cdev_del(cdev); 4268de111e2SJarod Wilson kfree(cdev); 42732cf86f6SMauro Carvalho Chehab kfree(ir); 42832cf86f6SMauro Carvalho Chehab irctls[minor] = NULL; 42932cf86f6SMauro Carvalho Chehab } 43032cf86f6SMauro Carvalho Chehab 43132cf86f6SMauro Carvalho Chehab mutex_unlock(&lirc_dev_lock); 43232cf86f6SMauro Carvalho Chehab 43332cf86f6SMauro Carvalho Chehab return 0; 43432cf86f6SMauro Carvalho Chehab } 43532cf86f6SMauro Carvalho Chehab EXPORT_SYMBOL(lirc_unregister_driver); 43632cf86f6SMauro Carvalho Chehab 43732cf86f6SMauro Carvalho Chehab int lirc_dev_fop_open(struct inode *inode, struct file *file) 43832cf86f6SMauro Carvalho Chehab { 43932cf86f6SMauro Carvalho Chehab struct irctl *ir; 44032cf86f6SMauro Carvalho Chehab struct cdev *cdev; 44132cf86f6SMauro Carvalho Chehab int retval = 0; 44232cf86f6SMauro Carvalho Chehab 44332cf86f6SMauro Carvalho Chehab if (iminor(inode) >= MAX_IRCTL_DEVICES) { 44432cf86f6SMauro Carvalho Chehab printk(KERN_WARNING "lirc_dev [%d]: open result = -ENODEV\n", 44532cf86f6SMauro Carvalho Chehab iminor(inode)); 44632cf86f6SMauro Carvalho Chehab return -ENODEV; 44732cf86f6SMauro Carvalho Chehab } 44832cf86f6SMauro Carvalho Chehab 44932cf86f6SMauro Carvalho Chehab if (mutex_lock_interruptible(&lirc_dev_lock)) 45032cf86f6SMauro Carvalho Chehab return -ERESTARTSYS; 45132cf86f6SMauro Carvalho Chehab 45232cf86f6SMauro Carvalho Chehab ir = irctls[iminor(inode)]; 45332cf86f6SMauro Carvalho Chehab if (!ir) { 45432cf86f6SMauro Carvalho Chehab retval = -ENODEV; 45532cf86f6SMauro Carvalho Chehab goto error; 45632cf86f6SMauro Carvalho Chehab } 45732cf86f6SMauro Carvalho Chehab 45832cf86f6SMauro Carvalho Chehab dev_dbg(ir->d.dev, LOGHEAD "open called\n", ir->d.name, ir->d.minor); 45932cf86f6SMauro Carvalho Chehab 46032cf86f6SMauro Carvalho Chehab if (ir->d.minor == NOPLUG) { 46132cf86f6SMauro Carvalho Chehab retval = -ENODEV; 46232cf86f6SMauro Carvalho Chehab goto error; 46332cf86f6SMauro Carvalho Chehab } 46432cf86f6SMauro Carvalho Chehab 46532cf86f6SMauro Carvalho Chehab if (ir->open) { 46632cf86f6SMauro Carvalho Chehab retval = -EBUSY; 46732cf86f6SMauro Carvalho Chehab goto error; 46832cf86f6SMauro Carvalho Chehab } 46932cf86f6SMauro Carvalho Chehab 4708de111e2SJarod Wilson cdev = ir->cdev; 47132cf86f6SMauro Carvalho Chehab if (try_module_get(cdev->owner)) { 47232cf86f6SMauro Carvalho Chehab ir->open++; 47332cf86f6SMauro Carvalho Chehab retval = ir->d.set_use_inc(ir->d.data); 47432cf86f6SMauro Carvalho Chehab 47532cf86f6SMauro Carvalho Chehab if (retval) { 47632cf86f6SMauro Carvalho Chehab module_put(cdev->owner); 47732cf86f6SMauro Carvalho Chehab ir->open--; 47832cf86f6SMauro Carvalho Chehab } else { 47932cf86f6SMauro Carvalho Chehab lirc_buffer_clear(ir->buf); 48032cf86f6SMauro Carvalho Chehab } 48132cf86f6SMauro Carvalho Chehab if (ir->task) 48232cf86f6SMauro Carvalho Chehab wake_up_process(ir->task); 48332cf86f6SMauro Carvalho Chehab } 48432cf86f6SMauro Carvalho Chehab 48532cf86f6SMauro Carvalho Chehab error: 48632cf86f6SMauro Carvalho Chehab if (ir) 48732cf86f6SMauro Carvalho Chehab dev_dbg(ir->d.dev, LOGHEAD "open result = %d\n", 48832cf86f6SMauro Carvalho Chehab ir->d.name, ir->d.minor, retval); 48932cf86f6SMauro Carvalho Chehab 49032cf86f6SMauro Carvalho Chehab mutex_unlock(&lirc_dev_lock); 49132cf86f6SMauro Carvalho Chehab 49232cf86f6SMauro Carvalho Chehab nonseekable_open(inode, file); 49332cf86f6SMauro Carvalho Chehab 49432cf86f6SMauro Carvalho Chehab return retval; 49532cf86f6SMauro Carvalho Chehab } 49632cf86f6SMauro Carvalho Chehab EXPORT_SYMBOL(lirc_dev_fop_open); 49732cf86f6SMauro Carvalho Chehab 49832cf86f6SMauro Carvalho Chehab int lirc_dev_fop_close(struct inode *inode, struct file *file) 49932cf86f6SMauro Carvalho Chehab { 50032cf86f6SMauro Carvalho Chehab struct irctl *ir = irctls[iminor(inode)]; 5018de111e2SJarod Wilson struct cdev *cdev; 50232cf86f6SMauro Carvalho Chehab 50332cf86f6SMauro Carvalho Chehab if (!ir) { 50432cf86f6SMauro Carvalho Chehab printk(KERN_ERR "%s: called with invalid irctl\n", __func__); 50532cf86f6SMauro Carvalho Chehab return -EINVAL; 50632cf86f6SMauro Carvalho Chehab } 50732cf86f6SMauro Carvalho Chehab 5088de111e2SJarod Wilson cdev = ir->cdev; 5098de111e2SJarod Wilson 51032cf86f6SMauro Carvalho Chehab dev_dbg(ir->d.dev, LOGHEAD "close called\n", ir->d.name, ir->d.minor); 51132cf86f6SMauro Carvalho Chehab 51232cf86f6SMauro Carvalho Chehab WARN_ON(mutex_lock_killable(&lirc_dev_lock)); 51332cf86f6SMauro Carvalho Chehab 51432cf86f6SMauro Carvalho Chehab ir->open--; 51532cf86f6SMauro Carvalho Chehab if (ir->attached) { 51632cf86f6SMauro Carvalho Chehab ir->d.set_use_dec(ir->d.data); 51732cf86f6SMauro Carvalho Chehab module_put(cdev->owner); 51832cf86f6SMauro Carvalho Chehab } else { 51932cf86f6SMauro Carvalho Chehab lirc_irctl_cleanup(ir); 52032cf86f6SMauro Carvalho Chehab cdev_del(cdev); 52132cf86f6SMauro Carvalho Chehab irctls[ir->d.minor] = NULL; 5228de111e2SJarod Wilson kfree(cdev); 52332cf86f6SMauro Carvalho Chehab kfree(ir); 52432cf86f6SMauro Carvalho Chehab } 52532cf86f6SMauro Carvalho Chehab 52632cf86f6SMauro Carvalho Chehab mutex_unlock(&lirc_dev_lock); 52732cf86f6SMauro Carvalho Chehab 52832cf86f6SMauro Carvalho Chehab return 0; 52932cf86f6SMauro Carvalho Chehab } 53032cf86f6SMauro Carvalho Chehab EXPORT_SYMBOL(lirc_dev_fop_close); 53132cf86f6SMauro Carvalho Chehab 53232cf86f6SMauro Carvalho Chehab unsigned int lirc_dev_fop_poll(struct file *file, poll_table *wait) 53332cf86f6SMauro Carvalho Chehab { 534*496ad9aaSAl Viro struct irctl *ir = irctls[iminor(file_inode(file))]; 53532cf86f6SMauro Carvalho Chehab unsigned int ret; 53632cf86f6SMauro Carvalho Chehab 53732cf86f6SMauro Carvalho Chehab if (!ir) { 53832cf86f6SMauro Carvalho Chehab printk(KERN_ERR "%s: called with invalid irctl\n", __func__); 53932cf86f6SMauro Carvalho Chehab return POLLERR; 54032cf86f6SMauro Carvalho Chehab } 54132cf86f6SMauro Carvalho Chehab 54232cf86f6SMauro Carvalho Chehab dev_dbg(ir->d.dev, LOGHEAD "poll called\n", ir->d.name, ir->d.minor); 54332cf86f6SMauro Carvalho Chehab 54432cf86f6SMauro Carvalho Chehab if (!ir->attached) 54532cf86f6SMauro Carvalho Chehab return POLLERR; 54632cf86f6SMauro Carvalho Chehab 54732cf86f6SMauro Carvalho Chehab poll_wait(file, &ir->buf->wait_poll, wait); 54832cf86f6SMauro Carvalho Chehab 54932cf86f6SMauro Carvalho Chehab if (ir->buf) 55032cf86f6SMauro Carvalho Chehab if (lirc_buffer_empty(ir->buf)) 55132cf86f6SMauro Carvalho Chehab ret = 0; 55232cf86f6SMauro Carvalho Chehab else 55332cf86f6SMauro Carvalho Chehab ret = POLLIN | POLLRDNORM; 55432cf86f6SMauro Carvalho Chehab else 55532cf86f6SMauro Carvalho Chehab ret = POLLERR; 55632cf86f6SMauro Carvalho Chehab 55732cf86f6SMauro Carvalho Chehab dev_dbg(ir->d.dev, LOGHEAD "poll result = %d\n", 55832cf86f6SMauro Carvalho Chehab ir->d.name, ir->d.minor, ret); 55932cf86f6SMauro Carvalho Chehab 56032cf86f6SMauro Carvalho Chehab return ret; 56132cf86f6SMauro Carvalho Chehab } 56232cf86f6SMauro Carvalho Chehab EXPORT_SYMBOL(lirc_dev_fop_poll); 56332cf86f6SMauro Carvalho Chehab 56432cf86f6SMauro Carvalho Chehab long lirc_dev_fop_ioctl(struct file *file, unsigned int cmd, unsigned long arg) 56532cf86f6SMauro Carvalho Chehab { 56632cf86f6SMauro Carvalho Chehab __u32 mode; 56732cf86f6SMauro Carvalho Chehab int result = 0; 568*496ad9aaSAl Viro struct irctl *ir = irctls[iminor(file_inode(file))]; 56932cf86f6SMauro Carvalho Chehab 57032cf86f6SMauro Carvalho Chehab if (!ir) { 57132cf86f6SMauro Carvalho Chehab printk(KERN_ERR "lirc_dev: %s: no irctl found!\n", __func__); 57232cf86f6SMauro Carvalho Chehab return -ENODEV; 57332cf86f6SMauro Carvalho Chehab } 57432cf86f6SMauro Carvalho Chehab 57532cf86f6SMauro Carvalho Chehab dev_dbg(ir->d.dev, LOGHEAD "ioctl called (0x%x)\n", 57632cf86f6SMauro Carvalho Chehab ir->d.name, ir->d.minor, cmd); 57732cf86f6SMauro Carvalho Chehab 57832cf86f6SMauro Carvalho Chehab if (ir->d.minor == NOPLUG || !ir->attached) { 57932cf86f6SMauro Carvalho Chehab dev_dbg(ir->d.dev, LOGHEAD "ioctl result = -ENODEV\n", 58032cf86f6SMauro Carvalho Chehab ir->d.name, ir->d.minor); 58132cf86f6SMauro Carvalho Chehab return -ENODEV; 58232cf86f6SMauro Carvalho Chehab } 58332cf86f6SMauro Carvalho Chehab 58432cf86f6SMauro Carvalho Chehab mutex_lock(&ir->irctl_lock); 58532cf86f6SMauro Carvalho Chehab 58632cf86f6SMauro Carvalho Chehab switch (cmd) { 58732cf86f6SMauro Carvalho Chehab case LIRC_GET_FEATURES: 58832cf86f6SMauro Carvalho Chehab result = put_user(ir->d.features, (__u32 *)arg); 58932cf86f6SMauro Carvalho Chehab break; 59032cf86f6SMauro Carvalho Chehab case LIRC_GET_REC_MODE: 59132cf86f6SMauro Carvalho Chehab if (!(ir->d.features & LIRC_CAN_REC_MASK)) { 59232cf86f6SMauro Carvalho Chehab result = -ENOSYS; 59332cf86f6SMauro Carvalho Chehab break; 59432cf86f6SMauro Carvalho Chehab } 59532cf86f6SMauro Carvalho Chehab 59632cf86f6SMauro Carvalho Chehab result = put_user(LIRC_REC2MODE 59732cf86f6SMauro Carvalho Chehab (ir->d.features & LIRC_CAN_REC_MASK), 59832cf86f6SMauro Carvalho Chehab (__u32 *)arg); 59932cf86f6SMauro Carvalho Chehab break; 60032cf86f6SMauro Carvalho Chehab case LIRC_SET_REC_MODE: 60132cf86f6SMauro Carvalho Chehab if (!(ir->d.features & LIRC_CAN_REC_MASK)) { 60232cf86f6SMauro Carvalho Chehab result = -ENOSYS; 60332cf86f6SMauro Carvalho Chehab break; 60432cf86f6SMauro Carvalho Chehab } 60532cf86f6SMauro Carvalho Chehab 60632cf86f6SMauro Carvalho Chehab result = get_user(mode, (__u32 *)arg); 60732cf86f6SMauro Carvalho Chehab if (!result && !(LIRC_MODE2REC(mode) & ir->d.features)) 60832cf86f6SMauro Carvalho Chehab result = -EINVAL; 60932cf86f6SMauro Carvalho Chehab /* 61032cf86f6SMauro Carvalho Chehab * FIXME: We should actually set the mode somehow but 61132cf86f6SMauro Carvalho Chehab * for now, lirc_serial doesn't support mode changing either 61232cf86f6SMauro Carvalho Chehab */ 61332cf86f6SMauro Carvalho Chehab break; 61432cf86f6SMauro Carvalho Chehab case LIRC_GET_LENGTH: 61532cf86f6SMauro Carvalho Chehab result = put_user(ir->d.code_length, (__u32 *)arg); 61632cf86f6SMauro Carvalho Chehab break; 61732cf86f6SMauro Carvalho Chehab case LIRC_GET_MIN_TIMEOUT: 61832cf86f6SMauro Carvalho Chehab if (!(ir->d.features & LIRC_CAN_SET_REC_TIMEOUT) || 61932cf86f6SMauro Carvalho Chehab ir->d.min_timeout == 0) { 62032cf86f6SMauro Carvalho Chehab result = -ENOSYS; 62132cf86f6SMauro Carvalho Chehab break; 62232cf86f6SMauro Carvalho Chehab } 62332cf86f6SMauro Carvalho Chehab 62432cf86f6SMauro Carvalho Chehab result = put_user(ir->d.min_timeout, (__u32 *)arg); 62532cf86f6SMauro Carvalho Chehab break; 62632cf86f6SMauro Carvalho Chehab case LIRC_GET_MAX_TIMEOUT: 62732cf86f6SMauro Carvalho Chehab if (!(ir->d.features & LIRC_CAN_SET_REC_TIMEOUT) || 62832cf86f6SMauro Carvalho Chehab ir->d.max_timeout == 0) { 62932cf86f6SMauro Carvalho Chehab result = -ENOSYS; 63032cf86f6SMauro Carvalho Chehab break; 63132cf86f6SMauro Carvalho Chehab } 63232cf86f6SMauro Carvalho Chehab 63332cf86f6SMauro Carvalho Chehab result = put_user(ir->d.max_timeout, (__u32 *)arg); 63432cf86f6SMauro Carvalho Chehab break; 63532cf86f6SMauro Carvalho Chehab default: 63632cf86f6SMauro Carvalho Chehab result = -EINVAL; 63732cf86f6SMauro Carvalho Chehab } 63832cf86f6SMauro Carvalho Chehab 63932cf86f6SMauro Carvalho Chehab dev_dbg(ir->d.dev, LOGHEAD "ioctl result = %d\n", 64032cf86f6SMauro Carvalho Chehab ir->d.name, ir->d.minor, result); 64132cf86f6SMauro Carvalho Chehab 64232cf86f6SMauro Carvalho Chehab mutex_unlock(&ir->irctl_lock); 64332cf86f6SMauro Carvalho Chehab 64432cf86f6SMauro Carvalho Chehab return result; 64532cf86f6SMauro Carvalho Chehab } 64632cf86f6SMauro Carvalho Chehab EXPORT_SYMBOL(lirc_dev_fop_ioctl); 64732cf86f6SMauro Carvalho Chehab 64832cf86f6SMauro Carvalho Chehab ssize_t lirc_dev_fop_read(struct file *file, 6490e835087SDan Carpenter char __user *buffer, 65032cf86f6SMauro Carvalho Chehab size_t length, 65132cf86f6SMauro Carvalho Chehab loff_t *ppos) 65232cf86f6SMauro Carvalho Chehab { 653*496ad9aaSAl Viro struct irctl *ir = irctls[iminor(file_inode(file))]; 65432cf86f6SMauro Carvalho Chehab unsigned char *buf; 65532cf86f6SMauro Carvalho Chehab int ret = 0, written = 0; 65632cf86f6SMauro Carvalho Chehab DECLARE_WAITQUEUE(wait, current); 65732cf86f6SMauro Carvalho Chehab 65832cf86f6SMauro Carvalho Chehab if (!ir) { 65932cf86f6SMauro Carvalho Chehab printk(KERN_ERR "%s: called with invalid irctl\n", __func__); 66032cf86f6SMauro Carvalho Chehab return -ENODEV; 66132cf86f6SMauro Carvalho Chehab } 66232cf86f6SMauro Carvalho Chehab 66332cf86f6SMauro Carvalho Chehab dev_dbg(ir->d.dev, LOGHEAD "read called\n", ir->d.name, ir->d.minor); 66432cf86f6SMauro Carvalho Chehab 66532cf86f6SMauro Carvalho Chehab buf = kzalloc(ir->chunk_size, GFP_KERNEL); 66632cf86f6SMauro Carvalho Chehab if (!buf) 66732cf86f6SMauro Carvalho Chehab return -ENOMEM; 66832cf86f6SMauro Carvalho Chehab 66932cf86f6SMauro Carvalho Chehab if (mutex_lock_interruptible(&ir->irctl_lock)) { 67032cf86f6SMauro Carvalho Chehab ret = -ERESTARTSYS; 67132cf86f6SMauro Carvalho Chehab goto out_unlocked; 67232cf86f6SMauro Carvalho Chehab } 67332cf86f6SMauro Carvalho Chehab if (!ir->attached) { 67432cf86f6SMauro Carvalho Chehab ret = -ENODEV; 67532cf86f6SMauro Carvalho Chehab goto out_locked; 67632cf86f6SMauro Carvalho Chehab } 67732cf86f6SMauro Carvalho Chehab 67832cf86f6SMauro Carvalho Chehab if (length % ir->chunk_size) { 67932cf86f6SMauro Carvalho Chehab ret = -EINVAL; 68032cf86f6SMauro Carvalho Chehab goto out_locked; 68132cf86f6SMauro Carvalho Chehab } 68232cf86f6SMauro Carvalho Chehab 68332cf86f6SMauro Carvalho Chehab /* 68432cf86f6SMauro Carvalho Chehab * we add ourselves to the task queue before buffer check 68532cf86f6SMauro Carvalho Chehab * to avoid losing scan code (in case when queue is awaken somewhere 68632cf86f6SMauro Carvalho Chehab * between while condition checking and scheduling) 68732cf86f6SMauro Carvalho Chehab */ 68832cf86f6SMauro Carvalho Chehab add_wait_queue(&ir->buf->wait_poll, &wait); 68932cf86f6SMauro Carvalho Chehab set_current_state(TASK_INTERRUPTIBLE); 69032cf86f6SMauro Carvalho Chehab 69132cf86f6SMauro Carvalho Chehab /* 69232cf86f6SMauro Carvalho Chehab * while we didn't provide 'length' bytes, device is opened in blocking 69332cf86f6SMauro Carvalho Chehab * mode and 'copy_to_user' is happy, wait for data. 69432cf86f6SMauro Carvalho Chehab */ 69532cf86f6SMauro Carvalho Chehab while (written < length && ret == 0) { 69632cf86f6SMauro Carvalho Chehab if (lirc_buffer_empty(ir->buf)) { 69732cf86f6SMauro Carvalho Chehab /* According to the read(2) man page, 'written' can be 69832cf86f6SMauro Carvalho Chehab * returned as less than 'length', instead of blocking 69932cf86f6SMauro Carvalho Chehab * again, returning -EWOULDBLOCK, or returning 70032cf86f6SMauro Carvalho Chehab * -ERESTARTSYS */ 70132cf86f6SMauro Carvalho Chehab if (written) 70232cf86f6SMauro Carvalho Chehab break; 70332cf86f6SMauro Carvalho Chehab if (file->f_flags & O_NONBLOCK) { 70432cf86f6SMauro Carvalho Chehab ret = -EWOULDBLOCK; 70532cf86f6SMauro Carvalho Chehab break; 70632cf86f6SMauro Carvalho Chehab } 70732cf86f6SMauro Carvalho Chehab if (signal_pending(current)) { 70832cf86f6SMauro Carvalho Chehab ret = -ERESTARTSYS; 70932cf86f6SMauro Carvalho Chehab break; 71032cf86f6SMauro Carvalho Chehab } 71132cf86f6SMauro Carvalho Chehab 71232cf86f6SMauro Carvalho Chehab mutex_unlock(&ir->irctl_lock); 71332cf86f6SMauro Carvalho Chehab schedule(); 71432cf86f6SMauro Carvalho Chehab set_current_state(TASK_INTERRUPTIBLE); 71532cf86f6SMauro Carvalho Chehab 71632cf86f6SMauro Carvalho Chehab if (mutex_lock_interruptible(&ir->irctl_lock)) { 71732cf86f6SMauro Carvalho Chehab ret = -ERESTARTSYS; 71832cf86f6SMauro Carvalho Chehab remove_wait_queue(&ir->buf->wait_poll, &wait); 71932cf86f6SMauro Carvalho Chehab set_current_state(TASK_RUNNING); 72032cf86f6SMauro Carvalho Chehab goto out_unlocked; 72132cf86f6SMauro Carvalho Chehab } 72232cf86f6SMauro Carvalho Chehab 72332cf86f6SMauro Carvalho Chehab if (!ir->attached) { 72432cf86f6SMauro Carvalho Chehab ret = -ENODEV; 72532cf86f6SMauro Carvalho Chehab break; 72632cf86f6SMauro Carvalho Chehab } 72732cf86f6SMauro Carvalho Chehab } else { 72832cf86f6SMauro Carvalho Chehab lirc_buffer_read(ir->buf, buf); 72932cf86f6SMauro Carvalho Chehab ret = copy_to_user((void *)buffer+written, buf, 73032cf86f6SMauro Carvalho Chehab ir->buf->chunk_size); 73132cf86f6SMauro Carvalho Chehab if (!ret) 73232cf86f6SMauro Carvalho Chehab written += ir->buf->chunk_size; 73332cf86f6SMauro Carvalho Chehab else 73432cf86f6SMauro Carvalho Chehab ret = -EFAULT; 73532cf86f6SMauro Carvalho Chehab } 73632cf86f6SMauro Carvalho Chehab } 73732cf86f6SMauro Carvalho Chehab 73832cf86f6SMauro Carvalho Chehab remove_wait_queue(&ir->buf->wait_poll, &wait); 73932cf86f6SMauro Carvalho Chehab set_current_state(TASK_RUNNING); 74032cf86f6SMauro Carvalho Chehab 74132cf86f6SMauro Carvalho Chehab out_locked: 74232cf86f6SMauro Carvalho Chehab mutex_unlock(&ir->irctl_lock); 74332cf86f6SMauro Carvalho Chehab 74432cf86f6SMauro Carvalho Chehab out_unlocked: 74532cf86f6SMauro Carvalho Chehab kfree(buf); 74632cf86f6SMauro Carvalho Chehab dev_dbg(ir->d.dev, LOGHEAD "read result = %s (%d)\n", 74732cf86f6SMauro Carvalho Chehab ir->d.name, ir->d.minor, ret ? "<fail>" : "<ok>", ret); 74832cf86f6SMauro Carvalho Chehab 74932cf86f6SMauro Carvalho Chehab return ret ? ret : written; 75032cf86f6SMauro Carvalho Chehab } 75132cf86f6SMauro Carvalho Chehab EXPORT_SYMBOL(lirc_dev_fop_read); 75232cf86f6SMauro Carvalho Chehab 75332cf86f6SMauro Carvalho Chehab void *lirc_get_pdata(struct file *file) 75432cf86f6SMauro Carvalho Chehab { 75532cf86f6SMauro Carvalho Chehab void *data = NULL; 75632cf86f6SMauro Carvalho Chehab 757*496ad9aaSAl Viro if (file && file->f_dentry && file_inode(file) && 758*496ad9aaSAl Viro file_inode(file)->i_rdev) { 75932cf86f6SMauro Carvalho Chehab struct irctl *ir; 760*496ad9aaSAl Viro ir = irctls[iminor(file_inode(file))]; 76132cf86f6SMauro Carvalho Chehab data = ir->d.data; 76232cf86f6SMauro Carvalho Chehab } 76332cf86f6SMauro Carvalho Chehab 76432cf86f6SMauro Carvalho Chehab return data; 76532cf86f6SMauro Carvalho Chehab } 76632cf86f6SMauro Carvalho Chehab EXPORT_SYMBOL(lirc_get_pdata); 76732cf86f6SMauro Carvalho Chehab 76832cf86f6SMauro Carvalho Chehab 7690e835087SDan Carpenter ssize_t lirc_dev_fop_write(struct file *file, const char __user *buffer, 77032cf86f6SMauro Carvalho Chehab size_t length, loff_t *ppos) 77132cf86f6SMauro Carvalho Chehab { 772*496ad9aaSAl Viro struct irctl *ir = irctls[iminor(file_inode(file))]; 77332cf86f6SMauro Carvalho Chehab 77432cf86f6SMauro Carvalho Chehab if (!ir) { 77532cf86f6SMauro Carvalho Chehab printk(KERN_ERR "%s: called with invalid irctl\n", __func__); 77632cf86f6SMauro Carvalho Chehab return -ENODEV; 77732cf86f6SMauro Carvalho Chehab } 77832cf86f6SMauro Carvalho Chehab 77932cf86f6SMauro Carvalho Chehab dev_dbg(ir->d.dev, LOGHEAD "write called\n", ir->d.name, ir->d.minor); 78032cf86f6SMauro Carvalho Chehab 78132cf86f6SMauro Carvalho Chehab if (!ir->attached) 78232cf86f6SMauro Carvalho Chehab return -ENODEV; 78332cf86f6SMauro Carvalho Chehab 78432cf86f6SMauro Carvalho Chehab return -EINVAL; 78532cf86f6SMauro Carvalho Chehab } 78632cf86f6SMauro Carvalho Chehab EXPORT_SYMBOL(lirc_dev_fop_write); 78732cf86f6SMauro Carvalho Chehab 78832cf86f6SMauro Carvalho Chehab 78932cf86f6SMauro Carvalho Chehab static int __init lirc_dev_init(void) 79032cf86f6SMauro Carvalho Chehab { 79132cf86f6SMauro Carvalho Chehab int retval; 79232cf86f6SMauro Carvalho Chehab 79332cf86f6SMauro Carvalho Chehab lirc_class = class_create(THIS_MODULE, "lirc"); 79432cf86f6SMauro Carvalho Chehab if (IS_ERR(lirc_class)) { 79532cf86f6SMauro Carvalho Chehab retval = PTR_ERR(lirc_class); 79632cf86f6SMauro Carvalho Chehab printk(KERN_ERR "lirc_dev: class_create failed\n"); 79732cf86f6SMauro Carvalho Chehab goto error; 79832cf86f6SMauro Carvalho Chehab } 79932cf86f6SMauro Carvalho Chehab 80032cf86f6SMauro Carvalho Chehab retval = alloc_chrdev_region(&lirc_base_dev, 0, MAX_IRCTL_DEVICES, 80132cf86f6SMauro Carvalho Chehab IRCTL_DEV_NAME); 80232cf86f6SMauro Carvalho Chehab if (retval) { 80332cf86f6SMauro Carvalho Chehab class_destroy(lirc_class); 80432cf86f6SMauro Carvalho Chehab printk(KERN_ERR "lirc_dev: alloc_chrdev_region failed\n"); 80532cf86f6SMauro Carvalho Chehab goto error; 80632cf86f6SMauro Carvalho Chehab } 80732cf86f6SMauro Carvalho Chehab 80832cf86f6SMauro Carvalho Chehab 80932cf86f6SMauro Carvalho Chehab printk(KERN_INFO "lirc_dev: IR Remote Control driver registered, " 81032cf86f6SMauro Carvalho Chehab "major %d \n", MAJOR(lirc_base_dev)); 81132cf86f6SMauro Carvalho Chehab 81232cf86f6SMauro Carvalho Chehab error: 81332cf86f6SMauro Carvalho Chehab return retval; 81432cf86f6SMauro Carvalho Chehab } 81532cf86f6SMauro Carvalho Chehab 81632cf86f6SMauro Carvalho Chehab 81732cf86f6SMauro Carvalho Chehab 81832cf86f6SMauro Carvalho Chehab static void __exit lirc_dev_exit(void) 81932cf86f6SMauro Carvalho Chehab { 82032cf86f6SMauro Carvalho Chehab class_destroy(lirc_class); 82132cf86f6SMauro Carvalho Chehab unregister_chrdev_region(lirc_base_dev, MAX_IRCTL_DEVICES); 82232cf86f6SMauro Carvalho Chehab printk(KERN_INFO "lirc_dev: module unloaded\n"); 82332cf86f6SMauro Carvalho Chehab } 82432cf86f6SMauro Carvalho Chehab 82532cf86f6SMauro Carvalho Chehab module_init(lirc_dev_init); 82632cf86f6SMauro Carvalho Chehab module_exit(lirc_dev_exit); 82732cf86f6SMauro Carvalho Chehab 82832cf86f6SMauro Carvalho Chehab MODULE_DESCRIPTION("LIRC base driver module"); 82932cf86f6SMauro Carvalho Chehab MODULE_AUTHOR("Artur Lipowski"); 83032cf86f6SMauro Carvalho Chehab MODULE_LICENSE("GPL"); 83132cf86f6SMauro Carvalho Chehab 83232cf86f6SMauro Carvalho Chehab module_param(debug, bool, S_IRUGO | S_IWUSR); 83332cf86f6SMauro Carvalho Chehab MODULE_PARM_DESC(debug, "Enable debugging messages"); 834