mirror of
https://github.com/AuxXxilium/linux_dsm_epyc7002.git
synced 2024-12-23 11:29:53 +07:00
1832f2d8ff
The .ioctl and .compat_ioctl file operations have the same prototype so they can both point to the same function, which works great almost all the time when all the commands are compatible. One exception is the s390 architecture, where a compat pointer is only 31 bit wide, and converting it into a 64-bit pointer requires calling compat_ptr(). Most drivers here will never run in s390, but since we now have a generic helper for it, it's easy enough to use it consistently. I double-checked all these drivers to ensure that all ioctl arguments are used as pointers or are ignored, but are not interpreted as integer values. Acked-by: Jason Gunthorpe <jgg@mellanox.com> Acked-by: Daniel Vetter <daniel.vetter@ffwll.ch> Acked-by: Mauro Carvalho Chehab <mchehab+samsung@kernel.org> Acked-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org> Acked-by: David Sterba <dsterba@suse.com> Acked-by: Darren Hart (VMware) <dvhart@infradead.org> Acked-by: Jonathan Cameron <Jonathan.Cameron@huawei.com> Acked-by: Bjorn Andersson <bjorn.andersson@linaro.org> Acked-by: Dan Williams <dan.j.williams@intel.com> Signed-off-by: Arnd Bergmann <arnd@arndb.de>
863 lines
18 KiB
C
863 lines
18 KiB
C
// 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 struct class *lirc_class;
|
|
|
|
/**
|
|
* ir_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 ir_lirc_raw_event(struct rc_dev *dev, struct ir_raw_event ev)
|
|
{
|
|
unsigned long flags;
|
|
struct lirc_fh *fh;
|
|
int sample;
|
|
|
|
/* Packet start */
|
|
if (ev.reset) {
|
|
/*
|
|
* Userspace expects a long space event before the start of
|
|
* the signal to use as a sync. This may be done with repeat
|
|
* packets and normal samples. But if a reset has been sent
|
|
* then we assume that a long time has passed, so we send a
|
|
* space with the maximum time value.
|
|
*/
|
|
sample = LIRC_SPACE(LIRC_VALUE_MASK);
|
|
dev_dbg(&dev->dev, "delivering reset sync space 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) {
|
|
if (dev->gap)
|
|
return;
|
|
|
|
dev->gap_start = ktime_get();
|
|
dev->gap = true;
|
|
dev->gap_duration = ev.duration;
|
|
|
|
sample = LIRC_TIMEOUT(ev.duration / 1000);
|
|
dev_dbg(&dev->dev, "timeout report (duration: %d)\n", sample);
|
|
|
|
/* Normal sample */
|
|
} else {
|
|
if (dev->gap) {
|
|
dev->gap_duration += ktime_to_ns(ktime_sub(ktime_get(),
|
|
dev->gap_start));
|
|
|
|
/* Convert to ms and cap by LIRC_VALUE_MASK */
|
|
do_div(dev->gap_duration, 1000);
|
|
dev->gap_duration = min_t(u64, dev->gap_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(dev->gap_duration));
|
|
spin_unlock_irqrestore(&dev->lirc_fh_lock, flags);
|
|
dev->gap = false;
|
|
}
|
|
|
|
sample = ev.pulse ? LIRC_PULSE(ev.duration / 1000) :
|
|
LIRC_SPACE(ev.duration / 1000);
|
|
dev_dbg(&dev->dev, "delivering %uus %s to lirc_dev\n",
|
|
TO_US(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 (LIRC_IS_TIMEOUT(sample) && !fh->send_timeout_reports)
|
|
continue;
|
|
if (kfifo_put(&fh->rawir, sample))
|
|
wake_up_poll(&fh->wait_poll, EPOLLIN | EPOLLRDNORM);
|
|
}
|
|
spin_unlock_irqrestore(&dev->lirc_fh_lock, flags);
|
|
}
|
|
|
|
/**
|
|
* ir_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 ir_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(ir_lirc_scancode_event);
|
|
|
|
static int ir_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(sizeof(*fh), GFP_KERNEL);
|
|
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;
|
|
fh->send_timeout_reports = true;
|
|
|
|
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 ir_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 ir_lirc_transmit_ir(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) {
|
|
ret = -EINVAL;
|
|
goto out_unlock;
|
|
}
|
|
|
|
/*
|
|
* The scancode field in lirc_scancode is 64-bit simply
|
|
* to future-proof it, since there are IR protocols encode
|
|
* use more than 32 bits. For now only 32-bit protocols
|
|
* are supported.
|
|
*/
|
|
if (scan.scancode > U32_MAX ||
|
|
!rc_validate_scancode(scan.rc_proto, scan.scancode)) {
|
|
ret = -EINVAL;
|
|
goto out_unlock;
|
|
}
|
|
|
|
raw = kmalloc_array(LIRCBUF_SIZE, sizeof(*raw), GFP_KERNEL);
|
|
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;
|
|
|
|
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++)
|
|
/* Convert from NS to US */
|
|
txbuf[i] = DIV_ROUND_UP(raw[i].duration, 1000);
|
|
|
|
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 / 1000 - 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 ir_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_learning_mode)
|
|
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:
|
|
if (!dev->s_rx_carrier_range)
|
|
ret = -ENOTTY;
|
|
else if (val <= 0)
|
|
ret = -EINVAL;
|
|
else
|
|
fh->carrier_low = val;
|
|
break;
|
|
|
|
case LIRC_GET_REC_RESOLUTION:
|
|
if (!dev->rx_resolution)
|
|
ret = -ENOTTY;
|
|
else
|
|
val = dev->rx_resolution / 1000;
|
|
break;
|
|
|
|
case LIRC_SET_WIDEBAND_RECEIVER:
|
|
if (!dev->s_learning_mode)
|
|
ret = -ENOTTY;
|
|
else
|
|
ret = dev->s_learning_mode(dev, !!val);
|
|
break;
|
|
|
|
case LIRC_SET_MEASURE_CARRIER_MODE:
|
|
if (!dev->s_carrier_report)
|
|
ret = -ENOTTY;
|
|
else
|
|
ret = dev->s_carrier_report(dev, !!val);
|
|
break;
|
|
|
|
/* Generic timeout support */
|
|
case LIRC_GET_MIN_TIMEOUT:
|
|
if (!dev->max_timeout)
|
|
ret = -ENOTTY;
|
|
else
|
|
val = DIV_ROUND_UP(dev->min_timeout, 1000);
|
|
break;
|
|
|
|
case LIRC_GET_MAX_TIMEOUT:
|
|
if (!dev->max_timeout)
|
|
ret = -ENOTTY;
|
|
else
|
|
val = dev->max_timeout / 1000;
|
|
break;
|
|
|
|
case LIRC_SET_REC_TIMEOUT:
|
|
if (!dev->max_timeout) {
|
|
ret = -ENOTTY;
|
|
} else if (val > U32_MAX / 1000) {
|
|
/* Check for multiply overflow */
|
|
ret = -EINVAL;
|
|
} else {
|
|
u32 tmp = val * 1000;
|
|
|
|
if (tmp < dev->min_timeout || tmp > dev->max_timeout)
|
|
ret = -EINVAL;
|
|
else if (dev->s_timeout)
|
|
ret = dev->s_timeout(dev, tmp);
|
|
else
|
|
dev->timeout = tmp;
|
|
}
|
|
break;
|
|
|
|
case LIRC_GET_REC_TIMEOUT:
|
|
if (!dev->timeout)
|
|
ret = -ENOTTY;
|
|
else
|
|
val = DIV_ROUND_UP(dev->timeout, 1000);
|
|
break;
|
|
|
|
case LIRC_SET_REC_TIMEOUT_REPORTS:
|
|
if (dev->driver_type != RC_DRIVER_IR_RAW)
|
|
ret = -ENOTTY;
|
|
else
|
|
fh->send_timeout_reports = !!val;
|
|
break;
|
|
|
|
default:
|
|
ret = -ENOTTY;
|
|
}
|
|
|
|
if (!ret && _IOC_DIR(cmd) & _IOC_READ)
|
|
ret = put_user(val, argp);
|
|
|
|
out:
|
|
mutex_unlock(&dev->lock);
|
|
return ret;
|
|
}
|
|
|
|
static __poll_t ir_lirc_poll(struct file *file, struct poll_table_struct *wait)
|
|
{
|
|
struct lirc_fh *fh = file->private_data;
|
|
struct rc_dev *rcdev = fh->rc;
|
|
__poll_t events = 0;
|
|
|
|
poll_wait(file, &fh->wait_poll, wait);
|
|
|
|
if (!rcdev->registered) {
|
|
events = EPOLLHUP | EPOLLERR;
|
|
} else if (rcdev->driver_type != RC_DRIVER_IR_RAW_TX) {
|
|
if (fh->rec_mode == LIRC_MODE_SCANCODE &&
|
|
!kfifo_is_empty(&fh->scancodes))
|
|
events = EPOLLIN | EPOLLRDNORM;
|
|
|
|
if (fh->rec_mode == LIRC_MODE_MODE2 &&
|
|
!kfifo_is_empty(&fh->rawir))
|
|
events = EPOLLIN | EPOLLRDNORM;
|
|
}
|
|
|
|
return events;
|
|
}
|
|
|
|
static ssize_t ir_lirc_read_mode2(struct file *file, char __user *buffer,
|
|
size_t length)
|
|
{
|
|
struct lirc_fh *fh = file->private_data;
|
|
struct rc_dev *rcdev = fh->rc;
|
|
unsigned int copied;
|
|
int ret;
|
|
|
|
if (length < sizeof(unsigned int) || length % sizeof(unsigned int))
|
|
return -EINVAL;
|
|
|
|
do {
|
|
if (kfifo_is_empty(&fh->rawir)) {
|
|
if (file->f_flags & O_NONBLOCK)
|
|
return -EAGAIN;
|
|
|
|
ret = wait_event_interruptible(fh->wait_poll,
|
|
!kfifo_is_empty(&fh->rawir) ||
|
|
!rcdev->registered);
|
|
if (ret)
|
|
return ret;
|
|
}
|
|
|
|
if (!rcdev->registered)
|
|
return -ENODEV;
|
|
|
|
ret = mutex_lock_interruptible(&rcdev->lock);
|
|
if (ret)
|
|
return ret;
|
|
ret = kfifo_to_user(&fh->rawir, buffer, length, &copied);
|
|
mutex_unlock(&rcdev->lock);
|
|
if (ret)
|
|
return ret;
|
|
} while (copied == 0);
|
|
|
|
return copied;
|
|
}
|
|
|
|
static ssize_t ir_lirc_read_scancode(struct file *file, char __user *buffer,
|
|
size_t length)
|
|
{
|
|
struct lirc_fh *fh = file->private_data;
|
|
struct rc_dev *rcdev = fh->rc;
|
|
unsigned int copied;
|
|
int ret;
|
|
|
|
if (length < sizeof(struct lirc_scancode) ||
|
|
length % sizeof(struct lirc_scancode))
|
|
return -EINVAL;
|
|
|
|
do {
|
|
if (kfifo_is_empty(&fh->scancodes)) {
|
|
if (file->f_flags & O_NONBLOCK)
|
|
return -EAGAIN;
|
|
|
|
ret = wait_event_interruptible(fh->wait_poll,
|
|
!kfifo_is_empty(&fh->scancodes) ||
|
|
!rcdev->registered);
|
|
if (ret)
|
|
return ret;
|
|
}
|
|
|
|
if (!rcdev->registered)
|
|
return -ENODEV;
|
|
|
|
ret = mutex_lock_interruptible(&rcdev->lock);
|
|
if (ret)
|
|
return ret;
|
|
ret = kfifo_to_user(&fh->scancodes, buffer, length, &copied);
|
|
mutex_unlock(&rcdev->lock);
|
|
if (ret)
|
|
return ret;
|
|
} while (copied == 0);
|
|
|
|
return copied;
|
|
}
|
|
|
|
static ssize_t ir_lirc_read(struct file *file, char __user *buffer,
|
|
size_t length, loff_t *ppos)
|
|
{
|
|
struct lirc_fh *fh = file->private_data;
|
|
struct rc_dev *rcdev = fh->rc;
|
|
|
|
if (rcdev->driver_type == RC_DRIVER_IR_RAW_TX)
|
|
return -EINVAL;
|
|
|
|
if (!rcdev->registered)
|
|
return -ENODEV;
|
|
|
|
if (fh->rec_mode == LIRC_MODE_MODE2)
|
|
return ir_lirc_read_mode2(file, buffer, length);
|
|
else /* LIRC_MODE_SCANCODE */
|
|
return ir_lirc_read_scancode(file, buffer, length);
|
|
}
|
|
|
|
static const struct file_operations lirc_fops = {
|
|
.owner = THIS_MODULE,
|
|
.write = ir_lirc_transmit_ir,
|
|
.unlocked_ioctl = ir_lirc_ioctl,
|
|
.compat_ioctl = compat_ptr_ioctl,
|
|
.read = ir_lirc_read,
|
|
.poll = ir_lirc_poll,
|
|
.open = ir_lirc_open,
|
|
.release = ir_lirc_close,
|
|
.llseek = no_llseek,
|
|
};
|
|
|
|
static void lirc_release_device(struct device *ld)
|
|
{
|
|
struct rc_dev *rcdev = container_of(ld, struct rc_dev, lirc_dev);
|
|
|
|
put_device(&rcdev->dev);
|
|
}
|
|
|
|
int ir_lirc_register(struct rc_dev *dev)
|
|
{
|
|
const char *rx_type, *tx_type;
|
|
int err, minor;
|
|
|
|
minor = ida_simple_get(&lirc_ida, 0, RC_DEV_MAX, GFP_KERNEL);
|
|
if (minor < 0)
|
|
return minor;
|
|
|
|
device_initialize(&dev->lirc_dev);
|
|
dev->lirc_dev.class = lirc_class;
|
|
dev->lirc_dev.parent = &dev->dev;
|
|
dev->lirc_dev.release = lirc_release_device;
|
|
dev->lirc_dev.devt = MKDEV(MAJOR(lirc_base_dev), minor);
|
|
dev_set_name(&dev->lirc_dev, "lirc%d", minor);
|
|
|
|
INIT_LIST_HEAD(&dev->lirc_fh);
|
|
spin_lock_init(&dev->lirc_fh_lock);
|
|
|
|
cdev_init(&dev->lirc_cdev, &lirc_fops);
|
|
|
|
err = cdev_device_add(&dev->lirc_cdev, &dev->lirc_dev);
|
|
if (err)
|
|
goto out_ida;
|
|
|
|
get_device(&dev->dev);
|
|
|
|
switch (dev->driver_type) {
|
|
case RC_DRIVER_SCANCODE:
|
|
rx_type = "scancode";
|
|
break;
|
|
case RC_DRIVER_IR_RAW:
|
|
rx_type = "raw IR";
|
|
break;
|
|
default:
|
|
rx_type = "no";
|
|
break;
|
|
}
|
|
|
|
if (dev->tx_ir)
|
|
tx_type = "raw IR";
|
|
else
|
|
tx_type = "no";
|
|
|
|
dev_info(&dev->dev, "lirc_dev: driver %s registered at minor = %d, %s receiver, %s transmitter",
|
|
dev->driver_name, minor, rx_type, tx_type);
|
|
|
|
return 0;
|
|
|
|
out_ida:
|
|
ida_simple_remove(&lirc_ida, minor);
|
|
return err;
|
|
}
|
|
|
|
void ir_lirc_unregister(struct rc_dev *dev)
|
|
{
|
|
unsigned long flags;
|
|
struct lirc_fh *fh;
|
|
|
|
dev_dbg(&dev->dev, "lirc_dev: driver %s unregistered from minor = %d\n",
|
|
dev->driver_name, MINOR(dev->lirc_dev.devt));
|
|
|
|
spin_lock_irqsave(&dev->lirc_fh_lock, flags);
|
|
list_for_each_entry(fh, &dev->lirc_fh, list)
|
|
wake_up_poll(&fh->wait_poll, EPOLLHUP | EPOLLERR);
|
|
spin_unlock_irqrestore(&dev->lirc_fh_lock, flags);
|
|
|
|
cdev_device_del(&dev->lirc_cdev, &dev->lirc_dev);
|
|
ida_simple_remove(&lirc_ida, MINOR(dev->lirc_dev.devt));
|
|
}
|
|
|
|
int __init lirc_dev_init(void)
|
|
{
|
|
int retval;
|
|
|
|
lirc_class = class_create(THIS_MODULE, "lirc");
|
|
if (IS_ERR(lirc_class)) {
|
|
pr_err("class_create failed\n");
|
|
return PTR_ERR(lirc_class);
|
|
}
|
|
|
|
retval = alloc_chrdev_region(&lirc_base_dev, 0, RC_DEV_MAX,
|
|
"BaseRemoteCtl");
|
|
if (retval) {
|
|
class_destroy(lirc_class);
|
|
pr_err("alloc_chrdev_region failed\n");
|
|
return retval;
|
|
}
|
|
|
|
pr_debug("IR Remote Control driver registered, major %d\n",
|
|
MAJOR(lirc_base_dev));
|
|
|
|
return 0;
|
|
}
|
|
|
|
void __exit lirc_dev_exit(void)
|
|
{
|
|
class_destroy(lirc_class);
|
|
unregister_chrdev_region(lirc_base_dev, RC_DEV_MAX);
|
|
}
|
|
|
|
struct rc_dev *rc_dev_get_from_fd(int fd)
|
|
{
|
|
struct fd f = fdget(fd);
|
|
struct lirc_fh *fh;
|
|
struct rc_dev *dev;
|
|
|
|
if (!f.file)
|
|
return ERR_PTR(-EBADF);
|
|
|
|
if (f.file->f_op != &lirc_fops) {
|
|
fdput(f);
|
|
return ERR_PTR(-EINVAL);
|
|
}
|
|
|
|
fh = f.file->private_data;
|
|
dev = fh->rc;
|
|
|
|
get_device(&dev->dev);
|
|
fdput(f);
|
|
|
|
return dev;
|
|
}
|
|
|
|
MODULE_ALIAS("lirc_dev");
|