Linux Audio

Check our new training course

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