1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-or-later
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun * ISA Plug & Play support
4*4882a593Smuzhiyun * Copyright (c) by Jaroslav Kysela <perex@perex.cz>
5*4882a593Smuzhiyun */
6*4882a593Smuzhiyun
7*4882a593Smuzhiyun #include <linux/module.h>
8*4882a593Smuzhiyun #include <linux/isapnp.h>
9*4882a593Smuzhiyun #include <linux/proc_fs.h>
10*4882a593Smuzhiyun #include <linux/init.h>
11*4882a593Smuzhiyun #include <linux/uaccess.h>
12*4882a593Smuzhiyun
13*4882a593Smuzhiyun extern struct pnp_protocol isapnp_protocol;
14*4882a593Smuzhiyun
15*4882a593Smuzhiyun static struct proc_dir_entry *isapnp_proc_bus_dir = NULL;
16*4882a593Smuzhiyun
isapnp_proc_bus_lseek(struct file * file,loff_t off,int whence)17*4882a593Smuzhiyun static loff_t isapnp_proc_bus_lseek(struct file *file, loff_t off, int whence)
18*4882a593Smuzhiyun {
19*4882a593Smuzhiyun return fixed_size_llseek(file, off, whence, 256);
20*4882a593Smuzhiyun }
21*4882a593Smuzhiyun
isapnp_proc_bus_read(struct file * file,char __user * buf,size_t nbytes,loff_t * ppos)22*4882a593Smuzhiyun static ssize_t isapnp_proc_bus_read(struct file *file, char __user * buf,
23*4882a593Smuzhiyun size_t nbytes, loff_t * ppos)
24*4882a593Smuzhiyun {
25*4882a593Smuzhiyun struct pnp_dev *dev = PDE_DATA(file_inode(file));
26*4882a593Smuzhiyun int pos = *ppos;
27*4882a593Smuzhiyun int cnt, size = 256;
28*4882a593Smuzhiyun
29*4882a593Smuzhiyun if (pos >= size)
30*4882a593Smuzhiyun return 0;
31*4882a593Smuzhiyun if (nbytes >= size)
32*4882a593Smuzhiyun nbytes = size;
33*4882a593Smuzhiyun if (pos + nbytes > size)
34*4882a593Smuzhiyun nbytes = size - pos;
35*4882a593Smuzhiyun cnt = nbytes;
36*4882a593Smuzhiyun
37*4882a593Smuzhiyun if (!access_ok(buf, cnt))
38*4882a593Smuzhiyun return -EINVAL;
39*4882a593Smuzhiyun
40*4882a593Smuzhiyun isapnp_cfg_begin(dev->card->number, dev->number);
41*4882a593Smuzhiyun for (; pos < 256 && cnt > 0; pos++, buf++, cnt--) {
42*4882a593Smuzhiyun unsigned char val;
43*4882a593Smuzhiyun val = isapnp_read_byte(pos);
44*4882a593Smuzhiyun __put_user(val, buf);
45*4882a593Smuzhiyun }
46*4882a593Smuzhiyun isapnp_cfg_end();
47*4882a593Smuzhiyun
48*4882a593Smuzhiyun *ppos = pos;
49*4882a593Smuzhiyun return nbytes;
50*4882a593Smuzhiyun }
51*4882a593Smuzhiyun
52*4882a593Smuzhiyun static const struct proc_ops isapnp_proc_bus_proc_ops = {
53*4882a593Smuzhiyun .proc_lseek = isapnp_proc_bus_lseek,
54*4882a593Smuzhiyun .proc_read = isapnp_proc_bus_read,
55*4882a593Smuzhiyun };
56*4882a593Smuzhiyun
isapnp_proc_attach_device(struct pnp_dev * dev)57*4882a593Smuzhiyun static int isapnp_proc_attach_device(struct pnp_dev *dev)
58*4882a593Smuzhiyun {
59*4882a593Smuzhiyun struct pnp_card *bus = dev->card;
60*4882a593Smuzhiyun struct proc_dir_entry *de, *e;
61*4882a593Smuzhiyun char name[16];
62*4882a593Smuzhiyun
63*4882a593Smuzhiyun if (!(de = bus->procdir)) {
64*4882a593Smuzhiyun sprintf(name, "%02x", bus->number);
65*4882a593Smuzhiyun de = bus->procdir = proc_mkdir(name, isapnp_proc_bus_dir);
66*4882a593Smuzhiyun if (!de)
67*4882a593Smuzhiyun return -ENOMEM;
68*4882a593Smuzhiyun }
69*4882a593Smuzhiyun sprintf(name, "%02x", dev->number);
70*4882a593Smuzhiyun e = dev->procent = proc_create_data(name, S_IFREG | S_IRUGO, de,
71*4882a593Smuzhiyun &isapnp_proc_bus_proc_ops, dev);
72*4882a593Smuzhiyun if (!e)
73*4882a593Smuzhiyun return -ENOMEM;
74*4882a593Smuzhiyun proc_set_size(e, 256);
75*4882a593Smuzhiyun return 0;
76*4882a593Smuzhiyun }
77*4882a593Smuzhiyun
isapnp_proc_init(void)78*4882a593Smuzhiyun int __init isapnp_proc_init(void)
79*4882a593Smuzhiyun {
80*4882a593Smuzhiyun struct pnp_dev *dev;
81*4882a593Smuzhiyun
82*4882a593Smuzhiyun isapnp_proc_bus_dir = proc_mkdir("bus/isapnp", NULL);
83*4882a593Smuzhiyun protocol_for_each_dev(&isapnp_protocol, dev) {
84*4882a593Smuzhiyun isapnp_proc_attach_device(dev);
85*4882a593Smuzhiyun }
86*4882a593Smuzhiyun return 0;
87*4882a593Smuzhiyun }
88