target/linux/adm5120-2.6/files/arch/mips/pci/fixup-adm5120.c

   1 /*
   2  *  $Id$
   3  *
   4  *  ADM5120 specific PCI fixups
   5  *
   6  *  Copyright (C) ADMtek Incorporated.
   7  *  Copyright (C) 2005 Jeroen Vreeken (pe1rxq@amsat.org)
   8  *  Copyright (C) 2007 Gabor Juhos <juhosg@freemail.hu>
   9  *  Copyright (C) 2007 OpenWrt.org
  10  *
  11  *  This program is free software; you can redistribute it and/or
  12  *  modify it under the terms of the GNU General Public License
  13  *  as published by the Free Software Foundation; either version 2
  14  *  of the License, or (at your option) any later version.
  15  *
  16  *  This program is distributed in the hope that it will be useful,
  17  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  18  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  19  *  GNU General Public License for more details.
  20  *
  21  *  You should have received a copy of the GNU General Public License
  22  *  along with this program; if not, write to the
  23  *  Free Software Foundation, Inc., 51 Franklin Street, Fifth Floor,
  24  *  Boston, MA  02110-1301, USA.
  25  *
  26  */
  27
  28 #include <linux/types.h>
  29 #include <linux/kernel.h>
  30 #include <linux/init.h>
  31 #include <linux/pci.h>
  32 #include <linux/pci_ids.h>
  33 #include <linux/pci_regs.h>
  34
  35 #include <asm/delay.h>
  36 #include <asm/bootinfo.h>
  37
  38 #include <asm/mach-adm5120/adm5120_info.h>
  39 #include <asm/mach-adm5120/adm5120_defs.h>
  40 #include <asm/mach-adm5120/adm5120_irq.h>
  41
  42 struct adm5120_pci_irq {
  43         u8      slot;
  44         u8      func;
  45         u8      pin;
  46         unsigned irq;
  47 };
  48
  49 #define PCIIRQ(s,f,p,i) {       \
  50         .slot = (s),            \
  51         .func = (f),            \
  52         .pin  = (p),            \
  53         .irq  = (i)             \
  54         }
  55
  56 static struct adm5120_pci_irq default_pci_irqs[] __initdata = {
  57         PCIIRQ(2, 0, 1, ADM5120_IRQ_PCI0),
  58 };
  59
  60 static struct adm5120_pci_irq rb1xx_pci_irqs[] __initdata = {
  61         PCIIRQ(1, 0, 1, ADM5120_IRQ_PCI0),
  62         PCIIRQ(2, 0, 1, ADM5120_IRQ_PCI1),
  63         PCIIRQ(3, 0, 1, ADM5120_IRQ_PCI2)
  64 };
  65
  66 static struct adm5120_pci_irq cas771_pci_irqs[] __initdata = {
  67         PCIIRQ(2, 0, 1, ADM5120_IRQ_PCI0),
  68         PCIIRQ(3, 0, 1, ADM5120_IRQ_PCI1),
  69         PCIIRQ(3, 2, 3, ADM5120_IRQ_PCI2)
  70 };
  71
  72 static struct adm5120_pci_irq np28g_pci_irqs[] __initdata = {
  73         PCIIRQ(2, 0, 1, ADM5120_IRQ_PCI0),
  74         PCIIRQ(3, 0, 1, ADM5120_IRQ_PCI0),
  75         PCIIRQ(3, 1, 2, ADM5120_IRQ_PCI1),
  76         PCIIRQ(3, 2, 3, ADM5120_IRQ_PCI2)
  77 };
  78
  79 #define GETMAP(n) do {                          \
  80                 nr_irqs = ARRAY_SIZE(n ## _pci_irqs);   \
  81                 p = n ## _pci_irqs;                     \
  82         } while (0)
  83
  84 int __init pcibios_map_irq(struct pci_dev *dev, u8 slot, u8 pin)
  85 {
  86         struct adm5120_pci_irq  *p;
  87         int nr_irqs;
  88         int i;
  89         int irq;
  90
  91         irq = -1;
  92         if (slot < 1 || slot > 3) {
  93                 printk(KERN_ALERT "PCI: slot number %u is not supported\n",
  94                         slot);
  95                 goto out;
  96         }
  97
  98         GETMAP(default);
  99
 100         switch (mips_machtype) {
 101         case MACH_ADM5120_RB_111:
 102         case MACH_ADM5120_RB_112:
 103         case MACH_ADM5120_RB_133:
 104         case MACH_ADM5120_RB_133C:
 105         case MACH_ADM5120_RB_153:
 106                 GETMAP(rb1xx);
 107                 break;
 108         case MACH_ADM5120_NP28G:
 109                 GETMAP(np28g);
 110                 break;
 111         case MACH_ADM5120_P335:
 112         case MACH_ADM5120_P334WT:
 113                 /* using default mapping */
 114                 break;
 115         case MACH_ADM5120_CAS771:
 116                 GETMAP(cas771);
 117                 break;
 118
 119         case MACH_ADM5120_NP27G:
 120         case MACH_ADM5120_NP28GHS:
 121         case MACH_ADM5120_WP54AG:
 122         case MACH_ADM5120_WP54G:
 123         case MACH_ADM5120_WP54G_WRT:
 124         case MACH_ADM5120_WPP54AG:
 125         case MACH_ADM5120_WPP54G:
 126         default:
 127                 printk(KERN_ALERT "PCI: irq map is unknown, using defaults.\n");
 128                 break;
 129         }
 130
 131         for (i=0; i<nr_irqs; i++, p++) {
 132                 if ((p->slot == slot) && (PCI_FUNC(dev->devfn) == p->func) &&
 133                     (p->pin == pin)) {
 134                         irq = p->irq;
 135                         break;
 136                 }
 137         }
 138
 139         if (irq < 0) {
 140                 printk(KERN_ALERT "PCI: no irq found for %s pin:%u\n",
 141                         pci_name(dev), pin);
 142         } else {
 143                 printk(KERN_INFO "PCI: mapping irq for %s pin:%u, irq:%d\n",
 144                         pci_name(dev), pin, irq);
 145         }
 146
 147 out:
 148         return irq;
 149 }
 150
 151 static void adm5120_pci_fixup(struct pci_dev *dev)
 152 {
 153         if (dev->devfn != 0)
 154                 return;
 155
 156         /* setup COMMAND register */
 157         pci_write_config_word(dev, PCI_COMMAND,
 158                 (PCI_COMMAND_IO | PCI_COMMAND_MEMORY | PCI_COMMAND_MASTER));
 159
 160         /* setup CACHE_LINE_SIZE register */
 161         pci_write_config_byte(dev, PCI_CACHE_LINE_SIZE, 4);
 162
 163         /* setting up BARS */
 164         pci_write_config_dword(dev, PCI_BASE_ADDRESS_0, 0);
 165         pci_write_config_dword(dev, PCI_BASE_ADDRESS_1, 0);
 166 }
 167
 168 DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_ADMTEK, PCI_DEVICE_ID_ADMTEK_ADM5120,
 169         adm5120_pci_fixup);
 170
 171 int pcibios_plat_dev_init(struct pci_dev *dev)
 172 {
 173         return 0;
 174 }
 175