1
2
3
4
5
6
7#include <linux/init.h>
8#include <linux/pci.h>
9#include <linux/module.h>
10#include <linux/proc_fs.h>
11#include <linux/seq_file.h>
12#include <linux/smp_lock.h>
13#include <linux/capability.h>
14#include <asm/uaccess.h>
15#include <asm/byteorder.h>
16#include "pci.h"
17
18static int proc_initialized;
19
20static loff_t
21proc_bus_pci_lseek(struct file *file, loff_t off, int whence)
22{
23 loff_t new = -1;
24 struct inode *inode = file->f_path.dentry->d_inode;
25
26 mutex_lock(&inode->i_mutex);
27 switch (whence) {
28 case 0:
29 new = off;
30 break;
31 case 1:
32 new = file->f_pos + off;
33 break;
34 case 2:
35 new = inode->i_size + off;
36 break;
37 }
38 if (new < 0 || new > inode->i_size)
39 new = -EINVAL;
40 else
41 file->f_pos = new;
42 mutex_unlock(&inode->i_mutex);
43 return new;
44}
45
46static ssize_t
47proc_bus_pci_read(struct file *file, char __user *buf, size_t nbytes, loff_t *ppos)
48{
49 const struct inode *ino = file->f_path.dentry->d_inode;
50 const struct proc_dir_entry *dp = PDE(ino);
51 struct pci_dev *dev = dp->data;
52 unsigned int pos = *ppos;
53 unsigned int cnt, size;
54
55
56
57
58
59
60
61 if (capable(CAP_SYS_ADMIN))
62 size = dp->size;
63 else if (dev->hdr_type == PCI_HEADER_TYPE_CARDBUS)
64 size = 128;
65 else
66 size = 64;
67
68 if (pos >= size)
69 return 0;
70 if (nbytes >= size)
71 nbytes = size;
72 if (pos + nbytes > size)
73 nbytes = size - pos;
74 cnt = nbytes;
75
76 if (!access_ok(VERIFY_WRITE, buf, cnt))
77 return -EINVAL;
78
79 if ((pos & 1) && cnt) {
80 unsigned char val;
81 pci_user_read_config_byte(dev, pos, &val);
82 __put_user(val, buf);
83 buf++;
84 pos++;
85 cnt--;
86 }
87
88 if ((pos & 3) && cnt > 2) {
89 unsigned short val;
90 pci_user_read_config_word(dev, pos, &val);
91 __put_user(cpu_to_le16(val), (__le16 __user *) buf);
92 buf += 2;
93 pos += 2;
94 cnt -= 2;
95 }
96
97 while (cnt >= 4) {
98 unsigned int val;
99 pci_user_read_config_dword(dev, pos, &val);
100 __put_user(cpu_to_le32(val), (__le32 __user *) buf);
101 buf += 4;
102 pos += 4;
103 cnt -= 4;
104 }
105
106 if (cnt >= 2) {
107 unsigned short val;
108 pci_user_read_config_word(dev, pos, &val);
109 __put_user(cpu_to_le16(val), (__le16 __user *) buf);
110 buf += 2;
111 pos += 2;
112 cnt -= 2;
113 }
114
115 if (cnt) {
116 unsigned char val;
117 pci_user_read_config_byte(dev, pos, &val);
118 __put_user(val, buf);
119 buf++;
120 pos++;
121 cnt--;
122 }
123
124 *ppos = pos;
125 return nbytes;
126}
127
128static ssize_t
129proc_bus_pci_write(struct file *file, const char __user *buf, size_t nbytes, loff_t *ppos)
130{
131 struct inode *ino = file->f_path.dentry->d_inode;
132 const struct proc_dir_entry *dp = PDE(ino);
133 struct pci_dev *dev = dp->data;
134 int pos = *ppos;
135 int size = dp->size;
136 int cnt;
137
138 if (pos >= size)
139 return 0;
140 if (nbytes >= size)
141 nbytes = size;
142 if (pos + nbytes > size)
143 nbytes = size - pos;
144 cnt = nbytes;
145
146 if (!access_ok(VERIFY_READ, buf, cnt))
147 return -EINVAL;
148
149 if ((pos & 1) && cnt) {
150 unsigned char val;
151 __get_user(val, buf);
152 pci_user_write_config_byte(dev, pos, val);
153 buf++;
154 pos++;
155 cnt--;
156 }
157
158 if ((pos & 3) && cnt > 2) {
159 __le16 val;
160 __get_user(val, (__le16 __user *) buf);
161 pci_user_write_config_word(dev, pos, le16_to_cpu(val));
162 buf += 2;
163 pos += 2;
164 cnt -= 2;
165 }
166
167 while (cnt >= 4) {
168 __le32 val;
169 __get_user(val, (__le32 __user *) buf);
170 pci_user_write_config_dword(dev, pos, le32_to_cpu(val));
171 buf += 4;
172 pos += 4;
173 cnt -= 4;
174 }
175
176 if (cnt >= 2) {
177 __le16 val;
178 __get_user(val, (__le16 __user *) buf);
179 pci_user_write_config_word(dev, pos, le16_to_cpu(val));
180 buf += 2;
181 pos += 2;
182 cnt -= 2;
183 }
184
185 if (cnt) {
186 unsigned char val;
187 __get_user(val, buf);
188 pci_user_write_config_byte(dev, pos, val);
189 buf++;
190 pos++;
191 cnt--;
192 }
193
194 *ppos = pos;
195 i_size_write(ino, dp->size);
196 return nbytes;
197}
198
199struct pci_filp_private {
200 enum pci_mmap_state mmap_state;
201 int write_combine;
202};
203
204static long proc_bus_pci_ioctl(struct file *file, unsigned int cmd,
205 unsigned long arg)
206{
207 const struct proc_dir_entry *dp = PDE(file->f_dentry->d_inode);
208 struct pci_dev *dev = dp->data;
209#ifdef HAVE_PCI_MMAP
210 struct pci_filp_private *fpriv = file->private_data;
211#endif
212 int ret = 0;
213
214 lock_kernel();
215
216 switch (cmd) {
217 case PCIIOC_CONTROLLER:
218 ret = pci_domain_nr(dev->bus);
219 break;
220
221#ifdef HAVE_PCI_MMAP
222 case PCIIOC_MMAP_IS_IO:
223 fpriv->mmap_state = pci_mmap_io;
224 break;
225
226 case PCIIOC_MMAP_IS_MEM:
227 fpriv->mmap_state = pci_mmap_mem;
228 break;
229
230 case PCIIOC_WRITE_COMBINE:
231 if (arg)
232 fpriv->write_combine = 1;
233 else
234 fpriv->write_combine = 0;
235 break;
236
237#endif
238
239 default:
240 ret = -EINVAL;
241 break;
242 };
243
244 unlock_kernel();
245 return ret;
246}
247
248#ifdef HAVE_PCI_MMAP
249static int proc_bus_pci_mmap(struct file *file, struct vm_area_struct *vma)
250{
251 struct inode *inode = file->f_path.dentry->d_inode;
252 const struct proc_dir_entry *dp = PDE(inode);
253 struct pci_dev *dev = dp->data;
254 struct pci_filp_private *fpriv = file->private_data;
255 int i, ret;
256
257 if (!capable(CAP_SYS_RAWIO))
258 return -EPERM;
259
260
261 for (i = 0; i < PCI_ROM_RESOURCE; i++) {
262 if (pci_mmap_fits(dev, i, vma))
263 break;
264 }
265
266 if (i >= PCI_ROM_RESOURCE)
267 return -ENODEV;
268
269 ret = pci_mmap_page_range(dev, vma,
270 fpriv->mmap_state,
271 fpriv->write_combine);
272 if (ret < 0)
273 return ret;
274
275 return 0;
276}
277
278static int proc_bus_pci_open(struct inode *inode, struct file *file)
279{
280 struct pci_filp_private *fpriv = kmalloc(sizeof(*fpriv), GFP_KERNEL);
281
282 if (!fpriv)
283 return -ENOMEM;
284
285 fpriv->mmap_state = pci_mmap_io;
286 fpriv->write_combine = 0;
287
288 file->private_data = fpriv;
289
290 return 0;
291}
292
293static int proc_bus_pci_release(struct inode *inode, struct file *file)
294{
295 kfree(file->private_data);
296 file->private_data = NULL;
297
298 return 0;
299}
300#endif
301
302static const struct file_operations proc_bus_pci_operations = {
303 .owner = THIS_MODULE,
304 .llseek = proc_bus_pci_lseek,
305 .read = proc_bus_pci_read,
306 .write = proc_bus_pci_write,
307 .unlocked_ioctl = proc_bus_pci_ioctl,
308#ifdef HAVE_PCI_MMAP
309 .open = proc_bus_pci_open,
310 .release = proc_bus_pci_release,
311 .mmap = proc_bus_pci_mmap,
312#ifdef HAVE_ARCH_PCI_GET_UNMAPPED_AREA
313 .get_unmapped_area = get_pci_unmapped_area,
314#endif
315#endif
316};
317
318
319static void *pci_seq_start(struct seq_file *m, loff_t *pos)
320{
321 struct pci_dev *dev = NULL;
322 loff_t n = *pos;
323
324 for_each_pci_dev(dev) {
325 if (!n--)
326 break;
327 }
328 return dev;
329}
330
331static void *pci_seq_next(struct seq_file *m, void *v, loff_t *pos)
332{
333 struct pci_dev *dev = v;
334
335 (*pos)++;
336 dev = pci_get_device(PCI_ANY_ID, PCI_ANY_ID, dev);
337 return dev;
338}
339
340static void pci_seq_stop(struct seq_file *m, void *v)
341{
342 if (v) {
343 struct pci_dev *dev = v;
344 pci_dev_put(dev);
345 }
346}
347
348static int show_device(struct seq_file *m, void *v)
349{
350 const struct pci_dev *dev = v;
351 const struct pci_driver *drv;
352 int i;
353
354 if (dev == NULL)
355 return 0;
356
357 drv = pci_dev_driver(dev);
358 seq_printf(m, "%02x%02x\t%04x%04x\t%x",
359 dev->bus->number,
360 dev->devfn,
361 dev->vendor,
362 dev->device,
363 dev->irq);
364
365
366 for (i = 0; i <= PCI_ROM_RESOURCE; i++) {
367 resource_size_t start, end;
368 pci_resource_to_user(dev, i, &dev->resource[i], &start, &end);
369 seq_printf(m, "\t%16llx",
370 (unsigned long long)(start |
371 (dev->resource[i].flags & PCI_REGION_FLAG_MASK)));
372 }
373 for (i = 0; i <= PCI_ROM_RESOURCE; i++) {
374 resource_size_t start, end;
375 pci_resource_to_user(dev, i, &dev->resource[i], &start, &end);
376 seq_printf(m, "\t%16llx",
377 dev->resource[i].start < dev->resource[i].end ?
378 (unsigned long long)(end - start) + 1 : 0);
379 }
380 seq_putc(m, '\t');
381 if (drv)
382 seq_printf(m, "%s", drv->name);
383 seq_putc(m, '\n');
384 return 0;
385}
386
387static const struct seq_operations proc_bus_pci_devices_op = {
388 .start = pci_seq_start,
389 .next = pci_seq_next,
390 .stop = pci_seq_stop,
391 .show = show_device
392};
393
394static struct proc_dir_entry *proc_bus_pci_dir;
395
396int pci_proc_attach_device(struct pci_dev *dev)
397{
398 struct pci_bus *bus = dev->bus;
399 struct proc_dir_entry *e;
400 char name[16];
401
402 if (!proc_initialized)
403 return -EACCES;
404
405 if (!bus->procdir) {
406 if (pci_proc_domain(bus)) {
407 sprintf(name, "%04x:%02x", pci_domain_nr(bus),
408 bus->number);
409 } else {
410 sprintf(name, "%02x", bus->number);
411 }
412 bus->procdir = proc_mkdir(name, proc_bus_pci_dir);
413 if (!bus->procdir)
414 return -ENOMEM;
415 }
416
417 sprintf(name, "%02x.%x", PCI_SLOT(dev->devfn), PCI_FUNC(dev->devfn));
418 e = proc_create_data(name, S_IFREG | S_IRUGO | S_IWUSR, bus->procdir,
419 &proc_bus_pci_operations, dev);
420 if (!e)
421 return -ENOMEM;
422 e->size = dev->cfg_size;
423 dev->procent = e;
424
425 return 0;
426}
427
428int pci_proc_detach_device(struct pci_dev *dev)
429{
430 struct proc_dir_entry *e;
431
432 if ((e = dev->procent)) {
433 if (atomic_read(&e->count) > 1)
434 return -EBUSY;
435 remove_proc_entry(e->name, dev->bus->procdir);
436 dev->procent = NULL;
437 }
438 return 0;
439}
440
441#if 0
442int pci_proc_attach_bus(struct pci_bus* bus)
443{
444 struct proc_dir_entry *de = bus->procdir;
445
446 if (!proc_initialized)
447 return -EACCES;
448
449 if (!de) {
450 char name[16];
451 sprintf(name, "%02x", bus->number);
452 de = bus->procdir = proc_mkdir(name, proc_bus_pci_dir);
453 if (!de)
454 return -ENOMEM;
455 }
456 return 0;
457}
458#endif
459
460int pci_proc_detach_bus(struct pci_bus* bus)
461{
462 struct proc_dir_entry *de = bus->procdir;
463 if (de)
464 remove_proc_entry(de->name, proc_bus_pci_dir);
465 return 0;
466}
467
468static int proc_bus_pci_dev_open(struct inode *inode, struct file *file)
469{
470 return seq_open(file, &proc_bus_pci_devices_op);
471}
472static const struct file_operations proc_bus_pci_dev_operations = {
473 .owner = THIS_MODULE,
474 .open = proc_bus_pci_dev_open,
475 .read = seq_read,
476 .llseek = seq_lseek,
477 .release = seq_release,
478};
479
480static int __init pci_proc_init(void)
481{
482 struct pci_dev *dev = NULL;
483 proc_bus_pci_dir = proc_mkdir("bus/pci", NULL);
484 proc_create("devices", 0, proc_bus_pci_dir,
485 &proc_bus_pci_dev_operations);
486 proc_initialized = 1;
487 while ((dev = pci_get_device(PCI_ANY_ID, PCI_ANY_ID, dev)) != NULL) {
488 pci_proc_attach_device(dev);
489 }
490 return 0;
491}
492
493device_initcall(pci_proc_init);
494
495
