ia64/linux-2.6.18-xen.hg

annotate drivers/pci/setup-res.c @ 0:831230e53067

Import 2.6.18 from kernel.org tarball.
author Ian Campbell <ian.campbell@xensource.com>
date Wed Apr 11 14:15:44 2007 +0100 (2007-04-11)
parents
children 2b5cc22ab406
rev   line source
ian@0 1 /*
ian@0 2 * drivers/pci/setup-res.c
ian@0 3 *
ian@0 4 * Extruded from code written by
ian@0 5 * Dave Rusling (david.rusling@reo.mts.dec.com)
ian@0 6 * David Mosberger (davidm@cs.arizona.edu)
ian@0 7 * David Miller (davem@redhat.com)
ian@0 8 *
ian@0 9 * Support routines for initializing a PCI subsystem.
ian@0 10 */
ian@0 11
ian@0 12 /* fixed for multiple pci buses, 1999 Andrea Arcangeli <andrea@suse.de> */
ian@0 13
ian@0 14 /*
ian@0 15 * Nov 2000, Ivan Kokshaysky <ink@jurassic.park.msu.ru>
ian@0 16 * Resource sorting
ian@0 17 */
ian@0 18
ian@0 19 #include <linux/init.h>
ian@0 20 #include <linux/kernel.h>
ian@0 21 #include <linux/pci.h>
ian@0 22 #include <linux/errno.h>
ian@0 23 #include <linux/ioport.h>
ian@0 24 #include <linux/cache.h>
ian@0 25 #include <linux/slab.h>
ian@0 26 #include "pci.h"
ian@0 27
ian@0 28
ian@0 29 void
ian@0 30 pci_update_resource(struct pci_dev *dev, struct resource *res, int resno)
ian@0 31 {
ian@0 32 struct pci_bus_region region;
ian@0 33 u32 new, check, mask;
ian@0 34 int reg;
ian@0 35
ian@0 36 /* Ignore resources for unimplemented BARs and unused resource slots
ian@0 37 for 64 bit BARs. */
ian@0 38 if (!res->flags)
ian@0 39 return;
ian@0 40
ian@0 41 pcibios_resource_to_bus(dev, &region, res);
ian@0 42
ian@0 43 pr_debug(" got res [%llx:%llx] bus [%lx:%lx] flags %lx for "
ian@0 44 "BAR %d of %s\n", (unsigned long long)res->start,
ian@0 45 (unsigned long long)res->end,
ian@0 46 region.start, region.end, res->flags, resno, pci_name(dev));
ian@0 47
ian@0 48 new = region.start | (res->flags & PCI_REGION_FLAG_MASK);
ian@0 49 if (res->flags & IORESOURCE_IO)
ian@0 50 mask = (u32)PCI_BASE_ADDRESS_IO_MASK;
ian@0 51 else
ian@0 52 mask = (u32)PCI_BASE_ADDRESS_MEM_MASK;
ian@0 53
ian@0 54 if (resno < 6) {
ian@0 55 reg = PCI_BASE_ADDRESS_0 + 4 * resno;
ian@0 56 } else if (resno == PCI_ROM_RESOURCE) {
ian@0 57 if (!(res->flags & IORESOURCE_ROM_ENABLE))
ian@0 58 return;
ian@0 59 new |= PCI_ROM_ADDRESS_ENABLE;
ian@0 60 reg = dev->rom_base_reg;
ian@0 61 } else {
ian@0 62 /* Hmm, non-standard resource. */
ian@0 63
ian@0 64 return; /* kill uninitialised var warning */
ian@0 65 }
ian@0 66
ian@0 67 pci_write_config_dword(dev, reg, new);
ian@0 68 pci_read_config_dword(dev, reg, &check);
ian@0 69
ian@0 70 if ((new ^ check) & mask) {
ian@0 71 printk(KERN_ERR "PCI: Error while updating region "
ian@0 72 "%s/%d (%08x != %08x)\n", pci_name(dev), resno,
ian@0 73 new, check);
ian@0 74 }
ian@0 75
ian@0 76 if ((new & (PCI_BASE_ADDRESS_SPACE|PCI_BASE_ADDRESS_MEM_TYPE_MASK)) ==
ian@0 77 (PCI_BASE_ADDRESS_SPACE_MEMORY|PCI_BASE_ADDRESS_MEM_TYPE_64)) {
ian@0 78 new = region.start >> 16 >> 16;
ian@0 79 pci_write_config_dword(dev, reg + 4, new);
ian@0 80 pci_read_config_dword(dev, reg + 4, &check);
ian@0 81 if (check != new) {
ian@0 82 printk(KERN_ERR "PCI: Error updating region "
ian@0 83 "%s/%d (high %08x != %08x)\n",
ian@0 84 pci_name(dev), resno, new, check);
ian@0 85 }
ian@0 86 }
ian@0 87 res->flags &= ~IORESOURCE_UNSET;
ian@0 88 pr_debug("PCI: moved device %s resource %d (%lx) to %x\n",
ian@0 89 pci_name(dev), resno, res->flags,
ian@0 90 new & ~PCI_REGION_FLAG_MASK);
ian@0 91 }
ian@0 92
ian@0 93 int __devinit
ian@0 94 pci_claim_resource(struct pci_dev *dev, int resource)
ian@0 95 {
ian@0 96 struct resource *res = &dev->resource[resource];
ian@0 97 struct resource *root = NULL;
ian@0 98 char *dtype = resource < PCI_BRIDGE_RESOURCES ? "device" : "bridge";
ian@0 99 int err;
ian@0 100
ian@0 101 root = pcibios_select_root(dev, res);
ian@0 102
ian@0 103 err = -EINVAL;
ian@0 104 if (root != NULL)
ian@0 105 err = insert_resource(root, res);
ian@0 106
ian@0 107 if (err) {
ian@0 108 printk(KERN_ERR "PCI: %s region %d of %s %s [%llx:%llx]\n",
ian@0 109 root ? "Address space collision on" :
ian@0 110 "No parent found for",
ian@0 111 resource, dtype, pci_name(dev),
ian@0 112 (unsigned long long)res->start,
ian@0 113 (unsigned long long)res->end);
ian@0 114 }
ian@0 115
ian@0 116 return err;
ian@0 117 }
ian@0 118 EXPORT_SYMBOL_GPL(pci_claim_resource);
ian@0 119
ian@0 120 int pci_assign_resource(struct pci_dev *dev, int resno)
ian@0 121 {
ian@0 122 struct pci_bus *bus = dev->bus;
ian@0 123 struct resource *res = dev->resource + resno;
ian@0 124 resource_size_t size, min, align;
ian@0 125 int ret;
ian@0 126
ian@0 127 size = res->end - res->start + 1;
ian@0 128 min = (res->flags & IORESOURCE_IO) ? PCIBIOS_MIN_IO : PCIBIOS_MIN_MEM;
ian@0 129 /* The bridge resources are special, as their
ian@0 130 size != alignment. Sizing routines return
ian@0 131 required alignment in the "start" field. */
ian@0 132 align = (resno < PCI_BRIDGE_RESOURCES) ? size : res->start;
ian@0 133
ian@0 134 /* First, try exact prefetching match.. */
ian@0 135 ret = pci_bus_alloc_resource(bus, res, size, align, min,
ian@0 136 IORESOURCE_PREFETCH,
ian@0 137 pcibios_align_resource, dev);
ian@0 138
ian@0 139 if (ret < 0 && (res->flags & IORESOURCE_PREFETCH)) {
ian@0 140 /*
ian@0 141 * That failed.
ian@0 142 *
ian@0 143 * But a prefetching area can handle a non-prefetching
ian@0 144 * window (it will just not perform as well).
ian@0 145 */
ian@0 146 ret = pci_bus_alloc_resource(bus, res, size, align, min, 0,
ian@0 147 pcibios_align_resource, dev);
ian@0 148 }
ian@0 149
ian@0 150 if (ret) {
ian@0 151 printk(KERN_ERR "PCI: Failed to allocate %s resource "
ian@0 152 "#%d:%llx@%llx for %s\n",
ian@0 153 res->flags & IORESOURCE_IO ? "I/O" : "mem",
ian@0 154 resno, (unsigned long long)size,
ian@0 155 (unsigned long long)res->start, pci_name(dev));
ian@0 156 } else if (resno < PCI_BRIDGE_RESOURCES) {
ian@0 157 pci_update_resource(dev, res, resno);
ian@0 158 }
ian@0 159
ian@0 160 return ret;
ian@0 161 }
ian@0 162
ian@0 163 #ifdef CONFIG_EMBEDDED
ian@0 164 int pci_assign_resource_fixed(struct pci_dev *dev, int resno)
ian@0 165 {
ian@0 166 struct pci_bus *bus = dev->bus;
ian@0 167 struct resource *res = dev->resource + resno;
ian@0 168 unsigned int type_mask;
ian@0 169 int i, ret = -EBUSY;
ian@0 170
ian@0 171 type_mask = IORESOURCE_IO | IORESOURCE_MEM | IORESOURCE_PREFETCH;
ian@0 172
ian@0 173 for (i = 0; i < PCI_BUS_NUM_RESOURCES; i++) {
ian@0 174 struct resource *r = bus->resource[i];
ian@0 175 if (!r)
ian@0 176 continue;
ian@0 177
ian@0 178 /* type_mask must match */
ian@0 179 if ((res->flags ^ r->flags) & type_mask)
ian@0 180 continue;
ian@0 181
ian@0 182 ret = request_resource(r, res);
ian@0 183
ian@0 184 if (ret == 0)
ian@0 185 break;
ian@0 186 }
ian@0 187
ian@0 188 if (ret) {
ian@0 189 printk(KERN_ERR "PCI: Failed to allocate %s resource "
ian@0 190 "#%d:%llx@%llx for %s\n",
ian@0 191 res->flags & IORESOURCE_IO ? "I/O" : "mem",
ian@0 192 resno, (unsigned long long)(res->end - res->start + 1),
ian@0 193 (unsigned long long)res->start, pci_name(dev));
ian@0 194 } else if (resno < PCI_BRIDGE_RESOURCES) {
ian@0 195 pci_update_resource(dev, res, resno);
ian@0 196 }
ian@0 197
ian@0 198 return ret;
ian@0 199 }
ian@0 200 EXPORT_SYMBOL_GPL(pci_assign_resource_fixed);
ian@0 201 #endif
ian@0 202
ian@0 203 /* Sort resources by alignment */
ian@0 204 void __devinit
ian@0 205 pdev_sort_resources(struct pci_dev *dev, struct resource_list *head)
ian@0 206 {
ian@0 207 int i;
ian@0 208
ian@0 209 for (i = 0; i < PCI_NUM_RESOURCES; i++) {
ian@0 210 struct resource *r;
ian@0 211 struct resource_list *list, *tmp;
ian@0 212 resource_size_t r_align;
ian@0 213
ian@0 214 r = &dev->resource[i];
ian@0 215 r_align = r->end - r->start;
ian@0 216
ian@0 217 if (!(r->flags) || r->parent)
ian@0 218 continue;
ian@0 219 if (!r_align) {
ian@0 220 printk(KERN_WARNING "PCI: Ignore bogus resource %d "
ian@0 221 "[%llx:%llx] of %s\n",
ian@0 222 i, (unsigned long long)r->start,
ian@0 223 (unsigned long long)r->end, pci_name(dev));
ian@0 224 continue;
ian@0 225 }
ian@0 226 r_align = (i < PCI_BRIDGE_RESOURCES) ? r_align + 1 : r->start;
ian@0 227 for (list = head; ; list = list->next) {
ian@0 228 resource_size_t align = 0;
ian@0 229 struct resource_list *ln = list->next;
ian@0 230 int idx;
ian@0 231
ian@0 232 if (ln) {
ian@0 233 idx = ln->res - &ln->dev->resource[0];
ian@0 234 align = (idx < PCI_BRIDGE_RESOURCES) ?
ian@0 235 ln->res->end - ln->res->start + 1 :
ian@0 236 ln->res->start;
ian@0 237 }
ian@0 238 if (r_align > align) {
ian@0 239 tmp = kmalloc(sizeof(*tmp), GFP_KERNEL);
ian@0 240 if (!tmp)
ian@0 241 panic("pdev_sort_resources(): "
ian@0 242 "kmalloc() failed!\n");
ian@0 243 tmp->next = ln;
ian@0 244 tmp->res = r;
ian@0 245 tmp->dev = dev;
ian@0 246 list->next = tmp;
ian@0 247 break;
ian@0 248 }
ian@0 249 }
ian@0 250 }
ian@0 251 }