Linux Audio

Check our new training course

Loading...
v3.5.6
 
   1/*
   2 * probe.c - PCI detection and setup code
   3 */
   4
   5#include <linux/kernel.h>
   6#include <linux/delay.h>
   7#include <linux/init.h>
   8#include <linux/pci.h>
 
 
 
   9#include <linux/slab.h>
  10#include <linux/module.h>
  11#include <linux/cpumask.h>
  12#include <linux/pci-aspm.h>
  13#include <asm-generic/pci-bridge.h>
 
 
 
 
  14#include "pci.h"
  15
  16#define CARDBUS_LATENCY_TIMER	176	/* secondary latency timer */
  17#define CARDBUS_RESERVE_BUSNR	3
  18
 
 
 
 
 
 
 
  19/* Ugh.  Need to stop exporting this to modules. */
  20LIST_HEAD(pci_root_buses);
  21EXPORT_SYMBOL(pci_root_buses);
  22
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
  23static int find_anything(struct device *dev, void *data)
  24{
  25	return 1;
  26}
  27
  28/*
  29 * Some device drivers need know if pci is initiated.
  30 * Basically, we think pci is not initiated when there
  31 * is no device to be found on the pci_bus_type.
  32 */
  33int no_pci_devices(void)
  34{
  35	struct device *dev;
  36	int no_devices;
  37
  38	dev = bus_find_device(&pci_bus_type, NULL, NULL, find_anything);
  39	no_devices = (dev == NULL);
  40	put_device(dev);
  41	return no_devices;
  42}
  43EXPORT_SYMBOL(no_pci_devices);
  44
  45/*
  46 * PCI Bus Class
  47 */
  48static void release_pcibus_dev(struct device *dev)
  49{
  50	struct pci_bus *pci_bus = to_pci_bus(dev);
  51
  52	if (pci_bus->bridge)
  53		put_device(pci_bus->bridge);
  54	pci_bus_remove_resources(pci_bus);
  55	pci_release_bus_of_node(pci_bus);
  56	kfree(pci_bus);
  57}
  58
  59static struct class pcibus_class = {
  60	.name		= "pci_bus",
  61	.dev_release	= &release_pcibus_dev,
  62	.dev_attrs	= pcibus_dev_attrs,
  63};
  64
  65static int __init pcibus_class_init(void)
  66{
  67	return class_register(&pcibus_class);
  68}
  69postcore_initcall(pcibus_class_init);
  70
  71static u64 pci_size(u64 base, u64 maxbase, u64 mask)
  72{
  73	u64 size = mask & maxbase;	/* Find the significant bits */
  74	if (!size)
  75		return 0;
  76
  77	/* Get the lowest of them to find the decode size, and
  78	   from that the extent.  */
 
 
  79	size = (size & ~(size-1)) - 1;
  80
  81	/* base == maxbase can be valid only if the BAR has
  82	   already been programmed with all 1s.  */
 
 
  83	if (base == maxbase && ((base | size) & mask) != mask)
  84		return 0;
  85
  86	return size;
  87}
  88
  89static inline unsigned long decode_bar(struct pci_dev *dev, u32 bar)
  90{
  91	u32 mem_type;
  92	unsigned long flags;
  93
  94	if ((bar & PCI_BASE_ADDRESS_SPACE) == PCI_BASE_ADDRESS_SPACE_IO) {
  95		flags = bar & ~PCI_BASE_ADDRESS_IO_MASK;
  96		flags |= IORESOURCE_IO;
  97		return flags;
  98	}
  99
 100	flags = bar & ~PCI_BASE_ADDRESS_MEM_MASK;
 101	flags |= IORESOURCE_MEM;
 102	if (flags & PCI_BASE_ADDRESS_MEM_PREFETCH)
 103		flags |= IORESOURCE_PREFETCH;
 104
 105	mem_type = bar & PCI_BASE_ADDRESS_MEM_TYPE_MASK;
 106	switch (mem_type) {
 107	case PCI_BASE_ADDRESS_MEM_TYPE_32:
 108		break;
 109	case PCI_BASE_ADDRESS_MEM_TYPE_1M:
 110		dev_info(&dev->dev, "1M mem BAR treated as 32-bit BAR\n");
 111		break;
 112	case PCI_BASE_ADDRESS_MEM_TYPE_64:
 113		flags |= IORESOURCE_MEM_64;
 114		break;
 115	default:
 116		dev_warn(&dev->dev,
 117			 "mem unknown type %x treated as 32-bit BAR\n",
 118			 mem_type);
 119		break;
 120	}
 121	return flags;
 122}
 123
 
 
 124/**
 125 * pci_read_base - read a PCI BAR
 126 * @dev: the PCI device
 127 * @type: type of the BAR
 128 * @res: resource buffer to be filled in
 129 * @pos: BAR position in the config space
 130 *
 131 * Returns 1 if the BAR is 64-bit, or 0 if 32-bit.
 132 */
 133int __pci_read_base(struct pci_dev *dev, enum pci_bar_type type,
 134			struct resource *res, unsigned int pos)
 135{
 136	u32 l, sz, mask;
 
 137	u16 orig_cmd;
 138	struct pci_bus_region region;
 139
 140	mask = type ? PCI_ROM_ADDRESS_MASK : ~0;
 141
 
 142	if (!dev->mmio_always_on) {
 143		pci_read_config_word(dev, PCI_COMMAND, &orig_cmd);
 144		pci_write_config_word(dev, PCI_COMMAND,
 145			orig_cmd & ~(PCI_COMMAND_MEMORY | PCI_COMMAND_IO));
 
 
 146	}
 147
 148	res->name = pci_name(dev);
 149
 150	pci_read_config_dword(dev, pos, &l);
 151	pci_write_config_dword(dev, pos, l | mask);
 152	pci_read_config_dword(dev, pos, &sz);
 153	pci_write_config_dword(dev, pos, l);
 154
 155	if (!dev->mmio_always_on)
 156		pci_write_config_word(dev, PCI_COMMAND, orig_cmd);
 157
 158	/*
 159	 * All bits set in sz means the device isn't working properly.
 160	 * If the BAR isn't implemented, all bits must be 0.  If it's a
 161	 * memory BAR or a ROM, bit 0 must be clear; if it's an io BAR, bit
 162	 * 1 must be clear.
 163	 */
 164	if (!sz || sz == 0xffffffff)
 165		goto fail;
 166
 167	/*
 168	 * I don't know how l can have all bits set.  Copied from old code.
 169	 * Maybe it fixes a bug on some ancient platform.
 170	 */
 171	if (l == 0xffffffff)
 172		l = 0;
 173
 174	if (type == pci_bar_unknown) {
 175		res->flags = decode_bar(dev, l);
 176		res->flags |= IORESOURCE_SIZEALIGN;
 177		if (res->flags & IORESOURCE_IO) {
 178			l &= PCI_BASE_ADDRESS_IO_MASK;
 179			mask = PCI_BASE_ADDRESS_IO_MASK & (u32) IO_SPACE_LIMIT;
 
 180		} else {
 181			l &= PCI_BASE_ADDRESS_MEM_MASK;
 182			mask = (u32)PCI_BASE_ADDRESS_MEM_MASK;
 
 183		}
 184	} else {
 185		res->flags |= (l & IORESOURCE_ROM_ENABLE);
 186		l &= PCI_ROM_ADDRESS_MASK;
 187		mask = (u32)PCI_ROM_ADDRESS_MASK;
 
 
 188	}
 189
 190	if (res->flags & IORESOURCE_MEM_64) {
 191		u64 l64 = l;
 192		u64 sz64 = sz;
 193		u64 mask64 = mask | (u64)~0 << 32;
 194
 195		pci_read_config_dword(dev, pos + 4, &l);
 196		pci_write_config_dword(dev, pos + 4, ~0);
 197		pci_read_config_dword(dev, pos + 4, &sz);
 198		pci_write_config_dword(dev, pos + 4, l);
 199
 200		l64 |= ((u64)l << 32);
 201		sz64 |= ((u64)sz << 32);
 
 
 202
 203		sz64 = pci_size(l64, sz64, mask64);
 
 204
 205		if (!sz64)
 206			goto fail;
 207
 208		if ((sizeof(resource_size_t) < 8) && (sz64 > 0x100000000ULL)) {
 209			dev_err(&dev->dev, "reg %x: can't handle 64-bit BAR\n",
 210				pos);
 211			goto fail;
 212		}
 213
 214		if ((sizeof(resource_size_t) < 8) && l) {
 215			/* Address above 32-bit boundary; disable the BAR */
 216			pci_write_config_dword(dev, pos, 0);
 217			pci_write_config_dword(dev, pos + 4, 0);
 218			region.start = 0;
 219			region.end = sz64;
 220			pcibios_bus_to_resource(dev, res, &region);
 221		} else {
 222			region.start = l64;
 223			region.end = l64 + sz64;
 224			pcibios_bus_to_resource(dev, res, &region);
 225			dev_printk(KERN_DEBUG, &dev->dev, "reg %x: %pR\n",
 226				   pos, res);
 227		}
 228	} else {
 229		sz = pci_size(l, sz, mask);
 230
 231		if (!sz)
 232			goto fail;
 
 
 
 
 
 
 
 
 
 
 
 233
 234		region.start = l;
 235		region.end = l + sz;
 236		pcibios_bus_to_resource(dev, res, &region);
 237
 238		dev_printk(KERN_DEBUG, &dev->dev, "reg %x: %pR\n", pos, res);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 239	}
 240
 241 out:
 242	return (res->flags & IORESOURCE_MEM_64) ? 1 : 0;
 243 fail:
 244	res->flags = 0;
 245	goto out;
 
 
 
 
 
 
 
 
 
 246}
 247
 248static void pci_read_bases(struct pci_dev *dev, unsigned int howmany, int rom)
 249{
 250	unsigned int pos, reg;
 251
 
 
 
 
 
 
 
 252	for (pos = 0; pos < howmany; pos++) {
 253		struct resource *res = &dev->resource[pos];
 254		reg = PCI_BASE_ADDRESS_0 + (pos << 2);
 255		pos += __pci_read_base(dev, pci_bar_unknown, res, reg);
 256	}
 257
 258	if (rom) {
 259		struct resource *res = &dev->resource[PCI_ROM_RESOURCE];
 260		dev->rom_base_reg = rom;
 261		res->flags = IORESOURCE_MEM | IORESOURCE_PREFETCH |
 262				IORESOURCE_READONLY | IORESOURCE_CACHEABLE |
 263				IORESOURCE_SIZEALIGN;
 264		__pci_read_base(dev, pci_bar_mem32, res, rom);
 265	}
 266}
 267
 268static void __devinit pci_read_bridge_io(struct pci_bus *child)
 269{
 270	struct pci_dev *dev = child->self;
 271	u8 io_base_lo, io_limit_lo;
 272	unsigned long base, limit;
 273	struct pci_bus_region region;
 274	struct resource *res, res2;
 
 
 
 
 
 
 
 
 275
 276	res = child->resource[0];
 277	pci_read_config_byte(dev, PCI_IO_BASE, &io_base_lo);
 278	pci_read_config_byte(dev, PCI_IO_LIMIT, &io_limit_lo);
 279	base = (io_base_lo & PCI_IO_RANGE_MASK) << 8;
 280	limit = (io_limit_lo & PCI_IO_RANGE_MASK) << 8;
 281
 282	if ((io_base_lo & PCI_IO_RANGE_TYPE_MASK) == PCI_IO_RANGE_TYPE_32) {
 283		u16 io_base_hi, io_limit_hi;
 
 284		pci_read_config_word(dev, PCI_IO_BASE_UPPER16, &io_base_hi);
 285		pci_read_config_word(dev, PCI_IO_LIMIT_UPPER16, &io_limit_hi);
 286		base |= (io_base_hi << 16);
 287		limit |= (io_limit_hi << 16);
 288	}
 289
 290	if (base && base <= limit) {
 291		res->flags = (io_base_lo & PCI_IO_RANGE_TYPE_MASK) | IORESOURCE_IO;
 292		res2.flags = res->flags;
 293		region.start = base;
 294		region.end = limit + 0xfff;
 295		pcibios_bus_to_resource(dev, &res2, &region);
 296		if (!res->start)
 297			res->start = res2.start;
 298		if (!res->end)
 299			res->end = res2.end;
 300		dev_printk(KERN_DEBUG, &dev->dev, "  bridge window %pR\n", res);
 301	}
 302}
 303
 304static void __devinit pci_read_bridge_mmio(struct pci_bus *child)
 305{
 306	struct pci_dev *dev = child->self;
 307	u16 mem_base_lo, mem_limit_lo;
 308	unsigned long base, limit;
 309	struct pci_bus_region region;
 310	struct resource *res;
 311
 312	res = child->resource[1];
 313	pci_read_config_word(dev, PCI_MEMORY_BASE, &mem_base_lo);
 314	pci_read_config_word(dev, PCI_MEMORY_LIMIT, &mem_limit_lo);
 315	base = (mem_base_lo & PCI_MEMORY_RANGE_MASK) << 16;
 316	limit = (mem_limit_lo & PCI_MEMORY_RANGE_MASK) << 16;
 317	if (base && base <= limit) {
 318		res->flags = (mem_base_lo & PCI_MEMORY_RANGE_TYPE_MASK) | IORESOURCE_MEM;
 319		region.start = base;
 320		region.end = limit + 0xfffff;
 321		pcibios_bus_to_resource(dev, res, &region);
 322		dev_printk(KERN_DEBUG, &dev->dev, "  bridge window %pR\n", res);
 323	}
 324}
 325
 326static void __devinit pci_read_bridge_mmio_pref(struct pci_bus *child)
 327{
 328	struct pci_dev *dev = child->self;
 329	u16 mem_base_lo, mem_limit_lo;
 330	unsigned long base, limit;
 
 331	struct pci_bus_region region;
 332	struct resource *res;
 333
 334	res = child->resource[2];
 335	pci_read_config_word(dev, PCI_PREF_MEMORY_BASE, &mem_base_lo);
 336	pci_read_config_word(dev, PCI_PREF_MEMORY_LIMIT, &mem_limit_lo);
 337	base = (mem_base_lo & PCI_PREF_RANGE_MASK) << 16;
 338	limit = (mem_limit_lo & PCI_PREF_RANGE_MASK) << 16;
 339
 340	if ((mem_base_lo & PCI_PREF_RANGE_TYPE_MASK) == PCI_PREF_RANGE_TYPE_64) {
 341		u32 mem_base_hi, mem_limit_hi;
 
 342		pci_read_config_dword(dev, PCI_PREF_BASE_UPPER32, &mem_base_hi);
 343		pci_read_config_dword(dev, PCI_PREF_LIMIT_UPPER32, &mem_limit_hi);
 344
 345		/*
 346		 * Some bridges set the base > limit by default, and some
 347		 * (broken) BIOSes do not initialize them.  If we find
 348		 * this, just assume they are not being used.
 349		 */
 350		if (mem_base_hi <= mem_limit_hi) {
 351#if BITS_PER_LONG == 64
 352			base |= ((long) mem_base_hi) << 32;
 353			limit |= ((long) mem_limit_hi) << 32;
 354#else
 355			if (mem_base_hi || mem_limit_hi) {
 356				dev_err(&dev->dev, "can't handle 64-bit "
 357					"address space for bridge\n");
 358				return;
 359			}
 360#endif
 361		}
 362	}
 363	if (base && base <= limit) {
 
 
 
 
 
 
 
 
 
 
 364		res->flags = (mem_base_lo & PCI_PREF_RANGE_TYPE_MASK) |
 365					 IORESOURCE_MEM | IORESOURCE_PREFETCH;
 366		if (res->flags & PCI_PREF_RANGE_TYPE_64)
 367			res->flags |= IORESOURCE_MEM_64;
 368		region.start = base;
 369		region.end = limit + 0xfffff;
 370		pcibios_bus_to_resource(dev, res, &region);
 371		dev_printk(KERN_DEBUG, &dev->dev, "  bridge window %pR\n", res);
 372	}
 373}
 374
 375void __devinit pci_read_bridge_bases(struct pci_bus *child)
 376{
 377	struct pci_dev *dev = child->self;
 378	struct resource *res;
 379	int i;
 380
 381	if (pci_is_root_bus(child))	/* It's a host bus, nothing to read */
 382		return;
 383
 384	dev_info(&dev->dev, "PCI bridge to [bus %02x-%02x]%s\n",
 385		 child->secondary, child->subordinate,
 386		 dev->transparent ? " (subtractive decode)" : "");
 387
 388	pci_bus_remove_resources(child);
 389	for (i = 0; i < PCI_BRIDGE_RESOURCE_NUM; i++)
 390		child->resource[i] = &dev->resource[PCI_BRIDGE_RESOURCES+i];
 391
 392	pci_read_bridge_io(child);
 393	pci_read_bridge_mmio(child);
 394	pci_read_bridge_mmio_pref(child);
 395
 396	if (dev->transparent) {
 397		pci_bus_for_each_resource(child->parent, res, i) {
 398			if (res) {
 399				pci_bus_add_resource(child, res,
 400						     PCI_SUBTRACTIVE_DECODE);
 401				dev_printk(KERN_DEBUG, &dev->dev,
 402					   "  bridge window %pR (subtractive decode)\n",
 403					   res);
 404			}
 405		}
 406	}
 407}
 408
 409static struct pci_bus * pci_alloc_bus(void)
 410{
 411	struct pci_bus *b;
 412
 413	b = kzalloc(sizeof(*b), GFP_KERNEL);
 414	if (b) {
 415		INIT_LIST_HEAD(&b->node);
 416		INIT_LIST_HEAD(&b->children);
 417		INIT_LIST_HEAD(&b->devices);
 418		INIT_LIST_HEAD(&b->slots);
 419		INIT_LIST_HEAD(&b->resources);
 420		b->max_bus_speed = PCI_SPEED_UNKNOWN;
 421		b->cur_bus_speed = PCI_SPEED_UNKNOWN;
 422	}
 
 
 
 
 
 423	return b;
 424}
 425
 426static struct pci_host_bridge *pci_alloc_host_bridge(struct pci_bus *b)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 427{
 428	struct pci_host_bridge *bridge;
 429
 430	bridge = kzalloc(sizeof(*bridge), GFP_KERNEL);
 431	if (bridge) {
 432		INIT_LIST_HEAD(&bridge->windows);
 433		bridge->bus = b;
 434	}
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 435
 436	return bridge;
 437}
 
 438
 439static unsigned char pcix_bus_speed[] = {
 
 
 
 
 
 
 
 
 440	PCI_SPEED_UNKNOWN,		/* 0 */
 441	PCI_SPEED_66MHz_PCIX,		/* 1 */
 442	PCI_SPEED_100MHz_PCIX,		/* 2 */
 443	PCI_SPEED_133MHz_PCIX,		/* 3 */
 444	PCI_SPEED_UNKNOWN,		/* 4 */
 445	PCI_SPEED_66MHz_PCIX_ECC,	/* 5 */
 446	PCI_SPEED_100MHz_PCIX_ECC,	/* 6 */
 447	PCI_SPEED_133MHz_PCIX_ECC,	/* 7 */
 448	PCI_SPEED_UNKNOWN,		/* 8 */
 449	PCI_SPEED_66MHz_PCIX_266,	/* 9 */
 450	PCI_SPEED_100MHz_PCIX_266,	/* A */
 451	PCI_SPEED_133MHz_PCIX_266,	/* B */
 452	PCI_SPEED_UNKNOWN,		/* C */
 453	PCI_SPEED_66MHz_PCIX_533,	/* D */
 454	PCI_SPEED_100MHz_PCIX_533,	/* E */
 455	PCI_SPEED_133MHz_PCIX_533	/* F */
 456};
 457
 458static unsigned char pcie_link_speed[] = {
 459	PCI_SPEED_UNKNOWN,		/* 0 */
 460	PCIE_SPEED_2_5GT,		/* 1 */
 461	PCIE_SPEED_5_0GT,		/* 2 */
 462	PCIE_SPEED_8_0GT,		/* 3 */
 463	PCI_SPEED_UNKNOWN,		/* 4 */
 464	PCI_SPEED_UNKNOWN,		/* 5 */
 465	PCI_SPEED_UNKNOWN,		/* 6 */
 466	PCI_SPEED_UNKNOWN,		/* 7 */
 467	PCI_SPEED_UNKNOWN,		/* 8 */
 468	PCI_SPEED_UNKNOWN,		/* 9 */
 469	PCI_SPEED_UNKNOWN,		/* A */
 470	PCI_SPEED_UNKNOWN,		/* B */
 471	PCI_SPEED_UNKNOWN,		/* C */
 472	PCI_SPEED_UNKNOWN,		/* D */
 473	PCI_SPEED_UNKNOWN,		/* E */
 474	PCI_SPEED_UNKNOWN		/* F */
 475};
 476
 477void pcie_update_link_speed(struct pci_bus *bus, u16 linksta)
 478{
 479	bus->cur_bus_speed = pcie_link_speed[linksta & 0xf];
 480}
 481EXPORT_SYMBOL_GPL(pcie_update_link_speed);
 482
 483static unsigned char agp_speeds[] = {
 484	AGP_UNKNOWN,
 485	AGP_1X,
 486	AGP_2X,
 487	AGP_4X,
 488	AGP_8X
 489};
 490
 491static enum pci_bus_speed agp_speed(int agp3, int agpstat)
 492{
 493	int index = 0;
 494
 495	if (agpstat & 4)
 496		index = 3;
 497	else if (agpstat & 2)
 498		index = 2;
 499	else if (agpstat & 1)
 500		index = 1;
 501	else
 502		goto out;
 503	
 504	if (agp3) {
 505		index += 2;
 506		if (index == 5)
 507			index = 0;
 508	}
 509
 510 out:
 511	return agp_speeds[index];
 512}
 513
 514
 515static void pci_set_bus_speed(struct pci_bus *bus)
 516{
 517	struct pci_dev *bridge = bus->self;
 518	int pos;
 519
 520	pos = pci_find_capability(bridge, PCI_CAP_ID_AGP);
 521	if (!pos)
 522		pos = pci_find_capability(bridge, PCI_CAP_ID_AGP3);
 523	if (pos) {
 524		u32 agpstat, agpcmd;
 525
 526		pci_read_config_dword(bridge, pos + PCI_AGP_STATUS, &agpstat);
 527		bus->max_bus_speed = agp_speed(agpstat & 8, agpstat & 7);
 528
 529		pci_read_config_dword(bridge, pos + PCI_AGP_COMMAND, &agpcmd);
 530		bus->cur_bus_speed = agp_speed(agpstat & 8, agpcmd & 7);
 531	}
 532
 533	pos = pci_find_capability(bridge, PCI_CAP_ID_PCIX);
 534	if (pos) {
 535		u16 status;
 536		enum pci_bus_speed max;
 537		pci_read_config_word(bridge, pos + 2, &status);
 538
 539		if (status & 0x8000) {
 
 
 
 540			max = PCI_SPEED_133MHz_PCIX_533;
 541		} else if (status & 0x4000) {
 542			max = PCI_SPEED_133MHz_PCIX_266;
 543		} else if (status & 0x0002) {
 544			if (((status >> 12) & 0x3) == 2) {
 545				max = PCI_SPEED_133MHz_PCIX_ECC;
 546			} else {
 547				max = PCI_SPEED_133MHz_PCIX;
 548			}
 549		} else {
 550			max = PCI_SPEED_66MHz_PCIX;
 551		}
 552
 553		bus->max_bus_speed = max;
 554		bus->cur_bus_speed = pcix_bus_speed[(status >> 6) & 0xf];
 
 555
 556		return;
 557	}
 558
 559	pos = pci_find_capability(bridge, PCI_CAP_ID_EXP);
 560	if (pos) {
 561		u32 linkcap;
 562		u16 linksta;
 563
 564		pci_read_config_dword(bridge, pos + PCI_EXP_LNKCAP, &linkcap);
 565		bus->max_bus_speed = pcie_link_speed[linkcap & 0xf];
 566
 567		pci_read_config_word(bridge, pos + PCI_EXP_LNKSTA, &linksta);
 568		pcie_update_link_speed(bus, linksta);
 569	}
 570}
 571
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 572
 573static struct pci_bus *pci_alloc_child_bus(struct pci_bus *parent,
 574					   struct pci_dev *bridge, int busnr)
 575{
 576	struct pci_bus *child;
 577	int i;
 
 578
 579	/*
 580	 * Allocate a new bus, and inherit stuff from the parent..
 581	 */
 582	child = pci_alloc_bus();
 583	if (!child)
 584		return NULL;
 585
 586	child->parent = parent;
 587	child->ops = parent->ops;
 
 588	child->sysdata = parent->sysdata;
 589	child->bus_flags = parent->bus_flags;
 590
 591	/* initialize some portions of the bus device, but don't register it
 592	 * now as the parent is not properly set up yet.  This device will get
 593	 * registered later in pci_bus_add_devices()
 594	 */
 595	child->dev.class = &pcibus_class;
 596	dev_set_name(&child->dev, "%04x:%02x", pci_domain_nr(child), busnr);
 597
 598	/*
 599	 * Set up the primary, secondary and subordinate
 600	 * bus numbers.
 601	 */
 602	child->number = child->secondary = busnr;
 603	child->primary = parent->secondary;
 604	child->subordinate = 0xff;
 605
 606	if (!bridge)
 607		return child;
 608
 609	child->self = bridge;
 610	child->bridge = get_device(&bridge->dev);
 
 611	pci_set_bus_of_node(child);
 612	pci_set_bus_speed(child);
 613
 614	/* Set up default resource pointers and names.. */
 615	for (i = 0; i < PCI_BRIDGE_RESOURCE_NUM; i++) {
 616		child->resource[i] = &bridge->resource[PCI_BRIDGE_RESOURCES+i];
 617		child->resource[i]->name = child->name;
 618	}
 619	bridge->subordinate = child;
 620
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 621	return child;
 622}
 623
 624struct pci_bus *__ref pci_add_new_bus(struct pci_bus *parent, struct pci_dev *dev, int busnr)
 
 625{
 626	struct pci_bus *child;
 627
 628	child = pci_alloc_child_bus(parent, dev, busnr);
 629	if (child) {
 630		down_write(&pci_bus_sem);
 631		list_add_tail(&child->node, &parent->children);
 632		up_write(&pci_bus_sem);
 633	}
 634	return child;
 635}
 
 636
 637static void pci_fixup_parent_subordinate_busnr(struct pci_bus *child, int max)
 638{
 639	struct pci_bus *parent = child->parent;
 640
 641	/* Attempts to fix that up are really dangerous unless
 642	   we're going to re-assign all bus numbers. */
 643	if (!pcibios_assign_all_busses())
 644		return;
 645
 646	while (parent->parent && parent->subordinate < max) {
 647		parent->subordinate = max;
 648		pci_write_config_byte(parent->self, PCI_SUBORDINATE_BUS, max);
 649		parent = parent->parent;
 650	}
 651}
 652
 
 
 
 653/*
 
 
 
 
 
 
 
 
 
 
 
 654 * If it's a bridge, configure it and scan the bus behind it.
 655 * For CardBus bridges, we don't scan behind as the devices will
 656 * be handled by the bridge driver itself.
 657 *
 658 * We need to process bridges in two passes -- first we scan those
 659 * already configured by the BIOS and after we are done with all of
 660 * them, we proceed to assigning numbers to the remaining buses in
 661 * order to avoid overlaps between old and new bus numbers.
 662 */
 663int __devinit pci_scan_bridge(struct pci_bus *bus, struct pci_dev *dev, int max, int pass)
 
 
 664{
 665	struct pci_bus *child;
 666	int is_cardbus = (dev->hdr_type == PCI_HEADER_TYPE_CARDBUS);
 667	u32 buses, i, j = 0;
 668	u16 bctl;
 669	u8 primary, secondary, subordinate;
 670	int broken = 0;
 671
 
 
 
 
 
 
 672	pci_read_config_dword(dev, PCI_PRIMARY_BUS, &buses);
 673	primary = buses & 0xFF;
 674	secondary = (buses >> 8) & 0xFF;
 675	subordinate = (buses >> 16) & 0xFF;
 676
 677	dev_dbg(&dev->dev, "scanning [bus %02x-%02x] behind bridge, pass %d\n",
 678		secondary, subordinate, pass);
 679
 680	if (!primary && (primary != bus->number) && secondary && subordinate) {
 681		dev_warn(&dev->dev, "Primary bus is hard wired to 0\n");
 682		primary = bus->number;
 683	}
 684
 685	/* Check if setup is sensible at all */
 686	if (!pass &&
 687	    (primary != bus->number || secondary <= bus->number)) {
 688		dev_dbg(&dev->dev, "bus configuration invalid, reconfiguring\n");
 
 
 689		broken = 1;
 690	}
 691
 692	/* Disable MasterAbortMode during probing to avoid reporting
 693	   of bus errors (in some architectures) */ 
 
 
 694	pci_read_config_word(dev, PCI_BRIDGE_CONTROL, &bctl);
 695	pci_write_config_word(dev, PCI_BRIDGE_CONTROL,
 696			      bctl & ~PCI_BRIDGE_CTL_MASTER_ABORT);
 697
 
 
 698	if ((secondary || subordinate) && !pcibios_assign_all_busses() &&
 699	    !is_cardbus && !broken) {
 700		unsigned int cmax;
 
 701		/*
 702		 * Bus already configured by firmware, process it in the first
 703		 * pass and just note the configuration.
 704		 */
 705		if (pass)
 706			goto out;
 707
 708		/*
 709		 * If we already got to this bus through a different bridge,
 710		 * don't re-add it. This can happen with the i450NX chipset.
 711		 *
 712		 * However, we continue to descend down the hierarchy and
 713		 * scan remaining child buses.
 714		 */
 715		child = pci_find_bus(pci_domain_nr(bus), secondary);
 716		if (!child) {
 717			child = pci_add_new_bus(bus, dev, secondary);
 718			if (!child)
 719				goto out;
 720			child->primary = primary;
 721			child->subordinate = subordinate;
 722			child->bridge_ctl = bctl;
 723		}
 724
 725		cmax = pci_scan_child_bus(child);
 726		if (cmax > max)
 727			max = cmax;
 728		if (child->subordinate > max)
 729			max = child->subordinate;
 
 
 
 730	} else {
 
 731		/*
 732		 * We need to assign a number to this bus which we always
 733		 * do in the second pass.
 734		 */
 735		if (!pass) {
 736			if (pcibios_assign_all_busses() || broken)
 737				/* Temporarily disable forwarding of the
 738				   configuration cycles on all bridges in
 739				   this bus segment to avoid possible
 740				   conflicts in the second pass between two
 741				   bridges programmed with overlapping
 742				   bus ranges. */
 
 
 
 743				pci_write_config_dword(dev, PCI_PRIMARY_BUS,
 744						       buses & ~0xffffff);
 745			goto out;
 746		}
 747
 748		/* Clear errors */
 749		pci_write_config_word(dev, PCI_STATUS, 0xffff);
 750
 751		/* Prevent assigning a bus number that already exists.
 752		 * This can happen when a bridge is hot-plugged, so in
 753		 * this case we only re-scan this bus. */
 
 
 754		child = pci_find_bus(pci_domain_nr(bus), max+1);
 755		if (!child) {
 756			child = pci_add_new_bus(bus, dev, ++max);
 757			if (!child)
 758				goto out;
 
 
 759		}
 
 
 
 
 760		buses = (buses & 0xff000000)
 761		      | ((unsigned int)(child->primary)     <<  0)
 762		      | ((unsigned int)(child->secondary)   <<  8)
 763		      | ((unsigned int)(child->subordinate) << 16);
 764
 765		/*
 766		 * yenta.c forces a secondary latency timer of 176.
 767		 * Copy that behaviour here.
 768		 */
 769		if (is_cardbus) {
 770			buses &= ~0xff000000;
 771			buses |= CARDBUS_LATENCY_TIMER << 24;
 772		}
 773
 774		/*
 775		 * We need to blast all three values with a single write.
 776		 */
 777		pci_write_config_dword(dev, PCI_PRIMARY_BUS, buses);
 778
 779		if (!is_cardbus) {
 780			child->bridge_ctl = bctl;
 781			/*
 782			 * Adjust subordinate busnr in parent buses.
 783			 * We do this before scanning for children because
 784			 * some devices may not be detected if the bios
 785			 * was lazy.
 786			 */
 787			pci_fixup_parent_subordinate_busnr(child, max);
 788			/* Now we can scan all subordinate buses... */
 789			max = pci_scan_child_bus(child);
 790			/*
 791			 * now fix it up again since we have found
 792			 * the real value of max.
 793			 */
 794			pci_fixup_parent_subordinate_busnr(child, max);
 795		} else {
 
 796			/*
 797			 * For CardBus bridges, we leave 4 bus numbers
 798			 * as cards with a PCI-to-PCI bridge can be
 799			 * inserted later.
 800			 */
 801			for (i=0; i<CARDBUS_RESERVE_BUSNR; i++) {
 802				struct pci_bus *parent = bus;
 803				if (pci_find_bus(pci_domain_nr(bus),
 804							max+i+1))
 805					break;
 806				while (parent->parent) {
 807					if ((!pcibios_assign_all_busses()) &&
 808					    (parent->subordinate > max) &&
 809					    (parent->subordinate <= max+i)) {
 810						j = 1;
 811					}
 812					parent = parent->parent;
 813				}
 814				if (j) {
 
 815					/*
 816					 * Often, there are two cardbus bridges
 817					 * -- try to leave one valid bus number
 818					 * for each one.
 819					 */
 820					i /= 2;
 821					break;
 822				}
 823			}
 824			max += i;
 825			pci_fixup_parent_subordinate_busnr(child, max);
 826		}
 827		/*
 828		 * Set the subordinate bus number to its real value.
 829		 */
 830		child->subordinate = max;
 831		pci_write_config_byte(dev, PCI_SUBORDINATE_BUS, max);
 832	}
 833
 834	sprintf(child->name,
 835		(is_cardbus ? "PCI CardBus %04x:%02x" : "PCI Bus %04x:%02x"),
 836		pci_domain_nr(bus), child->number);
 837
 838	/* Has only triggered on CardBus, fixup is in yenta_socket */
 839	while (bus->parent) {
 840		if ((child->subordinate > bus->subordinate) ||
 841		    (child->number > bus->subordinate) ||
 842		    (child->number < bus->number) ||
 843		    (child->subordinate < bus->number)) {
 844			dev_info(&child->dev, "[bus %02x-%02x] %s "
 845				"hidden behind%s bridge %s [bus %02x-%02x]\n",
 846				child->number, child->subordinate,
 847				(bus->number > child->subordinate &&
 848				 bus->subordinate < child->number) ?
 849					"wholly" : "partially",
 850				bus->self->transparent ? " transparent" : "",
 851				dev_name(&bus->dev),
 852				bus->number, bus->subordinate);
 853		}
 854		bus = bus->parent;
 855	}
 856
 857out:
 858	pci_write_config_word(dev, PCI_BRIDGE_CONTROL, bctl);
 859
 
 
 860	return max;
 861}
 862
 863/*
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 864 * Read interrupt line and base address registers.
 865 * The architecture-dependent code can tweak these, of course.
 866 */
 867static void pci_read_irq(struct pci_dev *dev)
 868{
 869	unsigned char irq;
 870
 
 
 
 
 
 
 
 871	pci_read_config_byte(dev, PCI_INTERRUPT_PIN, &irq);
 872	dev->pin = irq;
 873	if (irq)
 874		pci_read_config_byte(dev, PCI_INTERRUPT_LINE, &irq);
 875	dev->irq = irq;
 876}
 877
 878void set_pcie_port_type(struct pci_dev *pdev)
 879{
 880	int pos;
 881	u16 reg16;
 
 
 882
 883	pos = pci_find_capability(pdev, PCI_CAP_ID_EXP);
 884	if (!pos)
 885		return;
 886	pdev->is_pcie = 1;
 887	pdev->pcie_cap = pos;
 888	pci_read_config_word(pdev, pos + PCI_EXP_FLAGS, &reg16);
 889	pdev->pcie_type = (reg16 & PCI_EXP_FLAGS_TYPE) >> 4;
 890	pci_read_config_word(pdev, pos + PCI_EXP_DEVCAP, &reg16);
 891	pdev->pcie_mpss = reg16 & PCI_EXP_DEVCAP_PAYLOAD;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 892}
 893
 894void set_pcie_hotplug_bridge(struct pci_dev *pdev)
 895{
 896	int pos;
 897	u16 reg16;
 898	u32 reg32;
 899
 900	pos = pci_pcie_cap(pdev);
 901	if (!pos)
 902		return;
 903	pci_read_config_word(pdev, pos + PCI_EXP_FLAGS, &reg16);
 904	if (!(reg16 & PCI_EXP_FLAGS_SLOT))
 905		return;
 906	pci_read_config_dword(pdev, pos + PCI_EXP_SLTCAP, &reg32);
 907	if (reg32 & PCI_EXP_SLTCAP_HPC)
 908		pdev->is_hotplug_bridge = 1;
 909}
 910
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 911#define LEGACY_IO_RESOURCE	(IORESOURCE_IO | IORESOURCE_PCI_FIXED)
 912
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 913/**
 914 * pci_setup_device - fill in class and map information of a device
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 915 * @dev: the device structure to fill
 916 *
 917 * Initialize the device structure with information about the device's 
 918 * vendor,class,memory and IO-space addresses,IRQ lines etc.
 919 * Called at initialisation of the PCI subsystem and by CardBus services.
 920 * Returns 0 on success and negative if unknown type of device (not normal,
 921 * bridge or CardBus).
 922 */
 923int pci_setup_device(struct pci_dev *dev)
 924{
 925	u32 class;
 
 926	u8 hdr_type;
 927	struct pci_slot *slot;
 928	int pos = 0;
 929	struct pci_bus_region region;
 930	struct resource *res;
 931
 932	if (pci_read_config_byte(dev, PCI_HEADER_TYPE, &hdr_type))
 933		return -EIO;
 934
 935	dev->sysdata = dev->bus->sysdata;
 936	dev->dev.parent = dev->bus->bridge;
 937	dev->dev.bus = &pci_bus_type;
 938	dev->hdr_type = hdr_type & 0x7f;
 939	dev->multifunction = !!(hdr_type & 0x80);
 940	dev->error_state = pci_channel_io_normal;
 941	set_pcie_port_type(dev);
 942
 943	list_for_each_entry(slot, &dev->bus->slots, list)
 944		if (PCI_SLOT(dev->devfn) == slot->number)
 945			dev->slot = slot;
 946
 947	/* Assume 32-bit PCI; let 64-bit PCI cards (which are far rarer)
 948	   set this higher, assuming the system even supports it.  */
 
 
 949	dev->dma_mask = 0xffffffff;
 950
 951	dev_set_name(&dev->dev, "%04x:%02x:%02x.%d", pci_domain_nr(dev->bus),
 952		     dev->bus->number, PCI_SLOT(dev->devfn),
 953		     PCI_FUNC(dev->devfn));
 954
 955	pci_read_config_dword(dev, PCI_CLASS_REVISION, &class);
 
 956	dev->revision = class & 0xff;
 957	dev->class = class >> 8;		    /* upper 3 bytes */
 958
 959	dev_printk(KERN_DEBUG, &dev->dev, "[%04x:%04x] type %02x class %#08x\n",
 960		   dev->vendor, dev->device, dev->hdr_type, dev->class);
 961
 962	/* need to have dev->class ready */
 963	dev->cfg_size = pci_cfg_space_size(dev);
 964
 
 
 
 965	/* "Unknown power state" */
 966	dev->current_state = PCI_UNKNOWN;
 967
 968	/* Early fixups, before probing the BARs */
 969	pci_fixup_device(pci_fixup_early, dev);
 970	/* device class may be changed after fixup */
 
 971	class = dev->class >> 8;
 972
 
 
 
 
 
 
 
 
 
 
 
 
 973	switch (dev->hdr_type) {		    /* header type */
 974	case PCI_HEADER_TYPE_NORMAL:		    /* standard header */
 975		if (class == PCI_CLASS_BRIDGE_PCI)
 976			goto bad;
 977		pci_read_irq(dev);
 978		pci_read_bases(dev, 6, PCI_ROM_ADDRESS);
 979		pci_read_config_word(dev, PCI_SUBSYSTEM_VENDOR_ID, &dev->subsystem_vendor);
 980		pci_read_config_word(dev, PCI_SUBSYSTEM_ID, &dev->subsystem_device);
 981
 982		/*
 983		 *	Do the ugly legacy mode stuff here rather than broken chip
 984		 *	quirk code. Legacy mode ATA controllers have fixed
 985		 *	addresses. These are not always echoed in BAR0-3, and
 986		 *	BAR0-3 in a few cases contain junk!
 987		 */
 988		if (class == PCI_CLASS_STORAGE_IDE) {
 989			u8 progif;
 990			pci_read_config_byte(dev, PCI_CLASS_PROG, &progif);
 991			if ((progif & 1) == 0) {
 992				region.start = 0x1F0;
 993				region.end = 0x1F7;
 994				res = &dev->resource[0];
 995				res->flags = LEGACY_IO_RESOURCE;
 996				pcibios_bus_to_resource(dev, res, &region);
 
 
 997				region.start = 0x3F6;
 998				region.end = 0x3F6;
 999				res = &dev->resource[1];
1000				res->flags = LEGACY_IO_RESOURCE;
1001				pcibios_bus_to_resource(dev, res, &region);
 
 
1002			}
1003			if ((progif & 4) == 0) {
1004				region.start = 0x170;
1005				region.end = 0x177;
1006				res = &dev->resource[2];
1007				res->flags = LEGACY_IO_RESOURCE;
1008				pcibios_bus_to_resource(dev, res, &region);
 
 
1009				region.start = 0x376;
1010				region.end = 0x376;
1011				res = &dev->resource[3];
1012				res->flags = LEGACY_IO_RESOURCE;
1013				pcibios_bus_to_resource(dev, res, &region);
 
 
1014			}
1015		}
1016		break;
1017
1018	case PCI_HEADER_TYPE_BRIDGE:		    /* bridge header */
1019		if (class != PCI_CLASS_BRIDGE_PCI)
1020			goto bad;
1021		/* The PCI-to-PCI bridge spec requires that subtractive
1022		   decoding (i.e. transparent) bridge must have programming
1023		   interface code of 0x01. */ 
 
 
 
1024		pci_read_irq(dev);
1025		dev->transparent = ((dev->class & 0xff) == 1);
1026		pci_read_bases(dev, 2, PCI_ROM_ADDRESS1);
1027		set_pcie_hotplug_bridge(dev);
1028		pos = pci_find_capability(dev, PCI_CAP_ID_SSVID);
1029		if (pos) {
1030			pci_read_config_word(dev, pos + PCI_SSVID_VENDOR_ID, &dev->subsystem_vendor);
1031			pci_read_config_word(dev, pos + PCI_SSVID_DEVICE_ID, &dev->subsystem_device);
1032		}
1033		break;
1034
1035	case PCI_HEADER_TYPE_CARDBUS:		    /* CardBus bridge header */
1036		if (class != PCI_CLASS_BRIDGE_CARDBUS)
1037			goto bad;
1038		pci_read_irq(dev);
1039		pci_read_bases(dev, 1, 0);
1040		pci_read_config_word(dev, PCI_CB_SUBSYSTEM_VENDOR_ID, &dev->subsystem_vendor);
1041		pci_read_config_word(dev, PCI_CB_SUBSYSTEM_ID, &dev->subsystem_device);
1042		break;
1043
1044	default:				    /* unknown header */
1045		dev_err(&dev->dev, "unknown header type %02x, "
1046			"ignoring device\n", dev->hdr_type);
1047		return -EIO;
1048
1049	bad:
1050		dev_err(&dev->dev, "ignoring class %#08x (doesn't match header "
1051			"type %02x)\n", dev->class, dev->hdr_type);
1052		dev->class = PCI_CLASS_NOT_DEFINED;
1053	}
1054
1055	/* We found a fine healthy device, go go go... */
1056	return 0;
1057}
1058
1059static void pci_release_capabilities(struct pci_dev *dev)
1060{
1061	pci_vpd_release(dev);
1062	pci_iov_release(dev);
1063	pci_free_cap_save_buffers(dev);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1064}
1065
1066/**
1067 * pci_release_dev - free a pci device structure when all users of it are finished.
1068 * @dev: device that's been disconnected
1069 *
1070 * Will be called only by the device core when all users of this pci device are
1071 * done.
1072 */
1073static void pci_release_dev(struct device *dev)
 
1074{
1075	struct pci_dev *pci_dev;
1076
1077	pci_dev = to_pci_dev(dev);
1078	pci_release_capabilities(pci_dev);
1079	pci_release_of_node(pci_dev);
1080	kfree(pci_dev);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1081}
1082
1083/**
1084 * pci_cfg_space_size - get the configuration space size of the PCI device.
1085 * @dev: PCI device
1086 *
1087 * Regular PCI devices have 256 bytes, but PCI-X 2 and PCI Express devices
1088 * have 4096 bytes.  Even if the device is capable, that doesn't mean we can
1089 * access it.  Maybe we don't have a way to generate extended config space
1090 * accesses, or the device is behind a reverse Express bridge.  So we try
1091 * reading the dword at 0x100 which must either be 0 or a valid extended
1092 * capability header.
1093 */
1094int pci_cfg_space_size_ext(struct pci_dev *dev)
1095{
1096	u32 status;
1097	int pos = PCI_CFG_SPACE_SIZE;
1098
1099	if (pci_read_config_dword(dev, pos, &status) != PCIBIOS_SUCCESSFUL)
1100		goto fail;
1101	if (status == 0xffffffff)
1102		goto fail;
1103
1104	return PCI_CFG_SPACE_EXP_SIZE;
1105
1106 fail:
1107	return PCI_CFG_SPACE_SIZE;
1108}
 
1109
1110int pci_cfg_space_size(struct pci_dev *dev)
1111{
1112	int pos;
1113	u32 status;
1114	u16 class;
1115
1116	class = dev->class >> 8;
1117	if (class == PCI_CLASS_BRIDGE_HOST)
1118		return pci_cfg_space_size_ext(dev);
1119
1120	pos = pci_pcie_cap(dev);
1121	if (!pos) {
1122		pos = pci_find_capability(dev, PCI_CAP_ID_PCIX);
1123		if (!pos)
1124			goto fail;
1125
1126		pci_read_config_dword(dev, pos + PCI_X_STATUS, &status);
1127		if (!(status & (PCI_X_STATUS_266MHZ | PCI_X_STATUS_533MHZ)))
1128			goto fail;
 
 
 
 
 
 
 
 
 
1129	}
 
1130
1131	return pci_cfg_space_size_ext(dev);
 
 
 
 
1132
1133 fail:
1134	return PCI_CFG_SPACE_SIZE;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1135}
1136
1137static void pci_release_bus_bridge_dev(struct device *dev)
1138{
1139	struct pci_host_bridge *bridge = to_pci_host_bridge(dev);
 
1140
1141	if (bridge->release_fn)
1142		bridge->release_fn(bridge);
 
 
 
 
 
 
 
1143
1144	pci_free_resource_list(&bridge->windows);
 
 
 
1145
1146	kfree(bridge);
 
 
 
 
1147}
1148
1149struct pci_dev *alloc_pci_dev(void)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1150{
1151	struct pci_dev *dev;
1152
1153	dev = kzalloc(sizeof(struct pci_dev), GFP_KERNEL);
1154	if (!dev)
1155		return NULL;
1156
1157	INIT_LIST_HEAD(&dev->bus_list);
 
 
1158
1159	return dev;
1160}
1161EXPORT_SYMBOL(alloc_pci_dev);
1162
1163bool pci_bus_read_dev_vendor_id(struct pci_bus *bus, int devfn, u32 *l,
1164				 int crs_timeout)
 
 
 
 
 
1165{
1166	int delay = 1;
1167
1168	if (pci_bus_read_config_dword(bus, devfn, PCI_VENDOR_ID, l))
1169		return false;
1170
1171	/* some broken boards return 0 or ~0 if a slot is empty: */
1172	if (*l == 0xffffffff || *l == 0x00000000 ||
1173	    *l == 0x0000ffff || *l == 0xffff0000)
1174		return false;
 
 
 
 
 
 
 
 
 
1175
1176	/* Configuration request Retry Status */
1177	while (*l == 0xffff0001) {
1178		if (!crs_timeout)
1179			return false;
 
 
 
 
 
1180
1181		msleep(delay);
1182		delay *= 2;
 
1183		if (pci_bus_read_config_dword(bus, devfn, PCI_VENDOR_ID, l))
1184			return false;
1185		/* Card hasn't responded in 60 seconds?  Must be stuck. */
1186		if (delay > crs_timeout) {
1187			printk(KERN_WARNING "pci %04x:%02x:%02x.%d: not "
1188					"responding\n", pci_domain_nr(bus),
1189					bus->number, PCI_SLOT(devfn),
1190					PCI_FUNC(devfn));
1191			return false;
1192		}
1193	}
1194
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1195	return true;
1196}
1197EXPORT_SYMBOL(pci_bus_read_dev_vendor_id);
1198
1199/*
1200 * Read the config data for a PCI device, sanity-check it
1201 * and fill in the dev structure...
1202 */
1203static struct pci_dev *pci_scan_device(struct pci_bus *bus, int devfn)
1204{
1205	struct pci_dev *dev;
1206	u32 l;
1207
1208	if (!pci_bus_read_dev_vendor_id(bus, devfn, &l, 60*1000))
1209		return NULL;
1210
1211	dev = alloc_pci_dev();
1212	if (!dev)
1213		return NULL;
1214
1215	dev->bus = bus;
1216	dev->devfn = devfn;
1217	dev->vendor = l & 0xffff;
1218	dev->device = (l >> 16) & 0xffff;
1219
1220	pci_set_of_node(dev);
1221
1222	if (pci_setup_device(dev)) {
 
1223		kfree(dev);
1224		return NULL;
1225	}
1226
1227	return dev;
1228}
1229
1230static void pci_init_capabilities(struct pci_dev *dev)
1231{
1232	/* MSI/MSI-X list */
1233	pci_msi_init_pci_dev(dev);
 
 
 
1234
1235	/* Buffers for saving PCIe and PCI-X capabilities */
1236	pci_allocate_cap_save_buffers(dev);
1237
1238	/* Power Management */
1239	pci_pm_init(dev);
1240	platform_pci_wakeup_init(dev);
1241
1242	/* Vital Product Data */
1243	pci_vpd_pci22_init(dev);
1244
1245	/* Alternative Routing-ID Forwarding */
1246	pci_enable_ari(dev);
1247
1248	/* Single Root I/O Virtualization */
1249	pci_iov_init(dev);
1250
 
 
 
1251	/* Enable ACS P2P upstream forwarding */
1252	pci_enable_acs(dev);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1253}
1254
1255void pci_device_add(struct pci_dev *dev, struct pci_bus *bus)
1256{
 
 
 
 
1257	device_initialize(&dev->dev);
1258	dev->dev.release = pci_release_dev;
1259	pci_dev_get(dev);
1260
 
1261	dev->dev.dma_mask = &dev->dma_mask;
1262	dev->dev.dma_parms = &dev->dma_parms;
1263	dev->dev.coherent_dma_mask = 0xffffffffull;
1264
1265	pci_set_dma_max_seg_size(dev, 65536);
1266	pci_set_dma_seg_boundary(dev, 0xffffffff);
1267
1268	/* Fix up broken headers */
1269	pci_fixup_device(pci_fixup_header, dev);
1270
1271	/* moved out from quirk header fixup code */
1272	pci_reassigndev_resource_alignment(dev);
1273
1274	/* Clear the state_saved flag. */
1275	dev->state_saved = false;
1276
1277	/* Initialize various capabilities */
1278	pci_init_capabilities(dev);
1279
1280	/*
1281	 * Add the device to our list of discovered devices
1282	 * and the bus list for fixup functions, etc.
1283	 */
1284	down_write(&pci_bus_sem);
1285	list_add_tail(&dev->bus_list, &bus->devices);
1286	up_write(&pci_bus_sem);
 
 
 
 
 
 
 
 
 
 
 
1287}
1288
1289struct pci_dev *__ref pci_scan_single_device(struct pci_bus *bus, int devfn)
1290{
1291	struct pci_dev *dev;
1292
1293	dev = pci_get_slot(bus, devfn);
1294	if (dev) {
1295		pci_dev_put(dev);
1296		return dev;
1297	}
1298
1299	dev = pci_scan_device(bus, devfn);
1300	if (!dev)
1301		return NULL;
1302
1303	pci_device_add(dev, bus);
1304
1305	return dev;
1306}
1307EXPORT_SYMBOL(pci_scan_single_device);
1308
1309static unsigned next_ari_fn(struct pci_dev *dev, unsigned fn)
1310{
1311	u16 cap;
1312	unsigned pos, next_fn;
 
1313
1314	if (!dev)
1315		return 0;
 
 
 
 
1316
1317	pos = pci_find_ext_capability(dev, PCI_EXT_CAP_ID_ARI);
1318	if (!pos)
1319		return 0;
1320	pci_read_config_word(dev, pos + 4, &cap);
1321	next_fn = cap >> 8;
1322	if (next_fn <= fn)
1323		return 0;
1324	return next_fn;
1325}
1326
1327static unsigned next_trad_fn(struct pci_dev *dev, unsigned fn)
1328{
1329	return (fn + 1) % 8;
1330}
 
 
1331
1332static unsigned no_next_fn(struct pci_dev *dev, unsigned fn)
1333{
1334	return 0;
1335}
1336
1337static int only_one_child(struct pci_bus *bus)
1338{
1339	struct pci_dev *parent = bus->self;
1340
1341	if (!parent || !pci_is_pcie(parent))
 
 
 
 
1342		return 0;
1343	if (parent->pcie_type == PCI_EXP_TYPE_ROOT_PORT)
1344		return 1;
1345	if (parent->pcie_type == PCI_EXP_TYPE_DOWNSTREAM &&
1346	    !pci_has_flag(PCI_SCAN_ALL_PCIE_DEVS))
 
 
 
 
 
 
 
1347		return 1;
 
1348	return 0;
1349}
1350
1351/**
1352 * pci_scan_slot - scan a PCI slot on a bus for devices.
1353 * @bus: PCI bus to scan
1354 * @devfn: slot number to scan (must have zero function.)
1355 *
1356 * Scan a PCI slot on the specified PCI bus for devices, adding
1357 * discovered devices to the @bus->devices list.  New devices
1358 * will not have is_added set.
1359 *
1360 * Returns the number of new devices found.
1361 */
1362int pci_scan_slot(struct pci_bus *bus, int devfn)
1363{
1364	unsigned fn, nr = 0;
1365	struct pci_dev *dev;
1366	unsigned (*next_fn)(struct pci_dev *, unsigned) = no_next_fn;
1367
1368	if (only_one_child(bus) && (devfn > 0))
1369		return 0; /* Already scanned the entire slot */
1370
1371	dev = pci_scan_single_device(bus, devfn);
1372	if (!dev)
1373		return 0;
1374	if (!dev->is_added)
1375		nr++;
1376
1377	if (pci_ari_enabled(bus))
1378		next_fn = next_ari_fn;
1379	else if (dev->multifunction)
1380		next_fn = next_trad_fn;
1381
1382	for (fn = next_fn(dev, 0); fn > 0; fn = next_fn(dev, fn)) {
1383		dev = pci_scan_single_device(bus, devfn + fn);
1384		if (dev) {
1385			if (!dev->is_added)
1386				nr++;
1387			dev->multifunction = 1;
1388		}
1389	}
1390
1391	/* only one slot has pcie device */
1392	if (bus->self && nr)
1393		pcie_aspm_init_link_state(bus->self);
1394
1395	return nr;
1396}
 
1397
1398static int pcie_find_smpss(struct pci_dev *dev, void *data)
1399{
1400	u8 *smpss = data;
1401
1402	if (!pci_is_pcie(dev))
1403		return 0;
1404
1405	/* For PCIE hotplug enabled slots not connected directly to a
1406	 * PCI-E root port, there can be problems when hotplugging
1407	 * devices.  This is due to the possibility of hotplugging a
1408	 * device into the fabric with a smaller MPS that the devices
1409	 * currently running have configured.  Modifying the MPS on the
1410	 * running devices could cause a fatal bus error due to an
1411	 * incoming frame being larger than the newly configured MPS.
1412	 * To work around this, the MPS for the entire fabric must be
1413	 * set to the minimum size.  Any devices hotplugged into this
1414	 * fabric will have the minimum MPS set.  If the PCI hotplug
1415	 * slot is directly connected to the root port and there are not
1416	 * other devices on the fabric (which seems to be the most
1417	 * common case), then this is not an issue and MPS discovery
1418	 * will occur as normal.
1419	 */
1420	if (dev->is_hotplug_bridge && (!list_is_singular(&dev->bus->devices) ||
1421	     (dev->bus->self &&
1422	      dev->bus->self->pcie_type != PCI_EXP_TYPE_ROOT_PORT)))
1423		*smpss = 0;
1424
1425	if (*smpss > dev->pcie_mpss)
1426		*smpss = dev->pcie_mpss;
1427
1428	return 0;
1429}
1430
1431static void pcie_write_mps(struct pci_dev *dev, int mps)
1432{
1433	int rc;
1434
1435	if (pcie_bus_config == PCIE_BUS_PERFORMANCE) {
1436		mps = 128 << dev->pcie_mpss;
1437
1438		if (dev->pcie_type != PCI_EXP_TYPE_ROOT_PORT && dev->bus->self)
1439			/* For "Performance", the assumption is made that
 
 
 
1440			 * downstream communication will never be larger than
1441			 * the MRRS.  So, the MPS only needs to be configured
1442			 * for the upstream communication.  This being the case,
1443			 * walk from the top down and set the MPS of the child
1444			 * to that of the parent bus.
1445			 *
1446			 * Configure the device MPS with the smaller of the
1447			 * device MPSS or the bridge MPS (which is assumed to be
1448			 * properly configured at this point to the largest
1449			 * allowable MPS based on its parent bus).
1450			 */
1451			mps = min(mps, pcie_get_mps(dev->bus->self));
1452	}
1453
1454	rc = pcie_set_mps(dev, mps);
1455	if (rc)
1456		dev_err(&dev->dev, "Failed attempting to set the MPS\n");
1457}
1458
1459static void pcie_write_mrrs(struct pci_dev *dev)
1460{
1461	int rc, mrrs;
1462
1463	/* In the "safe" case, do not configure the MRRS.  There appear to be
 
1464	 * issues with setting MRRS to 0 on a number of devices.
1465	 */
1466	if (pcie_bus_config != PCIE_BUS_PERFORMANCE)
1467		return;
1468
1469	/* For Max performance, the MRRS must be set to the largest supported
 
1470	 * value.  However, it cannot be configured larger than the MPS the
1471	 * device or the bus can support.  This should already be properly
1472	 * configured by a prior call to pcie_write_mps.
1473	 */
1474	mrrs = pcie_get_mps(dev);
1475
1476	/* MRRS is a R/W register.  Invalid values can be written, but a
 
1477	 * subsequent read will verify if the value is acceptable or not.
1478	 * If the MRRS value provided is not acceptable (e.g., too large),
1479	 * shrink the value until it is acceptable to the HW.
1480 	 */
1481	while (mrrs != pcie_get_readrq(dev) && mrrs >= 128) {
1482		rc = pcie_set_readrq(dev, mrrs);
1483		if (!rc)
1484			break;
1485
1486		dev_warn(&dev->dev, "Failed attempting to set the MRRS\n");
1487		mrrs /= 2;
1488	}
1489
1490	if (mrrs < 128)
1491		dev_err(&dev->dev, "MRRS was unable to be configured with a "
1492			"safe value.  If problems are experienced, try running "
1493			"with pci=pcie_bus_safe.\n");
1494}
1495
1496static int pcie_bus_configure_set(struct pci_dev *dev, void *data)
1497{
1498	int mps, orig_mps;
1499
1500	if (!pci_is_pcie(dev))
1501		return 0;
1502
 
 
 
 
1503	mps = 128 << *(u8 *)data;
1504	orig_mps = pcie_get_mps(dev);
1505
1506	pcie_write_mps(dev, mps);
1507	pcie_write_mrrs(dev);
1508
1509	dev_info(&dev->dev, "PCI-E Max Payload Size set to %4d/%4d (was %4d), "
1510		 "Max Read Rq %4d\n", pcie_get_mps(dev), 128 << dev->pcie_mpss,
1511		 orig_mps, pcie_get_readrq(dev));
1512
1513	return 0;
1514}
1515
1516/* pcie_bus_configure_settings requires that pci_walk_bus work in a top-down,
 
1517 * parents then children fashion.  If this changes, then this code will not
1518 * work as designed.
1519 */
1520void pcie_bus_configure_settings(struct pci_bus *bus, u8 mpss)
1521{
1522	u8 smpss;
1523
1524	if (!pci_is_pcie(bus->self))
1525		return;
1526
1527	if (pcie_bus_config == PCIE_BUS_TUNE_OFF)
1528		return;
1529
1530	/* FIXME - Peer to peer DMA is possible, though the endpoint would need
1531	 * to be aware to the MPS of the destination.  To work around this,
 
1532	 * simply force the MPS of the entire system to the smallest possible.
1533	 */
1534	if (pcie_bus_config == PCIE_BUS_PEER2PEER)
1535		smpss = 0;
1536
1537	if (pcie_bus_config == PCIE_BUS_SAFE) {
1538		smpss = mpss;
1539
1540		pcie_find_smpss(bus->self, &smpss);
1541		pci_walk_bus(bus, pcie_find_smpss, &smpss);
1542	}
1543
1544	pcie_bus_configure_set(bus->self, &smpss);
1545	pci_walk_bus(bus, pcie_bus_configure_set, &smpss);
1546}
1547EXPORT_SYMBOL_GPL(pcie_bus_configure_settings);
1548
1549unsigned int __devinit pci_scan_child_bus(struct pci_bus *bus)
 
 
 
 
1550{
1551	unsigned int devfn, pass, max = bus->secondary;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1552	struct pci_dev *dev;
 
1553
1554	dev_dbg(&bus->dev, "scanning bus\n");
1555
1556	/* Go find them, Rover! */
1557	for (devfn = 0; devfn < 0x100; devfn += 8)
1558		pci_scan_slot(bus, devfn);
1559
1560	/* Reserve buses for SR-IOV capability. */
1561	max += pci_iov_bus_range(bus);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1562
1563	/*
1564	 * After performing arch-dependent fixup of the bus, look behind
1565	 * all PCI-to-PCI bridges on this bus.
1566	 */
1567	if (!bus->is_added) {
1568		dev_dbg(&bus->dev, "fixups for bus\n");
1569		pcibios_fixup_bus(bus);
1570		if (pci_is_root_bus(bus))
1571			bus->is_added = 1;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1572	}
1573
1574	for (pass=0; pass < 2; pass++)
1575		list_for_each_entry(dev, &bus->devices, bus_list) {
1576			if (dev->hdr_type == PCI_HEADER_TYPE_BRIDGE ||
1577			    dev->hdr_type == PCI_HEADER_TYPE_CARDBUS)
1578				max = pci_scan_bridge(bus, dev, max, pass);
 
 
 
 
 
 
 
 
 
 
 
 
1579		}
 
1580
1581	/*
1582	 * We've scanned the bus and so we know all about what's on
1583	 * the other side of any bridges that may be on this bus plus
1584	 * any devices.
1585	 *
1586	 * Return how far we've got finding sub-buses.
1587	 */
1588	dev_dbg(&bus->dev, "bus scan returning with max=%02x\n", max);
1589	return max;
1590}
1591
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1592struct pci_bus *pci_create_root_bus(struct device *parent, int bus,
1593		struct pci_ops *ops, void *sysdata, struct list_head *resources)
1594{
1595	int error;
1596	struct pci_host_bridge *bridge;
1597	struct pci_bus *b, *b2;
1598	struct pci_host_bridge_window *window, *n;
1599	struct resource *res;
1600	resource_size_t offset;
1601	char bus_addr[64];
1602	char *fmt;
1603
1604
1605	b = pci_alloc_bus();
1606	if (!b)
1607		return NULL;
1608
1609	b->sysdata = sysdata;
1610	b->ops = ops;
1611	b2 = pci_find_bus(pci_domain_nr(b), bus);
1612	if (b2) {
1613		/* If we already got to this bus through a different bridge, ignore it */
1614		dev_dbg(&b2->dev, "bus already known\n");
 
 
 
1615		goto err_out;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1616	}
1617
1618	bridge = pci_alloc_host_bridge(b);
1619	if (!bridge)
1620		goto err_out;
1621
1622	bridge->dev.parent = parent;
1623	bridge->dev.release = pci_release_bus_bridge_dev;
1624	dev_set_name(&bridge->dev, "pci%04x:%02x", pci_domain_nr(b), bus);
1625	error = device_register(&bridge->dev);
1626	if (error)
1627		goto bridge_dev_reg_err;
1628	b->bridge = get_device(&bridge->dev);
1629	device_enable_async_suspend(b->bridge);
1630	pci_set_bus_of_node(b);
 
1631
1632	if (!parent)
1633		set_dev_node(b->bridge, pcibus_to_node(b));
 
1634
1635	b->dev.class = &pcibus_class;
1636	b->dev.parent = b->bridge;
1637	dev_set_name(&b->dev, "%04x:%02x", pci_domain_nr(b), bus);
1638	error = device_register(&b->dev);
1639	if (error)
1640		goto class_dev_reg_err;
1641
1642	/* Create legacy_io and legacy_mem files for this bus */
1643	pci_create_legacy_files(b);
 
 
1644
1645	b->number = b->secondary = bus;
 
 
1646
1647	if (parent)
1648		dev_info(parent, "PCI host bridge to bus %s\n", dev_name(&b->dev));
1649	else
1650		printk(KERN_INFO "PCI host bridge to bus %s\n", dev_name(&b->dev));
 
 
1651
1652	/* Add initial resources to the bus */
1653	list_for_each_entry_safe(window, n, resources, list) {
1654		list_move_tail(&window->list, &bridge->windows);
1655		res = window->res;
1656		offset = window->offset;
1657		pci_bus_add_resource(b, res, 0);
1658		if (offset) {
1659			if (resource_type(res) == IORESOURCE_IO)
1660				fmt = " (bus address [%#06llx-%#06llx])";
1661			else
1662				fmt = " (bus address [%#010llx-%#010llx])";
1663			snprintf(bus_addr, sizeof(bus_addr), fmt,
1664				 (unsigned long long) (res->start - offset),
1665				 (unsigned long long) (res->end - offset));
1666		} else
1667			bus_addr[0] = '\0';
1668		dev_info(&b->dev, "root bus resource %pR%s\n", res, bus_addr);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1669	}
1670
1671	down_write(&pci_bus_sem);
1672	list_add_tail(&b->node, &pci_root_buses);
1673	up_write(&pci_bus_sem);
1674
1675	return b;
 
1676
1677class_dev_reg_err:
1678	put_device(&bridge->dev);
1679	device_unregister(&bridge->dev);
1680bridge_dev_reg_err:
1681	kfree(bridge);
1682err_out:
1683	kfree(b);
1684	return NULL;
1685}
 
1686
1687struct pci_bus * __devinit pci_scan_root_bus(struct device *parent, int bus,
1688		struct pci_ops *ops, void *sysdata, struct list_head *resources)
1689{
 
 
1690	struct pci_bus *b;
 
 
 
 
 
 
 
1691
1692	b = pci_create_root_bus(parent, bus, ops, sysdata, resources);
1693	if (!b)
1694		return NULL;
1695
1696	b->subordinate = pci_scan_child_bus(b);
1697	pci_bus_add_devices(b);
1698	return b;
1699}
1700EXPORT_SYMBOL(pci_scan_root_bus);
 
1701
1702/* Deprecated; use pci_scan_root_bus() instead */
1703struct pci_bus * __devinit pci_scan_bus_parented(struct device *parent,
1704		int bus, struct pci_ops *ops, void *sysdata)
1705{
1706	LIST_HEAD(resources);
1707	struct pci_bus *b;
1708
1709	pci_add_resource(&resources, &ioport_resource);
1710	pci_add_resource(&resources, &iomem_resource);
1711	b = pci_create_root_bus(parent, bus, ops, sysdata, &resources);
1712	if (b)
1713		b->subordinate = pci_scan_child_bus(b);
1714	else
1715		pci_free_resource_list(&resources);
1716	return b;
1717}
1718EXPORT_SYMBOL(pci_scan_bus_parented);
1719
1720struct pci_bus * __devinit pci_scan_bus(int bus, struct pci_ops *ops,
1721					void *sysdata)
1722{
1723	LIST_HEAD(resources);
1724	struct pci_bus *b;
1725
1726	pci_add_resource(&resources, &ioport_resource);
1727	pci_add_resource(&resources, &iomem_resource);
 
1728	b = pci_create_root_bus(NULL, bus, ops, sysdata, &resources);
1729	if (b) {
1730		b->subordinate = pci_scan_child_bus(b);
1731		pci_bus_add_devices(b);
1732	} else {
1733		pci_free_resource_list(&resources);
1734	}
1735	return b;
1736}
1737EXPORT_SYMBOL(pci_scan_bus);
1738
1739#ifdef CONFIG_HOTPLUG
1740/**
1741 * pci_rescan_bus_bridge_resize - scan a PCI bus for devices.
1742 * @bridge: PCI bridge for the bus to scan
1743 *
1744 * Scan a PCI bus and child buses for new devices, add them,
1745 * and enable them, resizing bridge mmio/io resource if necessary
1746 * and possible.  The caller must ensure the child devices are already
1747 * removed for resizing to occur.
1748 *
1749 * Returns the max number of subordinate bus discovered.
1750 */
1751unsigned int __ref pci_rescan_bus_bridge_resize(struct pci_dev *bridge)
1752{
1753	unsigned int max;
1754	struct pci_bus *bus = bridge->subordinate;
1755
1756	max = pci_scan_child_bus(bus);
1757
1758	pci_assign_unassigned_bridge_resources(bridge);
1759
1760	pci_bus_add_devices(bus);
1761
1762	return max;
1763}
1764
1765EXPORT_SYMBOL(pci_add_new_bus);
1766EXPORT_SYMBOL(pci_scan_slot);
1767EXPORT_SYMBOL(pci_scan_bridge);
1768EXPORT_SYMBOL_GPL(pci_scan_child_bus);
1769#endif
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1770
1771static int __init pci_sort_bf_cmp(const struct device *d_a, const struct device *d_b)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1772{
1773	const struct pci_dev *a = to_pci_dev(d_a);
1774	const struct pci_dev *b = to_pci_dev(d_b);
1775
1776	if      (pci_domain_nr(a->bus) < pci_domain_nr(b->bus)) return -1;
1777	else if (pci_domain_nr(a->bus) > pci_domain_nr(b->bus)) return  1;
1778
1779	if      (a->bus->number < b->bus->number) return -1;
1780	else if (a->bus->number > b->bus->number) return  1;
1781
1782	if      (a->devfn < b->devfn) return -1;
1783	else if (a->devfn > b->devfn) return  1;
1784
1785	return 0;
1786}
1787
1788void __init pci_sort_breadthfirst(void)
1789{
1790	bus_sort_breadthfirst(&pci_bus_type, &pci_sort_bf_cmp);
1791}
v4.17
   1// SPDX-License-Identifier: GPL-2.0
   2/*
   3 * PCI detection and setup code
   4 */
   5
   6#include <linux/kernel.h>
   7#include <linux/delay.h>
   8#include <linux/init.h>
   9#include <linux/pci.h>
  10#include <linux/of_device.h>
  11#include <linux/of_pci.h>
  12#include <linux/pci_hotplug.h>
  13#include <linux/slab.h>
  14#include <linux/module.h>
  15#include <linux/cpumask.h>
  16#include <linux/pci-aspm.h>
  17#include <linux/aer.h>
  18#include <linux/acpi.h>
  19#include <linux/hypervisor.h>
  20#include <linux/irqdomain.h>
  21#include <linux/pm_runtime.h>
  22#include "pci.h"
  23
  24#define CARDBUS_LATENCY_TIMER	176	/* secondary latency timer */
  25#define CARDBUS_RESERVE_BUSNR	3
  26
  27static struct resource busn_resource = {
  28	.name	= "PCI busn",
  29	.start	= 0,
  30	.end	= 255,
  31	.flags	= IORESOURCE_BUS,
  32};
  33
  34/* Ugh.  Need to stop exporting this to modules. */
  35LIST_HEAD(pci_root_buses);
  36EXPORT_SYMBOL(pci_root_buses);
  37
  38static LIST_HEAD(pci_domain_busn_res_list);
  39
  40struct pci_domain_busn_res {
  41	struct list_head list;
  42	struct resource res;
  43	int domain_nr;
  44};
  45
  46static struct resource *get_pci_domain_busn_res(int domain_nr)
  47{
  48	struct pci_domain_busn_res *r;
  49
  50	list_for_each_entry(r, &pci_domain_busn_res_list, list)
  51		if (r->domain_nr == domain_nr)
  52			return &r->res;
  53
  54	r = kzalloc(sizeof(*r), GFP_KERNEL);
  55	if (!r)
  56		return NULL;
  57
  58	r->domain_nr = domain_nr;
  59	r->res.start = 0;
  60	r->res.end = 0xff;
  61	r->res.flags = IORESOURCE_BUS | IORESOURCE_PCI_FIXED;
  62
  63	list_add_tail(&r->list, &pci_domain_busn_res_list);
  64
  65	return &r->res;
  66}
  67
  68static int find_anything(struct device *dev, void *data)
  69{
  70	return 1;
  71}
  72
  73/*
  74 * Some device drivers need know if PCI is initiated.
  75 * Basically, we think PCI is not initiated when there
  76 * is no device to be found on the pci_bus_type.
  77 */
  78int no_pci_devices(void)
  79{
  80	struct device *dev;
  81	int no_devices;
  82
  83	dev = bus_find_device(&pci_bus_type, NULL, NULL, find_anything);
  84	no_devices = (dev == NULL);
  85	put_device(dev);
  86	return no_devices;
  87}
  88EXPORT_SYMBOL(no_pci_devices);
  89
  90/*
  91 * PCI Bus Class
  92 */
  93static void release_pcibus_dev(struct device *dev)
  94{
  95	struct pci_bus *pci_bus = to_pci_bus(dev);
  96
  97	put_device(pci_bus->bridge);
 
  98	pci_bus_remove_resources(pci_bus);
  99	pci_release_bus_of_node(pci_bus);
 100	kfree(pci_bus);
 101}
 102
 103static struct class pcibus_class = {
 104	.name		= "pci_bus",
 105	.dev_release	= &release_pcibus_dev,
 106	.dev_groups	= pcibus_groups,
 107};
 108
 109static int __init pcibus_class_init(void)
 110{
 111	return class_register(&pcibus_class);
 112}
 113postcore_initcall(pcibus_class_init);
 114
 115static u64 pci_size(u64 base, u64 maxbase, u64 mask)
 116{
 117	u64 size = mask & maxbase;	/* Find the significant bits */
 118	if (!size)
 119		return 0;
 120
 121	/*
 122	 * Get the lowest of them to find the decode size, and from that
 123	 * the extent.
 124	 */
 125	size = (size & ~(size-1)) - 1;
 126
 127	/*
 128	 * base == maxbase can be valid only if the BAR has already been
 129	 * programmed with all 1s.
 130	 */
 131	if (base == maxbase && ((base | size) & mask) != mask)
 132		return 0;
 133
 134	return size;
 135}
 136
 137static inline unsigned long decode_bar(struct pci_dev *dev, u32 bar)
 138{
 139	u32 mem_type;
 140	unsigned long flags;
 141
 142	if ((bar & PCI_BASE_ADDRESS_SPACE) == PCI_BASE_ADDRESS_SPACE_IO) {
 143		flags = bar & ~PCI_BASE_ADDRESS_IO_MASK;
 144		flags |= IORESOURCE_IO;
 145		return flags;
 146	}
 147
 148	flags = bar & ~PCI_BASE_ADDRESS_MEM_MASK;
 149	flags |= IORESOURCE_MEM;
 150	if (flags & PCI_BASE_ADDRESS_MEM_PREFETCH)
 151		flags |= IORESOURCE_PREFETCH;
 152
 153	mem_type = bar & PCI_BASE_ADDRESS_MEM_TYPE_MASK;
 154	switch (mem_type) {
 155	case PCI_BASE_ADDRESS_MEM_TYPE_32:
 156		break;
 157	case PCI_BASE_ADDRESS_MEM_TYPE_1M:
 158		/* 1M mem BAR treated as 32-bit BAR */
 159		break;
 160	case PCI_BASE_ADDRESS_MEM_TYPE_64:
 161		flags |= IORESOURCE_MEM_64;
 162		break;
 163	default:
 164		/* mem unknown type treated as 32-bit BAR */
 
 
 165		break;
 166	}
 167	return flags;
 168}
 169
 170#define PCI_COMMAND_DECODE_ENABLE	(PCI_COMMAND_MEMORY | PCI_COMMAND_IO)
 171
 172/**
 173 * pci_read_base - Read a PCI BAR
 174 * @dev: the PCI device
 175 * @type: type of the BAR
 176 * @res: resource buffer to be filled in
 177 * @pos: BAR position in the config space
 178 *
 179 * Returns 1 if the BAR is 64-bit, or 0 if 32-bit.
 180 */
 181int __pci_read_base(struct pci_dev *dev, enum pci_bar_type type,
 182		    struct resource *res, unsigned int pos)
 183{
 184	u32 l = 0, sz = 0, mask;
 185	u64 l64, sz64, mask64;
 186	u16 orig_cmd;
 187	struct pci_bus_region region, inverted_region;
 188
 189	mask = type ? PCI_ROM_ADDRESS_MASK : ~0;
 190
 191	/* No printks while decoding is disabled! */
 192	if (!dev->mmio_always_on) {
 193		pci_read_config_word(dev, PCI_COMMAND, &orig_cmd);
 194		if (orig_cmd & PCI_COMMAND_DECODE_ENABLE) {
 195			pci_write_config_word(dev, PCI_COMMAND,
 196				orig_cmd & ~PCI_COMMAND_DECODE_ENABLE);
 197		}
 198	}
 199
 200	res->name = pci_name(dev);
 201
 202	pci_read_config_dword(dev, pos, &l);
 203	pci_write_config_dword(dev, pos, l | mask);
 204	pci_read_config_dword(dev, pos, &sz);
 205	pci_write_config_dword(dev, pos, l);
 206
 
 
 
 207	/*
 208	 * All bits set in sz means the device isn't working properly.
 209	 * If the BAR isn't implemented, all bits must be 0.  If it's a
 210	 * memory BAR or a ROM, bit 0 must be clear; if it's an io BAR, bit
 211	 * 1 must be clear.
 212	 */
 213	if (sz == 0xffffffff)
 214		sz = 0;
 215
 216	/*
 217	 * I don't know how l can have all bits set.  Copied from old code.
 218	 * Maybe it fixes a bug on some ancient platform.
 219	 */
 220	if (l == 0xffffffff)
 221		l = 0;
 222
 223	if (type == pci_bar_unknown) {
 224		res->flags = decode_bar(dev, l);
 225		res->flags |= IORESOURCE_SIZEALIGN;
 226		if (res->flags & IORESOURCE_IO) {
 227			l64 = l & PCI_BASE_ADDRESS_IO_MASK;
 228			sz64 = sz & PCI_BASE_ADDRESS_IO_MASK;
 229			mask64 = PCI_BASE_ADDRESS_IO_MASK & (u32)IO_SPACE_LIMIT;
 230		} else {
 231			l64 = l & PCI_BASE_ADDRESS_MEM_MASK;
 232			sz64 = sz & PCI_BASE_ADDRESS_MEM_MASK;
 233			mask64 = (u32)PCI_BASE_ADDRESS_MEM_MASK;
 234		}
 235	} else {
 236		if (l & PCI_ROM_ADDRESS_ENABLE)
 237			res->flags |= IORESOURCE_ROM_ENABLE;
 238		l64 = l & PCI_ROM_ADDRESS_MASK;
 239		sz64 = sz & PCI_ROM_ADDRESS_MASK;
 240		mask64 = PCI_ROM_ADDRESS_MASK;
 241	}
 242
 243	if (res->flags & IORESOURCE_MEM_64) {
 
 
 
 
 244		pci_read_config_dword(dev, pos + 4, &l);
 245		pci_write_config_dword(dev, pos + 4, ~0);
 246		pci_read_config_dword(dev, pos + 4, &sz);
 247		pci_write_config_dword(dev, pos + 4, l);
 248
 249		l64 |= ((u64)l << 32);
 250		sz64 |= ((u64)sz << 32);
 251		mask64 |= ((u64)~0 << 32);
 252	}
 253
 254	if (!dev->mmio_always_on && (orig_cmd & PCI_COMMAND_DECODE_ENABLE))
 255		pci_write_config_word(dev, PCI_COMMAND, orig_cmd);
 256
 257	if (!sz64)
 258		goto fail;
 259
 260	sz64 = pci_size(l64, sz64, mask64);
 261	if (!sz64) {
 262		pci_info(dev, FW_BUG "reg 0x%x: invalid BAR (can't size)\n",
 263			 pos);
 264		goto fail;
 265	}
 266
 267	if (res->flags & IORESOURCE_MEM_64) {
 268		if ((sizeof(pci_bus_addr_t) < 8 || sizeof(resource_size_t) < 8)
 269		    && sz64 > 0x100000000ULL) {
 270			res->flags |= IORESOURCE_UNSET | IORESOURCE_DISABLED;
 271			res->start = 0;
 272			res->end = 0;
 273			pci_err(dev, "reg 0x%x: can't handle BAR larger than 4GB (size %#010llx)\n",
 274				pos, (unsigned long long)sz64);
 275			goto out;
 
 
 
 276		}
 
 
 277
 278		if ((sizeof(pci_bus_addr_t) < 8) && l) {
 279			/* Above 32-bit boundary; try to reallocate */
 280			res->flags |= IORESOURCE_UNSET;
 281			res->start = 0;
 282			res->end = sz64;
 283			pci_info(dev, "reg 0x%x: can't handle BAR above 4GB (bus address %#010llx)\n",
 284				 pos, (unsigned long long)l64);
 285			goto out;
 286		}
 287	}
 288
 289	region.start = l64;
 290	region.end = l64 + sz64;
 291
 292	pcibios_bus_to_resource(dev->bus, res, &region);
 293	pcibios_resource_to_bus(dev->bus, &inverted_region, res);
 
 294
 295	/*
 296	 * If "A" is a BAR value (a bus address), "bus_to_resource(A)" is
 297	 * the corresponding resource address (the physical address used by
 298	 * the CPU.  Converting that resource address back to a bus address
 299	 * should yield the original BAR value:
 300	 *
 301	 *     resource_to_bus(bus_to_resource(A)) == A
 302	 *
 303	 * If it doesn't, CPU accesses to "bus_to_resource(A)" will not
 304	 * be claimed by the device.
 305	 */
 306	if (inverted_region.start != region.start) {
 307		res->flags |= IORESOURCE_UNSET;
 308		res->start = 0;
 309		res->end = region.end - region.start;
 310		pci_info(dev, "reg 0x%x: initial BAR value %#010llx invalid\n",
 311			 pos, (unsigned long long)region.start);
 312	}
 313
 
 
 
 
 314	goto out;
 315
 316
 317fail:
 318	res->flags = 0;
 319out:
 320	if (res->flags)
 321		pci_printk(KERN_DEBUG, dev, "reg 0x%x: %pR\n", pos, res);
 322
 323	return (res->flags & IORESOURCE_MEM_64) ? 1 : 0;
 324}
 325
 326static void pci_read_bases(struct pci_dev *dev, unsigned int howmany, int rom)
 327{
 328	unsigned int pos, reg;
 329
 330	if (dev->non_compliant_bars)
 331		return;
 332
 333	/* Per PCIe r4.0, sec 9.3.4.1.11, the VF BARs are all RO Zero */
 334	if (dev->is_virtfn)
 335		return;
 336
 337	for (pos = 0; pos < howmany; pos++) {
 338		struct resource *res = &dev->resource[pos];
 339		reg = PCI_BASE_ADDRESS_0 + (pos << 2);
 340		pos += __pci_read_base(dev, pci_bar_unknown, res, reg);
 341	}
 342
 343	if (rom) {
 344		struct resource *res = &dev->resource[PCI_ROM_RESOURCE];
 345		dev->rom_base_reg = rom;
 346		res->flags = IORESOURCE_MEM | IORESOURCE_PREFETCH |
 347				IORESOURCE_READONLY | IORESOURCE_SIZEALIGN;
 
 348		__pci_read_base(dev, pci_bar_mem32, res, rom);
 349	}
 350}
 351
 352static void pci_read_bridge_io(struct pci_bus *child)
 353{
 354	struct pci_dev *dev = child->self;
 355	u8 io_base_lo, io_limit_lo;
 356	unsigned long io_mask, io_granularity, base, limit;
 357	struct pci_bus_region region;
 358	struct resource *res;
 359
 360	io_mask = PCI_IO_RANGE_MASK;
 361	io_granularity = 0x1000;
 362	if (dev->io_window_1k) {
 363		/* Support 1K I/O space granularity */
 364		io_mask = PCI_IO_1K_RANGE_MASK;
 365		io_granularity = 0x400;
 366	}
 367
 368	res = child->resource[0];
 369	pci_read_config_byte(dev, PCI_IO_BASE, &io_base_lo);
 370	pci_read_config_byte(dev, PCI_IO_LIMIT, &io_limit_lo);
 371	base = (io_base_lo & io_mask) << 8;
 372	limit = (io_limit_lo & io_mask) << 8;
 373
 374	if ((io_base_lo & PCI_IO_RANGE_TYPE_MASK) == PCI_IO_RANGE_TYPE_32) {
 375		u16 io_base_hi, io_limit_hi;
 376
 377		pci_read_config_word(dev, PCI_IO_BASE_UPPER16, &io_base_hi);
 378		pci_read_config_word(dev, PCI_IO_LIMIT_UPPER16, &io_limit_hi);
 379		base |= ((unsigned long) io_base_hi << 16);
 380		limit |= ((unsigned long) io_limit_hi << 16);
 381	}
 382
 383	if (base <= limit) {
 384		res->flags = (io_base_lo & PCI_IO_RANGE_TYPE_MASK) | IORESOURCE_IO;
 
 385		region.start = base;
 386		region.end = limit + io_granularity - 1;
 387		pcibios_bus_to_resource(dev->bus, res, &region);
 388		pci_printk(KERN_DEBUG, dev, "  bridge window %pR\n", res);
 
 
 
 
 389	}
 390}
 391
 392static void pci_read_bridge_mmio(struct pci_bus *child)
 393{
 394	struct pci_dev *dev = child->self;
 395	u16 mem_base_lo, mem_limit_lo;
 396	unsigned long base, limit;
 397	struct pci_bus_region region;
 398	struct resource *res;
 399
 400	res = child->resource[1];
 401	pci_read_config_word(dev, PCI_MEMORY_BASE, &mem_base_lo);
 402	pci_read_config_word(dev, PCI_MEMORY_LIMIT, &mem_limit_lo);
 403	base = ((unsigned long) mem_base_lo & PCI_MEMORY_RANGE_MASK) << 16;
 404	limit = ((unsigned long) mem_limit_lo & PCI_MEMORY_RANGE_MASK) << 16;
 405	if (base <= limit) {
 406		res->flags = (mem_base_lo & PCI_MEMORY_RANGE_TYPE_MASK) | IORESOURCE_MEM;
 407		region.start = base;
 408		region.end = limit + 0xfffff;
 409		pcibios_bus_to_resource(dev->bus, res, &region);
 410		pci_printk(KERN_DEBUG, dev, "  bridge window %pR\n", res);
 411	}
 412}
 413
 414static void pci_read_bridge_mmio_pref(struct pci_bus *child)
 415{
 416	struct pci_dev *dev = child->self;
 417	u16 mem_base_lo, mem_limit_lo;
 418	u64 base64, limit64;
 419	pci_bus_addr_t base, limit;
 420	struct pci_bus_region region;
 421	struct resource *res;
 422
 423	res = child->resource[2];
 424	pci_read_config_word(dev, PCI_PREF_MEMORY_BASE, &mem_base_lo);
 425	pci_read_config_word(dev, PCI_PREF_MEMORY_LIMIT, &mem_limit_lo);
 426	base64 = (mem_base_lo & PCI_PREF_RANGE_MASK) << 16;
 427	limit64 = (mem_limit_lo & PCI_PREF_RANGE_MASK) << 16;
 428
 429	if ((mem_base_lo & PCI_PREF_RANGE_TYPE_MASK) == PCI_PREF_RANGE_TYPE_64) {
 430		u32 mem_base_hi, mem_limit_hi;
 431
 432		pci_read_config_dword(dev, PCI_PREF_BASE_UPPER32, &mem_base_hi);
 433		pci_read_config_dword(dev, PCI_PREF_LIMIT_UPPER32, &mem_limit_hi);
 434
 435		/*
 436		 * Some bridges set the base > limit by default, and some
 437		 * (broken) BIOSes do not initialize them.  If we find
 438		 * this, just assume they are not being used.
 439		 */
 440		if (mem_base_hi <= mem_limit_hi) {
 441			base64 |= (u64) mem_base_hi << 32;
 442			limit64 |= (u64) mem_limit_hi << 32;
 
 
 
 
 
 
 
 
 443		}
 444	}
 445
 446	base = (pci_bus_addr_t) base64;
 447	limit = (pci_bus_addr_t) limit64;
 448
 449	if (base != base64) {
 450		pci_err(dev, "can't handle bridge window above 4GB (bus address %#010llx)\n",
 451			(unsigned long long) base64);
 452		return;
 453	}
 454
 455	if (base <= limit) {
 456		res->flags = (mem_base_lo & PCI_PREF_RANGE_TYPE_MASK) |
 457					 IORESOURCE_MEM | IORESOURCE_PREFETCH;
 458		if (res->flags & PCI_PREF_RANGE_TYPE_64)
 459			res->flags |= IORESOURCE_MEM_64;
 460		region.start = base;
 461		region.end = limit + 0xfffff;
 462		pcibios_bus_to_resource(dev->bus, res, &region);
 463		pci_printk(KERN_DEBUG, dev, "  bridge window %pR\n", res);
 464	}
 465}
 466
 467void pci_read_bridge_bases(struct pci_bus *child)
 468{
 469	struct pci_dev *dev = child->self;
 470	struct resource *res;
 471	int i;
 472
 473	if (pci_is_root_bus(child))	/* It's a host bus, nothing to read */
 474		return;
 475
 476	pci_info(dev, "PCI bridge to %pR%s\n",
 477		 &child->busn_res,
 478		 dev->transparent ? " (subtractive decode)" : "");
 479
 480	pci_bus_remove_resources(child);
 481	for (i = 0; i < PCI_BRIDGE_RESOURCE_NUM; i++)
 482		child->resource[i] = &dev->resource[PCI_BRIDGE_RESOURCES+i];
 483
 484	pci_read_bridge_io(child);
 485	pci_read_bridge_mmio(child);
 486	pci_read_bridge_mmio_pref(child);
 487
 488	if (dev->transparent) {
 489		pci_bus_for_each_resource(child->parent, res, i) {
 490			if (res && res->flags) {
 491				pci_bus_add_resource(child, res,
 492						     PCI_SUBTRACTIVE_DECODE);
 493				pci_printk(KERN_DEBUG, dev,
 494					   "  bridge window %pR (subtractive decode)\n",
 495					   res);
 496			}
 497		}
 498	}
 499}
 500
 501static struct pci_bus *pci_alloc_bus(struct pci_bus *parent)
 502{
 503	struct pci_bus *b;
 504
 505	b = kzalloc(sizeof(*b), GFP_KERNEL);
 506	if (!b)
 507		return NULL;
 508
 509	INIT_LIST_HEAD(&b->node);
 510	INIT_LIST_HEAD(&b->children);
 511	INIT_LIST_HEAD(&b->devices);
 512	INIT_LIST_HEAD(&b->slots);
 513	INIT_LIST_HEAD(&b->resources);
 514	b->max_bus_speed = PCI_SPEED_UNKNOWN;
 515	b->cur_bus_speed = PCI_SPEED_UNKNOWN;
 516#ifdef CONFIG_PCI_DOMAINS_GENERIC
 517	if (parent)
 518		b->domain_nr = parent->domain_nr;
 519#endif
 520	return b;
 521}
 522
 523static void devm_pci_release_host_bridge_dev(struct device *dev)
 524{
 525	struct pci_host_bridge *bridge = to_pci_host_bridge(dev);
 526
 527	if (bridge->release_fn)
 528		bridge->release_fn(bridge);
 529}
 530
 531static void pci_release_host_bridge_dev(struct device *dev)
 532{
 533	devm_pci_release_host_bridge_dev(dev);
 534	pci_free_host_bridge(to_pci_host_bridge(dev));
 535}
 536
 537struct pci_host_bridge *pci_alloc_host_bridge(size_t priv)
 538{
 539	struct pci_host_bridge *bridge;
 540
 541	bridge = kzalloc(sizeof(*bridge) + priv, GFP_KERNEL);
 542	if (!bridge)
 543		return NULL;
 544
 545	INIT_LIST_HEAD(&bridge->windows);
 546	bridge->dev.release = pci_release_host_bridge_dev;
 547
 548	/*
 549	 * We assume we can manage these PCIe features.  Some systems may
 550	 * reserve these for use by the platform itself, e.g., an ACPI BIOS
 551	 * may implement its own AER handling and use _OSC to prevent the
 552	 * OS from interfering.
 553	 */
 554	bridge->native_aer = 1;
 555	bridge->native_hotplug = 1;
 556	bridge->native_pme = 1;
 557
 558	return bridge;
 559}
 560EXPORT_SYMBOL(pci_alloc_host_bridge);
 561
 562struct pci_host_bridge *devm_pci_alloc_host_bridge(struct device *dev,
 563						   size_t priv)
 564{
 565	struct pci_host_bridge *bridge;
 566
 567	bridge = devm_kzalloc(dev, sizeof(*bridge) + priv, GFP_KERNEL);
 568	if (!bridge)
 569		return NULL;
 570
 571	INIT_LIST_HEAD(&bridge->windows);
 572	bridge->dev.release = devm_pci_release_host_bridge_dev;
 573
 574	return bridge;
 575}
 576EXPORT_SYMBOL(devm_pci_alloc_host_bridge);
 577
 578void pci_free_host_bridge(struct pci_host_bridge *bridge)
 579{
 580	pci_free_resource_list(&bridge->windows);
 581
 582	kfree(bridge);
 583}
 584EXPORT_SYMBOL(pci_free_host_bridge);
 585
 586static const unsigned char pcix_bus_speed[] = {
 587	PCI_SPEED_UNKNOWN,		/* 0 */
 588	PCI_SPEED_66MHz_PCIX,		/* 1 */
 589	PCI_SPEED_100MHz_PCIX,		/* 2 */
 590	PCI_SPEED_133MHz_PCIX,		/* 3 */
 591	PCI_SPEED_UNKNOWN,		/* 4 */
 592	PCI_SPEED_66MHz_PCIX_ECC,	/* 5 */
 593	PCI_SPEED_100MHz_PCIX_ECC,	/* 6 */
 594	PCI_SPEED_133MHz_PCIX_ECC,	/* 7 */
 595	PCI_SPEED_UNKNOWN,		/* 8 */
 596	PCI_SPEED_66MHz_PCIX_266,	/* 9 */
 597	PCI_SPEED_100MHz_PCIX_266,	/* A */
 598	PCI_SPEED_133MHz_PCIX_266,	/* B */
 599	PCI_SPEED_UNKNOWN,		/* C */
 600	PCI_SPEED_66MHz_PCIX_533,	/* D */
 601	PCI_SPEED_100MHz_PCIX_533,	/* E */
 602	PCI_SPEED_133MHz_PCIX_533	/* F */
 603};
 604
 605const unsigned char pcie_link_speed[] = {
 606	PCI_SPEED_UNKNOWN,		/* 0 */
 607	PCIE_SPEED_2_5GT,		/* 1 */
 608	PCIE_SPEED_5_0GT,		/* 2 */
 609	PCIE_SPEED_8_0GT,		/* 3 */
 610	PCIE_SPEED_16_0GT,		/* 4 */
 611	PCI_SPEED_UNKNOWN,		/* 5 */
 612	PCI_SPEED_UNKNOWN,		/* 6 */
 613	PCI_SPEED_UNKNOWN,		/* 7 */
 614	PCI_SPEED_UNKNOWN,		/* 8 */
 615	PCI_SPEED_UNKNOWN,		/* 9 */
 616	PCI_SPEED_UNKNOWN,		/* A */
 617	PCI_SPEED_UNKNOWN,		/* B */
 618	PCI_SPEED_UNKNOWN,		/* C */
 619	PCI_SPEED_UNKNOWN,		/* D */
 620	PCI_SPEED_UNKNOWN,		/* E */
 621	PCI_SPEED_UNKNOWN		/* F */
 622};
 623
 624void pcie_update_link_speed(struct pci_bus *bus, u16 linksta)
 625{
 626	bus->cur_bus_speed = pcie_link_speed[linksta & PCI_EXP_LNKSTA_CLS];
 627}
 628EXPORT_SYMBOL_GPL(pcie_update_link_speed);
 629
 630static unsigned char agp_speeds[] = {
 631	AGP_UNKNOWN,
 632	AGP_1X,
 633	AGP_2X,
 634	AGP_4X,
 635	AGP_8X
 636};
 637
 638static enum pci_bus_speed agp_speed(int agp3, int agpstat)
 639{
 640	int index = 0;
 641
 642	if (agpstat & 4)
 643		index = 3;
 644	else if (agpstat & 2)
 645		index = 2;
 646	else if (agpstat & 1)
 647		index = 1;
 648	else
 649		goto out;
 650
 651	if (agp3) {
 652		index += 2;
 653		if (index == 5)
 654			index = 0;
 655	}
 656
 657 out:
 658	return agp_speeds[index];
 659}
 660
 
 661static void pci_set_bus_speed(struct pci_bus *bus)
 662{
 663	struct pci_dev *bridge = bus->self;
 664	int pos;
 665
 666	pos = pci_find_capability(bridge, PCI_CAP_ID_AGP);
 667	if (!pos)
 668		pos = pci_find_capability(bridge, PCI_CAP_ID_AGP3);
 669	if (pos) {
 670		u32 agpstat, agpcmd;
 671
 672		pci_read_config_dword(bridge, pos + PCI_AGP_STATUS, &agpstat);
 673		bus->max_bus_speed = agp_speed(agpstat & 8, agpstat & 7);
 674
 675		pci_read_config_dword(bridge, pos + PCI_AGP_COMMAND, &agpcmd);
 676		bus->cur_bus_speed = agp_speed(agpstat & 8, agpcmd & 7);
 677	}
 678
 679	pos = pci_find_capability(bridge, PCI_CAP_ID_PCIX);
 680	if (pos) {
 681		u16 status;
 682		enum pci_bus_speed max;
 
 683
 684		pci_read_config_word(bridge, pos + PCI_X_BRIDGE_SSTATUS,
 685				     &status);
 686
 687		if (status & PCI_X_SSTATUS_533MHZ) {
 688			max = PCI_SPEED_133MHz_PCIX_533;
 689		} else if (status & PCI_X_SSTATUS_266MHZ) {
 690			max = PCI_SPEED_133MHz_PCIX_266;
 691		} else if (status & PCI_X_SSTATUS_133MHZ) {
 692			if ((status & PCI_X_SSTATUS_VERS) == PCI_X_SSTATUS_V2)
 693				max = PCI_SPEED_133MHz_PCIX_ECC;
 694			else
 695				max = PCI_SPEED_133MHz_PCIX;
 
 696		} else {
 697			max = PCI_SPEED_66MHz_PCIX;
 698		}
 699
 700		bus->max_bus_speed = max;
 701		bus->cur_bus_speed = pcix_bus_speed[
 702			(status & PCI_X_SSTATUS_FREQ) >> 6];
 703
 704		return;
 705	}
 706
 707	if (pci_is_pcie(bridge)) {
 
 708		u32 linkcap;
 709		u16 linksta;
 710
 711		pcie_capability_read_dword(bridge, PCI_EXP_LNKCAP, &linkcap);
 712		bus->max_bus_speed = pcie_link_speed[linkcap & PCI_EXP_LNKCAP_SLS];
 713
 714		pcie_capability_read_word(bridge, PCI_EXP_LNKSTA, &linksta);
 715		pcie_update_link_speed(bus, linksta);
 716	}
 717}
 718
 719static struct irq_domain *pci_host_bridge_msi_domain(struct pci_bus *bus)
 720{
 721	struct irq_domain *d;
 722
 723	/*
 724	 * Any firmware interface that can resolve the msi_domain
 725	 * should be called from here.
 726	 */
 727	d = pci_host_bridge_of_msi_domain(bus);
 728	if (!d)
 729		d = pci_host_bridge_acpi_msi_domain(bus);
 730
 731#ifdef CONFIG_PCI_MSI_IRQ_DOMAIN
 732	/*
 733	 * If no IRQ domain was found via the OF tree, try looking it up
 734	 * directly through the fwnode_handle.
 735	 */
 736	if (!d) {
 737		struct fwnode_handle *fwnode = pci_root_bus_fwnode(bus);
 738
 739		if (fwnode)
 740			d = irq_find_matching_fwnode(fwnode,
 741						     DOMAIN_BUS_PCI_MSI);
 742	}
 743#endif
 744
 745	return d;
 746}
 747
 748static void pci_set_bus_msi_domain(struct pci_bus *bus)
 749{
 750	struct irq_domain *d;
 751	struct pci_bus *b;
 752
 753	/*
 754	 * The bus can be a root bus, a subordinate bus, or a virtual bus
 755	 * created by an SR-IOV device.  Walk up to the first bridge device
 756	 * found or derive the domain from the host bridge.
 757	 */
 758	for (b = bus, d = NULL; !d && !pci_is_root_bus(b); b = b->parent) {
 759		if (b->self)
 760			d = dev_get_msi_domain(&b->self->dev);
 761	}
 762
 763	if (!d)
 764		d = pci_host_bridge_msi_domain(b);
 765
 766	dev_set_msi_domain(&bus->dev, d);
 767}
 768
 769static int pci_register_host_bridge(struct pci_host_bridge *bridge)
 770{
 771	struct device *parent = bridge->dev.parent;
 772	struct resource_entry *window, *n;
 773	struct pci_bus *bus, *b;
 774	resource_size_t offset;
 775	LIST_HEAD(resources);
 776	struct resource *res;
 777	char addr[64], *fmt;
 778	const char *name;
 779	int err;
 780
 781	bus = pci_alloc_bus(NULL);
 782	if (!bus)
 783		return -ENOMEM;
 784
 785	bridge->bus = bus;
 786
 787	/* Temporarily move resources off the list */
 788	list_splice_init(&bridge->windows, &resources);
 789	bus->sysdata = bridge->sysdata;
 790	bus->msi = bridge->msi;
 791	bus->ops = bridge->ops;
 792	bus->number = bus->busn_res.start = bridge->busnr;
 793#ifdef CONFIG_PCI_DOMAINS_GENERIC
 794	bus->domain_nr = pci_bus_find_domain_nr(bus, parent);
 795#endif
 796
 797	b = pci_find_bus(pci_domain_nr(bus), bridge->busnr);
 798	if (b) {
 799		/* Ignore it if we already got here via a different bridge */
 800		dev_dbg(&b->dev, "bus already known\n");
 801		err = -EEXIST;
 802		goto free;
 803	}
 804
 805	dev_set_name(&bridge->dev, "pci%04x:%02x", pci_domain_nr(bus),
 806		     bridge->busnr);
 807
 808	err = pcibios_root_bridge_prepare(bridge);
 809	if (err)
 810		goto free;
 811
 812	err = device_register(&bridge->dev);
 813	if (err)
 814		put_device(&bridge->dev);
 815
 816	bus->bridge = get_device(&bridge->dev);
 817	device_enable_async_suspend(bus->bridge);
 818	pci_set_bus_of_node(bus);
 819	pci_set_bus_msi_domain(bus);
 820
 821	if (!parent)
 822		set_dev_node(bus->bridge, pcibus_to_node(bus));
 823
 824	bus->dev.class = &pcibus_class;
 825	bus->dev.parent = bus->bridge;
 826
 827	dev_set_name(&bus->dev, "%04x:%02x", pci_domain_nr(bus), bus->number);
 828	name = dev_name(&bus->dev);
 829
 830	err = device_register(&bus->dev);
 831	if (err)
 832		goto unregister;
 833
 834	pcibios_add_bus(bus);
 835
 836	/* Create legacy_io and legacy_mem files for this bus */
 837	pci_create_legacy_files(bus);
 838
 839	if (parent)
 840		dev_info(parent, "PCI host bridge to bus %s\n", name);
 841	else
 842		pr_info("PCI host bridge to bus %s\n", name);
 843
 844	/* Add initial resources to the bus */
 845	resource_list_for_each_entry_safe(window, n, &resources) {
 846		list_move_tail(&window->node, &bridge->windows);
 847		offset = window->offset;
 848		res = window->res;
 849
 850		if (res->flags & IORESOURCE_BUS)
 851			pci_bus_insert_busn_res(bus, bus->number, res->end);
 852		else
 853			pci_bus_add_resource(bus, res, 0);
 854
 855		if (offset) {
 856			if (resource_type(res) == IORESOURCE_IO)
 857				fmt = " (bus address [%#06llx-%#06llx])";
 858			else
 859				fmt = " (bus address [%#010llx-%#010llx])";
 860
 861			snprintf(addr, sizeof(addr), fmt,
 862				 (unsigned long long)(res->start - offset),
 863				 (unsigned long long)(res->end - offset));
 864		} else
 865			addr[0] = '\0';
 866
 867		dev_info(&bus->dev, "root bus resource %pR%s\n", res, addr);
 868	}
 869
 870	down_write(&pci_bus_sem);
 871	list_add_tail(&bus->node, &pci_root_buses);
 872	up_write(&pci_bus_sem);
 873
 874	return 0;
 875
 876unregister:
 877	put_device(&bridge->dev);
 878	device_unregister(&bridge->dev);
 879
 880free:
 881	kfree(bus);
 882	return err;
 883}
 884
 885static struct pci_bus *pci_alloc_child_bus(struct pci_bus *parent,
 886					   struct pci_dev *bridge, int busnr)
 887{
 888	struct pci_bus *child;
 889	int i;
 890	int ret;
 891
 892	/* Allocate a new bus and inherit stuff from the parent */
 893	child = pci_alloc_bus(parent);
 
 
 894	if (!child)
 895		return NULL;
 896
 897	child->parent = parent;
 898	child->ops = parent->ops;
 899	child->msi = parent->msi;
 900	child->sysdata = parent->sysdata;
 901	child->bus_flags = parent->bus_flags;
 902
 903	/*
 904	 * Initialize some portions of the bus device, but don't register
 905	 * it now as the parent is not properly set up yet.
 906	 */
 907	child->dev.class = &pcibus_class;
 908	dev_set_name(&child->dev, "%04x:%02x", pci_domain_nr(child), busnr);
 909
 910	/* Set up the primary, secondary and subordinate bus numbers */
 911	child->number = child->busn_res.start = busnr;
 912	child->primary = parent->busn_res.start;
 913	child->busn_res.end = 0xff;
 914
 915	if (!bridge) {
 916		child->dev.parent = parent->bridge;
 917		goto add_dev;
 918	}
 
 919
 920	child->self = bridge;
 921	child->bridge = get_device(&bridge->dev);
 922	child->dev.parent = child->bridge;
 923	pci_set_bus_of_node(child);
 924	pci_set_bus_speed(child);
 925
 926	/* Set up default resource pointers and names */
 927	for (i = 0; i < PCI_BRIDGE_RESOURCE_NUM; i++) {
 928		child->resource[i] = &bridge->resource[PCI_BRIDGE_RESOURCES+i];
 929		child->resource[i]->name = child->name;
 930	}
 931	bridge->subordinate = child;
 932
 933add_dev:
 934	pci_set_bus_msi_domain(child);
 935	ret = device_register(&child->dev);
 936	WARN_ON(ret < 0);
 937
 938	pcibios_add_bus(child);
 939
 940	if (child->ops->add_bus) {
 941		ret = child->ops->add_bus(child);
 942		if (WARN_ON(ret < 0))
 943			dev_err(&child->dev, "failed to add bus: %d\n", ret);
 944	}
 945
 946	/* Create legacy_io and legacy_mem files for this bus */
 947	pci_create_legacy_files(child);
 948
 949	return child;
 950}
 951
 952struct pci_bus *pci_add_new_bus(struct pci_bus *parent, struct pci_dev *dev,
 953				int busnr)
 954{
 955	struct pci_bus *child;
 956
 957	child = pci_alloc_child_bus(parent, dev, busnr);
 958	if (child) {
 959		down_write(&pci_bus_sem);
 960		list_add_tail(&child->node, &parent->children);
 961		up_write(&pci_bus_sem);
 962	}
 963	return child;
 964}
 965EXPORT_SYMBOL(pci_add_new_bus);
 966
 967static void pci_enable_crs(struct pci_dev *pdev)
 968{
 969	u16 root_cap = 0;
 970
 971	/* Enable CRS Software Visibility if supported */
 972	pcie_capability_read_word(pdev, PCI_EXP_RTCAP, &root_cap);
 973	if (root_cap & PCI_EXP_RTCAP_CRSVIS)
 974		pcie_capability_set_word(pdev, PCI_EXP_RTCTL,
 975					 PCI_EXP_RTCTL_CRSSVE);
 
 
 
 
 
 976}
 977
 978static unsigned int pci_scan_child_bus_extend(struct pci_bus *bus,
 979					      unsigned int available_buses);
 980
 981/*
 982 * pci_scan_bridge_extend() - Scan buses behind a bridge
 983 * @bus: Parent bus the bridge is on
 984 * @dev: Bridge itself
 985 * @max: Starting subordinate number of buses behind this bridge
 986 * @available_buses: Total number of buses available for this bridge and
 987 *		     the devices below. After the minimal bus space has
 988 *		     been allocated the remaining buses will be
 989 *		     distributed equally between hotplug-capable bridges.
 990 * @pass: Either %0 (scan already configured bridges) or %1 (scan bridges
 991 *        that need to be reconfigured.
 992 *
 993 * If it's a bridge, configure it and scan the bus behind it.
 994 * For CardBus bridges, we don't scan behind as the devices will
 995 * be handled by the bridge driver itself.
 996 *
 997 * We need to process bridges in two passes -- first we scan those
 998 * already configured by the BIOS and after we are done with all of
 999 * them, we proceed to assigning numbers to the remaining buses in
1000 * order to avoid overlaps between old and new bus numbers.
1001 */
1002static int pci_scan_bridge_extend(struct pci_bus *bus, struct pci_dev *dev,
1003				  int max, unsigned int available_buses,
1004				  int pass)
1005{
1006	struct pci_bus *child;
1007	int is_cardbus = (dev->hdr_type == PCI_HEADER_TYPE_CARDBUS);
1008	u32 buses, i, j = 0;
1009	u16 bctl;
1010	u8 primary, secondary, subordinate;
1011	int broken = 0;
1012
1013	/*
1014	 * Make sure the bridge is powered on to be able to access config
1015	 * space of devices below it.
1016	 */
1017	pm_runtime_get_sync(&dev->dev);
1018
1019	pci_read_config_dword(dev, PCI_PRIMARY_BUS, &buses);
1020	primary = buses & 0xFF;
1021	secondary = (buses >> 8) & 0xFF;
1022	subordinate = (buses >> 16) & 0xFF;
1023
1024	pci_dbg(dev, "scanning [bus %02x-%02x] behind bridge, pass %d\n",
1025		secondary, subordinate, pass);
1026
1027	if (!primary && (primary != bus->number) && secondary && subordinate) {
1028		pci_warn(dev, "Primary bus is hard wired to 0\n");
1029		primary = bus->number;
1030	}
1031
1032	/* Check if setup is sensible at all */
1033	if (!pass &&
1034	    (primary != bus->number || secondary <= bus->number ||
1035	     secondary > subordinate)) {
1036		pci_info(dev, "bridge configuration invalid ([bus %02x-%02x]), reconfiguring\n",
1037			 secondary, subordinate);
1038		broken = 1;
1039	}
1040
1041	/*
1042	 * Disable Master-Abort Mode during probing to avoid reporting of
1043	 * bus errors in some architectures.
1044	 */
1045	pci_read_config_word(dev, PCI_BRIDGE_CONTROL, &bctl);
1046	pci_write_config_word(dev, PCI_BRIDGE_CONTROL,
1047			      bctl & ~PCI_BRIDGE_CTL_MASTER_ABORT);
1048
1049	pci_enable_crs(dev);
1050
1051	if ((secondary || subordinate) && !pcibios_assign_all_busses() &&
1052	    !is_cardbus && !broken) {
1053		unsigned int cmax;
1054
1055		/*
1056		 * Bus already configured by firmware, process it in the
1057		 * first pass and just note the configuration.
1058		 */
1059		if (pass)
1060			goto out;
1061
1062		/*
1063		 * The bus might already exist for two reasons: Either we
1064		 * are rescanning the bus or the bus is reachable through
1065		 * more than one bridge. The second case can happen with
1066		 * the i450NX chipset.
 
1067		 */
1068		child = pci_find_bus(pci_domain_nr(bus), secondary);
1069		if (!child) {
1070			child = pci_add_new_bus(bus, dev, secondary);
1071			if (!child)
1072				goto out;
1073			child->primary = primary;
1074			pci_bus_insert_busn_res(child, secondary, subordinate);
1075			child->bridge_ctl = bctl;
1076		}
1077
1078		cmax = pci_scan_child_bus(child);
1079		if (cmax > subordinate)
1080			pci_warn(dev, "bridge has subordinate %02x but max busn %02x\n",
1081				 subordinate, cmax);
1082
1083		/* Subordinate should equal child->busn_res.end */
1084		if (subordinate > max)
1085			max = subordinate;
1086	} else {
1087
1088		/*
1089		 * We need to assign a number to this bus which we always
1090		 * do in the second pass.
1091		 */
1092		if (!pass) {
1093			if (pcibios_assign_all_busses() || broken || is_cardbus)
1094
1095				/*
1096				 * Temporarily disable forwarding of the
1097				 * configuration cycles on all bridges in
1098				 * this bus segment to avoid possible
1099				 * conflicts in the second pass between two
1100				 * bridges programmed with overlapping bus
1101				 * ranges.
1102				 */
1103				pci_write_config_dword(dev, PCI_PRIMARY_BUS,
1104						       buses & ~0xffffff);
1105			goto out;
1106		}
1107
1108		/* Clear errors */
1109		pci_write_config_word(dev, PCI_STATUS, 0xffff);
1110
1111		/*
1112		 * Prevent assigning a bus number that already exists.
1113		 * This can happen when a bridge is hot-plugged, so in this
1114		 * case we only re-scan this bus.
1115		 */
1116		child = pci_find_bus(pci_domain_nr(bus), max+1);
1117		if (!child) {
1118			child = pci_add_new_bus(bus, dev, max+1);
1119			if (!child)
1120				goto out;
1121			pci_bus_insert_busn_res(child, max+1,
1122						bus->busn_res.end);
1123		}
1124		max++;
1125		if (available_buses)
1126			available_buses--;
1127
1128		buses = (buses & 0xff000000)
1129		      | ((unsigned int)(child->primary)     <<  0)
1130		      | ((unsigned int)(child->busn_res.start)   <<  8)
1131		      | ((unsigned int)(child->busn_res.end) << 16);
1132
1133		/*
1134		 * yenta.c forces a secondary latency timer of 176.
1135		 * Copy that behaviour here.
1136		 */
1137		if (is_cardbus) {
1138			buses &= ~0xff000000;
1139			buses |= CARDBUS_LATENCY_TIMER << 24;
1140		}
1141
1142		/* We need to blast all three values with a single write */
 
 
1143		pci_write_config_dword(dev, PCI_PRIMARY_BUS, buses);
1144
1145		if (!is_cardbus) {
1146			child->bridge_ctl = bctl;
1147			max = pci_scan_child_bus_extend(child, available_buses);
 
 
 
 
 
 
 
 
 
 
 
 
 
1148		} else {
1149
1150			/*
1151			 * For CardBus bridges, we leave 4 bus numbers as
1152			 * cards with a PCI-to-PCI bridge can be inserted
1153			 * later.
1154			 */
1155			for (i = 0; i < CARDBUS_RESERVE_BUSNR; i++) {
1156				struct pci_bus *parent = bus;
1157				if (pci_find_bus(pci_domain_nr(bus),
1158							max+i+1))
1159					break;
1160				while (parent->parent) {
1161					if ((!pcibios_assign_all_busses()) &&
1162					    (parent->busn_res.end > max) &&
1163					    (parent->busn_res.end <= max+i)) {
1164						j = 1;
1165					}
1166					parent = parent->parent;
1167				}
1168				if (j) {
1169
1170					/*
1171					 * Often, there are two CardBus
1172					 * bridges -- try to leave one
1173					 * valid bus number for each one.
1174					 */
1175					i /= 2;
1176					break;
1177				}
1178			}
1179			max += i;
 
1180		}
1181
1182		/* Set subordinate bus number to its real value */
1183		pci_bus_update_busn_res_end(child, max);
 
1184		pci_write_config_byte(dev, PCI_SUBORDINATE_BUS, max);
1185	}
1186
1187	sprintf(child->name,
1188		(is_cardbus ? "PCI CardBus %04x:%02x" : "PCI Bus %04x:%02x"),
1189		pci_domain_nr(bus), child->number);
1190
1191	/* Has only triggered on CardBus, fixup is in yenta_socket */
1192	while (bus->parent) {
1193		if ((child->busn_res.end > bus->busn_res.end) ||
1194		    (child->number > bus->busn_res.end) ||
1195		    (child->number < bus->number) ||
1196		    (child->busn_res.end < bus->number)) {
1197			dev_info(&child->dev, "%pR %s hidden behind%s bridge %s %pR\n",
1198				&child->busn_res,
1199				(bus->number > child->busn_res.end &&
1200				 bus->busn_res.end < child->number) ?
 
1201					"wholly" : "partially",
1202				bus->self->transparent ? " transparent" : "",
1203				dev_name(&bus->dev),
1204				&bus->busn_res);
1205		}
1206		bus = bus->parent;
1207	}
1208
1209out:
1210	pci_write_config_word(dev, PCI_BRIDGE_CONTROL, bctl);
1211
1212	pm_runtime_put(&dev->dev);
1213
1214	return max;
1215}
1216
1217/*
1218 * pci_scan_bridge() - Scan buses behind a bridge
1219 * @bus: Parent bus the bridge is on
1220 * @dev: Bridge itself
1221 * @max: Starting subordinate number of buses behind this bridge
1222 * @pass: Either %0 (scan already configured bridges) or %1 (scan bridges
1223 *        that need to be reconfigured.
1224 *
1225 * If it's a bridge, configure it and scan the bus behind it.
1226 * For CardBus bridges, we don't scan behind as the devices will
1227 * be handled by the bridge driver itself.
1228 *
1229 * We need to process bridges in two passes -- first we scan those
1230 * already configured by the BIOS and after we are done with all of
1231 * them, we proceed to assigning numbers to the remaining buses in
1232 * order to avoid overlaps between old and new bus numbers.
1233 */
1234int pci_scan_bridge(struct pci_bus *bus, struct pci_dev *dev, int max, int pass)
1235{
1236	return pci_scan_bridge_extend(bus, dev, max, 0, pass);
1237}
1238EXPORT_SYMBOL(pci_scan_bridge);
1239
1240/*
1241 * Read interrupt line and base address registers.
1242 * The architecture-dependent code can tweak these, of course.
1243 */
1244static void pci_read_irq(struct pci_dev *dev)
1245{
1246	unsigned char irq;
1247
1248	/* VFs are not allowed to use INTx, so skip the config reads */
1249	if (dev->is_virtfn) {
1250		dev->pin = 0;
1251		dev->irq = 0;
1252		return;
1253	}
1254
1255	pci_read_config_byte(dev, PCI_INTERRUPT_PIN, &irq);
1256	dev->pin = irq;
1257	if (irq)
1258		pci_read_config_byte(dev, PCI_INTERRUPT_LINE, &irq);
1259	dev->irq = irq;
1260}
1261
1262void set_pcie_port_type(struct pci_dev *pdev)
1263{
1264	int pos;
1265	u16 reg16;
1266	int type;
1267	struct pci_dev *parent;
1268
1269	pos = pci_find_capability(pdev, PCI_CAP_ID_EXP);
1270	if (!pos)
1271		return;
1272
1273	pdev->pcie_cap = pos;
1274	pci_read_config_word(pdev, pos + PCI_EXP_FLAGS, &reg16);
1275	pdev->pcie_flags_reg = reg16;
1276	pci_read_config_word(pdev, pos + PCI_EXP_DEVCAP, &reg16);
1277	pdev->pcie_mpss = reg16 & PCI_EXP_DEVCAP_PAYLOAD;
1278
1279	/*
1280	 * A Root Port or a PCI-to-PCIe bridge is always the upstream end
1281	 * of a Link.  No PCIe component has two Links.  Two Links are
1282	 * connected by a Switch that has a Port on each Link and internal
1283	 * logic to connect the two Ports.
1284	 */
1285	type = pci_pcie_type(pdev);
1286	if (type == PCI_EXP_TYPE_ROOT_PORT ||
1287	    type == PCI_EXP_TYPE_PCIE_BRIDGE)
1288		pdev->has_secondary_link = 1;
1289	else if (type == PCI_EXP_TYPE_UPSTREAM ||
1290		 type == PCI_EXP_TYPE_DOWNSTREAM) {
1291		parent = pci_upstream_bridge(pdev);
1292
1293		/*
1294		 * Usually there's an upstream device (Root Port or Switch
1295		 * Downstream Port), but we can't assume one exists.
1296		 */
1297		if (parent && !parent->has_secondary_link)
1298			pdev->has_secondary_link = 1;
1299	}
1300}
1301
1302void set_pcie_hotplug_bridge(struct pci_dev *pdev)
1303{
 
 
1304	u32 reg32;
1305
1306	pcie_capability_read_dword(pdev, PCI_EXP_SLTCAP, &reg32);
 
 
 
 
 
 
1307	if (reg32 & PCI_EXP_SLTCAP_HPC)
1308		pdev->is_hotplug_bridge = 1;
1309}
1310
1311static void set_pcie_thunderbolt(struct pci_dev *dev)
1312{
1313	int vsec = 0;
1314	u32 header;
1315
1316	while ((vsec = pci_find_next_ext_capability(dev, vsec,
1317						    PCI_EXT_CAP_ID_VNDR))) {
1318		pci_read_config_dword(dev, vsec + PCI_VNDR_HEADER, &header);
1319
1320		/* Is the device part of a Thunderbolt controller? */
1321		if (dev->vendor == PCI_VENDOR_ID_INTEL &&
1322		    PCI_VNDR_HEADER_ID(header) == PCI_VSEC_ID_INTEL_TBT) {
1323			dev->is_thunderbolt = 1;
1324			return;
1325		}
1326	}
1327}
1328
1329/**
1330 * pci_ext_cfg_is_aliased - Is ext config space just an alias of std config?
1331 * @dev: PCI device
1332 *
1333 * PCI Express to PCI/PCI-X Bridge Specification, rev 1.0, 4.1.4 says that
1334 * when forwarding a type1 configuration request the bridge must check that
1335 * the extended register address field is zero.  The bridge is not permitted
1336 * to forward the transactions and must handle it as an Unsupported Request.
1337 * Some bridges do not follow this rule and simply drop the extended register
1338 * bits, resulting in the standard config space being aliased, every 256
1339 * bytes across the entire configuration space.  Test for this condition by
1340 * comparing the first dword of each potential alias to the vendor/device ID.
1341 * Known offenders:
1342 *   ASM1083/1085 PCIe-to-PCI Reversible Bridge (1b21:1080, rev 01 & 03)
1343 *   AMD/ATI SBx00 PCI to PCI Bridge (1002:4384, rev 40)
1344 */
1345static bool pci_ext_cfg_is_aliased(struct pci_dev *dev)
1346{
1347#ifdef CONFIG_PCI_QUIRKS
1348	int pos;
1349	u32 header, tmp;
1350
1351	pci_read_config_dword(dev, PCI_VENDOR_ID, &header);
1352
1353	for (pos = PCI_CFG_SPACE_SIZE;
1354	     pos < PCI_CFG_SPACE_EXP_SIZE; pos += PCI_CFG_SPACE_SIZE) {
1355		if (pci_read_config_dword(dev, pos, &tmp) != PCIBIOS_SUCCESSFUL
1356		    || header != tmp)
1357			return false;
1358	}
1359
1360	return true;
1361#else
1362	return false;
1363#endif
1364}
1365
1366/**
1367 * pci_cfg_space_size - Get the configuration space size of the PCI device
1368 * @dev: PCI device
1369 *
1370 * Regular PCI devices have 256 bytes, but PCI-X 2 and PCI Express devices
1371 * have 4096 bytes.  Even if the device is capable, that doesn't mean we can
1372 * access it.  Maybe we don't have a way to generate extended config space
1373 * accesses, or the device is behind a reverse Express bridge.  So we try
1374 * reading the dword at 0x100 which must either be 0 or a valid extended
1375 * capability header.
1376 */
1377static int pci_cfg_space_size_ext(struct pci_dev *dev)
1378{
1379	u32 status;
1380	int pos = PCI_CFG_SPACE_SIZE;
1381
1382	if (pci_read_config_dword(dev, pos, &status) != PCIBIOS_SUCCESSFUL)
1383		return PCI_CFG_SPACE_SIZE;
1384	if (status == 0xffffffff || pci_ext_cfg_is_aliased(dev))
1385		return PCI_CFG_SPACE_SIZE;
1386
1387	return PCI_CFG_SPACE_EXP_SIZE;
1388}
1389
1390int pci_cfg_space_size(struct pci_dev *dev)
1391{
1392	int pos;
1393	u32 status;
1394	u16 class;
1395
1396	class = dev->class >> 8;
1397	if (class == PCI_CLASS_BRIDGE_HOST)
1398		return pci_cfg_space_size_ext(dev);
1399
1400	if (pci_is_pcie(dev))
1401		return pci_cfg_space_size_ext(dev);
1402
1403	pos = pci_find_capability(dev, PCI_CAP_ID_PCIX);
1404	if (!pos)
1405		return PCI_CFG_SPACE_SIZE;
1406
1407	pci_read_config_dword(dev, pos + PCI_X_STATUS, &status);
1408	if (status & (PCI_X_STATUS_266MHZ | PCI_X_STATUS_533MHZ))
1409		return pci_cfg_space_size_ext(dev);
1410
1411	return PCI_CFG_SPACE_SIZE;
1412}
1413
1414static u32 pci_class(struct pci_dev *dev)
1415{
1416	u32 class;
1417
1418#ifdef CONFIG_PCI_IOV
1419	if (dev->is_virtfn)
1420		return dev->physfn->sriov->class;
1421#endif
1422	pci_read_config_dword(dev, PCI_CLASS_REVISION, &class);
1423	return class;
1424}
1425
1426static void pci_subsystem_ids(struct pci_dev *dev, u16 *vendor, u16 *device)
1427{
1428#ifdef CONFIG_PCI_IOV
1429	if (dev->is_virtfn) {
1430		*vendor = dev->physfn->sriov->subsystem_vendor;
1431		*device = dev->physfn->sriov->subsystem_device;
1432		return;
1433	}
1434#endif
1435	pci_read_config_word(dev, PCI_SUBSYSTEM_VENDOR_ID, vendor);
1436	pci_read_config_word(dev, PCI_SUBSYSTEM_ID, device);
1437}
1438
1439static u8 pci_hdr_type(struct pci_dev *dev)
1440{
1441	u8 hdr_type;
1442
1443#ifdef CONFIG_PCI_IOV
1444	if (dev->is_virtfn)
1445		return dev->physfn->sriov->hdr_type;
1446#endif
1447	pci_read_config_byte(dev, PCI_HEADER_TYPE, &hdr_type);
1448	return hdr_type;
1449}
1450
1451#define LEGACY_IO_RESOURCE	(IORESOURCE_IO | IORESOURCE_PCI_FIXED)
1452
1453static void pci_msi_setup_pci_dev(struct pci_dev *dev)
1454{
1455	/*
1456	 * Disable the MSI hardware to avoid screaming interrupts
1457	 * during boot.  This is the power on reset default so
1458	 * usually this should be a noop.
1459	 */
1460	dev->msi_cap = pci_find_capability(dev, PCI_CAP_ID_MSI);
1461	if (dev->msi_cap)
1462		pci_msi_set_enable(dev, 0);
1463
1464	dev->msix_cap = pci_find_capability(dev, PCI_CAP_ID_MSIX);
1465	if (dev->msix_cap)
1466		pci_msix_clear_and_set_ctrl(dev, PCI_MSIX_FLAGS_ENABLE, 0);
1467}
1468
1469/**
1470 * pci_intx_mask_broken - Test PCI_COMMAND_INTX_DISABLE writability
1471 * @dev: PCI device
1472 *
1473 * Test whether PCI_COMMAND_INTX_DISABLE is writable for @dev.  Check this
1474 * at enumeration-time to avoid modifying PCI_COMMAND at run-time.
1475 */
1476static int pci_intx_mask_broken(struct pci_dev *dev)
1477{
1478	u16 orig, toggle, new;
1479
1480	pci_read_config_word(dev, PCI_COMMAND, &orig);
1481	toggle = orig ^ PCI_COMMAND_INTX_DISABLE;
1482	pci_write_config_word(dev, PCI_COMMAND, toggle);
1483	pci_read_config_word(dev, PCI_COMMAND, &new);
1484
1485	pci_write_config_word(dev, PCI_COMMAND, orig);
1486
1487	/*
1488	 * PCI_COMMAND_INTX_DISABLE was reserved and read-only prior to PCI
1489	 * r2.3, so strictly speaking, a device is not *broken* if it's not
1490	 * writable.  But we'll live with the misnomer for now.
1491	 */
1492	if (new != toggle)
1493		return 1;
1494	return 0;
1495}
1496
1497/**
1498 * pci_setup_device - Fill in class and map information of a device
1499 * @dev: the device structure to fill
1500 *
1501 * Initialize the device structure with information about the device's
1502 * vendor,class,memory and IO-space addresses, IRQ lines etc.
1503 * Called at initialisation of the PCI subsystem and by CardBus services.
1504 * Returns 0 on success and negative if unknown type of device (not normal,
1505 * bridge or CardBus).
1506 */
1507int pci_setup_device(struct pci_dev *dev)
1508{
1509	u32 class;
1510	u16 cmd;
1511	u8 hdr_type;
 
1512	int pos = 0;
1513	struct pci_bus_region region;
1514	struct resource *res;
1515
1516	hdr_type = pci_hdr_type(dev);
 
1517
1518	dev->sysdata = dev->bus->sysdata;
1519	dev->dev.parent = dev->bus->bridge;
1520	dev->dev.bus = &pci_bus_type;
1521	dev->hdr_type = hdr_type & 0x7f;
1522	dev->multifunction = !!(hdr_type & 0x80);
1523	dev->error_state = pci_channel_io_normal;
1524	set_pcie_port_type(dev);
1525
1526	pci_dev_assign_slot(dev);
 
 
1527
1528	/*
1529	 * Assume 32-bit PCI; let 64-bit PCI cards (which are far rarer)
1530	 * set this higher, assuming the system even supports it.
1531	 */
1532	dev->dma_mask = 0xffffffff;
1533
1534	dev_set_name(&dev->dev, "%04x:%02x:%02x.%d", pci_domain_nr(dev->bus),
1535		     dev->bus->number, PCI_SLOT(dev->devfn),
1536		     PCI_FUNC(dev->devfn));
1537
1538	class = pci_class(dev);
1539
1540	dev->revision = class & 0xff;
1541	dev->class = class >> 8;		    /* upper 3 bytes */
1542
1543	pci_printk(KERN_DEBUG, dev, "[%04x:%04x] type %02x class %#08x\n",
1544		   dev->vendor, dev->device, dev->hdr_type, dev->class);
1545
1546	/* Need to have dev->class ready */
1547	dev->cfg_size = pci_cfg_space_size(dev);
1548
1549	/* Need to have dev->cfg_size ready */
1550	set_pcie_thunderbolt(dev);
1551
1552	/* "Unknown power state" */
1553	dev->current_state = PCI_UNKNOWN;
1554
1555	/* Early fixups, before probing the BARs */
1556	pci_fixup_device(pci_fixup_early, dev);
1557
1558	/* Device class may be changed after fixup */
1559	class = dev->class >> 8;
1560
1561	if (dev->non_compliant_bars) {
1562		pci_read_config_word(dev, PCI_COMMAND, &cmd);
1563		if (cmd & (PCI_COMMAND_IO | PCI_COMMAND_MEMORY)) {
1564			pci_info(dev, "device has non-compliant BARs; disabling IO/MEM decoding\n");
1565			cmd &= ~PCI_COMMAND_IO;
1566			cmd &= ~PCI_COMMAND_MEMORY;
1567			pci_write_config_word(dev, PCI_COMMAND, cmd);
1568		}
1569	}
1570
1571	dev->broken_intx_masking = pci_intx_mask_broken(dev);
1572
1573	switch (dev->hdr_type) {		    /* header type */
1574	case PCI_HEADER_TYPE_NORMAL:		    /* standard header */
1575		if (class == PCI_CLASS_BRIDGE_PCI)
1576			goto bad;
1577		pci_read_irq(dev);
1578		pci_read_bases(dev, 6, PCI_ROM_ADDRESS);
1579
1580		pci_subsystem_ids(dev, &dev->subsystem_vendor, &dev->subsystem_device);
1581
1582		/*
1583		 * Do the ugly legacy mode stuff here rather than broken chip
1584		 * quirk code. Legacy mode ATA controllers have fixed
1585		 * addresses. These are not always echoed in BAR0-3, and
1586		 * BAR0-3 in a few cases contain junk!
1587		 */
1588		if (class == PCI_CLASS_STORAGE_IDE) {
1589			u8 progif;
1590			pci_read_config_byte(dev, PCI_CLASS_PROG, &progif);
1591			if ((progif & 1) == 0) {
1592				region.start = 0x1F0;
1593				region.end = 0x1F7;
1594				res = &dev->resource[0];
1595				res->flags = LEGACY_IO_RESOURCE;
1596				pcibios_bus_to_resource(dev->bus, res, &region);
1597				pci_info(dev, "legacy IDE quirk: reg 0x10: %pR\n",
1598					 res);
1599				region.start = 0x3F6;
1600				region.end = 0x3F6;
1601				res = &dev->resource[1];
1602				res->flags = LEGACY_IO_RESOURCE;
1603				pcibios_bus_to_resource(dev->bus, res, &region);
1604				pci_info(dev, "legacy IDE quirk: reg 0x14: %pR\n",
1605					 res);
1606			}
1607			if ((progif & 4) == 0) {
1608				region.start = 0x170;
1609				region.end = 0x177;
1610				res = &dev->resource[2];
1611				res->flags = LEGACY_IO_RESOURCE;
1612				pcibios_bus_to_resource(dev->bus, res, &region);
1613				pci_info(dev, "legacy IDE quirk: reg 0x18: %pR\n",
1614					 res);
1615				region.start = 0x376;
1616				region.end = 0x376;
1617				res = &dev->resource[3];
1618				res->flags = LEGACY_IO_RESOURCE;
1619				pcibios_bus_to_resource(dev->bus, res, &region);
1620				pci_info(dev, "legacy IDE quirk: reg 0x1c: %pR\n",
1621					 res);
1622			}
1623		}
1624		break;
1625
1626	case PCI_HEADER_TYPE_BRIDGE:		    /* bridge header */
1627		if (class != PCI_CLASS_BRIDGE_PCI)
1628			goto bad;
1629
1630		/*
1631		 * The PCI-to-PCI bridge spec requires that subtractive
1632		 * decoding (i.e. transparent) bridge must have programming
1633		 * interface code of 0x01.
1634		 */
1635		pci_read_irq(dev);
1636		dev->transparent = ((dev->class & 0xff) == 1);
1637		pci_read_bases(dev, 2, PCI_ROM_ADDRESS1);
1638		set_pcie_hotplug_bridge(dev);
1639		pos = pci_find_capability(dev, PCI_CAP_ID_SSVID);
1640		if (pos) {
1641			pci_read_config_word(dev, pos + PCI_SSVID_VENDOR_ID, &dev->subsystem_vendor);
1642			pci_read_config_word(dev, pos + PCI_SSVID_DEVICE_ID, &dev->subsystem_device);
1643		}
1644		break;
1645
1646	case PCI_HEADER_TYPE_CARDBUS:		    /* CardBus bridge header */
1647		if (class != PCI_CLASS_BRIDGE_CARDBUS)
1648			goto bad;
1649		pci_read_irq(dev);
1650		pci_read_bases(dev, 1, 0);
1651		pci_read_config_word(dev, PCI_CB_SUBSYSTEM_VENDOR_ID, &dev->subsystem_vendor);
1652		pci_read_config_word(dev, PCI_CB_SUBSYSTEM_ID, &dev->subsystem_device);
1653		break;
1654
1655	default:				    /* unknown header */
1656		pci_err(dev, "unknown header type %02x, ignoring device\n",
1657			dev->hdr_type);
1658		return -EIO;
1659
1660	bad:
1661		pci_err(dev, "ignoring class %#08x (doesn't match header type %02x)\n",
1662			dev->class, dev->hdr_type);
1663		dev->class = PCI_CLASS_NOT_DEFINED << 8;
1664	}
1665
1666	/* We found a fine healthy device, go go go... */
1667	return 0;
1668}
1669
1670static void pci_configure_mps(struct pci_dev *dev)
1671{
1672	struct pci_dev *bridge = pci_upstream_bridge(dev);
1673	int mps, p_mps, rc;
1674
1675	if (!pci_is_pcie(dev) || !bridge || !pci_is_pcie(bridge))
1676		return;
1677
1678	mps = pcie_get_mps(dev);
1679	p_mps = pcie_get_mps(bridge);
1680
1681	if (mps == p_mps)
1682		return;
1683
1684	if (pcie_bus_config == PCIE_BUS_TUNE_OFF) {
1685		pci_warn(dev, "Max Payload Size %d, but upstream %s set to %d; if necessary, use \"pci=pcie_bus_safe\" and report a bug\n",
1686			 mps, pci_name(bridge), p_mps);
1687		return;
1688	}
1689
1690	/*
1691	 * Fancier MPS configuration is done later by
1692	 * pcie_bus_configure_settings()
1693	 */
1694	if (pcie_bus_config != PCIE_BUS_DEFAULT)
1695		return;
1696
1697	rc = pcie_set_mps(dev, p_mps);
1698	if (rc) {
1699		pci_warn(dev, "can't set Max Payload Size to %d; if necessary, use \"pci=pcie_bus_safe\" and report a bug\n",
1700			 p_mps);
1701		return;
1702	}
1703
1704	pci_info(dev, "Max Payload Size set to %d (was %d, max %d)\n",
1705		 p_mps, mps, 128 << dev->pcie_mpss);
1706}
1707
1708static struct hpp_type0 pci_default_type0 = {
1709	.revision = 1,
1710	.cache_line_size = 8,
1711	.latency_timer = 0x40,
1712	.enable_serr = 0,
1713	.enable_perr = 0,
1714};
1715
1716static void program_hpp_type0(struct pci_dev *dev, struct hpp_type0 *hpp)
1717{
1718	u16 pci_cmd, pci_bctl;
1719
1720	if (!hpp)
1721		hpp = &pci_default_type0;
1722
1723	if (hpp->revision > 1) {
1724		pci_warn(dev, "PCI settings rev %d not supported; using defaults\n",
1725			 hpp->revision);
1726		hpp = &pci_default_type0;
1727	}
1728
1729	pci_write_config_byte(dev, PCI_CACHE_LINE_SIZE, hpp->cache_line_size);
1730	pci_write_config_byte(dev, PCI_LATENCY_TIMER, hpp->latency_timer);
1731	pci_read_config_word(dev, PCI_COMMAND, &pci_cmd);
1732	if (hpp->enable_serr)
1733		pci_cmd |= PCI_COMMAND_SERR;
1734	if (hpp->enable_perr)
1735		pci_cmd |= PCI_COMMAND_PARITY;
1736	pci_write_config_word(dev, PCI_COMMAND, pci_cmd);
1737
1738	/* Program bridge control value */
1739	if ((dev->class >> 8) == PCI_CLASS_BRIDGE_PCI) {
1740		pci_write_config_byte(dev, PCI_SEC_LATENCY_TIMER,
1741				      hpp->latency_timer);
1742		pci_read_config_word(dev, PCI_BRIDGE_CONTROL, &pci_bctl);
1743		if (hpp->enable_serr)
1744			pci_bctl |= PCI_BRIDGE_CTL_SERR;
1745		if (hpp->enable_perr)
1746			pci_bctl |= PCI_BRIDGE_CTL_PARITY;
1747		pci_write_config_word(dev, PCI_BRIDGE_CONTROL, pci_bctl);
1748	}
1749}
1750
1751static void program_hpp_type1(struct pci_dev *dev, struct hpp_type1 *hpp)
1752{
1753	int pos;
1754
1755	if (!hpp)
1756		return;
1757
1758	pos = pci_find_capability(dev, PCI_CAP_ID_PCIX);
1759	if (!pos)
1760		return;
1761
1762	pci_warn(dev, "PCI-X settings not supported\n");
1763}
1764
1765static bool pcie_root_rcb_set(struct pci_dev *dev)
1766{
1767	struct pci_dev *rp = pcie_find_root_port(dev);
1768	u16 lnkctl;
1769
1770	if (!rp)
1771		return false;
1772
1773	pcie_capability_read_word(rp, PCI_EXP_LNKCTL, &lnkctl);
1774	if (lnkctl & PCI_EXP_LNKCTL_RCB)
1775		return true;
1776
1777	return false;
1778}
1779
1780static void program_hpp_type2(struct pci_dev *dev, struct hpp_type2 *hpp)
1781{
1782	int pos;
1783	u32 reg32;
1784
1785	if (!hpp)
1786		return;
1787
1788	if (!pci_is_pcie(dev))
1789		return;
1790
1791	if (hpp->revision > 1) {
1792		pci_warn(dev, "PCIe settings rev %d not supported\n",
1793			 hpp->revision);
1794		return;
1795	}
1796
1797	/*
1798	 * Don't allow _HPX to change MPS or MRRS settings.  We manage
1799	 * those to make sure they're consistent with the rest of the
1800	 * platform.
1801	 */
1802	hpp->pci_exp_devctl_and |= PCI_EXP_DEVCTL_PAYLOAD |
1803				    PCI_EXP_DEVCTL_READRQ;
1804	hpp->pci_exp_devctl_or &= ~(PCI_EXP_DEVCTL_PAYLOAD |
1805				    PCI_EXP_DEVCTL_READRQ);
1806
1807	/* Initialize Device Control Register */
1808	pcie_capability_clear_and_set_word(dev, PCI_EXP_DEVCTL,
1809			~hpp->pci_exp_devctl_and, hpp->pci_exp_devctl_or);
1810
1811	/* Initialize Link Control Register */
1812	if (pcie_cap_has_lnkctl(dev)) {
1813
1814		/*
1815		 * If the Root Port supports Read Completion Boundary of
1816		 * 128, set RCB to 128.  Otherwise, clear it.
1817		 */
1818		hpp->pci_exp_lnkctl_and |= PCI_EXP_LNKCTL_RCB;
1819		hpp->pci_exp_lnkctl_or &= ~PCI_EXP_LNKCTL_RCB;
1820		if (pcie_root_rcb_set(dev))
1821			hpp->pci_exp_lnkctl_or |= PCI_EXP_LNKCTL_RCB;
1822
1823		pcie_capability_clear_and_set_word(dev, PCI_EXP_LNKCTL,
1824			~hpp->pci_exp_lnkctl_and, hpp->pci_exp_lnkctl_or);
1825	}
1826
1827	/* Find Advanced Error Reporting Enhanced Capability */
1828	pos = pci_find_ext_capability(dev, PCI_EXT_CAP_ID_ERR);
1829	if (!pos)
1830		return;
1831
1832	/* Initialize Uncorrectable Error Mask Register */
1833	pci_read_config_dword(dev, pos + PCI_ERR_UNCOR_MASK, &reg32);
1834	reg32 = (reg32 & hpp->unc_err_mask_and) | hpp->unc_err_mask_or;
1835	pci_write_config_dword(dev, pos + PCI_ERR_UNCOR_MASK, reg32);
1836
1837	/* Initialize Uncorrectable Error Severity Register */
1838	pci_read_config_dword(dev, pos + PCI_ERR_UNCOR_SEVER, &reg32);
1839	reg32 = (reg32 & hpp->unc_err_sever_and) | hpp->unc_err_sever_or;
1840	pci_write_config_dword(dev, pos + PCI_ERR_UNCOR_SEVER, reg32);
1841
1842	/* Initialize Correctable Error Mask Register */
1843	pci_read_config_dword(dev, pos + PCI_ERR_COR_MASK, &reg32);
1844	reg32 = (reg32 & hpp->cor_err_mask_and) | hpp->cor_err_mask_or;
1845	pci_write_config_dword(dev, pos + PCI_ERR_COR_MASK, reg32);
1846
1847	/* Initialize Advanced Error Capabilities and Control Register */
1848	pci_read_config_dword(dev, pos + PCI_ERR_CAP, &reg32);
1849	reg32 = (reg32 & hpp->adv_err_cap_and) | hpp->adv_err_cap_or;
1850
1851	/* Don't enable ECRC generation or checking if unsupported */
1852	if (!(reg32 & PCI_ERR_CAP_ECRC_GENC))
1853		reg32 &= ~PCI_ERR_CAP_ECRC_GENE;
1854	if (!(reg32 & PCI_ERR_CAP_ECRC_CHKC))
1855		reg32 &= ~PCI_ERR_CAP_ECRC_CHKE;
1856	pci_write_config_dword(dev, pos + PCI_ERR_CAP, reg32);
1857
1858	/*
1859	 * FIXME: The following two registers are not supported yet.
1860	 *
1861	 *   o Secondary Uncorrectable Error Severity Register
1862	 *   o Secondary Uncorrectable Error Mask Register
1863	 */
1864}
1865
1866int pci_configure_extended_tags(struct pci_dev *dev, void *ign)
1867{
1868	struct pci_host_bridge *host;
1869	u32 cap;
1870	u16 ctl;
1871	int ret;
1872
1873	if (!pci_is_pcie(dev))
1874		return 0;
1875
1876	ret = pcie_capability_read_dword(dev, PCI_EXP_DEVCAP, &cap);
1877	if (ret)
1878		return 0;
1879
1880	if (!(cap & PCI_EXP_DEVCAP_EXT_TAG))
1881		return 0;
1882
1883	ret = pcie_capability_read_word(dev, PCI_EXP_DEVCTL, &ctl);
1884	if (ret)
1885		return 0;
1886
1887	host = pci_find_host_bridge(dev->bus);
1888	if (!host)
1889		return 0;
1890
1891	/*
1892	 * If some device in the hierarchy doesn't handle Extended Tags
1893	 * correctly, make sure they're disabled.
1894	 */
1895	if (host->no_ext_tags) {
1896		if (ctl & PCI_EXP_DEVCTL_EXT_TAG) {
1897			pci_info(dev, "disabling Extended Tags\n");
1898			pcie_capability_clear_word(dev, PCI_EXP_DEVCTL,
1899						   PCI_EXP_DEVCTL_EXT_TAG);
1900		}
1901		return 0;
1902	}
1903
1904	if (!(ctl & PCI_EXP_DEVCTL_EXT_TAG)) {
1905		pci_info(dev, "enabling Extended Tags\n");
1906		pcie_capability_set_word(dev, PCI_EXP_DEVCTL,
1907					 PCI_EXP_DEVCTL_EXT_TAG);
1908	}
1909	return 0;
1910}
1911
1912/**
1913 * pcie_relaxed_ordering_enabled - Probe for PCIe relaxed ordering enable
1914 * @dev: PCI device to query
1915 *
1916 * Returns true if the device has enabled relaxed ordering attribute.
 
 
 
 
 
1917 */
1918bool pcie_relaxed_ordering_enabled(struct pci_dev *dev)
1919{
1920	u16 v;
 
 
 
 
 
 
1921
1922	pcie_capability_read_word(dev, PCI_EXP_DEVCTL, &v);
1923
1924	return !!(v & PCI_EXP_DEVCTL_RELAX_EN);
 
1925}
1926EXPORT_SYMBOL(pcie_relaxed_ordering_enabled);
1927
1928static void pci_configure_relaxed_ordering(struct pci_dev *dev)
1929{
1930	struct pci_dev *root;
 
 
1931
1932	/* PCI_EXP_DEVICE_RELAX_EN is RsvdP in VFs */
1933	if (dev->is_virtfn)
1934		return;
1935
1936	if (!pcie_relaxed_ordering_enabled(dev))
1937		return;
 
 
 
1938
1939	/*
1940	 * For now, we only deal with Relaxed Ordering issues with Root
1941	 * Ports. Peer-to-Peer DMA is another can of worms.
1942	 */
1943	root = pci_find_pcie_root_port(dev);
1944	if (!root)
1945		return;
1946
1947	if (root->dev_flags & PCI_DEV_FLAGS_NO_RELAXED_ORDERING) {
1948		pcie_capability_clear_word(dev, PCI_EXP_DEVCTL,
1949					   PCI_EXP_DEVCTL_RELAX_EN);
1950		pci_info(dev, "Relaxed Ordering disabled because the Root Port didn't support it\n");
1951	}
1952}
1953
1954static void pci_configure_ltr(struct pci_dev *dev)
1955{
1956#ifdef CONFIG_PCIEASPM
1957	u32 cap;
1958	struct pci_dev *bridge;
1959
1960	if (!pci_is_pcie(dev))
1961		return;
1962
1963	pcie_capability_read_dword(dev, PCI_EXP_DEVCAP2, &cap);
1964	if (!(cap & PCI_EXP_DEVCAP2_LTR))
1965		return;
1966
1967	/*
1968	 * Software must not enable LTR in an Endpoint unless the Root
1969	 * Complex and all intermediate Switches indicate support for LTR.
1970	 * PCIe r3.1, sec 6.18.
1971	 */
1972	if (pci_pcie_type(dev) == PCI_EXP_TYPE_ROOT_PORT)
1973		dev->ltr_path = 1;
1974	else {
1975		bridge = pci_upstream_bridge(dev);
1976		if (bridge && bridge->ltr_path)
1977			dev->ltr_path = 1;
1978	}
1979
1980	if (dev->ltr_path)
1981		pcie_capability_set_word(dev, PCI_EXP_DEVCTL2,
1982					 PCI_EXP_DEVCTL2_LTR_EN);
1983#endif
1984}
1985
1986static void pci_configure_device(struct pci_dev *dev)
1987{
1988	struct hotplug_params hpp;
1989	int ret;
1990
1991	pci_configure_mps(dev);
1992	pci_configure_extended_tags(dev, NULL);
1993	pci_configure_relaxed_ordering(dev);
1994	pci_configure_ltr(dev);
1995
1996	memset(&hpp, 0, sizeof(hpp));
1997	ret = pci_get_hp_params(dev, &hpp);
1998	if (ret)
1999		return;
2000
2001	program_hpp_type2(dev, hpp.t2);
2002	program_hpp_type1(dev, hpp.t1);
2003	program_hpp_type0(dev, hpp.t0);
2004}
2005
2006static void pci_release_capabilities(struct pci_dev *dev)
2007{
2008	pci_vpd_release(dev);
2009	pci_iov_release(dev);
2010	pci_free_cap_save_buffers(dev);
2011}
2012
2013/**
2014 * pci_release_dev - Free a PCI device structure when all users of it are
2015 *		     finished
2016 * @dev: device that's been disconnected
2017 *
2018 * Will be called only by the device core when all users of this PCI device are
2019 * done.
2020 */
2021static void pci_release_dev(struct device *dev)
2022{
2023	struct pci_dev *pci_dev;
2024
2025	pci_dev = to_pci_dev(dev);
2026	pci_release_capabilities(pci_dev);
2027	pci_release_of_node(pci_dev);
2028	pcibios_release_device(pci_dev);
2029	pci_bus_put(pci_dev->bus);
2030	kfree(pci_dev->driver_override);
2031	kfree(pci_dev->dma_alias_mask);
2032	kfree(pci_dev);
2033}
2034
2035struct pci_dev *pci_alloc_dev(struct pci_bus *bus)
2036{
2037	struct pci_dev *dev;
2038
2039	dev = kzalloc(sizeof(struct pci_dev), GFP_KERNEL);
2040	if (!dev)
2041		return NULL;
2042
2043	INIT_LIST_HEAD(&dev->bus_list);
2044	dev->dev.type = &pci_dev_type;
2045	dev->bus = pci_bus_get(bus);
2046
2047	return dev;
2048}
2049EXPORT_SYMBOL(pci_alloc_dev);
2050
2051static bool pci_bus_crs_vendor_id(u32 l)
2052{
2053	return (l & 0xffff) == 0x0001;
2054}
2055
2056static bool pci_bus_wait_crs(struct pci_bus *bus, int devfn, u32 *l,
2057			     int timeout)
2058{
2059	int delay = 1;
2060
2061	if (!pci_bus_crs_vendor_id(*l))
2062		return true;	/* not a CRS completion */
2063
2064	if (!timeout)
2065		return false;	/* CRS, but caller doesn't want to wait */
2066
2067	/*
2068	 * We got the reserved Vendor ID that indicates a completion with
2069	 * Configuration Request Retry Status (CRS).  Retry until we get a
2070	 * valid Vendor ID or we time out.
2071	 */
2072	while (pci_bus_crs_vendor_id(*l)) {
2073		if (delay > timeout) {
2074			pr_warn("pci %04x:%02x:%02x.%d: not ready after %dms; giving up\n",
2075				pci_domain_nr(bus), bus->number,
2076				PCI_SLOT(devfn), PCI_FUNC(devfn), delay - 1);
2077
 
 
 
2078			return false;
2079		}
2080		if (delay >= 1000)
2081			pr_info("pci %04x:%02x:%02x.%d: not ready after %dms; waiting\n",
2082				pci_domain_nr(bus), bus->number,
2083				PCI_SLOT(devfn), PCI_FUNC(devfn), delay - 1);
2084
2085		msleep(delay);
2086		delay *= 2;
2087
2088		if (pci_bus_read_config_dword(bus, devfn, PCI_VENDOR_ID, l))
2089			return false;
 
 
 
 
 
 
 
 
2090	}
2091
2092	if (delay >= 1000)
2093		pr_info("pci %04x:%02x:%02x.%d: ready after %dms\n",
2094			pci_domain_nr(bus), bus->number,
2095			PCI_SLOT(devfn), PCI_FUNC(devfn), delay - 1);
2096
2097	return true;
2098}
2099
2100bool pci_bus_read_dev_vendor_id(struct pci_bus *bus, int devfn, u32 *l,
2101				int timeout)
2102{
2103	if (pci_bus_read_config_dword(bus, devfn, PCI_VENDOR_ID, l))
2104		return false;
2105
2106	/* Some broken boards return 0 or ~0 if a slot is empty: */
2107	if (*l == 0xffffffff || *l == 0x00000000 ||
2108	    *l == 0x0000ffff || *l == 0xffff0000)
2109		return false;
2110
2111	if (pci_bus_crs_vendor_id(*l))
2112		return pci_bus_wait_crs(bus, devfn, l, timeout);
2113
2114	return true;
2115}
2116EXPORT_SYMBOL(pci_bus_read_dev_vendor_id);
2117
2118/*
2119 * Read the config data for a PCI device, sanity-check it,
2120 * and fill in the dev structure.
2121 */
2122static struct pci_dev *pci_scan_device(struct pci_bus *bus, int devfn)
2123{
2124	struct pci_dev *dev;
2125	u32 l;
2126
2127	if (!pci_bus_read_dev_vendor_id(bus, devfn, &l, 60*1000))
2128		return NULL;
2129
2130	dev = pci_alloc_dev(bus);
2131	if (!dev)
2132		return NULL;
2133
 
2134	dev->devfn = devfn;
2135	dev->vendor = l & 0xffff;
2136	dev->device = (l >> 16) & 0xffff;
2137
2138	pci_set_of_node(dev);
2139
2140	if (pci_setup_device(dev)) {
2141		pci_bus_put(dev->bus);
2142		kfree(dev);
2143		return NULL;
2144	}
2145
2146	return dev;
2147}
2148
2149static void pci_init_capabilities(struct pci_dev *dev)
2150{
2151	/* Enhanced Allocation */
2152	pci_ea_init(dev);
2153
2154	/* Setup MSI caps & disable MSI/MSI-X interrupts */
2155	pci_msi_setup_pci_dev(dev);
2156
2157	/* Buffers for saving PCIe and PCI-X capabilities */
2158	pci_allocate_cap_save_buffers(dev);
2159
2160	/* Power Management */
2161	pci_pm_init(dev);
 
2162
2163	/* Vital Product Data */
2164	pci_vpd_init(dev);
2165
2166	/* Alternative Routing-ID Forwarding */
2167	pci_configure_ari(dev);
2168
2169	/* Single Root I/O Virtualization */
2170	pci_iov_init(dev);
2171
2172	/* Address Translation Services */
2173	pci_ats_init(dev);
2174
2175	/* Enable ACS P2P upstream forwarding */
2176	pci_enable_acs(dev);
2177
2178	/* Precision Time Measurement */
2179	pci_ptm_init(dev);
2180
2181	/* Advanced Error Reporting */
2182	pci_aer_init(dev);
2183
2184	if (pci_probe_reset_function(dev) == 0)
2185		dev->reset_fn = 1;
2186}
2187
2188/*
2189 * This is the equivalent of pci_host_bridge_msi_domain() that acts on
2190 * devices. Firmware interfaces that can select the MSI domain on a
2191 * per-device basis should be called from here.
2192 */
2193static struct irq_domain *pci_dev_msi_domain(struct pci_dev *dev)
2194{
2195	struct irq_domain *d;
2196
2197	/*
2198	 * If a domain has been set through the pcibios_add_device()
2199	 * callback, then this is the one (platform code knows best).
2200	 */
2201	d = dev_get_msi_domain(&dev->dev);
2202	if (d)
2203		return d;
2204
2205	/*
2206	 * Let's see if we have a firmware interface able to provide
2207	 * the domain.
2208	 */
2209	d = pci_msi_get_device_domain(dev);
2210	if (d)
2211		return d;
2212
2213	return NULL;
2214}
2215
2216static void pci_set_msi_domain(struct pci_dev *dev)
2217{
2218	struct irq_domain *d;
2219
2220	/*
2221	 * If the platform or firmware interfaces cannot supply a
2222	 * device-specific MSI domain, then inherit the default domain
2223	 * from the host bridge itself.
2224	 */
2225	d = pci_dev_msi_domain(dev);
2226	if (!d)
2227		d = dev_get_msi_domain(&dev->bus->dev);
2228
2229	dev_set_msi_domain(&dev->dev, d);
2230}
2231
2232void pci_device_add(struct pci_dev *dev, struct pci_bus *bus)
2233{
2234	int ret;
2235
2236	pci_configure_device(dev);
2237
2238	device_initialize(&dev->dev);
2239	dev->dev.release = pci_release_dev;
 
2240
2241	set_dev_node(&dev->dev, pcibus_to_node(bus));
2242	dev->dev.dma_mask = &dev->dma_mask;
2243	dev->dev.dma_parms = &dev->dma_parms;
2244	dev->dev.coherent_dma_mask = 0xffffffffull;
2245
2246	pci_set_dma_max_seg_size(dev, 65536);
2247	pci_set_dma_seg_boundary(dev, 0xffffffff);
2248
2249	/* Fix up broken headers */
2250	pci_fixup_device(pci_fixup_header, dev);
2251
2252	/* Moved out from quirk header fixup code */
2253	pci_reassigndev_resource_alignment(dev);
2254
2255	/* Clear the state_saved flag */
2256	dev->state_saved = false;
2257
2258	/* Initialize various capabilities */
2259	pci_init_capabilities(dev);
2260
2261	/*
2262	 * Add the device to our list of discovered devices
2263	 * and the bus list for fixup functions, etc.
2264	 */
2265	down_write(&pci_bus_sem);
2266	list_add_tail(&dev->bus_list, &bus->devices);
2267	up_write(&pci_bus_sem);
2268
2269	ret = pcibios_add_device(dev);
2270	WARN_ON(ret < 0);
2271
2272	/* Set up MSI IRQ domain */
2273	pci_set_msi_domain(dev);
2274
2275	/* Notifier could use PCI capabilities */
2276	dev->match_driver = false;
2277	ret = device_add(&dev->dev);
2278	WARN_ON(ret < 0);
2279}
2280
2281struct pci_dev *pci_scan_single_device(struct pci_bus *bus, int devfn)
2282{
2283	struct pci_dev *dev;
2284
2285	dev = pci_get_slot(bus, devfn);
2286	if (dev) {
2287		pci_dev_put(dev);
2288		return dev;
2289	}
2290
2291	dev = pci_scan_device(bus, devfn);
2292	if (!dev)
2293		return NULL;
2294
2295	pci_device_add(dev, bus);
2296
2297	return dev;
2298}
2299EXPORT_SYMBOL(pci_scan_single_device);
2300
2301static unsigned next_fn(struct pci_bus *bus, struct pci_dev *dev, unsigned fn)
2302{
2303	int pos;
2304	u16 cap = 0;
2305	unsigned next_fn;
2306
2307	if (pci_ari_enabled(bus)) {
2308		if (!dev)
2309			return 0;
2310		pos = pci_find_ext_capability(dev, PCI_EXT_CAP_ID_ARI);
2311		if (!pos)
2312			return 0;
2313
2314		pci_read_config_word(dev, pos + PCI_ARI_CAP, &cap);
2315		next_fn = PCI_ARI_CAP_NFN(cap);
2316		if (next_fn <= fn)
2317			return 0;	/* protect against malformed list */
 
 
 
 
 
2318
2319		return next_fn;
2320	}
2321
2322	/* dev may be NULL for non-contiguous multifunction devices */
2323	if (!dev || dev->multifunction)
2324		return (fn + 1) % 8;
2325
 
 
2326	return 0;
2327}
2328
2329static int only_one_child(struct pci_bus *bus)
2330{
2331	struct pci_dev *bridge = bus->self;
2332
2333	/*
2334	 * Systems with unusual topologies set PCI_SCAN_ALL_PCIE_DEVS so
2335	 * we scan for all possible devices, not just Device 0.
2336	 */
2337	if (pci_has_flag(PCI_SCAN_ALL_PCIE_DEVS))
2338		return 0;
2339
2340	/*
2341	 * A PCIe Downstream Port normally leads to a Link with only Device
2342	 * 0 on it (PCIe spec r3.1, sec 7.3.1).  As an optimization, scan
2343	 * only for Device 0 in that situation.
2344	 *
2345	 * Checking has_secondary_link is a hack to identify Downstream
2346	 * Ports because sometimes Switches are configured such that the
2347	 * PCIe Port Type labels are backwards.
2348	 */
2349	if (bridge && pci_is_pcie(bridge) && bridge->has_secondary_link)
2350		return 1;
2351
2352	return 0;
2353}
2354
2355/**
2356 * pci_scan_slot - Scan a PCI slot on a bus for devices
2357 * @bus: PCI bus to scan
2358 * @devfn: slot number to scan (must have zero function)
2359 *
2360 * Scan a PCI slot on the specified PCI bus for devices, adding
2361 * discovered devices to the @bus->devices list.  New devices
2362 * will not have is_added set.
2363 *
2364 * Returns the number of new devices found.
2365 */
2366int pci_scan_slot(struct pci_bus *bus, int devfn)
2367{
2368	unsigned fn, nr = 0;
2369	struct pci_dev *dev;
 
2370
2371	if (only_one_child(bus) && (devfn > 0))
2372		return 0; /* Already scanned the entire slot */
2373
2374	dev = pci_scan_single_device(bus, devfn);
2375	if (!dev)
2376		return 0;
2377	if (!dev->is_added)
2378		nr++;
2379
2380	for (fn = next_fn(bus, dev, 0); fn > 0; fn = next_fn(bus, dev, fn)) {
 
 
 
 
 
2381		dev = pci_scan_single_device(bus, devfn + fn);
2382		if (dev) {
2383			if (!dev->is_added)
2384				nr++;
2385			dev->multifunction = 1;
2386		}
2387	}
2388
2389	/* Only one slot has PCIe device */
2390	if (bus->self && nr)
2391		pcie_aspm_init_link_state(bus->self);
2392
2393	return nr;
2394}
2395EXPORT_SYMBOL(pci_scan_slot);
2396
2397static int pcie_find_smpss(struct pci_dev *dev, void *data)
2398{
2399	u8 *smpss = data;
2400
2401	if (!pci_is_pcie(dev))
2402		return 0;
2403
2404	/*
2405	 * We don't have a way to change MPS settings on devices that have
2406	 * drivers attached.  A hot-added device might support only the minimum
2407	 * MPS setting (MPS=128).  Therefore, if the fabric contains a bridge
2408	 * where devices may be hot-added, we limit the fabric MPS to 128 so
2409	 * hot-added devices will work correctly.
2410	 *
2411	 * However, if we hot-add a device to a slot directly below a Root
2412	 * Port, it's impossible for there to be other existing devices below
2413	 * the port.  We don't limit the MPS in this case because we can
2414	 * reconfigure MPS on both the Root Port and the hot-added device,
2415	 * and there are no other devices involved.
2416	 *
2417	 * Note that this PCIE_BUS_SAFE path assumes no peer-to-peer DMA.
2418	 */
2419	if (dev->is_hotplug_bridge &&
2420	    pci_pcie_type(dev) != PCI_EXP_TYPE_ROOT_PORT)
 
2421		*smpss = 0;
2422
2423	if (*smpss > dev->pcie_mpss)
2424		*smpss = dev->pcie_mpss;
2425
2426	return 0;
2427}
2428
2429static void pcie_write_mps(struct pci_dev *dev, int mps)
2430{
2431	int rc;
2432
2433	if (pcie_bus_config == PCIE_BUS_PERFORMANCE) {
2434		mps = 128 << dev->pcie_mpss;
2435
2436		if (pci_pcie_type(dev) != PCI_EXP_TYPE_ROOT_PORT &&
2437		    dev->bus->self)
2438
2439			/*
2440			 * For "Performance", the assumption is made that
2441			 * downstream communication will never be larger than
2442			 * the MRRS.  So, the MPS only needs to be configured
2443			 * for the upstream communication.  This being the case,
2444			 * walk from the top down and set the MPS of the child
2445			 * to that of the parent bus.
2446			 *
2447			 * Configure the device MPS with the smaller of the
2448			 * device MPSS or the bridge MPS (which is assumed to be
2449			 * properly configured at this point to the largest
2450			 * allowable MPS based on its parent bus).
2451			 */
2452			mps = min(mps, pcie_get_mps(dev->bus->self));
2453	}
2454
2455	rc = pcie_set_mps(dev, mps);
2456	if (rc)
2457		pci_err(dev, "Failed attempting to set the MPS\n");
2458}
2459
2460static void pcie_write_mrrs(struct pci_dev *dev)
2461{
2462	int rc, mrrs;
2463
2464	/*
2465	 * In the "safe" case, do not configure the MRRS.  There appear to be
2466	 * issues with setting MRRS to 0 on a number of devices.
2467	 */
2468	if (pcie_bus_config != PCIE_BUS_PERFORMANCE)
2469		return;
2470
2471	/*
2472	 * For max performance, the MRRS must be set to the largest supported
2473	 * value.  However, it cannot be configured larger than the MPS the
2474	 * device or the bus can support.  This should already be properly
2475	 * configured by a prior call to pcie_write_mps().
2476	 */
2477	mrrs = pcie_get_mps(dev);
2478
2479	/*
2480	 * MRRS is a R/W register.  Invalid values can be written, but a
2481	 * subsequent read will verify if the value is acceptable or not.
2482	 * If the MRRS value provided is not acceptable (e.g., too large),
2483	 * shrink the value until it is acceptable to the HW.
2484	 */
2485	while (mrrs != pcie_get_readrq(dev) && mrrs >= 128) {
2486		rc = pcie_set_readrq(dev, mrrs);
2487		if (!rc)
2488			break;
2489
2490		pci_warn(dev, "Failed attempting to set the MRRS\n");
2491		mrrs /= 2;
2492	}
2493
2494	if (mrrs < 128)
2495		pci_err(dev, "MRRS was unable to be configured with a safe value.  If problems are experienced, try running with pci=pcie_bus_safe\n");
 
 
2496}
2497
2498static int pcie_bus_configure_set(struct pci_dev *dev, void *data)
2499{
2500	int mps, orig_mps;
2501
2502	if (!pci_is_pcie(dev))
2503		return 0;
2504
2505	if (pcie_bus_config == PCIE_BUS_TUNE_OFF ||
2506	    pcie_bus_config == PCIE_BUS_DEFAULT)
2507		return 0;
2508
2509	mps = 128 << *(u8 *)data;
2510	orig_mps = pcie_get_mps(dev);
2511
2512	pcie_write_mps(dev, mps);
2513	pcie_write_mrrs(dev);
2514
2515	pci_info(dev, "Max Payload Size set to %4d/%4d (was %4d), Max Read Rq %4d\n",
2516		 pcie_get_mps(dev), 128 << dev->pcie_mpss,
2517		 orig_mps, pcie_get_readrq(dev));
2518
2519	return 0;
2520}
2521
2522/*
2523 * pcie_bus_configure_settings() requires that pci_walk_bus work in a top-down,
2524 * parents then children fashion.  If this changes, then this code will not
2525 * work as designed.
2526 */
2527void pcie_bus_configure_settings(struct pci_bus *bus)
2528{
2529	u8 smpss = 0;
2530
2531	if (!bus->self)
2532		return;
2533
2534	if (!pci_is_pcie(bus->self))
2535		return;
2536
2537	/*
2538	 * FIXME - Peer to peer DMA is possible, though the endpoint would need
2539	 * to be aware of the MPS of the destination.  To work around this,
2540	 * simply force the MPS of the entire system to the smallest possible.
2541	 */
2542	if (pcie_bus_config == PCIE_BUS_PEER2PEER)
2543		smpss = 0;
2544
2545	if (pcie_bus_config == PCIE_BUS_SAFE) {
2546		smpss = bus->self->pcie_mpss;
2547
2548		pcie_find_smpss(bus->self, &smpss);
2549		pci_walk_bus(bus, pcie_find_smpss, &smpss);
2550	}
2551
2552	pcie_bus_configure_set(bus->self, &smpss);
2553	pci_walk_bus(bus, pcie_bus_configure_set, &smpss);
2554}
2555EXPORT_SYMBOL_GPL(pcie_bus_configure_settings);
2556
2557/*
2558 * Called after each bus is probed, but before its children are examined.  This
2559 * is marked as __weak because multiple architectures define it.
2560 */
2561void __weak pcibios_fixup_bus(struct pci_bus *bus)
2562{
2563       /* nothing to do, expected to be removed in the future */
2564}
2565
2566/**
2567 * pci_scan_child_bus_extend() - Scan devices below a bus
2568 * @bus: Bus to scan for devices
2569 * @available_buses: Total number of buses available (%0 does not try to
2570 *		     extend beyond the minimal)
2571 *
2572 * Scans devices below @bus including subordinate buses. Returns new
2573 * subordinate number including all the found devices. Passing
2574 * @available_buses causes the remaining bus space to be distributed
2575 * equally between hotplug-capable bridges to allow future extension of the
2576 * hierarchy.
2577 */
2578static unsigned int pci_scan_child_bus_extend(struct pci_bus *bus,
2579					      unsigned int available_buses)
2580{
2581	unsigned int used_buses, normal_bridges = 0, hotplug_bridges = 0;
2582	unsigned int start = bus->busn_res.start;
2583	unsigned int devfn, fn, cmax, max = start;
2584	struct pci_dev *dev;
2585	int nr_devs;
2586
2587	dev_dbg(&bus->dev, "scanning bus\n");
2588
2589	/* Go find them, Rover! */
2590	for (devfn = 0; devfn < 256; devfn += 8) {
2591		nr_devs = pci_scan_slot(bus, devfn);
2592
2593		/*
2594		 * The Jailhouse hypervisor may pass individual functions of a
2595		 * multi-function device to a guest without passing function 0.
2596		 * Look for them as well.
2597		 */
2598		if (jailhouse_paravirt() && nr_devs == 0) {
2599			for (fn = 1; fn < 8; fn++) {
2600				dev = pci_scan_single_device(bus, devfn + fn);
2601				if (dev)
2602					dev->multifunction = 1;
2603			}
2604		}
2605	}
2606
2607	/* Reserve buses for SR-IOV capability */
2608	used_buses = pci_iov_bus_range(bus);
2609	max += used_buses;
2610
2611	/*
2612	 * After performing arch-dependent fixup of the bus, look behind
2613	 * all PCI-to-PCI bridges on this bus.
2614	 */
2615	if (!bus->is_added) {
2616		dev_dbg(&bus->dev, "fixups for bus\n");
2617		pcibios_fixup_bus(bus);
2618		bus->is_added = 1;
2619	}
2620
2621	/*
2622	 * Calculate how many hotplug bridges and normal bridges there
2623	 * are on this bus. We will distribute the additional available
2624	 * buses between hotplug bridges.
2625	 */
2626	for_each_pci_bridge(dev, bus) {
2627		if (dev->is_hotplug_bridge)
2628			hotplug_bridges++;
2629		else
2630			normal_bridges++;
2631	}
2632
2633	/*
2634	 * Scan bridges that are already configured. We don't touch them
2635	 * unless they are misconfigured (which will be done in the second
2636	 * scan below).
2637	 */
2638	for_each_pci_bridge(dev, bus) {
2639		cmax = max;
2640		max = pci_scan_bridge_extend(bus, dev, max, 0, 0);
2641		used_buses += cmax - max;
2642	}
2643
2644	/* Scan bridges that need to be reconfigured */
2645	for_each_pci_bridge(dev, bus) {
2646		unsigned int buses = 0;
2647
2648		if (!hotplug_bridges && normal_bridges == 1) {
2649
2650			/*
2651			 * There is only one bridge on the bus (upstream
2652			 * port) so it gets all available buses which it
2653			 * can then distribute to the possible hotplug
2654			 * bridges below.
2655			 */
2656			buses = available_buses;
2657		} else if (dev->is_hotplug_bridge) {
2658
2659			/*
2660			 * Distribute the extra buses between hotplug
2661			 * bridges if any.
2662			 */
2663			buses = available_buses / hotplug_bridges;
2664			buses = min(buses, available_buses - used_buses);
2665		}
2666
2667		cmax = max;
2668		max = pci_scan_bridge_extend(bus, dev, cmax, buses, 1);
2669		used_buses += max - cmax;
2670	}
2671
2672	/*
2673	 * Make sure a hotplug bridge has at least the minimum requested
2674	 * number of buses but allow it to grow up to the maximum available
2675	 * bus number of there is room.
2676	 */
2677	if (bus->self && bus->self->is_hotplug_bridge) {
2678		used_buses = max_t(unsigned int, available_buses,
2679				   pci_hotplug_bus_size - 1);
2680		if (max - start < used_buses) {
2681			max = start + used_buses;
2682
2683			/* Do not allocate more buses than we have room left */
2684			if (max > bus->busn_res.end)
2685				max = bus->busn_res.end;
2686
2687			dev_dbg(&bus->dev, "%pR extended by %#02x\n",
2688				&bus->busn_res, max - start);
2689		}
2690	}
2691
2692	/*
2693	 * We've scanned the bus and so we know all about what's on
2694	 * the other side of any bridges that may be on this bus plus
2695	 * any devices.
2696	 *
2697	 * Return how far we've got finding sub-buses.
2698	 */
2699	dev_dbg(&bus->dev, "bus scan returning with max=%02x\n", max);
2700	return max;
2701}
2702
2703/**
2704 * pci_scan_child_bus() - Scan devices below a bus
2705 * @bus: Bus to scan for devices
2706 *
2707 * Scans devices below @bus including subordinate buses. Returns new
2708 * subordinate number including all the found devices.
2709 */
2710unsigned int pci_scan_child_bus(struct pci_bus *bus)
2711{
2712	return pci_scan_child_bus_extend(bus, 0);
2713}
2714EXPORT_SYMBOL_GPL(pci_scan_child_bus);
2715
2716/**
2717 * pcibios_root_bridge_prepare - Platform-specific host bridge setup
2718 * @bridge: Host bridge to set up
2719 *
2720 * Default empty implementation.  Replace with an architecture-specific setup
2721 * routine, if necessary.
2722 */
2723int __weak pcibios_root_bridge_prepare(struct pci_host_bridge *bridge)
2724{
2725	return 0;
2726}
2727
2728void __weak pcibios_add_bus(struct pci_bus *bus)
2729{
2730}
2731
2732void __weak pcibios_remove_bus(struct pci_bus *bus)
2733{
2734}
2735
2736struct pci_bus *pci_create_root_bus(struct device *parent, int bus,
2737		struct pci_ops *ops, void *sysdata, struct list_head *resources)
2738{
2739	int error;
2740	struct pci_host_bridge *bridge;
 
 
 
 
 
 
 
2741
2742	bridge = pci_alloc_host_bridge(0);
2743	if (!bridge)
2744		return NULL;
2745
2746	bridge->dev.parent = parent;
2747
2748	list_splice_init(resources, &bridge->windows);
2749	bridge->sysdata = sysdata;
2750	bridge->busnr = bus;
2751	bridge->ops = ops;
2752
2753	error = pci_register_host_bridge(bridge);
2754	if (error < 0)
2755		goto err_out;
2756
2757	return bridge->bus;
2758
2759err_out:
2760	kfree(bridge);
2761	return NULL;
2762}
2763EXPORT_SYMBOL_GPL(pci_create_root_bus);
2764
2765int pci_host_probe(struct pci_host_bridge *bridge)
2766{
2767	struct pci_bus *bus, *child;
2768	int ret;
2769
2770	ret = pci_scan_root_bus_bridge(bridge);
2771	if (ret < 0) {
2772		dev_err(bridge->dev.parent, "Scanning root bridge failed");
2773		return ret;
2774	}
2775
2776	bus = bridge->bus;
 
 
2777
2778	/*
2779	 * We insert PCI resources into the iomem_resource and
2780	 * ioport_resource trees in either pci_bus_claim_resources()
2781	 * or pci_bus_assign_resources().
2782	 */
2783	if (pci_has_flag(PCI_PROBE_ONLY)) {
2784		pci_bus_claim_resources(bus);
2785	} else {
2786		pci_bus_size_bridges(bus);
2787		pci_bus_assign_resources(bus);
2788
2789		list_for_each_entry(child, &bus->children, node)
2790			pcie_bus_configure_settings(child);
2791	}
2792
2793	pci_bus_add_devices(bus);
2794	return 0;
2795}
2796EXPORT_SYMBOL_GPL(pci_host_probe);
 
 
2797
2798int pci_bus_insert_busn_res(struct pci_bus *b, int bus, int bus_max)
2799{
2800	struct resource *res = &b->busn_res;
2801	struct resource *parent_res, *conflict;
2802
2803	res->start = bus;
2804	res->end = bus_max;
2805	res->flags = IORESOURCE_BUS;
2806
2807	if (!pci_is_root_bus(b))
2808		parent_res = &b->parent->busn_res;
2809	else {
2810		parent_res = get_pci_domain_busn_res(pci_domain_nr(b));
2811		res->flags |= IORESOURCE_PCI_FIXED;
2812	}
2813
2814	conflict = request_resource_conflict(parent_res, res);
2815
2816	if (conflict)
2817		dev_printk(KERN_DEBUG, &b->dev,
2818			   "busn_res: can not insert %pR under %s%pR (conflicts with %s %pR)\n",
2819			    res, pci_is_root_bus(b) ? "domain " : "",
2820			    parent_res, conflict->name, conflict);
2821
2822	return conflict == NULL;
2823}
2824
2825int pci_bus_update_busn_res_end(struct pci_bus *b, int bus_max)
2826{
2827	struct resource *res = &b->busn_res;
2828	struct resource old_res = *res;
2829	resource_size_t size;
2830	int ret;
2831
2832	if (res->start > bus_max)
2833		return -EINVAL;
2834
2835	size = bus_max - res->start + 1;
2836	ret = adjust_resource(res, res->start, size);
2837	dev_printk(KERN_DEBUG, &b->dev,
2838			"busn_res: %pR end %s updated to %02x\n",
2839			&old_res, ret ? "can not be" : "is", bus_max);
2840
2841	if (!ret && !res->parent)
2842		pci_bus_insert_busn_res(b, res->start, res->end);
2843
2844	return ret;
2845}
2846
2847void pci_bus_release_busn_res(struct pci_bus *b)
2848{
2849	struct resource *res = &b->busn_res;
2850	int ret;
2851
2852	if (!res->flags || !res->parent)
2853		return;
2854
2855	ret = release_resource(res);
2856	dev_printk(KERN_DEBUG, &b->dev,
2857			"busn_res: %pR %s released\n",
2858			res, ret ? "can not be" : "is");
2859}
2860
2861int pci_scan_root_bus_bridge(struct pci_host_bridge *bridge)
2862{
2863	struct resource_entry *window;
2864	bool found = false;
2865	struct pci_bus *b;
2866	int max, bus, ret;
2867
2868	if (!bridge)
2869		return -EINVAL;
2870
2871	resource_list_for_each_entry(window, &bridge->windows)
2872		if (window->res->flags & IORESOURCE_BUS) {
2873			found = true;
2874			break;
2875		}
2876
2877	ret = pci_register_host_bridge(bridge);
2878	if (ret < 0)
2879		return ret;
2880
2881	b = bridge->bus;
2882	bus = bridge->busnr;
2883
2884	if (!found) {
2885		dev_info(&b->dev,
2886		 "No busn resource found for root bus, will use [bus %02x-ff]\n",
2887			bus);
2888		pci_bus_insert_busn_res(b, bus, 255);
2889	}
2890
2891	max = pci_scan_child_bus(b);
 
 
2892
2893	if (!found)
2894		pci_bus_update_busn_res_end(b, max);
2895
2896	return 0;
 
 
 
 
 
 
 
2897}
2898EXPORT_SYMBOL(pci_scan_root_bus_bridge);
2899
2900struct pci_bus *pci_scan_root_bus(struct device *parent, int bus,
2901		struct pci_ops *ops, void *sysdata, struct list_head *resources)
2902{
2903	struct resource_entry *window;
2904	bool found = false;
2905	struct pci_bus *b;
2906	int max;
2907
2908	resource_list_for_each_entry(window, resources)
2909		if (window->res->flags & IORESOURCE_BUS) {
2910			found = true;
2911			break;
2912		}
2913
2914	b = pci_create_root_bus(parent, bus, ops, sysdata, resources);
2915	if (!b)
2916		return NULL;
2917
2918	if (!found) {
2919		dev_info(&b->dev,
2920		 "No busn resource found for root bus, will use [bus %02x-ff]\n",
2921			bus);
2922		pci_bus_insert_busn_res(b, bus, 255);
2923	}
2924
2925	max = pci_scan_child_bus(b);
2926
2927	if (!found)
2928		pci_bus_update_busn_res_end(b, max);
 
 
2929
 
 
 
 
 
 
 
2930	return b;
2931}
2932EXPORT_SYMBOL(pci_scan_root_bus);
2933
2934struct pci_bus *pci_scan_bus(int bus, struct pci_ops *ops,
2935					void *sysdata)
2936{
2937	LIST_HEAD(resources);
2938	struct pci_bus *b;
2939
2940	pci_add_resource(&resources, &ioport_resource);
2941	pci_add_resource(&resources, &iomem_resource);
2942	pci_add_resource(&resources, &busn_resource);
2943	b = pci_create_root_bus(NULL, bus, ops, sysdata, &resources);
2944	if (b) {
2945		pci_scan_child_bus(b);
 
2946	} else {
2947		pci_free_resource_list(&resources);
2948	}
2949	return b;
2950}
2951EXPORT_SYMBOL(pci_scan_bus);
2952
 
2953/**
2954 * pci_rescan_bus_bridge_resize - Scan a PCI bus for devices
2955 * @bridge: PCI bridge for the bus to scan
2956 *
2957 * Scan a PCI bus and child buses for new devices, add them,
2958 * and enable them, resizing bridge mmio/io resource if necessary
2959 * and possible.  The caller must ensure the child devices are already
2960 * removed for resizing to occur.
2961 *
2962 * Returns the max number of subordinate bus discovered.
2963 */
2964unsigned int pci_rescan_bus_bridge_resize(struct pci_dev *bridge)
2965{
2966	unsigned int max;
2967	struct pci_bus *bus = bridge->subordinate;
2968
2969	max = pci_scan_child_bus(bus);
2970
2971	pci_assign_unassigned_bridge_resources(bridge);
2972
2973	pci_bus_add_devices(bus);
2974
2975	return max;
2976}
2977
2978/**
2979 * pci_rescan_bus - Scan a PCI bus for devices
2980 * @bus: PCI bus to scan
2981 *
2982 * Scan a PCI bus and child buses for new devices, add them,
2983 * and enable them.
2984 *
2985 * Returns the max number of subordinate bus discovered.
2986 */
2987unsigned int pci_rescan_bus(struct pci_bus *bus)
2988{
2989	unsigned int max;
2990
2991	max = pci_scan_child_bus(bus);
2992	pci_assign_unassigned_bus_resources(bus);
2993	pci_bus_add_devices(bus);
2994
2995	return max;
2996}
2997EXPORT_SYMBOL_GPL(pci_rescan_bus);
2998
2999/*
3000 * pci_rescan_bus(), pci_rescan_bus_bridge_resize() and PCI device removal
3001 * routines should always be executed under this mutex.
3002 */
3003static DEFINE_MUTEX(pci_rescan_remove_lock);
3004
3005void pci_lock_rescan_remove(void)
3006{
3007	mutex_lock(&pci_rescan_remove_lock);
3008}
3009EXPORT_SYMBOL_GPL(pci_lock_rescan_remove);
3010
3011void pci_unlock_rescan_remove(void)
3012{
3013	mutex_unlock(&pci_rescan_remove_lock);
3014}
3015EXPORT_SYMBOL_GPL(pci_unlock_rescan_remove);
3016
3017static int __init pci_sort_bf_cmp(const struct device *d_a,
3018				  const struct device *d_b)
3019{
3020	const struct pci_dev *a = to_pci_dev(d_a);
3021	const struct pci_dev *b = to_pci_dev(d_b);
3022
3023	if      (pci_domain_nr(a->bus) < pci_domain_nr(b->bus)) return -1;
3024	else if (pci_domain_nr(a->bus) > pci_domain_nr(b->bus)) return  1;
3025
3026	if      (a->bus->number < b->bus->number) return -1;
3027	else if (a->bus->number > b->bus->number) return  1;
3028
3029	if      (a->devfn < b->devfn) return -1;
3030	else if (a->devfn > b->devfn) return  1;
3031
3032	return 0;
3033}
3034
3035void __init pci_sort_breadthfirst(void)
3036{
3037	bus_sort_breadthfirst(&pci_bus_type, &pci_sort_bf_cmp);
3038}
3039
3040int pci_hp_add_bridge(struct pci_dev *dev)
3041{
3042	struct pci_bus *parent = dev->bus;
3043	int busnr, start = parent->busn_res.start;
3044	unsigned int available_buses = 0;
3045	int end = parent->busn_res.end;
3046
3047	for (busnr = start; busnr <= end; busnr++) {
3048		if (!pci_find_bus(pci_domain_nr(parent), busnr))
3049			break;
3050	}
3051	if (busnr-- > end) {
3052		pci_err(dev, "No bus number available for hot-added bridge\n");
3053		return -1;
3054	}
3055
3056	/* Scan bridges that are already configured */
3057	busnr = pci_scan_bridge(parent, dev, busnr, 0);
3058
3059	/*
3060	 * Distribute the available bus numbers between hotplug-capable
3061	 * bridges to make extending the chain later possible.
3062	 */
3063	available_buses = end - busnr;
3064
3065	/* Scan bridges that need to be reconfigured */
3066	pci_scan_bridge_extend(parent, dev, busnr, available_buses, 1);
3067
3068	if (!dev->subordinate)
3069		return -1;
3070
3071	return 0;
3072}
3073EXPORT_SYMBOL_GPL(pci_hp_add_bridge);