From 2c3c1048746a4622d8c89a29670120dc8fab93c4 Mon Sep 17 00:00:00 2001 From: Daniel Baumann Date: Sun, 7 Apr 2024 20:49:45 +0200 Subject: Adding upstream version 6.1.76. Signed-off-by: Daniel Baumann --- drivers/pnp/isapnp/proc.c | 86 +++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 86 insertions(+) create mode 100644 drivers/pnp/isapnp/proc.c (limited to 'drivers/pnp/isapnp/proc.c') diff --git a/drivers/pnp/isapnp/proc.c b/drivers/pnp/isapnp/proc.c new file mode 100644 index 000000000..55ae72a28 --- /dev/null +++ b/drivers/pnp/isapnp/proc.c @@ -0,0 +1,86 @@ +// SPDX-License-Identifier: GPL-2.0-or-later +/* + * ISA Plug & Play support + * Copyright (c) by Jaroslav Kysela + */ + +#include +#include +#include +#include +#include + +extern struct pnp_protocol isapnp_protocol; + +static struct proc_dir_entry *isapnp_proc_bus_dir = NULL; + +static loff_t isapnp_proc_bus_lseek(struct file *file, loff_t off, int whence) +{ + return fixed_size_llseek(file, off, whence, 256); +} + +static ssize_t isapnp_proc_bus_read(struct file *file, char __user * buf, + size_t nbytes, loff_t * ppos) +{ + struct pnp_dev *dev = pde_data(file_inode(file)); + int pos = *ppos; + int cnt, size = 256; + + if (pos >= size) + return 0; + if (nbytes >= size) + nbytes = size; + if (pos + nbytes > size) + nbytes = size - pos; + cnt = nbytes; + + if (!access_ok(buf, cnt)) + return -EINVAL; + + isapnp_cfg_begin(dev->card->number, dev->number); + for (; pos < 256 && cnt > 0; pos++, buf++, cnt--) { + unsigned char val; + val = isapnp_read_byte(pos); + __put_user(val, buf); + } + isapnp_cfg_end(); + + *ppos = pos; + return nbytes; +} + +static const struct proc_ops isapnp_proc_bus_proc_ops = { + .proc_lseek = isapnp_proc_bus_lseek, + .proc_read = isapnp_proc_bus_read, +}; + +static int isapnp_proc_attach_device(struct pnp_dev *dev) +{ + struct pnp_card *bus = dev->card; + char name[16]; + + if (!bus->procdir) { + sprintf(name, "%02x", bus->number); + bus->procdir = proc_mkdir(name, isapnp_proc_bus_dir); + if (!bus->procdir) + return -ENOMEM; + } + sprintf(name, "%02x", dev->number); + dev->procent = proc_create_data(name, S_IFREG | S_IRUGO, bus->procdir, + &isapnp_proc_bus_proc_ops, dev); + if (!dev->procent) + return -ENOMEM; + proc_set_size(dev->procent, 256); + return 0; +} + +int __init isapnp_proc_init(void) +{ + struct pnp_dev *dev; + + isapnp_proc_bus_dir = proc_mkdir("bus/isapnp", NULL); + protocol_for_each_dev(&isapnp_protocol, dev) { + isapnp_proc_attach_device(dev); + } + return 0; +} -- cgit v1.2.3