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/autoconf.h>
  29 #include <linux/types.h>
  30 #include <linux/kernel.h>
  31 #include <linux/init.h>
  32 #include <linux/pci.h>
  33 #include <linux/pci_ids.h>
  34 #include <linux/pci_regs.h>
  35
  36 #include <asm/delay.h>
  37 #include <asm/bootinfo.h>
  38
  39 #include <asm/mach-adm5120/adm5120_info.h>
  40 #include <asm/mach-adm5120/adm5120_defs.h>
  41 #include <asm/mach-adm5120/adm5120_irq.h>
  42
  43 struct adm5120_pci_irq {
  44         u8      slot;
  45         u8      func;
  46         u8      pin;
  47         unsigned irq;
  48 };
  49
  50 #define PCIIRQ(s,f,p,i) {       \
  51         .slot = (s),            \
  52         .func = (f),            \
  53         .pin  = (p),            \
  54         .irq  = (i)             \
  55         }
  56
  57 static struct adm5120_pci_irq default_pci_irqs[] __initdata = {
  58         PCIIRQ(2, 0, 1, ADM5120_IRQ_PCI0),
  59 };
  60
  61 static struct adm5120_pci_irq rb1xx_pci_irqs[] __initdata = {
  62         PCIIRQ(1, 0, 1, ADM5120_IRQ_PCI0),
  63         PCIIRQ(2, 0, 1, ADM5120_IRQ_PCI1),
  64         PCIIRQ(3, 0, 1, ADM5120_IRQ_PCI2)
  65 };
  66
  67 static struct adm5120_pci_irq cas771_pci_irqs[] __initdata = {
  68         PCIIRQ(2, 0, 1, ADM5120_IRQ_PCI0),
  69         PCIIRQ(3, 0, 1, ADM5120_IRQ_PCI1),
  70         PCIIRQ(3, 2, 3, ADM5120_IRQ_PCI2)
  71 };
  72
  73 static struct adm5120_pci_irq np28g_pci_irqs[] __initdata = {
  74         PCIIRQ(2, 0, 1, ADM5120_IRQ_PCI0),
  75         PCIIRQ(3, 0, 1, ADM5120_IRQ_PCI0),
  76         PCIIRQ(3, 1, 2, ADM5120_IRQ_PCI1),
  77         PCIIRQ(3, 2, 3, ADM5120_IRQ_PCI2)
  78 };
  79
  80 #define GETMAP(n) do {                          \
  81                 nr_irqs = ARRAY_SIZE(n ## _pci_irqs);   \
  82                 p = n ## _pci_irqs;                     \
  83         } while (0)
  84
  85 int __init pcibios_map_irq(struct pci_dev *dev, u8 slot, u8 pin)
  86 {
  87         struct adm5120_pci_irq  *p;
  88         int nr_irqs;
  89         int i;
  90         int irq;
  91
  92         irq = -1;
  93         if (slot < 1 || slot > 3) {
  94                 printk("PCI: slot number %u is not supported\n", 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 #if 0
 116         case MACH_ADM5120_CAS771:
 117                 GETMAP(cas771)
 118                 break;
 119         case MACH_ADM5120_CAS630:
 120         case MACH_ADM5120_CAS670:
 121         case MACH_ADM5120_CAS700:
 122         case MACH_ADM5120_CAS790:
 123         case MACH_ADM5120_CAS861:
 124 #endif
 125         case MACH_ADM5120_NP27G:
 126         case MACH_ADM5120_NP28GHS:
 127         case MACH_ADM5120_WP54AG:
 128         case MACH_ADM5120_WP54G:
 129         case MACH_ADM5120_WP54G_WRT:
 130         case MACH_ADM5120_WPP54AG:
 131         case MACH_ADM5120_WPP54G:
 132         default:
 133                 printk("PCI: irq map is unknown for %s, using defaults.\n",
 134                         adm5120_board_name());
 135                 break;
 136         }
 137
 138         for (i=0; i<nr_irqs; i++, p++) {
 139                 if ((p->slot == slot) && (PCI_FUNC(dev->devfn) == p->func) &&
 140                     (p->pin == pin)) {
 141                         irq = p->irq;
 142                         break;
 143                 }
 144         }
 145
 146         if (irq < 0) {
 147                 printk(KERN_INFO "PCI: no irq found for %s pin:%u\n",
 148                         pci_name(dev), pin);
 149         } else {
 150                 printk(KERN_INFO "PCI: mapping irq for %s pin:%u, irq:%d\n",
 151                         pci_name(dev), pin, irq);
 152         }
 153
 154 out:
 155         return irq;
 156 }
 157
 158 static void adm5120_pci_fixup(struct pci_dev *dev)
 159 {
 160         if (dev->devfn != 0)
 161                 return;
 162
 163         /* setup COMMAND register */
 164         pci_write_config_word(dev, PCI_COMMAND,
 165                 (PCI_COMMAND_IO | PCI_COMMAND_MEMORY | PCI_COMMAND_MASTER));
 166
 167         /* setup CACHE_LINE_SIZE register */
 168         pci_write_config_byte(dev, PCI_CACHE_LINE_SIZE, 4);
 169
 170         /* setting up BARS */
 171         pci_write_config_dword(dev, PCI_BASE_ADDRESS_0, 0);
 172         pci_write_config_dword(dev, PCI_BASE_ADDRESS_1, 0);
 173 }
 174
 175 DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_ADMTEK, PCI_DEVICE_ID_ADMTEK_ADM5120,
 176         adm5120_pci_fixup);
 177
 178 int pcibios_plat_dev_init(struct pci_dev *dev)
 179 {
 180         return 0;
 181 }
 182