pcidata.c
上传用户:wudi5211
上传日期:2010-01-21
资源大小:607k
文件大小:3k
源码类别:

嵌入式Linux

开发平台:

C/C++

  1. /*
  2.  * pcidata.c --  a module that dumps the cfg registers through /proc
  3.  *
  4.  * Tested with 2.0 (intel)
  5.  * Tested with 2.1.43 (intel)
  6.  *
  7.  * Copyright (C) 1997   rubini@linux.it (Alessandro Rubini)
  8.  *
  9.  *   This program is free software; you can redistribute it and/or modify
  10.  *   it under the terms of the GNU General Public License as published by
  11.  *   the Free Software Foundation; either version 2 of the License, or
  12.  *   (at your option) any later version.
  13.  *
  14.  *   This program is distributed in the hope that it will be useful,
  15.  *   but WITHOUT ANY WARRANTY; without even the implied warranty of
  16.  *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  17.  *   GNU General Public License for more details.
  18.  *
  19.  *   You should have received a copy of the GNU General Public License
  20.  *   along with this program; if not, write to the Free Software
  21.  *   Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  22.  */
  23. #ifndef __KERNEL__
  24. #  define __KERNEL__
  25. #endif
  26. #ifndef MODULE
  27. #  define MODULE
  28. #endif
  29. #include <linux/module.h>
  30. #include <linux/sched.h>
  31. #include <linux/proc_fs.h>
  32. #include <linux/bios32.h> /* pcibios_* */
  33. #include <linux/pci.h>
  34. #include "sysdep-2.1.h"
  35. /*
  36.  * This simple module offers in a /proc file the binary
  37.  * configuration data of available PCI devices.
  38.  * Each device has 256 bytes of cfg data: 16 devices
  39.  * can fit in a page (32 on the alpha).
  40.  */
  41. int pcimod_read_proc(char *buf, char **start, off_t offset,
  42.                    int len, int unused)
  43. {
  44.     int i, pos=0;
  45.     int bus, fun;
  46.     unsigned char headertype=0;
  47.     unsigned int id;
  48.     if (!pcibios_present())
  49.         return sprintf(buf,"No PCI bios presentn");
  50.     /*
  51.      * This code is derived from "drivers/pci/pci.c". This means that
  52.      * the GPL applies to this source file and credit is due to the
  53.      * original authors (Drew Eckhardt, Frederic Potter, David
  54.      * Mosberger-Tang)
  55.      */
  56.     for (bus=0; !bus; bus++) { /* only bus 0 :-) */
  57.         for (fun=0; fun < 0x100 && pos < PAGE_SIZE; fun++) {
  58.             if (!PCI_FUNC(fun)) /* first function */
  59.                 pcibios_read_config_byte(bus,fun,PCI_HEADER_TYPE,&headertype);
  60.             else if (!(headertype&0x80))
  61.                 continue;
  62.             pcibios_read_config_dword(bus,fun,PCI_VENDOR_ID, &id);
  63.             if (!id || id==~0) {
  64.                 headertype=0; continue;
  65.             }
  66.             /* Ok, we've found a device, copy its cfg space to the buffer*/
  67.             for (i=0; i<256; i+=4, pos+=4)
  68.                 pcibios_read_config_dword(bus,fun,i,(u32 *)(buf+pos));
  69.         }
  70.     }
  71.     return pos;
  72. }
  73. struct proc_dir_entry pcimod_proc_entry = {
  74.         0,                 /* low_ino: the inode -- dynamic */
  75.         7, "pcidata",      /* len of name and name */
  76.         S_IFREG | S_IRUGO, /* mode */
  77.         1, 0, 0,           /* nlinks, owner, group */
  78.         0, NULL,           /* size - unused; operations -- use default */
  79.         &pcimod_read_proc,   /* function used to read data */
  80.         /* nothing more */
  81.     };
  82. int init_module(void)
  83. {
  84.     proc_register_dynamic(&proc_root, &pcimod_proc_entry);
  85.     return 0;
  86. }
  87. void cleanup_module(void)
  88. {
  89.     proc_unregister(&proc_root, pcimod_proc_entry.low_ino);
  90.     return;
  91. }