840 lines · 17.7 KB · C
RawDownload
// SPDX-License-Identifier: GPL-2.0-or-later/* * LIRC base driver * * by Artur Lipowski <alipowski@interia.pl> */ #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt #include <linux/module.h>#include <linux/mutex.h>#include <linux/device.h>#include <linux/file.h>#include <linux/idr.h>#include <linux/poll.h>#include <linux/sched.h>#include <linux/wait.h> #include "rc-core-priv.h"#include <uapi/linux/lirc.h> #define LIRCBUF_SIZE	1024 static dev_t lirc_base_dev; /* Used to keep track of allocated lirc devices */static DEFINE_IDA(lirc_ida); /* Only used for sysfs but defined to void otherwise */static const struct class lirc_class = {	.name = "lirc",}; /** * lirc_raw_event() - Send raw IR data to lirc to be relayed to userspace * * @dev:	the struct rc_dev descriptor of the device * @ev:		the struct ir_raw_event descriptor of the pulse/space */void lirc_raw_event(struct rc_dev *dev, struct ir_raw_event ev){	unsigned long flags;	struct lirc_fh *fh;	int sample; 	/* Receiver overflow, data missing */	if (ev.overflow) {		/*		 * Send lirc overflow message. This message is unknown to		 * lircd, but it will interpret this as a long space as		 * long as the value is set to high value. This resets its		 * decoder state.		 */		sample = LIRC_OVERFLOW(LIRC_VALUE_MASK);		dev_dbg(&dev->dev, "delivering overflow to lirc_dev\n"); 	/* Carrier reports */	} else if (ev.carrier_report) {		sample = LIRC_FREQUENCY(ev.carrier);		dev_dbg(&dev->dev, "carrier report (freq: %d)\n", sample); 	/* Packet end */	} else if (ev.timeout) {		dev->gap_start = ktime_get(); 		sample = LIRC_TIMEOUT(ev.duration);		dev_dbg(&dev->dev, "timeout report (duration: %d)\n", sample); 	/* Normal sample */	} else {		if (dev->gap_start) {			u64 duration = ktime_us_delta(ktime_get(),						      dev->gap_start); 			/* Cap by LIRC_VALUE_MASK */			duration = min_t(u64, duration, LIRC_VALUE_MASK); 			spin_lock_irqsave(&dev->lirc_fh_lock, flags);			list_for_each_entry(fh, &dev->lirc_fh, list)				kfifo_put(&fh->rawir, LIRC_SPACE(duration));			spin_unlock_irqrestore(&dev->lirc_fh_lock, flags);			dev->gap_start = 0;		} 		sample = ev.pulse ? LIRC_PULSE(ev.duration) :					LIRC_SPACE(ev.duration);		dev_dbg(&dev->dev, "delivering %uus %s to lirc_dev\n",			ev.duration, TO_STR(ev.pulse));	} 	/*	 * bpf does not care about the gap generated above; that exists	 * for backwards compatibility	 */	lirc_bpf_run(dev, sample); 	spin_lock_irqsave(&dev->lirc_fh_lock, flags);	list_for_each_entry(fh, &dev->lirc_fh, list) {		if (kfifo_put(&fh->rawir, sample))			wake_up_poll(&fh->wait_poll, EPOLLIN | EPOLLRDNORM);	}	spin_unlock_irqrestore(&dev->lirc_fh_lock, flags);} /** * lirc_scancode_event() - Send scancode data to lirc to be relayed to *		userspace. This can be called in atomic context. * @dev:	the struct rc_dev descriptor of the device * @lsc:	the struct lirc_scancode describing the decoded scancode */void lirc_scancode_event(struct rc_dev *dev, struct lirc_scancode *lsc){	unsigned long flags;	struct lirc_fh *fh; 	lsc->timestamp = ktime_get_ns(); 	spin_lock_irqsave(&dev->lirc_fh_lock, flags);	list_for_each_entry(fh, &dev->lirc_fh, list) {		if (kfifo_put(&fh->scancodes, *lsc))			wake_up_poll(&fh->wait_poll, EPOLLIN | EPOLLRDNORM);	}	spin_unlock_irqrestore(&dev->lirc_fh_lock, flags);}EXPORT_SYMBOL_GPL(lirc_scancode_event); static int lirc_open(struct inode *inode, struct file *file){	struct rc_dev *dev = container_of(inode->i_cdev, struct rc_dev,					  lirc_cdev);	struct lirc_fh *fh = kzalloc_obj(*fh);	unsigned long flags;	int retval; 	if (!fh)		return -ENOMEM; 	get_device(&dev->dev); 	if (!dev->registered) {		retval = -ENODEV;		goto out_fh;	} 	if (dev->driver_type == RC_DRIVER_IR_RAW) {		if (kfifo_alloc(&fh->rawir, MAX_IR_EVENT_SIZE, GFP_KERNEL)) {			retval = -ENOMEM;			goto out_fh;		}	} 	if (dev->driver_type != RC_DRIVER_IR_RAW_TX) {		if (kfifo_alloc(&fh->scancodes, 32, GFP_KERNEL)) {			retval = -ENOMEM;			goto out_rawir;		}	} 	fh->send_mode = LIRC_MODE_PULSE;	fh->rc = dev; 	if (dev->driver_type == RC_DRIVER_SCANCODE)		fh->rec_mode = LIRC_MODE_SCANCODE;	else		fh->rec_mode = LIRC_MODE_MODE2; 	retval = rc_open(dev);	if (retval)		goto out_kfifo; 	init_waitqueue_head(&fh->wait_poll); 	file->private_data = fh;	spin_lock_irqsave(&dev->lirc_fh_lock, flags);	list_add(&fh->list, &dev->lirc_fh);	spin_unlock_irqrestore(&dev->lirc_fh_lock, flags); 	stream_open(inode, file); 	return 0;out_kfifo:	if (dev->driver_type != RC_DRIVER_IR_RAW_TX)		kfifo_free(&fh->scancodes);out_rawir:	if (dev->driver_type == RC_DRIVER_IR_RAW)		kfifo_free(&fh->rawir);out_fh:	kfree(fh);	put_device(&dev->dev); 	return retval;} static int lirc_close(struct inode *inode, struct file *file){	struct lirc_fh *fh = file->private_data;	struct rc_dev *dev = fh->rc;	unsigned long flags; 	spin_lock_irqsave(&dev->lirc_fh_lock, flags);	list_del(&fh->list);	spin_unlock_irqrestore(&dev->lirc_fh_lock, flags); 	if (dev->driver_type == RC_DRIVER_IR_RAW)		kfifo_free(&fh->rawir);	if (dev->driver_type != RC_DRIVER_IR_RAW_TX)		kfifo_free(&fh->scancodes);	kfree(fh); 	rc_close(dev);	put_device(&dev->dev); 	return 0;} static ssize_t lirc_transmit(struct file *file, const char __user *buf,			     size_t n, loff_t *ppos){	struct lirc_fh *fh = file->private_data;	struct rc_dev *dev = fh->rc;	unsigned int *txbuf;	struct ir_raw_event *raw = NULL;	ssize_t ret;	size_t count;	ktime_t start;	s64 towait;	unsigned int duration = 0; /* signal duration in us */	int i; 	ret = mutex_lock_interruptible(&dev->lock);	if (ret)		return ret; 	if (!dev->registered) {		ret = -ENODEV;		goto out_unlock;	} 	if (!dev->tx_ir) {		ret = -EINVAL;		goto out_unlock;	} 	if (fh->send_mode == LIRC_MODE_SCANCODE) {		struct lirc_scancode scan; 		if (n != sizeof(scan)) {			ret = -EINVAL;			goto out_unlock;		} 		if (copy_from_user(&scan, buf, sizeof(scan))) {			ret = -EFAULT;			goto out_unlock;		} 		if (scan.flags || scan.keycode || scan.timestamp ||		    scan.rc_proto > RC_PROTO_MAX) {			ret = -EINVAL;			goto out_unlock;		} 		/* We only have encoders for 32-bit protocols. */		if (scan.scancode > U32_MAX ||		    !rc_validate_scancode(scan.rc_proto, scan.scancode)) {			ret = -EINVAL;			goto out_unlock;		} 		raw = kmalloc_objs(*raw, LIRCBUF_SIZE);		if (!raw) {			ret = -ENOMEM;			goto out_unlock;		} 		ret = ir_raw_encode_scancode(scan.rc_proto, scan.scancode,					     raw, LIRCBUF_SIZE);		if (ret < 0)			goto out_kfree_raw; 		/* drop trailing space */		if (!(ret % 2))			count = ret - 1;		else			count = ret; 		txbuf = kmalloc_array(count, sizeof(unsigned int), GFP_KERNEL);		if (!txbuf) {			ret = -ENOMEM;			goto out_kfree_raw;		} 		for (i = 0; i < count; i++)			txbuf[i] = raw[i].duration; 		if (dev->s_tx_carrier) {			int carrier = ir_raw_encode_carrier(scan.rc_proto); 			if (carrier > 0)				dev->s_tx_carrier(dev, carrier);		}	} else {		if (n < sizeof(unsigned int) || n % sizeof(unsigned int)) {			ret = -EINVAL;			goto out_unlock;		} 		count = n / sizeof(unsigned int);		if (count > LIRCBUF_SIZE || count % 2 == 0) {			ret = -EINVAL;			goto out_unlock;		} 		txbuf = memdup_user(buf, n);		if (IS_ERR(txbuf)) {			ret = PTR_ERR(txbuf);			goto out_unlock;		}	} 	for (i = 0; i < count; i++) {		if (txbuf[i] > IR_MAX_DURATION - duration || !txbuf[i]) {			ret = -EINVAL;			goto out_kfree;		} 		duration += txbuf[i];	} 	start = ktime_get(); 	ret = dev->tx_ir(dev, txbuf, count);	if (ret < 0)		goto out_kfree; 	kfree(txbuf);	kfree(raw);	mutex_unlock(&dev->lock); 	/*	 * The lircd gap calculation expects the write function to	 * wait for the actual IR signal to be transmitted before	 * returning.	 */	towait = ktime_us_delta(ktime_add_us(start, duration),				ktime_get());	if (towait > 0) {		set_current_state(TASK_INTERRUPTIBLE);		schedule_timeout(usecs_to_jiffies(towait));	} 	return n;out_kfree:	kfree(txbuf);out_kfree_raw:	kfree(raw);out_unlock:	mutex_unlock(&dev->lock);	return ret;} static long lirc_ioctl(struct file *file, unsigned int cmd, unsigned long arg){	struct lirc_fh *fh = file->private_data;	struct rc_dev *dev = fh->rc;	u32 __user *argp = (u32 __user *)(arg);	u32 val = 0;	int ret; 	if (_IOC_DIR(cmd) & _IOC_WRITE) {		ret = get_user(val, argp);		if (ret)			return ret;	} 	ret = mutex_lock_interruptible(&dev->lock);	if (ret)		return ret; 	if (!dev->registered) {		ret = -ENODEV;		goto out;	} 	switch (cmd) {	case LIRC_GET_FEATURES:		if (dev->driver_type == RC_DRIVER_SCANCODE)			val |= LIRC_CAN_REC_SCANCODE; 		if (dev->driver_type == RC_DRIVER_IR_RAW) {			val |= LIRC_CAN_REC_MODE2;			if (dev->rx_resolution)				val |= LIRC_CAN_GET_REC_RESOLUTION;		} 		if (dev->tx_ir) {			val |= LIRC_CAN_SEND_PULSE;			if (dev->s_tx_mask)				val |= LIRC_CAN_SET_TRANSMITTER_MASK;			if (dev->s_tx_carrier)				val |= LIRC_CAN_SET_SEND_CARRIER;			if (dev->s_tx_duty_cycle)				val |= LIRC_CAN_SET_SEND_DUTY_CYCLE;		} 		if (dev->s_rx_carrier_range)			val |= LIRC_CAN_SET_REC_CARRIER |				LIRC_CAN_SET_REC_CARRIER_RANGE; 		if (dev->s_wideband_receiver)			val |= LIRC_CAN_USE_WIDEBAND_RECEIVER; 		if (dev->s_carrier_report)			val |= LIRC_CAN_MEASURE_CARRIER; 		if (dev->max_timeout)			val |= LIRC_CAN_SET_REC_TIMEOUT; 		break; 	/* mode support */	case LIRC_GET_REC_MODE:		if (dev->driver_type == RC_DRIVER_IR_RAW_TX)			ret = -ENOTTY;		else			val = fh->rec_mode;		break; 	case LIRC_SET_REC_MODE:		switch (dev->driver_type) {		case RC_DRIVER_IR_RAW_TX:			ret = -ENOTTY;			break;		case RC_DRIVER_SCANCODE:			if (val != LIRC_MODE_SCANCODE)				ret = -EINVAL;			break;		case RC_DRIVER_IR_RAW:			if (!(val == LIRC_MODE_MODE2 ||			      val == LIRC_MODE_SCANCODE))				ret = -EINVAL;			break;		} 		if (!ret)			fh->rec_mode = val;		break; 	case LIRC_GET_SEND_MODE:		if (!dev->tx_ir)			ret = -ENOTTY;		else			val = fh->send_mode;		break; 	case LIRC_SET_SEND_MODE:		if (!dev->tx_ir)			ret = -ENOTTY;		else if (!(val == LIRC_MODE_PULSE || val == LIRC_MODE_SCANCODE))			ret = -EINVAL;		else			fh->send_mode = val;		break; 	/* TX settings */	case LIRC_SET_TRANSMITTER_MASK:		if (!dev->s_tx_mask)			ret = -ENOTTY;		else			ret = dev->s_tx_mask(dev, val);		break; 	case LIRC_SET_SEND_CARRIER:		if (!dev->s_tx_carrier)			ret = -ENOTTY;		else			ret = dev->s_tx_carrier(dev, val);		break; 	case LIRC_SET_SEND_DUTY_CYCLE:		if (!dev->s_tx_duty_cycle)			ret = -ENOTTY;		else if (val <= 0 || val >= 100)			ret = -EINVAL;		else			ret = dev->s_tx_duty_cycle(dev, val);		break; 	/* RX settings */	case LIRC_SET_REC_CARRIER:		if (!dev->s_rx_carrier_range)			ret = -ENOTTY;		else if (val <= 0)			ret = -EINVAL;		else			ret = dev->s_rx_carrier_range(dev, fh->carrier_low,						      val);		break; 	case LIRC_SET_REC_CARRIER_RANGE:

Lines 1–500 of 840.