release/src-rt-6.x.4708/linux/linux-2.6.36/arch/microblaze/pci/pci_32.c

   1 /*
   2  * Common pmac/prep/chrp pci routines. -- Cort
   3  */
   4
   5 #include <linux/kernel.h>
   6 #include <linux/pci.h>
   7 #include <linux/delay.h>
   8 #include <linux/string.h>
   9 #include <linux/init.h>
  10 #include <linux/capability.h>
  11 #include <linux/sched.h>
  12 #include <linux/errno.h>
  13 #include <linux/bootmem.h>
  14 #include <linux/irq.h>
  15 #include <linux/list.h>
  16 #include <linux/of.h>
  17 #include <linux/slab.h>
  18
  19 #include <asm/processor.h>
  20 #include <asm/io.h>
  21 #include <asm/prom.h>
  22 #include <asm/sections.h>
  23 #include <asm/pci-bridge.h>
  24 #include <asm/byteorder.h>
  25 #include <asm/uaccess.h>
  26
  27 #undef DEBUG
  28
  29 unsigned long isa_io_base;
  30 unsigned long pci_dram_offset;
  31 int pcibios_assign_bus_offset = 1;
  32
  33 static u8 *pci_to_OF_bus_map;
  34
  35 /* By default, we don't re-assign bus numbers. We do this only on
  36  * some pmacs
  37  */
  38 static int pci_assign_all_buses;
  39
  40 static int pci_bus_count;
  41
  42 /*
  43  * Functions below are used on OpenFirmware machines.
  44  */
  45 static void
  46 make_one_node_map(struct device_node *node, u8 pci_bus)
  47 {
  48         const int *bus_range;
  49         int len;
  50
  51         if (pci_bus >= pci_bus_count)
  52                 return;
  53         bus_range = of_get_property(node, "bus-range", &len);
  54         if (bus_range == NULL || len < 2 * sizeof(int)) {
  55                 printk(KERN_WARNING "Can't get bus-range for %s, "
  56                        "assuming it starts at 0\n", node->full_name);
  57                 pci_to_OF_bus_map[pci_bus] = 0;
  58         } else
  59                 pci_to_OF_bus_map[pci_bus] = bus_range[0];
  60
  61         for_each_child_of_node(node, node) {
  62                 struct pci_dev *dev;
  63                 const unsigned int *class_code, *reg;
  64
  65                 class_code = of_get_property(node, "class-code", NULL);
  66                 if (!class_code ||
  67                         ((*class_code >> 8) != PCI_CLASS_BRIDGE_PCI &&
  68                         (*class_code >> 8) != PCI_CLASS_BRIDGE_CARDBUS))
  69                         continue;
  70                 reg = of_get_property(node, "reg", NULL);
  71                 if (!reg)
  72                         continue;
  73                 dev = pci_get_bus_and_slot(pci_bus, ((reg[0] >> 8) & 0xff));
  74                 if (!dev || !dev->subordinate) {
  75                         pci_dev_put(dev);
  76                         continue;
  77                 }
  78                 make_one_node_map(node, dev->subordinate->number);
  79                 pci_dev_put(dev);
  80         }
  81 }
  82
  83 void
  84 pcibios_make_OF_bus_map(void)
  85 {
  86         int i;
  87         struct pci_controller *hose, *tmp;
  88         struct property *map_prop;
  89         struct device_node *dn;
  90
  91         pci_to_OF_bus_map = kmalloc(pci_bus_count, GFP_KERNEL);
  92         if (!pci_to_OF_bus_map) {
  93                 printk(KERN_ERR "Can't allocate OF bus map !\n");
  94                 return;
  95         }
  96
  97         /* We fill the bus map with invalid values, that helps
  98          * debugging.
  99          */
 100         for (i = 0; i < pci_bus_count; i++)
 101                 pci_to_OF_bus_map[i] = 0xff;
 102
 103         /* For each hose, we begin searching bridges */
 104         list_for_each_entry_safe(hose, tmp, &hose_list, list_node) {
 105                 struct device_node *node = hose->dn;
 106
 107                 if (!node)
 108                         continue;
 109                 make_one_node_map(node, hose->first_busno);
 110         }
 111         dn = of_find_node_by_path("/");
 112         map_prop = of_find_property(dn, "pci-OF-bus-map", NULL);
 113         if (map_prop) {
 114                 BUG_ON(pci_bus_count > map_prop->length);
 115                 memcpy(map_prop->value, pci_to_OF_bus_map, pci_bus_count);
 116         }
 117         of_node_put(dn);
 118 #ifdef DEBUG
 119         printk(KERN_INFO "PCI->OF bus map:\n");
 120         for (i = 0; i < pci_bus_count; i++) {
 121                 if (pci_to_OF_bus_map[i] == 0xff)
 122                         continue;
 123                 printk(KERN_INFO "%d -> %d\n", i, pci_to_OF_bus_map[i]);
 124         }
 125 #endif
 126 }
 127
 128 typedef int (*pci_OF_scan_iterator)(struct device_node *node, void *data);
 129
 130 static struct device_node *scan_OF_pci_childs(struct device_node *parent,
 131                                         pci_OF_scan_iterator filter, void *data)
 132 {
 133         struct device_node *node;
 134         struct device_node *sub_node;
 135
 136         for_each_child_of_node(parent, node) {
 137                 const unsigned int *class_code;
 138
 139                 if (filter(node, data)) {
 140                         of_node_put(node);
 141                         return node;
 142                 }
 143
 144                 /* For PCI<->PCI bridges or CardBus bridges, we go down
 145                  * Note: some OFs create a parent node "multifunc-device" as
 146                  * a fake root for all functions of a multi-function device,
 147                  * we go down them as well.
 148                  */
 149                 class_code = of_get_property(node, "class-code", NULL);
 150                 if ((!class_code ||
 151                         ((*class_code >> 8) != PCI_CLASS_BRIDGE_PCI &&
 152                         (*class_code >> 8) != PCI_CLASS_BRIDGE_CARDBUS)) &&
 153                         strcmp(node->name, "multifunc-device"))
 154                         continue;
 155                 sub_node = scan_OF_pci_childs(node, filter, data);
 156                 if (sub_node) {
 157                         of_node_put(node);
 158                         return sub_node;
 159                 }
 160         }
 161         return NULL;
 162 }
 163
 164 static struct device_node *scan_OF_for_pci_dev(struct device_node *parent,
 165                                                unsigned int devfn)
 166 {
 167         struct device_node *np, *cnp;
 168         const u32 *reg;
 169         unsigned int psize;
 170
 171         for_each_child_of_node(parent, np) {
 172                 reg = of_get_property(np, "reg", &psize);
 173                 if (reg && psize >= 4 && ((reg[0] >> 8) & 0xff) == devfn)
 174                         return np;
 175
 176                 /* Note: some OFs create a parent node "multifunc-device" as
 177                  * a fake root for all functions of a multi-function device,
 178                  * we go down them as well. */
 179                 if (!strcmp(np->name, "multifunc-device")) {
 180                         cnp = scan_OF_for_pci_dev(np, devfn);
 181                         if (cnp)
 182                                 return cnp;
 183                 }
 184         }
 185         return NULL;
 186 }
 187
 188
 189 static struct device_node *scan_OF_for_pci_bus(struct pci_bus *bus)
 190 {
 191         struct device_node *parent, *np;
 192
 193         /* Are we a root bus ? */
 194         if (bus->self == NULL || bus->parent == NULL) {
 195                 struct pci_controller *hose = pci_bus_to_host(bus);
 196                 if (hose == NULL)
 197                         return NULL;
 198                 return of_node_get(hose->dn);
 199         }
 200
 201         /* not a root bus, we need to get our parent */
 202         parent = scan_OF_for_pci_bus(bus->parent);
 203         if (parent == NULL)
 204                 return NULL;
 205
 206         /* now iterate for children for a match */
 207         np = scan_OF_for_pci_dev(parent, bus->self->devfn);
 208         of_node_put(parent);
 209
 210         return np;
 211 }
 212
 213 /*
 214  * Scans the OF tree for a device node matching a PCI device
 215  */
 216 struct device_node *
 217 pci_busdev_to_OF_node(struct pci_bus *bus, int devfn)
 218 {
 219         struct device_node *parent, *np;
 220
 221         pr_debug("pci_busdev_to_OF_node(%d,0x%x)\n", bus->number, devfn);
 222         parent = scan_OF_for_pci_bus(bus);
 223         if (parent == NULL)
 224                 return NULL;
 225         pr_debug(" parent is %s\n", parent ? parent->full_name : "<NULL>");
 226         np = scan_OF_for_pci_dev(parent, devfn);
 227         of_node_put(parent);
 228         pr_debug(" result is %s\n", np ? np->full_name : "<NULL>");
 229
 230         return np;
 231 }
 232 EXPORT_SYMBOL(pci_busdev_to_OF_node);
 233
 234 struct device_node*
 235 pci_device_to_OF_node(struct pci_dev *dev)
 236 {
 237         return pci_busdev_to_OF_node(dev->bus, dev->devfn);
 238 }
 239 EXPORT_SYMBOL(pci_device_to_OF_node);
 240
 241 static int
 242 find_OF_pci_device_filter(struct device_node *node, void *data)
 243 {
 244         return ((void *)node == data);
 245 }
 246
 247 /*
 248  * Returns the PCI device matching a given OF node
 249  */
 250 int
 251 pci_device_from_OF_node(struct device_node *node, u8 *bus, u8 *devfn)
 252 {
 253         const unsigned int *reg;
 254         struct pci_controller *hose;
 255         struct pci_dev *dev = NULL;
 256
 257         /* Make sure it's really a PCI device */
 258         hose = pci_find_hose_for_OF_device(node);
 259         if (!hose || !hose->dn)
 260                 return -ENODEV;
 261         if (!scan_OF_pci_childs(hose->dn,
 262                         find_OF_pci_device_filter, (void *)node))
 263                 return -ENODEV;
 264         reg = of_get_property(node, "reg", NULL);
 265         if (!reg)
 266                 return -ENODEV;
 267         *bus = (reg[0] >> 16) & 0xff;
 268         *devfn = ((reg[0] >> 8) & 0xff);
 269
 270         /* Ok, here we need some tweak. If we have already renumbered
 271          * all busses, we can't rely on the OF bus number any more.
 272          * the pci_to_OF_bus_map is not enough as several PCI busses
 273          * may match the same OF bus number.
 274          */
 275         if (!pci_to_OF_bus_map)
 276                 return 0;
 277
 278         for_each_pci_dev(dev)
 279                 if (pci_to_OF_bus_map[dev->bus->number] == *bus &&
 280                                 dev->devfn == *devfn) {
 281                         *bus = dev->bus->number;
 282                         pci_dev_put(dev);
 283                         return 0;
 284                 }
 285
 286         return -ENODEV;
 287 }
 288 EXPORT_SYMBOL(pci_device_from_OF_node);
 289
 290 /* We create the "pci-OF-bus-map" property now so it appears in the
 291  * /proc device tree
 292  */
 293 void __init
 294 pci_create_OF_bus_map(void)
 295 {
 296         struct property *of_prop;
 297         struct device_node *dn;
 298
 299         of_prop = (struct property *) alloc_bootmem(sizeof(struct property) + \
 300                                                                          256);
 301         if (!of_prop)
 302                 return;
 303         dn = of_find_node_by_path("/");
 304         if (dn) {
 305                 memset(of_prop, -1, sizeof(struct property) + 256);
 306                 of_prop->name = "pci-OF-bus-map";
 307                 of_prop->length = 256;
 308                 of_prop->value = &of_prop[1];
 309                 prom_add_property(dn, of_prop);
 310                 of_node_put(dn);
 311         }
 312 }
 313
 314 static void __devinit pcibios_scan_phb(struct pci_controller *hose)
 315 {
 316         struct pci_bus *bus;
 317         struct device_node *node = hose->dn;
 318         unsigned long io_offset;
 319         struct resource *res = &hose->io_resource;
 320
 321         pr_debug("PCI: Scanning PHB %s\n",
 322                  node ? node->full_name : "<NO NAME>");
 323
 324         /* Create an empty bus for the toplevel */
 325         bus = pci_create_bus(hose->parent, hose->first_busno, hose->ops, hose);
 326         if (bus == NULL) {
 327                 printk(KERN_ERR "Failed to create bus for PCI domain %04x\n",
 328                        hose->global_number);
 329                 return;
 330         }
 331         bus->secondary = hose->first_busno;
 332         hose->bus = bus;
 333
 334         /* Fixup IO space offset */
 335         io_offset = (unsigned long)hose->io_base_virt - isa_io_base;
 336         res->start = (res->start + io_offset) & 0xffffffffu;
 337         res->end = (res->end + io_offset) & 0xffffffffu;
 338
 339         /* Wire up PHB bus resources */
 340         pcibios_setup_phb_resources(hose);
 341
 342         /* Scan children */
 343         hose->last_busno = bus->subordinate = pci_scan_child_bus(bus);
 344 }
 345
 346 static int __init pcibios_init(void)
 347 {
 348         struct pci_controller *hose, *tmp;
 349         int next_busno = 0;
 350
 351         printk(KERN_INFO "PCI: Probing PCI hardware\n");
 352
 353         if (pci_flags & PCI_REASSIGN_ALL_BUS) {
 354                 printk(KERN_INFO "setting pci_asign_all_busses\n");
 355                 pci_assign_all_buses = 1;
 356         }
 357
 358         /* Scan all of the recorded PCI controllers.  */
 359         list_for_each_entry_safe(hose, tmp, &hose_list, list_node) {
 360                 if (pci_assign_all_buses)
 361                         hose->first_busno = next_busno;
 362                 hose->last_busno = 0xff;
 363                 pcibios_scan_phb(hose);
 364                 printk(KERN_INFO "calling pci_bus_add_devices()\n");
 365                 pci_bus_add_devices(hose->bus);
 366                 if (pci_assign_all_buses || next_busno <= hose->last_busno)
 367                         next_busno = hose->last_busno + \
 368                                         pcibios_assign_bus_offset;
 369         }
 370         pci_bus_count = next_busno;
 371
 372         /* OpenFirmware based machines need a map of OF bus
 373          * numbers vs. kernel bus numbers since we may have to
 374          * remap them.
 375          */
 376         if (pci_assign_all_buses)
 377                 pcibios_make_OF_bus_map();
 378
 379         /* Call common code to handle resource allocation */
 380         pcibios_resource_survey();
 381
 382         return 0;
 383 }
 384
 385 subsys_initcall(pcibios_init);
 386
 387 static struct pci_controller*
 388 pci_bus_to_hose(int bus)
 389 {
 390         struct pci_controller *hose, *tmp;
 391
 392         list_for_each_entry_safe(hose, tmp, &hose_list, list_node)
 393                 if (bus >= hose->first_busno && bus <= hose->last_busno)
 394                         return hose;
 395         return NULL;
 396 }
 397
 398 /* Provide information on locations of various I/O regions in physical
 399  * memory.  Do this on a per-card basis so that we choose the right
 400  * root bridge.
 401  * Note that the returned IO or memory base is a physical address
 402  */
 403
 404 long sys_pciconfig_iobase(long which, unsigned long bus, unsigned long devfn)
 405 {
 406         struct pci_controller *hose;
 407         long result = -EOPNOTSUPP;
 408
 409         hose = pci_bus_to_hose(bus);
 410         if (!hose)
 411                 return -ENODEV;
 412
 413         switch (which) {
 414         case IOBASE_BRIDGE_NUMBER:
 415                 return (long)hose->first_busno;
 416         case IOBASE_MEMORY:
 417                 return (long)hose->pci_mem_offset;
 418         case IOBASE_IO:
 419                 return (long)hose->io_base_phys;
 420         case IOBASE_ISA_IO:
 421                 return (long)isa_io_base;
 422         case IOBASE_ISA_MEM:
 423                 return (long)isa_mem_base;
 424         }
 425
 426         return result;
 427 }