arch/mips/lemote/lm2e/mipsdha.c

   1 /*
   2  * Copyright (C) 2007 Lemote, Inc. & Institute of Computing Technology
   3  * Author: Fuxin Zhang, zhangfx@lemote.com
   4  *
   5  *  This program is free software; you can redistribute  it and/or modify it
   6  *  under  the terms of  the GNU General  Public License as published by the
   7  *  Free Software Foundation;  either version 2 of the  License, or (at your
   8  *  option) any later version.
   9  *
  10  *  THIS  SOFTWARE  IS PROVIDED   ``AS  IS'' AND   ANY  EXPRESS OR IMPLIED
  11  *  WARRANTIES,   INCLUDING, BUT NOT  LIMITED  TO, THE IMPLIED WARRANTIES OF
  12  *  MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.  IN
  13  *  NO  EVENT  SHALL   THE AUTHOR  BE    LIABLE FOR ANY   DIRECT, INDIRECT,
  14  *  INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  15  *  NOT LIMITED   TO, PROCUREMENT OF  SUBSTITUTE GOODS  OR SERVICES; LOSS OF
  16  *  USE, DATA,  OR PROFITS; OR  BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
  17  *  ANY THEORY OF LIABILITY, WHETHER IN  CONTRACT, STRICT LIABILITY, OR TORT
  18  *  (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  19  *  THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  20  *
  21  *  You should have received a copy of the  GNU General Public License along
  22  *  with this program; if not, write  to the Free Software Foundation, Inc.,
  23  *  675 Mass Ave, Cambridge, MA 02139, USA.
  24  *
  25  */
  26 #include <linux/kernel.h>
  27 #include <linux/module.h>
  28 #include <linux/errno.h>
  29 #include <linux/mm.h>
  30 #include <linux/pci.h>
  31 #include <linux/init.h>
  32 #include <linux/proc_fs.h>
  33 #include <asm/uaccess.h>
  34 #include <asm/io.h>
  35
  36 static ssize_t mipsdha_proc_read(struct file *file, char *buf, size_t len, loff_t *ppos);
  37
  38 static ssize_t mipsdha_proc_write(struct file *file, const char *buf, size_t len, loff_t *ppos);
  39
  40
  41 static struct proc_dir_entry *mipsdha_proc_entry;
  42
  43 #define INFO_SIZE 4096
  44 static char info_buf[INFO_SIZE];
  45
  46 static struct file_operations mipsdha_fops =
  47 {
  48     owner:      THIS_MODULE,
  49     read:       mipsdha_proc_read,
  50     write:      mipsdha_proc_write,
  51 };
  52
  53 static enum {CMD_ERR, CMD_GIB, CMD_GPI} cmd;
  54
  55 typedef struct pciinfo_s
  56 {
  57   int           bus,card,func;
  58   unsigned short command;
  59   unsigned short vendor,device;
  60   unsigned      base0,base1,base2,baserom;
  61 } pciinfo_t;
  62
  63
  64 extern struct proc_dir_entry proc_root;
  65
  66 static int __init mipsdha_proc_init(void)
  67 {
  68         mipsdha_proc_entry = create_proc_entry("mipsdha", S_IWUSR | S_IRUGO, &proc_root);
  69         if (mipsdha_proc_entry == NULL) {
  70                 printk("MIPSDHA: register /proc/mipsdha failed!\n");
  71                 return 0;
  72         }
  73
  74         mipsdha_proc_entry->proc_fops = &mipsdha_fops;
  75
  76         cmd=CMD_ERR;
  77         return 0;
  78 }
  79
  80 static ssize_t mipsdha_proc_write (struct file *file, const char *buf, size_t len, loff_t *ppos)
  81 {
  82         char cmd_gib[]="GET IO BASE";
  83         char cmd_gpi[]="GET PCI INFO";
  84
  85         if (len >= INFO_SIZE) return -ENOMEM;
  86
  87         if (copy_from_user(info_buf, buf, len)) return -EFAULT;
  88         info_buf[len] = '\0';
  89
  90         if (strncmp(info_buf, cmd_gib, sizeof(cmd_gib)-1)==0) {
  91                 cmd = CMD_GIB;
  92                 return len;
  93         } else if (strncmp(info_buf, cmd_gpi, sizeof(cmd_gpi)-1)==0) {
  94                 cmd = CMD_GPI;
  95                 return len;
  96         } else {
  97                 return -EINVAL;
  98         }
  99 }
 100
 101 static ssize_t mipsdha_proc_read (struct file *file, char *buf, size_t len, loff_t *ppos)
 102 {
 103         int info_cnt;
 104         pciinfo_t *pciinfo;
 105         struct pci_dev *dev = NULL;
 106
 107         switch (cmd) {
 108                 default:
 109                         printk("MIPSDHA: BUG found in function %s!(cmd=%d)\n",
 110                                         __FUNCTION__, cmd);
 111                         return -EINVAL;
 112
 113
 114                 case CMD_ERR:
 115                         return -EINVAL;
 116
 117
 118                 case CMD_GIB:
 119                         *(unsigned long *)info_buf =
 120                                 virt_to_phys((void *) mips_io_port_base);
 121                         info_cnt=sizeof(unsigned long);
 122                         break;
 123
 124
 125                 case CMD_GPI:
 126                         pciinfo = (pciinfo_t *) info_buf;
 127                         info_cnt = 0;
 128                         for_each_pci_dev(dev) {
 129
 130                                 if (info_cnt+sizeof(pciinfo_t)>INFO_SIZE) return -ENOMEM;
 131
 132                                 pciinfo->bus = dev->bus->number;
 133                                 pciinfo->card = PCI_SLOT(dev->devfn);
 134                                 pciinfo->func = PCI_FUNC(dev->devfn);
 135
 136                                 if (pci_read_config_word(dev, PCI_COMMAND, &pciinfo->command)
 137                                                 != PCIBIOS_SUCCESSFUL) {
 138                                         printk("MIPSDHA: BUG found in function %s!\n",
 139                                                         __FUNCTION__);
 140                                         pciinfo->command=0;
 141                                 }
 142
 143                                 pciinfo->vendor = dev->vendor;
 144                                 pciinfo->device = dev->device;
 145
 146                                 pciinfo->base0 = (dev->resource[0]).start;
 147                                 pciinfo->base1 = (dev->resource[1]).start;
 148                                 pciinfo->base2 = (dev->resource[2]).start;
 149                                 pciinfo->baserom = (dev->resource[PCI_ROM_RESOURCE]).start;
 150
 151                                 pciinfo++;
 152                                 info_cnt += sizeof(pciinfo_t);
 153                         }
 154                         break;
 155         }
 156
 157         if (len < info_cnt) return -ENOMEM;
 158         if (copy_to_user(buf, info_buf, info_cnt)) return -EFAULT;
 159
 160         return info_cnt;
 161 }
 162
 163 __initcall(mipsdha_proc_init);