xref: /openbmc/linux/drivers/pci/probe.c (revision 8571e645)
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/of_device.h>
10 #include <linux/of_pci.h>
11 #include <linux/pci_hotplug.h>
12 #include <linux/slab.h>
13 #include <linux/module.h>
14 #include <linux/cpumask.h>
15 #include <linux/pci-aspm.h>
16 #include <linux/aer.h>
17 #include <linux/acpi.h>
18 #include <linux/irqdomain.h>
19 #include "pci.h"
20 
21 #define CARDBUS_LATENCY_TIMER	176	/* secondary latency timer */
22 #define CARDBUS_RESERVE_BUSNR	3
23 
24 static struct resource busn_resource = {
25 	.name	= "PCI busn",
26 	.start	= 0,
27 	.end	= 255,
28 	.flags	= IORESOURCE_BUS,
29 };
30 
31 /* Ugh.  Need to stop exporting this to modules. */
32 LIST_HEAD(pci_root_buses);
33 EXPORT_SYMBOL(pci_root_buses);
34 
35 static LIST_HEAD(pci_domain_busn_res_list);
36 
37 struct pci_domain_busn_res {
38 	struct list_head list;
39 	struct resource res;
40 	int domain_nr;
41 };
42 
43 static struct resource *get_pci_domain_busn_res(int domain_nr)
44 {
45 	struct pci_domain_busn_res *r;
46 
47 	list_for_each_entry(r, &pci_domain_busn_res_list, list)
48 		if (r->domain_nr == domain_nr)
49 			return &r->res;
50 
51 	r = kzalloc(sizeof(*r), GFP_KERNEL);
52 	if (!r)
53 		return NULL;
54 
55 	r->domain_nr = domain_nr;
56 	r->res.start = 0;
57 	r->res.end = 0xff;
58 	r->res.flags = IORESOURCE_BUS | IORESOURCE_PCI_FIXED;
59 
60 	list_add_tail(&r->list, &pci_domain_busn_res_list);
61 
62 	return &r->res;
63 }
64 
65 static int find_anything(struct device *dev, void *data)
66 {
67 	return 1;
68 }
69 
70 /*
71  * Some device drivers need know if pci is initiated.
72  * Basically, we think pci is not initiated when there
73  * is no device to be found on the pci_bus_type.
74  */
75 int no_pci_devices(void)
76 {
77 	struct device *dev;
78 	int no_devices;
79 
80 	dev = bus_find_device(&pci_bus_type, NULL, NULL, find_anything);
81 	no_devices = (dev == NULL);
82 	put_device(dev);
83 	return no_devices;
84 }
85 EXPORT_SYMBOL(no_pci_devices);
86 
87 /*
88  * PCI Bus Class
89  */
90 static void release_pcibus_dev(struct device *dev)
91 {
92 	struct pci_bus *pci_bus = to_pci_bus(dev);
93 
94 	put_device(pci_bus->bridge);
95 	pci_bus_remove_resources(pci_bus);
96 	pci_release_bus_of_node(pci_bus);
97 	kfree(pci_bus);
98 }
99 
100 static struct class pcibus_class = {
101 	.name		= "pci_bus",
102 	.dev_release	= &release_pcibus_dev,
103 	.dev_groups	= pcibus_groups,
104 };
105 
106 static int __init pcibus_class_init(void)
107 {
108 	return class_register(&pcibus_class);
109 }
110 postcore_initcall(pcibus_class_init);
111 
112 static u64 pci_size(u64 base, u64 maxbase, u64 mask)
113 {
114 	u64 size = mask & maxbase;	/* Find the significant bits */
115 	if (!size)
116 		return 0;
117 
118 	/* Get the lowest of them to find the decode size, and
119 	   from that the extent.  */
120 	size = (size & ~(size-1)) - 1;
121 
122 	/* base == maxbase can be valid only if the BAR has
123 	   already been programmed with all 1s.  */
124 	if (base == maxbase && ((base | size) & mask) != mask)
125 		return 0;
126 
127 	return size;
128 }
129 
130 static inline unsigned long decode_bar(struct pci_dev *dev, u32 bar)
131 {
132 	u32 mem_type;
133 	unsigned long flags;
134 
135 	if ((bar & PCI_BASE_ADDRESS_SPACE) == PCI_BASE_ADDRESS_SPACE_IO) {
136 		flags = bar & ~PCI_BASE_ADDRESS_IO_MASK;
137 		flags |= IORESOURCE_IO;
138 		return flags;
139 	}
140 
141 	flags = bar & ~PCI_BASE_ADDRESS_MEM_MASK;
142 	flags |= IORESOURCE_MEM;
143 	if (flags & PCI_BASE_ADDRESS_MEM_PREFETCH)
144 		flags |= IORESOURCE_PREFETCH;
145 
146 	mem_type = bar & PCI_BASE_ADDRESS_MEM_TYPE_MASK;
147 	switch (mem_type) {
148 	case PCI_BASE_ADDRESS_MEM_TYPE_32:
149 		break;
150 	case PCI_BASE_ADDRESS_MEM_TYPE_1M:
151 		/* 1M mem BAR treated as 32-bit BAR */
152 		break;
153 	case PCI_BASE_ADDRESS_MEM_TYPE_64:
154 		flags |= IORESOURCE_MEM_64;
155 		break;
156 	default:
157 		/* mem unknown type treated as 32-bit BAR */
158 		break;
159 	}
160 	return flags;
161 }
162 
163 #define PCI_COMMAND_DECODE_ENABLE	(PCI_COMMAND_MEMORY | PCI_COMMAND_IO)
164 
165 /**
166  * pci_read_base - read a PCI BAR
167  * @dev: the PCI device
168  * @type: type of the BAR
169  * @res: resource buffer to be filled in
170  * @pos: BAR position in the config space
171  *
172  * Returns 1 if the BAR is 64-bit, or 0 if 32-bit.
173  */
174 int __pci_read_base(struct pci_dev *dev, enum pci_bar_type type,
175 		    struct resource *res, unsigned int pos)
176 {
177 	u32 l, sz, mask;
178 	u64 l64, sz64, mask64;
179 	u16 orig_cmd;
180 	struct pci_bus_region region, inverted_region;
181 
182 	if (dev->non_compliant_bars)
183 		return 0;
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 (sz == 0xffffffff)
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 (l == 0xffffffff)
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 		res->flags |= (l & IORESOURCE_ROM_ENABLE);
233 		l64 = l & PCI_ROM_ADDRESS_MASK;
234 		sz64 = sz & PCI_ROM_ADDRESS_MASK;
235 		mask64 = (u32)PCI_ROM_ADDRESS_MASK;
236 	}
237 
238 	if (res->flags & IORESOURCE_MEM_64) {
239 		pci_read_config_dword(dev, pos + 4, &l);
240 		pci_write_config_dword(dev, pos + 4, ~0);
241 		pci_read_config_dword(dev, pos + 4, &sz);
242 		pci_write_config_dword(dev, pos + 4, l);
243 
244 		l64 |= ((u64)l << 32);
245 		sz64 |= ((u64)sz << 32);
246 		mask64 |= ((u64)~0 << 32);
247 	}
248 
249 	if (!dev->mmio_always_on && (orig_cmd & PCI_COMMAND_DECODE_ENABLE))
250 		pci_write_config_word(dev, PCI_COMMAND, orig_cmd);
251 
252 	if (!sz64)
253 		goto fail;
254 
255 	sz64 = pci_size(l64, sz64, mask64);
256 	if (!sz64) {
257 		dev_info(&dev->dev, FW_BUG "reg 0x%x: invalid BAR (can't size)\n",
258 			 pos);
259 		goto fail;
260 	}
261 
262 	if (res->flags & IORESOURCE_MEM_64) {
263 		if ((sizeof(pci_bus_addr_t) < 8 || sizeof(resource_size_t) < 8)
264 		    && sz64 > 0x100000000ULL) {
265 			res->flags |= IORESOURCE_UNSET | IORESOURCE_DISABLED;
266 			res->start = 0;
267 			res->end = 0;
268 			dev_err(&dev->dev, "reg 0x%x: can't handle BAR larger than 4GB (size %#010llx)\n",
269 				pos, (unsigned long long)sz64);
270 			goto out;
271 		}
272 
273 		if ((sizeof(pci_bus_addr_t) < 8) && l) {
274 			/* Above 32-bit boundary; try to reallocate */
275 			res->flags |= IORESOURCE_UNSET;
276 			res->start = 0;
277 			res->end = sz64;
278 			dev_info(&dev->dev, "reg 0x%x: can't handle BAR above 4GB (bus address %#010llx)\n",
279 				 pos, (unsigned long long)l64);
280 			goto out;
281 		}
282 	}
283 
284 	region.start = l64;
285 	region.end = l64 + sz64;
286 
287 	pcibios_bus_to_resource(dev->bus, res, &region);
288 	pcibios_resource_to_bus(dev->bus, &inverted_region, res);
289 
290 	/*
291 	 * If "A" is a BAR value (a bus address), "bus_to_resource(A)" is
292 	 * the corresponding resource address (the physical address used by
293 	 * the CPU.  Converting that resource address back to a bus address
294 	 * should yield the original BAR value:
295 	 *
296 	 *     resource_to_bus(bus_to_resource(A)) == A
297 	 *
298 	 * If it doesn't, CPU accesses to "bus_to_resource(A)" will not
299 	 * be claimed by the device.
300 	 */
301 	if (inverted_region.start != region.start) {
302 		res->flags |= IORESOURCE_UNSET;
303 		res->start = 0;
304 		res->end = region.end - region.start;
305 		dev_info(&dev->dev, "reg 0x%x: initial BAR value %#010llx invalid\n",
306 			 pos, (unsigned long long)region.start);
307 	}
308 
309 	goto out;
310 
311 
312 fail:
313 	res->flags = 0;
314 out:
315 	if (res->flags)
316 		dev_printk(KERN_DEBUG, &dev->dev, "reg 0x%x: %pR\n", pos, res);
317 
318 	return (res->flags & IORESOURCE_MEM_64) ? 1 : 0;
319 }
320 
321 static void pci_read_bases(struct pci_dev *dev, unsigned int howmany, int rom)
322 {
323 	unsigned int pos, reg;
324 
325 	for (pos = 0; pos < howmany; pos++) {
326 		struct resource *res = &dev->resource[pos];
327 		reg = PCI_BASE_ADDRESS_0 + (pos << 2);
328 		pos += __pci_read_base(dev, pci_bar_unknown, res, reg);
329 	}
330 
331 	if (rom) {
332 		struct resource *res = &dev->resource[PCI_ROM_RESOURCE];
333 		dev->rom_base_reg = rom;
334 		res->flags = IORESOURCE_MEM | IORESOURCE_PREFETCH |
335 				IORESOURCE_READONLY | IORESOURCE_SIZEALIGN;
336 		__pci_read_base(dev, pci_bar_mem32, res, rom);
337 	}
338 }
339 
340 static void pci_read_bridge_io(struct pci_bus *child)
341 {
342 	struct pci_dev *dev = child->self;
343 	u8 io_base_lo, io_limit_lo;
344 	unsigned long io_mask, io_granularity, base, limit;
345 	struct pci_bus_region region;
346 	struct resource *res;
347 
348 	io_mask = PCI_IO_RANGE_MASK;
349 	io_granularity = 0x1000;
350 	if (dev->io_window_1k) {
351 		/* Support 1K I/O space granularity */
352 		io_mask = PCI_IO_1K_RANGE_MASK;
353 		io_granularity = 0x400;
354 	}
355 
356 	res = child->resource[0];
357 	pci_read_config_byte(dev, PCI_IO_BASE, &io_base_lo);
358 	pci_read_config_byte(dev, PCI_IO_LIMIT, &io_limit_lo);
359 	base = (io_base_lo & io_mask) << 8;
360 	limit = (io_limit_lo & io_mask) << 8;
361 
362 	if ((io_base_lo & PCI_IO_RANGE_TYPE_MASK) == PCI_IO_RANGE_TYPE_32) {
363 		u16 io_base_hi, io_limit_hi;
364 
365 		pci_read_config_word(dev, PCI_IO_BASE_UPPER16, &io_base_hi);
366 		pci_read_config_word(dev, PCI_IO_LIMIT_UPPER16, &io_limit_hi);
367 		base |= ((unsigned long) io_base_hi << 16);
368 		limit |= ((unsigned long) io_limit_hi << 16);
369 	}
370 
371 	if (base <= limit) {
372 		res->flags = (io_base_lo & PCI_IO_RANGE_TYPE_MASK) | IORESOURCE_IO;
373 		region.start = base;
374 		region.end = limit + io_granularity - 1;
375 		pcibios_bus_to_resource(dev->bus, res, &region);
376 		dev_printk(KERN_DEBUG, &dev->dev, "  bridge window %pR\n", res);
377 	}
378 }
379 
380 static void pci_read_bridge_mmio(struct pci_bus *child)
381 {
382 	struct pci_dev *dev = child->self;
383 	u16 mem_base_lo, mem_limit_lo;
384 	unsigned long base, limit;
385 	struct pci_bus_region region;
386 	struct resource *res;
387 
388 	res = child->resource[1];
389 	pci_read_config_word(dev, PCI_MEMORY_BASE, &mem_base_lo);
390 	pci_read_config_word(dev, PCI_MEMORY_LIMIT, &mem_limit_lo);
391 	base = ((unsigned long) mem_base_lo & PCI_MEMORY_RANGE_MASK) << 16;
392 	limit = ((unsigned long) mem_limit_lo & PCI_MEMORY_RANGE_MASK) << 16;
393 	if (base <= limit) {
394 		res->flags = (mem_base_lo & PCI_MEMORY_RANGE_TYPE_MASK) | IORESOURCE_MEM;
395 		region.start = base;
396 		region.end = limit + 0xfffff;
397 		pcibios_bus_to_resource(dev->bus, res, &region);
398 		dev_printk(KERN_DEBUG, &dev->dev, "  bridge window %pR\n", res);
399 	}
400 }
401 
402 static void pci_read_bridge_mmio_pref(struct pci_bus *child)
403 {
404 	struct pci_dev *dev = child->self;
405 	u16 mem_base_lo, mem_limit_lo;
406 	u64 base64, limit64;
407 	pci_bus_addr_t base, limit;
408 	struct pci_bus_region region;
409 	struct resource *res;
410 
411 	res = child->resource[2];
412 	pci_read_config_word(dev, PCI_PREF_MEMORY_BASE, &mem_base_lo);
413 	pci_read_config_word(dev, PCI_PREF_MEMORY_LIMIT, &mem_limit_lo);
414 	base64 = (mem_base_lo & PCI_PREF_RANGE_MASK) << 16;
415 	limit64 = (mem_limit_lo & PCI_PREF_RANGE_MASK) << 16;
416 
417 	if ((mem_base_lo & PCI_PREF_RANGE_TYPE_MASK) == PCI_PREF_RANGE_TYPE_64) {
418 		u32 mem_base_hi, mem_limit_hi;
419 
420 		pci_read_config_dword(dev, PCI_PREF_BASE_UPPER32, &mem_base_hi);
421 		pci_read_config_dword(dev, PCI_PREF_LIMIT_UPPER32, &mem_limit_hi);
422 
423 		/*
424 		 * Some bridges set the base > limit by default, and some
425 		 * (broken) BIOSes do not initialize them.  If we find
426 		 * this, just assume they are not being used.
427 		 */
428 		if (mem_base_hi <= mem_limit_hi) {
429 			base64 |= (u64) mem_base_hi << 32;
430 			limit64 |= (u64) mem_limit_hi << 32;
431 		}
432 	}
433 
434 	base = (pci_bus_addr_t) base64;
435 	limit = (pci_bus_addr_t) limit64;
436 
437 	if (base != base64) {
438 		dev_err(&dev->dev, "can't handle bridge window above 4GB (bus address %#010llx)\n",
439 			(unsigned long long) base64);
440 		return;
441 	}
442 
443 	if (base <= limit) {
444 		res->flags = (mem_base_lo & PCI_PREF_RANGE_TYPE_MASK) |
445 					 IORESOURCE_MEM | IORESOURCE_PREFETCH;
446 		if (res->flags & PCI_PREF_RANGE_TYPE_64)
447 			res->flags |= IORESOURCE_MEM_64;
448 		region.start = base;
449 		region.end = limit + 0xfffff;
450 		pcibios_bus_to_resource(dev->bus, res, &region);
451 		dev_printk(KERN_DEBUG, &dev->dev, "  bridge window %pR\n", res);
452 	}
453 }
454 
455 void pci_read_bridge_bases(struct pci_bus *child)
456 {
457 	struct pci_dev *dev = child->self;
458 	struct resource *res;
459 	int i;
460 
461 	if (pci_is_root_bus(child))	/* It's a host bus, nothing to read */
462 		return;
463 
464 	dev_info(&dev->dev, "PCI bridge to %pR%s\n",
465 		 &child->busn_res,
466 		 dev->transparent ? " (subtractive decode)" : "");
467 
468 	pci_bus_remove_resources(child);
469 	for (i = 0; i < PCI_BRIDGE_RESOURCE_NUM; i++)
470 		child->resource[i] = &dev->resource[PCI_BRIDGE_RESOURCES+i];
471 
472 	pci_read_bridge_io(child);
473 	pci_read_bridge_mmio(child);
474 	pci_read_bridge_mmio_pref(child);
475 
476 	if (dev->transparent) {
477 		pci_bus_for_each_resource(child->parent, res, i) {
478 			if (res && res->flags) {
479 				pci_bus_add_resource(child, res,
480 						     PCI_SUBTRACTIVE_DECODE);
481 				dev_printk(KERN_DEBUG, &dev->dev,
482 					   "  bridge window %pR (subtractive decode)\n",
483 					   res);
484 			}
485 		}
486 	}
487 }
488 
489 static struct pci_bus *pci_alloc_bus(struct pci_bus *parent)
490 {
491 	struct pci_bus *b;
492 
493 	b = kzalloc(sizeof(*b), GFP_KERNEL);
494 	if (!b)
495 		return NULL;
496 
497 	INIT_LIST_HEAD(&b->node);
498 	INIT_LIST_HEAD(&b->children);
499 	INIT_LIST_HEAD(&b->devices);
500 	INIT_LIST_HEAD(&b->slots);
501 	INIT_LIST_HEAD(&b->resources);
502 	b->max_bus_speed = PCI_SPEED_UNKNOWN;
503 	b->cur_bus_speed = PCI_SPEED_UNKNOWN;
504 #ifdef CONFIG_PCI_DOMAINS_GENERIC
505 	if (parent)
506 		b->domain_nr = parent->domain_nr;
507 #endif
508 	return b;
509 }
510 
511 static void pci_release_host_bridge_dev(struct device *dev)
512 {
513 	struct pci_host_bridge *bridge = to_pci_host_bridge(dev);
514 
515 	if (bridge->release_fn)
516 		bridge->release_fn(bridge);
517 
518 	pci_free_resource_list(&bridge->windows);
519 
520 	kfree(bridge);
521 }
522 
523 static struct pci_host_bridge *pci_alloc_host_bridge(struct pci_bus *b)
524 {
525 	struct pci_host_bridge *bridge;
526 
527 	bridge = kzalloc(sizeof(*bridge), GFP_KERNEL);
528 	if (!bridge)
529 		return NULL;
530 
531 	INIT_LIST_HEAD(&bridge->windows);
532 	bridge->bus = b;
533 	return bridge;
534 }
535 
536 static const unsigned char pcix_bus_speed[] = {
537 	PCI_SPEED_UNKNOWN,		/* 0 */
538 	PCI_SPEED_66MHz_PCIX,		/* 1 */
539 	PCI_SPEED_100MHz_PCIX,		/* 2 */
540 	PCI_SPEED_133MHz_PCIX,		/* 3 */
541 	PCI_SPEED_UNKNOWN,		/* 4 */
542 	PCI_SPEED_66MHz_PCIX_ECC,	/* 5 */
543 	PCI_SPEED_100MHz_PCIX_ECC,	/* 6 */
544 	PCI_SPEED_133MHz_PCIX_ECC,	/* 7 */
545 	PCI_SPEED_UNKNOWN,		/* 8 */
546 	PCI_SPEED_66MHz_PCIX_266,	/* 9 */
547 	PCI_SPEED_100MHz_PCIX_266,	/* A */
548 	PCI_SPEED_133MHz_PCIX_266,	/* B */
549 	PCI_SPEED_UNKNOWN,		/* C */
550 	PCI_SPEED_66MHz_PCIX_533,	/* D */
551 	PCI_SPEED_100MHz_PCIX_533,	/* E */
552 	PCI_SPEED_133MHz_PCIX_533	/* F */
553 };
554 
555 const unsigned char pcie_link_speed[] = {
556 	PCI_SPEED_UNKNOWN,		/* 0 */
557 	PCIE_SPEED_2_5GT,		/* 1 */
558 	PCIE_SPEED_5_0GT,		/* 2 */
559 	PCIE_SPEED_8_0GT,		/* 3 */
560 	PCI_SPEED_UNKNOWN,		/* 4 */
561 	PCI_SPEED_UNKNOWN,		/* 5 */
562 	PCI_SPEED_UNKNOWN,		/* 6 */
563 	PCI_SPEED_UNKNOWN,		/* 7 */
564 	PCI_SPEED_UNKNOWN,		/* 8 */
565 	PCI_SPEED_UNKNOWN,		/* 9 */
566 	PCI_SPEED_UNKNOWN,		/* A */
567 	PCI_SPEED_UNKNOWN,		/* B */
568 	PCI_SPEED_UNKNOWN,		/* C */
569 	PCI_SPEED_UNKNOWN,		/* D */
570 	PCI_SPEED_UNKNOWN,		/* E */
571 	PCI_SPEED_UNKNOWN		/* F */
572 };
573 
574 void pcie_update_link_speed(struct pci_bus *bus, u16 linksta)
575 {
576 	bus->cur_bus_speed = pcie_link_speed[linksta & PCI_EXP_LNKSTA_CLS];
577 }
578 EXPORT_SYMBOL_GPL(pcie_update_link_speed);
579 
580 static unsigned char agp_speeds[] = {
581 	AGP_UNKNOWN,
582 	AGP_1X,
583 	AGP_2X,
584 	AGP_4X,
585 	AGP_8X
586 };
587 
588 static enum pci_bus_speed agp_speed(int agp3, int agpstat)
589 {
590 	int index = 0;
591 
592 	if (agpstat & 4)
593 		index = 3;
594 	else if (agpstat & 2)
595 		index = 2;
596 	else if (agpstat & 1)
597 		index = 1;
598 	else
599 		goto out;
600 
601 	if (agp3) {
602 		index += 2;
603 		if (index == 5)
604 			index = 0;
605 	}
606 
607  out:
608 	return agp_speeds[index];
609 }
610 
611 static void pci_set_bus_speed(struct pci_bus *bus)
612 {
613 	struct pci_dev *bridge = bus->self;
614 	int pos;
615 
616 	pos = pci_find_capability(bridge, PCI_CAP_ID_AGP);
617 	if (!pos)
618 		pos = pci_find_capability(bridge, PCI_CAP_ID_AGP3);
619 	if (pos) {
620 		u32 agpstat, agpcmd;
621 
622 		pci_read_config_dword(bridge, pos + PCI_AGP_STATUS, &agpstat);
623 		bus->max_bus_speed = agp_speed(agpstat & 8, agpstat & 7);
624 
625 		pci_read_config_dword(bridge, pos + PCI_AGP_COMMAND, &agpcmd);
626 		bus->cur_bus_speed = agp_speed(agpstat & 8, agpcmd & 7);
627 	}
628 
629 	pos = pci_find_capability(bridge, PCI_CAP_ID_PCIX);
630 	if (pos) {
631 		u16 status;
632 		enum pci_bus_speed max;
633 
634 		pci_read_config_word(bridge, pos + PCI_X_BRIDGE_SSTATUS,
635 				     &status);
636 
637 		if (status & PCI_X_SSTATUS_533MHZ) {
638 			max = PCI_SPEED_133MHz_PCIX_533;
639 		} else if (status & PCI_X_SSTATUS_266MHZ) {
640 			max = PCI_SPEED_133MHz_PCIX_266;
641 		} else if (status & PCI_X_SSTATUS_133MHZ) {
642 			if ((status & PCI_X_SSTATUS_VERS) == PCI_X_SSTATUS_V2)
643 				max = PCI_SPEED_133MHz_PCIX_ECC;
644 			else
645 				max = PCI_SPEED_133MHz_PCIX;
646 		} else {
647 			max = PCI_SPEED_66MHz_PCIX;
648 		}
649 
650 		bus->max_bus_speed = max;
651 		bus->cur_bus_speed = pcix_bus_speed[
652 			(status & PCI_X_SSTATUS_FREQ) >> 6];
653 
654 		return;
655 	}
656 
657 	if (pci_is_pcie(bridge)) {
658 		u32 linkcap;
659 		u16 linksta;
660 
661 		pcie_capability_read_dword(bridge, PCI_EXP_LNKCAP, &linkcap);
662 		bus->max_bus_speed = pcie_link_speed[linkcap & PCI_EXP_LNKCAP_SLS];
663 
664 		pcie_capability_read_word(bridge, PCI_EXP_LNKSTA, &linksta);
665 		pcie_update_link_speed(bus, linksta);
666 	}
667 }
668 
669 static struct irq_domain *pci_host_bridge_msi_domain(struct pci_bus *bus)
670 {
671 	struct irq_domain *d;
672 
673 	/*
674 	 * Any firmware interface that can resolve the msi_domain
675 	 * should be called from here.
676 	 */
677 	d = pci_host_bridge_of_msi_domain(bus);
678 	if (!d)
679 		d = pci_host_bridge_acpi_msi_domain(bus);
680 
681 #ifdef CONFIG_PCI_MSI_IRQ_DOMAIN
682 	/*
683 	 * If no IRQ domain was found via the OF tree, try looking it up
684 	 * directly through the fwnode_handle.
685 	 */
686 	if (!d) {
687 		struct fwnode_handle *fwnode = pci_root_bus_fwnode(bus);
688 
689 		if (fwnode)
690 			d = irq_find_matching_fwnode(fwnode,
691 						     DOMAIN_BUS_PCI_MSI);
692 	}
693 #endif
694 
695 	return d;
696 }
697 
698 static void pci_set_bus_msi_domain(struct pci_bus *bus)
699 {
700 	struct irq_domain *d;
701 	struct pci_bus *b;
702 
703 	/*
704 	 * The bus can be a root bus, a subordinate bus, or a virtual bus
705 	 * created by an SR-IOV device.  Walk up to the first bridge device
706 	 * found or derive the domain from the host bridge.
707 	 */
708 	for (b = bus, d = NULL; !d && !pci_is_root_bus(b); b = b->parent) {
709 		if (b->self)
710 			d = dev_get_msi_domain(&b->self->dev);
711 	}
712 
713 	if (!d)
714 		d = pci_host_bridge_msi_domain(b);
715 
716 	dev_set_msi_domain(&bus->dev, d);
717 }
718 
719 static struct pci_bus *pci_alloc_child_bus(struct pci_bus *parent,
720 					   struct pci_dev *bridge, int busnr)
721 {
722 	struct pci_bus *child;
723 	int i;
724 	int ret;
725 
726 	/*
727 	 * Allocate a new bus, and inherit stuff from the parent..
728 	 */
729 	child = pci_alloc_bus(parent);
730 	if (!child)
731 		return NULL;
732 
733 	child->parent = parent;
734 	child->ops = parent->ops;
735 	child->msi = parent->msi;
736 	child->sysdata = parent->sysdata;
737 	child->bus_flags = parent->bus_flags;
738 
739 	/* initialize some portions of the bus device, but don't register it
740 	 * now as the parent is not properly set up yet.
741 	 */
742 	child->dev.class = &pcibus_class;
743 	dev_set_name(&child->dev, "%04x:%02x", pci_domain_nr(child), busnr);
744 
745 	/*
746 	 * Set up the primary, secondary and subordinate
747 	 * bus numbers.
748 	 */
749 	child->number = child->busn_res.start = busnr;
750 	child->primary = parent->busn_res.start;
751 	child->busn_res.end = 0xff;
752 
753 	if (!bridge) {
754 		child->dev.parent = parent->bridge;
755 		goto add_dev;
756 	}
757 
758 	child->self = bridge;
759 	child->bridge = get_device(&bridge->dev);
760 	child->dev.parent = child->bridge;
761 	pci_set_bus_of_node(child);
762 	pci_set_bus_speed(child);
763 
764 	/* Set up default resource pointers and names.. */
765 	for (i = 0; i < PCI_BRIDGE_RESOURCE_NUM; i++) {
766 		child->resource[i] = &bridge->resource[PCI_BRIDGE_RESOURCES+i];
767 		child->resource[i]->name = child->name;
768 	}
769 	bridge->subordinate = child;
770 
771 add_dev:
772 	pci_set_bus_msi_domain(child);
773 	ret = device_register(&child->dev);
774 	WARN_ON(ret < 0);
775 
776 	pcibios_add_bus(child);
777 
778 	if (child->ops->add_bus) {
779 		ret = child->ops->add_bus(child);
780 		if (WARN_ON(ret < 0))
781 			dev_err(&child->dev, "failed to add bus: %d\n", ret);
782 	}
783 
784 	/* Create legacy_io and legacy_mem files for this bus */
785 	pci_create_legacy_files(child);
786 
787 	return child;
788 }
789 
790 struct pci_bus *pci_add_new_bus(struct pci_bus *parent, struct pci_dev *dev,
791 				int busnr)
792 {
793 	struct pci_bus *child;
794 
795 	child = pci_alloc_child_bus(parent, dev, busnr);
796 	if (child) {
797 		down_write(&pci_bus_sem);
798 		list_add_tail(&child->node, &parent->children);
799 		up_write(&pci_bus_sem);
800 	}
801 	return child;
802 }
803 EXPORT_SYMBOL(pci_add_new_bus);
804 
805 static void pci_enable_crs(struct pci_dev *pdev)
806 {
807 	u16 root_cap = 0;
808 
809 	/* Enable CRS Software Visibility if supported */
810 	pcie_capability_read_word(pdev, PCI_EXP_RTCAP, &root_cap);
811 	if (root_cap & PCI_EXP_RTCAP_CRSVIS)
812 		pcie_capability_set_word(pdev, PCI_EXP_RTCTL,
813 					 PCI_EXP_RTCTL_CRSSVE);
814 }
815 
816 /*
817  * If it's a bridge, configure it and scan the bus behind it.
818  * For CardBus bridges, we don't scan behind as the devices will
819  * be handled by the bridge driver itself.
820  *
821  * We need to process bridges in two passes -- first we scan those
822  * already configured by the BIOS and after we are done with all of
823  * them, we proceed to assigning numbers to the remaining buses in
824  * order to avoid overlaps between old and new bus numbers.
825  */
826 int pci_scan_bridge(struct pci_bus *bus, struct pci_dev *dev, int max, int pass)
827 {
828 	struct pci_bus *child;
829 	int is_cardbus = (dev->hdr_type == PCI_HEADER_TYPE_CARDBUS);
830 	u32 buses, i, j = 0;
831 	u16 bctl;
832 	u8 primary, secondary, subordinate;
833 	int broken = 0;
834 
835 	pci_read_config_dword(dev, PCI_PRIMARY_BUS, &buses);
836 	primary = buses & 0xFF;
837 	secondary = (buses >> 8) & 0xFF;
838 	subordinate = (buses >> 16) & 0xFF;
839 
840 	dev_dbg(&dev->dev, "scanning [bus %02x-%02x] behind bridge, pass %d\n",
841 		secondary, subordinate, pass);
842 
843 	if (!primary && (primary != bus->number) && secondary && subordinate) {
844 		dev_warn(&dev->dev, "Primary bus is hard wired to 0\n");
845 		primary = bus->number;
846 	}
847 
848 	/* Check if setup is sensible at all */
849 	if (!pass &&
850 	    (primary != bus->number || secondary <= bus->number ||
851 	     secondary > subordinate)) {
852 		dev_info(&dev->dev, "bridge configuration invalid ([bus %02x-%02x]), reconfiguring\n",
853 			 secondary, subordinate);
854 		broken = 1;
855 	}
856 
857 	/* Disable MasterAbortMode during probing to avoid reporting
858 	   of bus errors (in some architectures) */
859 	pci_read_config_word(dev, PCI_BRIDGE_CONTROL, &bctl);
860 	pci_write_config_word(dev, PCI_BRIDGE_CONTROL,
861 			      bctl & ~PCI_BRIDGE_CTL_MASTER_ABORT);
862 
863 	pci_enable_crs(dev);
864 
865 	if ((secondary || subordinate) && !pcibios_assign_all_busses() &&
866 	    !is_cardbus && !broken) {
867 		unsigned int cmax;
868 		/*
869 		 * Bus already configured by firmware, process it in the first
870 		 * pass and just note the configuration.
871 		 */
872 		if (pass)
873 			goto out;
874 
875 		/*
876 		 * The bus might already exist for two reasons: Either we are
877 		 * rescanning the bus or the bus is reachable through more than
878 		 * one bridge. The second case can happen with the i450NX
879 		 * chipset.
880 		 */
881 		child = pci_find_bus(pci_domain_nr(bus), secondary);
882 		if (!child) {
883 			child = pci_add_new_bus(bus, dev, secondary);
884 			if (!child)
885 				goto out;
886 			child->primary = primary;
887 			pci_bus_insert_busn_res(child, secondary, subordinate);
888 			child->bridge_ctl = bctl;
889 		}
890 
891 		cmax = pci_scan_child_bus(child);
892 		if (cmax > subordinate)
893 			dev_warn(&dev->dev, "bridge has subordinate %02x but max busn %02x\n",
894 				 subordinate, cmax);
895 		/* subordinate should equal child->busn_res.end */
896 		if (subordinate > max)
897 			max = subordinate;
898 	} else {
899 		/*
900 		 * We need to assign a number to this bus which we always
901 		 * do in the second pass.
902 		 */
903 		if (!pass) {
904 			if (pcibios_assign_all_busses() || broken || is_cardbus)
905 				/* Temporarily disable forwarding of the
906 				   configuration cycles on all bridges in
907 				   this bus segment to avoid possible
908 				   conflicts in the second pass between two
909 				   bridges programmed with overlapping
910 				   bus ranges. */
911 				pci_write_config_dword(dev, PCI_PRIMARY_BUS,
912 						       buses & ~0xffffff);
913 			goto out;
914 		}
915 
916 		/* Clear errors */
917 		pci_write_config_word(dev, PCI_STATUS, 0xffff);
918 
919 		/* Prevent assigning a bus number that already exists.
920 		 * This can happen when a bridge is hot-plugged, so in
921 		 * this case we only re-scan this bus. */
922 		child = pci_find_bus(pci_domain_nr(bus), max+1);
923 		if (!child) {
924 			child = pci_add_new_bus(bus, dev, max+1);
925 			if (!child)
926 				goto out;
927 			pci_bus_insert_busn_res(child, max+1, 0xff);
928 		}
929 		max++;
930 		buses = (buses & 0xff000000)
931 		      | ((unsigned int)(child->primary)     <<  0)
932 		      | ((unsigned int)(child->busn_res.start)   <<  8)
933 		      | ((unsigned int)(child->busn_res.end) << 16);
934 
935 		/*
936 		 * yenta.c forces a secondary latency timer of 176.
937 		 * Copy that behaviour here.
938 		 */
939 		if (is_cardbus) {
940 			buses &= ~0xff000000;
941 			buses |= CARDBUS_LATENCY_TIMER << 24;
942 		}
943 
944 		/*
945 		 * We need to blast all three values with a single write.
946 		 */
947 		pci_write_config_dword(dev, PCI_PRIMARY_BUS, buses);
948 
949 		if (!is_cardbus) {
950 			child->bridge_ctl = bctl;
951 			max = pci_scan_child_bus(child);
952 		} else {
953 			/*
954 			 * For CardBus bridges, we leave 4 bus numbers
955 			 * as cards with a PCI-to-PCI bridge can be
956 			 * inserted later.
957 			 */
958 			for (i = 0; i < CARDBUS_RESERVE_BUSNR; i++) {
959 				struct pci_bus *parent = bus;
960 				if (pci_find_bus(pci_domain_nr(bus),
961 							max+i+1))
962 					break;
963 				while (parent->parent) {
964 					if ((!pcibios_assign_all_busses()) &&
965 					    (parent->busn_res.end > max) &&
966 					    (parent->busn_res.end <= max+i)) {
967 						j = 1;
968 					}
969 					parent = parent->parent;
970 				}
971 				if (j) {
972 					/*
973 					 * Often, there are two cardbus bridges
974 					 * -- try to leave one valid bus number
975 					 * for each one.
976 					 */
977 					i /= 2;
978 					break;
979 				}
980 			}
981 			max += i;
982 		}
983 		/*
984 		 * Set the subordinate bus number to its real value.
985 		 */
986 		pci_bus_update_busn_res_end(child, max);
987 		pci_write_config_byte(dev, PCI_SUBORDINATE_BUS, max);
988 	}
989 
990 	sprintf(child->name,
991 		(is_cardbus ? "PCI CardBus %04x:%02x" : "PCI Bus %04x:%02x"),
992 		pci_domain_nr(bus), child->number);
993 
994 	/* Has only triggered on CardBus, fixup is in yenta_socket */
995 	while (bus->parent) {
996 		if ((child->busn_res.end > bus->busn_res.end) ||
997 		    (child->number > bus->busn_res.end) ||
998 		    (child->number < bus->number) ||
999 		    (child->busn_res.end < bus->number)) {
1000 			dev_info(&child->dev, "%pR %s hidden behind%s bridge %s %pR\n",
1001 				&child->busn_res,
1002 				(bus->number > child->busn_res.end &&
1003 				 bus->busn_res.end < child->number) ?
1004 					"wholly" : "partially",
1005 				bus->self->transparent ? " transparent" : "",
1006 				dev_name(&bus->dev),
1007 				&bus->busn_res);
1008 		}
1009 		bus = bus->parent;
1010 	}
1011 
1012 out:
1013 	pci_write_config_word(dev, PCI_BRIDGE_CONTROL, bctl);
1014 
1015 	return max;
1016 }
1017 EXPORT_SYMBOL(pci_scan_bridge);
1018 
1019 /*
1020  * Read interrupt line and base address registers.
1021  * The architecture-dependent code can tweak these, of course.
1022  */
1023 static void pci_read_irq(struct pci_dev *dev)
1024 {
1025 	unsigned char irq;
1026 
1027 	pci_read_config_byte(dev, PCI_INTERRUPT_PIN, &irq);
1028 	dev->pin = irq;
1029 	if (irq)
1030 		pci_read_config_byte(dev, PCI_INTERRUPT_LINE, &irq);
1031 	dev->irq = irq;
1032 }
1033 
1034 void set_pcie_port_type(struct pci_dev *pdev)
1035 {
1036 	int pos;
1037 	u16 reg16;
1038 	int type;
1039 	struct pci_dev *parent;
1040 
1041 	pos = pci_find_capability(pdev, PCI_CAP_ID_EXP);
1042 	if (!pos)
1043 		return;
1044 	pdev->pcie_cap = pos;
1045 	pci_read_config_word(pdev, pos + PCI_EXP_FLAGS, &reg16);
1046 	pdev->pcie_flags_reg = reg16;
1047 	pci_read_config_word(pdev, pos + PCI_EXP_DEVCAP, &reg16);
1048 	pdev->pcie_mpss = reg16 & PCI_EXP_DEVCAP_PAYLOAD;
1049 
1050 	/*
1051 	 * A Root Port is always the upstream end of a Link.  No PCIe
1052 	 * component has two Links.  Two Links are connected by a Switch
1053 	 * that has a Port on each Link and internal logic to connect the
1054 	 * two Ports.
1055 	 */
1056 	type = pci_pcie_type(pdev);
1057 	if (type == PCI_EXP_TYPE_ROOT_PORT)
1058 		pdev->has_secondary_link = 1;
1059 	else if (type == PCI_EXP_TYPE_UPSTREAM ||
1060 		 type == PCI_EXP_TYPE_DOWNSTREAM) {
1061 		parent = pci_upstream_bridge(pdev);
1062 
1063 		/*
1064 		 * Usually there's an upstream device (Root Port or Switch
1065 		 * Downstream Port), but we can't assume one exists.
1066 		 */
1067 		if (parent && !parent->has_secondary_link)
1068 			pdev->has_secondary_link = 1;
1069 	}
1070 }
1071 
1072 void set_pcie_hotplug_bridge(struct pci_dev *pdev)
1073 {
1074 	u32 reg32;
1075 
1076 	pcie_capability_read_dword(pdev, PCI_EXP_SLTCAP, &reg32);
1077 	if (reg32 & PCI_EXP_SLTCAP_HPC)
1078 		pdev->is_hotplug_bridge = 1;
1079 }
1080 
1081 /**
1082  * pci_ext_cfg_is_aliased - is ext config space just an alias of std config?
1083  * @dev: PCI device
1084  *
1085  * PCI Express to PCI/PCI-X Bridge Specification, rev 1.0, 4.1.4 says that
1086  * when forwarding a type1 configuration request the bridge must check that
1087  * the extended register address field is zero.  The bridge is not permitted
1088  * to forward the transactions and must handle it as an Unsupported Request.
1089  * Some bridges do not follow this rule and simply drop the extended register
1090  * bits, resulting in the standard config space being aliased, every 256
1091  * bytes across the entire configuration space.  Test for this condition by
1092  * comparing the first dword of each potential alias to the vendor/device ID.
1093  * Known offenders:
1094  *   ASM1083/1085 PCIe-to-PCI Reversible Bridge (1b21:1080, rev 01 & 03)
1095  *   AMD/ATI SBx00 PCI to PCI Bridge (1002:4384, rev 40)
1096  */
1097 static bool pci_ext_cfg_is_aliased(struct pci_dev *dev)
1098 {
1099 #ifdef CONFIG_PCI_QUIRKS
1100 	int pos;
1101 	u32 header, tmp;
1102 
1103 	pci_read_config_dword(dev, PCI_VENDOR_ID, &header);
1104 
1105 	for (pos = PCI_CFG_SPACE_SIZE;
1106 	     pos < PCI_CFG_SPACE_EXP_SIZE; pos += PCI_CFG_SPACE_SIZE) {
1107 		if (pci_read_config_dword(dev, pos, &tmp) != PCIBIOS_SUCCESSFUL
1108 		    || header != tmp)
1109 			return false;
1110 	}
1111 
1112 	return true;
1113 #else
1114 	return false;
1115 #endif
1116 }
1117 
1118 /**
1119  * pci_cfg_space_size - get the configuration space size of the PCI device.
1120  * @dev: PCI device
1121  *
1122  * Regular PCI devices have 256 bytes, but PCI-X 2 and PCI Express devices
1123  * have 4096 bytes.  Even if the device is capable, that doesn't mean we can
1124  * access it.  Maybe we don't have a way to generate extended config space
1125  * accesses, or the device is behind a reverse Express bridge.  So we try
1126  * reading the dword at 0x100 which must either be 0 or a valid extended
1127  * capability header.
1128  */
1129 static int pci_cfg_space_size_ext(struct pci_dev *dev)
1130 {
1131 	u32 status;
1132 	int pos = PCI_CFG_SPACE_SIZE;
1133 
1134 	if (pci_read_config_dword(dev, pos, &status) != PCIBIOS_SUCCESSFUL)
1135 		return PCI_CFG_SPACE_SIZE;
1136 	if (status == 0xffffffff || pci_ext_cfg_is_aliased(dev))
1137 		return PCI_CFG_SPACE_SIZE;
1138 
1139 	return PCI_CFG_SPACE_EXP_SIZE;
1140 }
1141 
1142 int pci_cfg_space_size(struct pci_dev *dev)
1143 {
1144 	int pos;
1145 	u32 status;
1146 	u16 class;
1147 
1148 	class = dev->class >> 8;
1149 	if (class == PCI_CLASS_BRIDGE_HOST)
1150 		return pci_cfg_space_size_ext(dev);
1151 
1152 	if (pci_is_pcie(dev))
1153 		return pci_cfg_space_size_ext(dev);
1154 
1155 	pos = pci_find_capability(dev, PCI_CAP_ID_PCIX);
1156 	if (!pos)
1157 		return PCI_CFG_SPACE_SIZE;
1158 
1159 	pci_read_config_dword(dev, pos + PCI_X_STATUS, &status);
1160 	if (status & (PCI_X_STATUS_266MHZ | PCI_X_STATUS_533MHZ))
1161 		return pci_cfg_space_size_ext(dev);
1162 
1163 	return PCI_CFG_SPACE_SIZE;
1164 }
1165 
1166 #define LEGACY_IO_RESOURCE	(IORESOURCE_IO | IORESOURCE_PCI_FIXED)
1167 
1168 static void pci_msi_setup_pci_dev(struct pci_dev *dev)
1169 {
1170 	/*
1171 	 * Disable the MSI hardware to avoid screaming interrupts
1172 	 * during boot.  This is the power on reset default so
1173 	 * usually this should be a noop.
1174 	 */
1175 	dev->msi_cap = pci_find_capability(dev, PCI_CAP_ID_MSI);
1176 	if (dev->msi_cap)
1177 		pci_msi_set_enable(dev, 0);
1178 
1179 	dev->msix_cap = pci_find_capability(dev, PCI_CAP_ID_MSIX);
1180 	if (dev->msix_cap)
1181 		pci_msix_clear_and_set_ctrl(dev, PCI_MSIX_FLAGS_ENABLE, 0);
1182 }
1183 
1184 /**
1185  * pci_setup_device - fill in class and map information of a device
1186  * @dev: the device structure to fill
1187  *
1188  * Initialize the device structure with information about the device's
1189  * vendor,class,memory and IO-space addresses,IRQ lines etc.
1190  * Called at initialisation of the PCI subsystem and by CardBus services.
1191  * Returns 0 on success and negative if unknown type of device (not normal,
1192  * bridge or CardBus).
1193  */
1194 int pci_setup_device(struct pci_dev *dev)
1195 {
1196 	u32 class;
1197 	u16 cmd;
1198 	u8 hdr_type;
1199 	int pos = 0;
1200 	struct pci_bus_region region;
1201 	struct resource *res;
1202 
1203 	if (pci_read_config_byte(dev, PCI_HEADER_TYPE, &hdr_type))
1204 		return -EIO;
1205 
1206 	dev->sysdata = dev->bus->sysdata;
1207 	dev->dev.parent = dev->bus->bridge;
1208 	dev->dev.bus = &pci_bus_type;
1209 	dev->hdr_type = hdr_type & 0x7f;
1210 	dev->multifunction = !!(hdr_type & 0x80);
1211 	dev->error_state = pci_channel_io_normal;
1212 	set_pcie_port_type(dev);
1213 
1214 	pci_dev_assign_slot(dev);
1215 	/* Assume 32-bit PCI; let 64-bit PCI cards (which are far rarer)
1216 	   set this higher, assuming the system even supports it.  */
1217 	dev->dma_mask = 0xffffffff;
1218 
1219 	dev_set_name(&dev->dev, "%04x:%02x:%02x.%d", pci_domain_nr(dev->bus),
1220 		     dev->bus->number, PCI_SLOT(dev->devfn),
1221 		     PCI_FUNC(dev->devfn));
1222 
1223 	pci_read_config_dword(dev, PCI_CLASS_REVISION, &class);
1224 	dev->revision = class & 0xff;
1225 	dev->class = class >> 8;		    /* upper 3 bytes */
1226 
1227 	dev_printk(KERN_DEBUG, &dev->dev, "[%04x:%04x] type %02x class %#08x\n",
1228 		   dev->vendor, dev->device, dev->hdr_type, dev->class);
1229 
1230 	/* need to have dev->class ready */
1231 	dev->cfg_size = pci_cfg_space_size(dev);
1232 
1233 	/* "Unknown power state" */
1234 	dev->current_state = PCI_UNKNOWN;
1235 
1236 	/* Early fixups, before probing the BARs */
1237 	pci_fixup_device(pci_fixup_early, dev);
1238 	/* device class may be changed after fixup */
1239 	class = dev->class >> 8;
1240 
1241 	if (dev->non_compliant_bars) {
1242 		pci_read_config_word(dev, PCI_COMMAND, &cmd);
1243 		if (cmd & (PCI_COMMAND_IO | PCI_COMMAND_MEMORY)) {
1244 			dev_info(&dev->dev, "device has non-compliant BARs; disabling IO/MEM decoding\n");
1245 			cmd &= ~PCI_COMMAND_IO;
1246 			cmd &= ~PCI_COMMAND_MEMORY;
1247 			pci_write_config_word(dev, PCI_COMMAND, cmd);
1248 		}
1249 	}
1250 
1251 	switch (dev->hdr_type) {		    /* header type */
1252 	case PCI_HEADER_TYPE_NORMAL:		    /* standard header */
1253 		if (class == PCI_CLASS_BRIDGE_PCI)
1254 			goto bad;
1255 		pci_read_irq(dev);
1256 		pci_read_bases(dev, 6, PCI_ROM_ADDRESS);
1257 		pci_read_config_word(dev, PCI_SUBSYSTEM_VENDOR_ID, &dev->subsystem_vendor);
1258 		pci_read_config_word(dev, PCI_SUBSYSTEM_ID, &dev->subsystem_device);
1259 
1260 		/*
1261 		 * Do the ugly legacy mode stuff here rather than broken chip
1262 		 * quirk code. Legacy mode ATA controllers have fixed
1263 		 * addresses. These are not always echoed in BAR0-3, and
1264 		 * BAR0-3 in a few cases contain junk!
1265 		 */
1266 		if (class == PCI_CLASS_STORAGE_IDE) {
1267 			u8 progif;
1268 			pci_read_config_byte(dev, PCI_CLASS_PROG, &progif);
1269 			if ((progif & 1) == 0) {
1270 				region.start = 0x1F0;
1271 				region.end = 0x1F7;
1272 				res = &dev->resource[0];
1273 				res->flags = LEGACY_IO_RESOURCE;
1274 				pcibios_bus_to_resource(dev->bus, res, &region);
1275 				dev_info(&dev->dev, "legacy IDE quirk: reg 0x10: %pR\n",
1276 					 res);
1277 				region.start = 0x3F6;
1278 				region.end = 0x3F6;
1279 				res = &dev->resource[1];
1280 				res->flags = LEGACY_IO_RESOURCE;
1281 				pcibios_bus_to_resource(dev->bus, res, &region);
1282 				dev_info(&dev->dev, "legacy IDE quirk: reg 0x14: %pR\n",
1283 					 res);
1284 			}
1285 			if ((progif & 4) == 0) {
1286 				region.start = 0x170;
1287 				region.end = 0x177;
1288 				res = &dev->resource[2];
1289 				res->flags = LEGACY_IO_RESOURCE;
1290 				pcibios_bus_to_resource(dev->bus, res, &region);
1291 				dev_info(&dev->dev, "legacy IDE quirk: reg 0x18: %pR\n",
1292 					 res);
1293 				region.start = 0x376;
1294 				region.end = 0x376;
1295 				res = &dev->resource[3];
1296 				res->flags = LEGACY_IO_RESOURCE;
1297 				pcibios_bus_to_resource(dev->bus, res, &region);
1298 				dev_info(&dev->dev, "legacy IDE quirk: reg 0x1c: %pR\n",
1299 					 res);
1300 			}
1301 		}
1302 		break;
1303 
1304 	case PCI_HEADER_TYPE_BRIDGE:		    /* bridge header */
1305 		if (class != PCI_CLASS_BRIDGE_PCI)
1306 			goto bad;
1307 		/* The PCI-to-PCI bridge spec requires that subtractive
1308 		   decoding (i.e. transparent) bridge must have programming
1309 		   interface code of 0x01. */
1310 		pci_read_irq(dev);
1311 		dev->transparent = ((dev->class & 0xff) == 1);
1312 		pci_read_bases(dev, 2, PCI_ROM_ADDRESS1);
1313 		set_pcie_hotplug_bridge(dev);
1314 		pos = pci_find_capability(dev, PCI_CAP_ID_SSVID);
1315 		if (pos) {
1316 			pci_read_config_word(dev, pos + PCI_SSVID_VENDOR_ID, &dev->subsystem_vendor);
1317 			pci_read_config_word(dev, pos + PCI_SSVID_DEVICE_ID, &dev->subsystem_device);
1318 		}
1319 		break;
1320 
1321 	case PCI_HEADER_TYPE_CARDBUS:		    /* CardBus bridge header */
1322 		if (class != PCI_CLASS_BRIDGE_CARDBUS)
1323 			goto bad;
1324 		pci_read_irq(dev);
1325 		pci_read_bases(dev, 1, 0);
1326 		pci_read_config_word(dev, PCI_CB_SUBSYSTEM_VENDOR_ID, &dev->subsystem_vendor);
1327 		pci_read_config_word(dev, PCI_CB_SUBSYSTEM_ID, &dev->subsystem_device);
1328 		break;
1329 
1330 	default:				    /* unknown header */
1331 		dev_err(&dev->dev, "unknown header type %02x, ignoring device\n",
1332 			dev->hdr_type);
1333 		return -EIO;
1334 
1335 	bad:
1336 		dev_err(&dev->dev, "ignoring class %#08x (doesn't match header type %02x)\n",
1337 			dev->class, dev->hdr_type);
1338 		dev->class = PCI_CLASS_NOT_DEFINED << 8;
1339 	}
1340 
1341 	/* We found a fine healthy device, go go go... */
1342 	return 0;
1343 }
1344 
1345 static void pci_configure_mps(struct pci_dev *dev)
1346 {
1347 	struct pci_dev *bridge = pci_upstream_bridge(dev);
1348 	int mps, p_mps, rc;
1349 
1350 	if (!pci_is_pcie(dev) || !bridge || !pci_is_pcie(bridge))
1351 		return;
1352 
1353 	mps = pcie_get_mps(dev);
1354 	p_mps = pcie_get_mps(bridge);
1355 
1356 	if (mps == p_mps)
1357 		return;
1358 
1359 	if (pcie_bus_config == PCIE_BUS_TUNE_OFF) {
1360 		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",
1361 			 mps, pci_name(bridge), p_mps);
1362 		return;
1363 	}
1364 
1365 	/*
1366 	 * Fancier MPS configuration is done later by
1367 	 * pcie_bus_configure_settings()
1368 	 */
1369 	if (pcie_bus_config != PCIE_BUS_DEFAULT)
1370 		return;
1371 
1372 	rc = pcie_set_mps(dev, p_mps);
1373 	if (rc) {
1374 		dev_warn(&dev->dev, "can't set Max Payload Size to %d; if necessary, use \"pci=pcie_bus_safe\" and report a bug\n",
1375 			 p_mps);
1376 		return;
1377 	}
1378 
1379 	dev_info(&dev->dev, "Max Payload Size set to %d (was %d, max %d)\n",
1380 		 p_mps, mps, 128 << dev->pcie_mpss);
1381 }
1382 
1383 static struct hpp_type0 pci_default_type0 = {
1384 	.revision = 1,
1385 	.cache_line_size = 8,
1386 	.latency_timer = 0x40,
1387 	.enable_serr = 0,
1388 	.enable_perr = 0,
1389 };
1390 
1391 static void program_hpp_type0(struct pci_dev *dev, struct hpp_type0 *hpp)
1392 {
1393 	u16 pci_cmd, pci_bctl;
1394 
1395 	if (!hpp)
1396 		hpp = &pci_default_type0;
1397 
1398 	if (hpp->revision > 1) {
1399 		dev_warn(&dev->dev,
1400 			 "PCI settings rev %d not supported; using defaults\n",
1401 			 hpp->revision);
1402 		hpp = &pci_default_type0;
1403 	}
1404 
1405 	pci_write_config_byte(dev, PCI_CACHE_LINE_SIZE, hpp->cache_line_size);
1406 	pci_write_config_byte(dev, PCI_LATENCY_TIMER, hpp->latency_timer);
1407 	pci_read_config_word(dev, PCI_COMMAND, &pci_cmd);
1408 	if (hpp->enable_serr)
1409 		pci_cmd |= PCI_COMMAND_SERR;
1410 	if (hpp->enable_perr)
1411 		pci_cmd |= PCI_COMMAND_PARITY;
1412 	pci_write_config_word(dev, PCI_COMMAND, pci_cmd);
1413 
1414 	/* Program bridge control value */
1415 	if ((dev->class >> 8) == PCI_CLASS_BRIDGE_PCI) {
1416 		pci_write_config_byte(dev, PCI_SEC_LATENCY_TIMER,
1417 				      hpp->latency_timer);
1418 		pci_read_config_word(dev, PCI_BRIDGE_CONTROL, &pci_bctl);
1419 		if (hpp->enable_serr)
1420 			pci_bctl |= PCI_BRIDGE_CTL_SERR;
1421 		if (hpp->enable_perr)
1422 			pci_bctl |= PCI_BRIDGE_CTL_PARITY;
1423 		pci_write_config_word(dev, PCI_BRIDGE_CONTROL, pci_bctl);
1424 	}
1425 }
1426 
1427 static void program_hpp_type1(struct pci_dev *dev, struct hpp_type1 *hpp)
1428 {
1429 	if (hpp)
1430 		dev_warn(&dev->dev, "PCI-X settings not supported\n");
1431 }
1432 
1433 static void program_hpp_type2(struct pci_dev *dev, struct hpp_type2 *hpp)
1434 {
1435 	int pos;
1436 	u32 reg32;
1437 
1438 	if (!hpp)
1439 		return;
1440 
1441 	if (hpp->revision > 1) {
1442 		dev_warn(&dev->dev, "PCIe settings rev %d not supported\n",
1443 			 hpp->revision);
1444 		return;
1445 	}
1446 
1447 	/*
1448 	 * Don't allow _HPX to change MPS or MRRS settings.  We manage
1449 	 * those to make sure they're consistent with the rest of the
1450 	 * platform.
1451 	 */
1452 	hpp->pci_exp_devctl_and |= PCI_EXP_DEVCTL_PAYLOAD |
1453 				    PCI_EXP_DEVCTL_READRQ;
1454 	hpp->pci_exp_devctl_or &= ~(PCI_EXP_DEVCTL_PAYLOAD |
1455 				    PCI_EXP_DEVCTL_READRQ);
1456 
1457 	/* Initialize Device Control Register */
1458 	pcie_capability_clear_and_set_word(dev, PCI_EXP_DEVCTL,
1459 			~hpp->pci_exp_devctl_and, hpp->pci_exp_devctl_or);
1460 
1461 	/* Initialize Link Control Register */
1462 	if (pcie_cap_has_lnkctl(dev))
1463 		pcie_capability_clear_and_set_word(dev, PCI_EXP_LNKCTL,
1464 			~hpp->pci_exp_lnkctl_and, hpp->pci_exp_lnkctl_or);
1465 
1466 	/* Find Advanced Error Reporting Enhanced Capability */
1467 	pos = pci_find_ext_capability(dev, PCI_EXT_CAP_ID_ERR);
1468 	if (!pos)
1469 		return;
1470 
1471 	/* Initialize Uncorrectable Error Mask Register */
1472 	pci_read_config_dword(dev, pos + PCI_ERR_UNCOR_MASK, &reg32);
1473 	reg32 = (reg32 & hpp->unc_err_mask_and) | hpp->unc_err_mask_or;
1474 	pci_write_config_dword(dev, pos + PCI_ERR_UNCOR_MASK, reg32);
1475 
1476 	/* Initialize Uncorrectable Error Severity Register */
1477 	pci_read_config_dword(dev, pos + PCI_ERR_UNCOR_SEVER, &reg32);
1478 	reg32 = (reg32 & hpp->unc_err_sever_and) | hpp->unc_err_sever_or;
1479 	pci_write_config_dword(dev, pos + PCI_ERR_UNCOR_SEVER, reg32);
1480 
1481 	/* Initialize Correctable Error Mask Register */
1482 	pci_read_config_dword(dev, pos + PCI_ERR_COR_MASK, &reg32);
1483 	reg32 = (reg32 & hpp->cor_err_mask_and) | hpp->cor_err_mask_or;
1484 	pci_write_config_dword(dev, pos + PCI_ERR_COR_MASK, reg32);
1485 
1486 	/* Initialize Advanced Error Capabilities and Control Register */
1487 	pci_read_config_dword(dev, pos + PCI_ERR_CAP, &reg32);
1488 	reg32 = (reg32 & hpp->adv_err_cap_and) | hpp->adv_err_cap_or;
1489 	pci_write_config_dword(dev, pos + PCI_ERR_CAP, reg32);
1490 
1491 	/*
1492 	 * FIXME: The following two registers are not supported yet.
1493 	 *
1494 	 *   o Secondary Uncorrectable Error Severity Register
1495 	 *   o Secondary Uncorrectable Error Mask Register
1496 	 */
1497 }
1498 
1499 static void pci_configure_device(struct pci_dev *dev)
1500 {
1501 	struct hotplug_params hpp;
1502 	int ret;
1503 
1504 	pci_configure_mps(dev);
1505 
1506 	memset(&hpp, 0, sizeof(hpp));
1507 	ret = pci_get_hp_params(dev, &hpp);
1508 	if (ret)
1509 		return;
1510 
1511 	program_hpp_type2(dev, hpp.t2);
1512 	program_hpp_type1(dev, hpp.t1);
1513 	program_hpp_type0(dev, hpp.t0);
1514 }
1515 
1516 static void pci_release_capabilities(struct pci_dev *dev)
1517 {
1518 	pci_vpd_release(dev);
1519 	pci_iov_release(dev);
1520 	pci_free_cap_save_buffers(dev);
1521 }
1522 
1523 /**
1524  * pci_release_dev - free a pci device structure when all users of it are finished.
1525  * @dev: device that's been disconnected
1526  *
1527  * Will be called only by the device core when all users of this pci device are
1528  * done.
1529  */
1530 static void pci_release_dev(struct device *dev)
1531 {
1532 	struct pci_dev *pci_dev;
1533 
1534 	pci_dev = to_pci_dev(dev);
1535 	pci_release_capabilities(pci_dev);
1536 	pci_release_of_node(pci_dev);
1537 	pcibios_release_device(pci_dev);
1538 	pci_bus_put(pci_dev->bus);
1539 	kfree(pci_dev->driver_override);
1540 	kfree(pci_dev);
1541 }
1542 
1543 struct pci_dev *pci_alloc_dev(struct pci_bus *bus)
1544 {
1545 	struct pci_dev *dev;
1546 
1547 	dev = kzalloc(sizeof(struct pci_dev), GFP_KERNEL);
1548 	if (!dev)
1549 		return NULL;
1550 
1551 	INIT_LIST_HEAD(&dev->bus_list);
1552 	dev->dev.type = &pci_dev_type;
1553 	dev->bus = pci_bus_get(bus);
1554 
1555 	return dev;
1556 }
1557 EXPORT_SYMBOL(pci_alloc_dev);
1558 
1559 bool pci_bus_read_dev_vendor_id(struct pci_bus *bus, int devfn, u32 *l,
1560 				int crs_timeout)
1561 {
1562 	int delay = 1;
1563 
1564 	if (pci_bus_read_config_dword(bus, devfn, PCI_VENDOR_ID, l))
1565 		return false;
1566 
1567 	/* some broken boards return 0 or ~0 if a slot is empty: */
1568 	if (*l == 0xffffffff || *l == 0x00000000 ||
1569 	    *l == 0x0000ffff || *l == 0xffff0000)
1570 		return false;
1571 
1572 	/*
1573 	 * Configuration Request Retry Status.  Some root ports return the
1574 	 * actual device ID instead of the synthetic ID (0xFFFF) required
1575 	 * by the PCIe spec.  Ignore the device ID and only check for
1576 	 * (vendor id == 1).
1577 	 */
1578 	while ((*l & 0xffff) == 0x0001) {
1579 		if (!crs_timeout)
1580 			return false;
1581 
1582 		msleep(delay);
1583 		delay *= 2;
1584 		if (pci_bus_read_config_dword(bus, devfn, PCI_VENDOR_ID, l))
1585 			return false;
1586 		/* Card hasn't responded in 60 seconds?  Must be stuck. */
1587 		if (delay > crs_timeout) {
1588 			printk(KERN_WARNING "pci %04x:%02x:%02x.%d: not responding\n",
1589 			       pci_domain_nr(bus), bus->number, PCI_SLOT(devfn),
1590 			       PCI_FUNC(devfn));
1591 			return false;
1592 		}
1593 	}
1594 
1595 	return true;
1596 }
1597 EXPORT_SYMBOL(pci_bus_read_dev_vendor_id);
1598 
1599 /*
1600  * Read the config data for a PCI device, sanity-check it
1601  * and fill in the dev structure...
1602  */
1603 static struct pci_dev *pci_scan_device(struct pci_bus *bus, int devfn)
1604 {
1605 	struct pci_dev *dev;
1606 	u32 l;
1607 
1608 	if (!pci_bus_read_dev_vendor_id(bus, devfn, &l, 60*1000))
1609 		return NULL;
1610 
1611 	dev = pci_alloc_dev(bus);
1612 	if (!dev)
1613 		return NULL;
1614 
1615 	dev->devfn = devfn;
1616 	dev->vendor = l & 0xffff;
1617 	dev->device = (l >> 16) & 0xffff;
1618 
1619 	pci_set_of_node(dev);
1620 
1621 	if (pci_setup_device(dev)) {
1622 		pci_bus_put(dev->bus);
1623 		kfree(dev);
1624 		return NULL;
1625 	}
1626 
1627 	return dev;
1628 }
1629 
1630 static void pci_init_capabilities(struct pci_dev *dev)
1631 {
1632 	/* Enhanced Allocation */
1633 	pci_ea_init(dev);
1634 
1635 	/* Setup MSI caps & disable MSI/MSI-X interrupts */
1636 	pci_msi_setup_pci_dev(dev);
1637 
1638 	/* Buffers for saving PCIe and PCI-X capabilities */
1639 	pci_allocate_cap_save_buffers(dev);
1640 
1641 	/* Power Management */
1642 	pci_pm_init(dev);
1643 
1644 	/* Vital Product Data */
1645 	pci_vpd_init(dev);
1646 
1647 	/* Alternative Routing-ID Forwarding */
1648 	pci_configure_ari(dev);
1649 
1650 	/* Single Root I/O Virtualization */
1651 	pci_iov_init(dev);
1652 
1653 	/* Address Translation Services */
1654 	pci_ats_init(dev);
1655 
1656 	/* Enable ACS P2P upstream forwarding */
1657 	pci_enable_acs(dev);
1658 
1659 	pci_cleanup_aer_error_status_regs(dev);
1660 }
1661 
1662 /*
1663  * This is the equivalent of pci_host_bridge_msi_domain that acts on
1664  * devices. Firmware interfaces that can select the MSI domain on a
1665  * per-device basis should be called from here.
1666  */
1667 static struct irq_domain *pci_dev_msi_domain(struct pci_dev *dev)
1668 {
1669 	struct irq_domain *d;
1670 
1671 	/*
1672 	 * If a domain has been set through the pcibios_add_device
1673 	 * callback, then this is the one (platform code knows best).
1674 	 */
1675 	d = dev_get_msi_domain(&dev->dev);
1676 	if (d)
1677 		return d;
1678 
1679 	/*
1680 	 * Let's see if we have a firmware interface able to provide
1681 	 * the domain.
1682 	 */
1683 	d = pci_msi_get_device_domain(dev);
1684 	if (d)
1685 		return d;
1686 
1687 	return NULL;
1688 }
1689 
1690 static void pci_set_msi_domain(struct pci_dev *dev)
1691 {
1692 	struct irq_domain *d;
1693 
1694 	/*
1695 	 * If the platform or firmware interfaces cannot supply a
1696 	 * device-specific MSI domain, then inherit the default domain
1697 	 * from the host bridge itself.
1698 	 */
1699 	d = pci_dev_msi_domain(dev);
1700 	if (!d)
1701 		d = dev_get_msi_domain(&dev->bus->dev);
1702 
1703 	dev_set_msi_domain(&dev->dev, d);
1704 }
1705 
1706 /**
1707  * pci_dma_configure - Setup DMA configuration
1708  * @dev: ptr to pci_dev struct of the PCI device
1709  *
1710  * Function to update PCI devices's DMA configuration using the same
1711  * info from the OF node or ACPI node of host bridge's parent (if any).
1712  */
1713 static void pci_dma_configure(struct pci_dev *dev)
1714 {
1715 	struct device *bridge = pci_get_host_bridge_device(dev);
1716 
1717 	if (IS_ENABLED(CONFIG_OF) &&
1718 		bridge->parent && bridge->parent->of_node) {
1719 			of_dma_configure(&dev->dev, bridge->parent->of_node);
1720 	} else if (has_acpi_companion(bridge)) {
1721 		struct acpi_device *adev = to_acpi_device_node(bridge->fwnode);
1722 		enum dev_dma_attr attr = acpi_get_dma_attr(adev);
1723 
1724 		if (attr == DEV_DMA_NOT_SUPPORTED)
1725 			dev_warn(&dev->dev, "DMA not supported.\n");
1726 		else
1727 			arch_setup_dma_ops(&dev->dev, 0, 0, NULL,
1728 					   attr == DEV_DMA_COHERENT);
1729 	}
1730 
1731 	pci_put_host_bridge_device(bridge);
1732 }
1733 
1734 void pci_device_add(struct pci_dev *dev, struct pci_bus *bus)
1735 {
1736 	int ret;
1737 
1738 	pci_configure_device(dev);
1739 
1740 	device_initialize(&dev->dev);
1741 	dev->dev.release = pci_release_dev;
1742 
1743 	set_dev_node(&dev->dev, pcibus_to_node(bus));
1744 	dev->dev.dma_mask = &dev->dma_mask;
1745 	dev->dev.dma_parms = &dev->dma_parms;
1746 	dev->dev.coherent_dma_mask = 0xffffffffull;
1747 	pci_dma_configure(dev);
1748 
1749 	pci_set_dma_max_seg_size(dev, 65536);
1750 	pci_set_dma_seg_boundary(dev, 0xffffffff);
1751 
1752 	/* Fix up broken headers */
1753 	pci_fixup_device(pci_fixup_header, dev);
1754 
1755 	/* moved out from quirk header fixup code */
1756 	pci_reassigndev_resource_alignment(dev);
1757 
1758 	/* Clear the state_saved flag. */
1759 	dev->state_saved = false;
1760 
1761 	/* Initialize various capabilities */
1762 	pci_init_capabilities(dev);
1763 
1764 	/*
1765 	 * Add the device to our list of discovered devices
1766 	 * and the bus list for fixup functions, etc.
1767 	 */
1768 	down_write(&pci_bus_sem);
1769 	list_add_tail(&dev->bus_list, &bus->devices);
1770 	up_write(&pci_bus_sem);
1771 
1772 	ret = pcibios_add_device(dev);
1773 	WARN_ON(ret < 0);
1774 
1775 	/* Setup MSI irq domain */
1776 	pci_set_msi_domain(dev);
1777 
1778 	/* Notifier could use PCI capabilities */
1779 	dev->match_driver = false;
1780 	ret = device_add(&dev->dev);
1781 	WARN_ON(ret < 0);
1782 }
1783 
1784 struct pci_dev *pci_scan_single_device(struct pci_bus *bus, int devfn)
1785 {
1786 	struct pci_dev *dev;
1787 
1788 	dev = pci_get_slot(bus, devfn);
1789 	if (dev) {
1790 		pci_dev_put(dev);
1791 		return dev;
1792 	}
1793 
1794 	dev = pci_scan_device(bus, devfn);
1795 	if (!dev)
1796 		return NULL;
1797 
1798 	pci_device_add(dev, bus);
1799 
1800 	return dev;
1801 }
1802 EXPORT_SYMBOL(pci_scan_single_device);
1803 
1804 static unsigned next_fn(struct pci_bus *bus, struct pci_dev *dev, unsigned fn)
1805 {
1806 	int pos;
1807 	u16 cap = 0;
1808 	unsigned next_fn;
1809 
1810 	if (pci_ari_enabled(bus)) {
1811 		if (!dev)
1812 			return 0;
1813 		pos = pci_find_ext_capability(dev, PCI_EXT_CAP_ID_ARI);
1814 		if (!pos)
1815 			return 0;
1816 
1817 		pci_read_config_word(dev, pos + PCI_ARI_CAP, &cap);
1818 		next_fn = PCI_ARI_CAP_NFN(cap);
1819 		if (next_fn <= fn)
1820 			return 0;	/* protect against malformed list */
1821 
1822 		return next_fn;
1823 	}
1824 
1825 	/* dev may be NULL for non-contiguous multifunction devices */
1826 	if (!dev || dev->multifunction)
1827 		return (fn + 1) % 8;
1828 
1829 	return 0;
1830 }
1831 
1832 static int only_one_child(struct pci_bus *bus)
1833 {
1834 	struct pci_dev *parent = bus->self;
1835 
1836 	if (!parent || !pci_is_pcie(parent))
1837 		return 0;
1838 	if (pci_pcie_type(parent) == PCI_EXP_TYPE_ROOT_PORT)
1839 		return 1;
1840 
1841 	/*
1842 	 * PCIe downstream ports are bridges that normally lead to only a
1843 	 * device 0, but if PCI_SCAN_ALL_PCIE_DEVS is set, scan all
1844 	 * possible devices, not just device 0.  See PCIe spec r3.0,
1845 	 * sec 7.3.1.
1846 	 */
1847 	if (parent->has_secondary_link &&
1848 	    !pci_has_flag(PCI_SCAN_ALL_PCIE_DEVS))
1849 		return 1;
1850 	return 0;
1851 }
1852 
1853 /**
1854  * pci_scan_slot - scan a PCI slot on a bus for devices.
1855  * @bus: PCI bus to scan
1856  * @devfn: slot number to scan (must have zero function.)
1857  *
1858  * Scan a PCI slot on the specified PCI bus for devices, adding
1859  * discovered devices to the @bus->devices list.  New devices
1860  * will not have is_added set.
1861  *
1862  * Returns the number of new devices found.
1863  */
1864 int pci_scan_slot(struct pci_bus *bus, int devfn)
1865 {
1866 	unsigned fn, nr = 0;
1867 	struct pci_dev *dev;
1868 
1869 	if (only_one_child(bus) && (devfn > 0))
1870 		return 0; /* Already scanned the entire slot */
1871 
1872 	dev = pci_scan_single_device(bus, devfn);
1873 	if (!dev)
1874 		return 0;
1875 	if (!dev->is_added)
1876 		nr++;
1877 
1878 	for (fn = next_fn(bus, dev, 0); fn > 0; fn = next_fn(bus, dev, fn)) {
1879 		dev = pci_scan_single_device(bus, devfn + fn);
1880 		if (dev) {
1881 			if (!dev->is_added)
1882 				nr++;
1883 			dev->multifunction = 1;
1884 		}
1885 	}
1886 
1887 	/* only one slot has pcie device */
1888 	if (bus->self && nr)
1889 		pcie_aspm_init_link_state(bus->self);
1890 
1891 	return nr;
1892 }
1893 EXPORT_SYMBOL(pci_scan_slot);
1894 
1895 static int pcie_find_smpss(struct pci_dev *dev, void *data)
1896 {
1897 	u8 *smpss = data;
1898 
1899 	if (!pci_is_pcie(dev))
1900 		return 0;
1901 
1902 	/*
1903 	 * We don't have a way to change MPS settings on devices that have
1904 	 * drivers attached.  A hot-added device might support only the minimum
1905 	 * MPS setting (MPS=128).  Therefore, if the fabric contains a bridge
1906 	 * where devices may be hot-added, we limit the fabric MPS to 128 so
1907 	 * hot-added devices will work correctly.
1908 	 *
1909 	 * However, if we hot-add a device to a slot directly below a Root
1910 	 * Port, it's impossible for there to be other existing devices below
1911 	 * the port.  We don't limit the MPS in this case because we can
1912 	 * reconfigure MPS on both the Root Port and the hot-added device,
1913 	 * and there are no other devices involved.
1914 	 *
1915 	 * Note that this PCIE_BUS_SAFE path assumes no peer-to-peer DMA.
1916 	 */
1917 	if (dev->is_hotplug_bridge &&
1918 	    pci_pcie_type(dev) != PCI_EXP_TYPE_ROOT_PORT)
1919 		*smpss = 0;
1920 
1921 	if (*smpss > dev->pcie_mpss)
1922 		*smpss = dev->pcie_mpss;
1923 
1924 	return 0;
1925 }
1926 
1927 static void pcie_write_mps(struct pci_dev *dev, int mps)
1928 {
1929 	int rc;
1930 
1931 	if (pcie_bus_config == PCIE_BUS_PERFORMANCE) {
1932 		mps = 128 << dev->pcie_mpss;
1933 
1934 		if (pci_pcie_type(dev) != PCI_EXP_TYPE_ROOT_PORT &&
1935 		    dev->bus->self)
1936 			/* For "Performance", the assumption is made that
1937 			 * downstream communication will never be larger than
1938 			 * the MRRS.  So, the MPS only needs to be configured
1939 			 * for the upstream communication.  This being the case,
1940 			 * walk from the top down and set the MPS of the child
1941 			 * to that of the parent bus.
1942 			 *
1943 			 * Configure the device MPS with the smaller of the
1944 			 * device MPSS or the bridge MPS (which is assumed to be
1945 			 * properly configured at this point to the largest
1946 			 * allowable MPS based on its parent bus).
1947 			 */
1948 			mps = min(mps, pcie_get_mps(dev->bus->self));
1949 	}
1950 
1951 	rc = pcie_set_mps(dev, mps);
1952 	if (rc)
1953 		dev_err(&dev->dev, "Failed attempting to set the MPS\n");
1954 }
1955 
1956 static void pcie_write_mrrs(struct pci_dev *dev)
1957 {
1958 	int rc, mrrs;
1959 
1960 	/* In the "safe" case, do not configure the MRRS.  There appear to be
1961 	 * issues with setting MRRS to 0 on a number of devices.
1962 	 */
1963 	if (pcie_bus_config != PCIE_BUS_PERFORMANCE)
1964 		return;
1965 
1966 	/* For Max performance, the MRRS must be set to the largest supported
1967 	 * value.  However, it cannot be configured larger than the MPS the
1968 	 * device or the bus can support.  This should already be properly
1969 	 * configured by a prior call to pcie_write_mps.
1970 	 */
1971 	mrrs = pcie_get_mps(dev);
1972 
1973 	/* MRRS is a R/W register.  Invalid values can be written, but a
1974 	 * subsequent read will verify if the value is acceptable or not.
1975 	 * If the MRRS value provided is not acceptable (e.g., too large),
1976 	 * shrink the value until it is acceptable to the HW.
1977 	 */
1978 	while (mrrs != pcie_get_readrq(dev) && mrrs >= 128) {
1979 		rc = pcie_set_readrq(dev, mrrs);
1980 		if (!rc)
1981 			break;
1982 
1983 		dev_warn(&dev->dev, "Failed attempting to set the MRRS\n");
1984 		mrrs /= 2;
1985 	}
1986 
1987 	if (mrrs < 128)
1988 		dev_err(&dev->dev, "MRRS was unable to be configured with a safe value.  If problems are experienced, try running with pci=pcie_bus_safe\n");
1989 }
1990 
1991 static int pcie_bus_configure_set(struct pci_dev *dev, void *data)
1992 {
1993 	int mps, orig_mps;
1994 
1995 	if (!pci_is_pcie(dev))
1996 		return 0;
1997 
1998 	if (pcie_bus_config == PCIE_BUS_TUNE_OFF ||
1999 	    pcie_bus_config == PCIE_BUS_DEFAULT)
2000 		return 0;
2001 
2002 	mps = 128 << *(u8 *)data;
2003 	orig_mps = pcie_get_mps(dev);
2004 
2005 	pcie_write_mps(dev, mps);
2006 	pcie_write_mrrs(dev);
2007 
2008 	dev_info(&dev->dev, "Max Payload Size set to %4d/%4d (was %4d), Max Read Rq %4d\n",
2009 		 pcie_get_mps(dev), 128 << dev->pcie_mpss,
2010 		 orig_mps, pcie_get_readrq(dev));
2011 
2012 	return 0;
2013 }
2014 
2015 /* pcie_bus_configure_settings requires that pci_walk_bus work in a top-down,
2016  * parents then children fashion.  If this changes, then this code will not
2017  * work as designed.
2018  */
2019 void pcie_bus_configure_settings(struct pci_bus *bus)
2020 {
2021 	u8 smpss = 0;
2022 
2023 	if (!bus->self)
2024 		return;
2025 
2026 	if (!pci_is_pcie(bus->self))
2027 		return;
2028 
2029 	/* FIXME - Peer to peer DMA is possible, though the endpoint would need
2030 	 * to be aware of the MPS of the destination.  To work around this,
2031 	 * simply force the MPS of the entire system to the smallest possible.
2032 	 */
2033 	if (pcie_bus_config == PCIE_BUS_PEER2PEER)
2034 		smpss = 0;
2035 
2036 	if (pcie_bus_config == PCIE_BUS_SAFE) {
2037 		smpss = bus->self->pcie_mpss;
2038 
2039 		pcie_find_smpss(bus->self, &smpss);
2040 		pci_walk_bus(bus, pcie_find_smpss, &smpss);
2041 	}
2042 
2043 	pcie_bus_configure_set(bus->self, &smpss);
2044 	pci_walk_bus(bus, pcie_bus_configure_set, &smpss);
2045 }
2046 EXPORT_SYMBOL_GPL(pcie_bus_configure_settings);
2047 
2048 unsigned int pci_scan_child_bus(struct pci_bus *bus)
2049 {
2050 	unsigned int devfn, pass, max = bus->busn_res.start;
2051 	struct pci_dev *dev;
2052 
2053 	dev_dbg(&bus->dev, "scanning bus\n");
2054 
2055 	/* Go find them, Rover! */
2056 	for (devfn = 0; devfn < 0x100; devfn += 8)
2057 		pci_scan_slot(bus, devfn);
2058 
2059 	/* Reserve buses for SR-IOV capability. */
2060 	max += pci_iov_bus_range(bus);
2061 
2062 	/*
2063 	 * After performing arch-dependent fixup of the bus, look behind
2064 	 * all PCI-to-PCI bridges on this bus.
2065 	 */
2066 	if (!bus->is_added) {
2067 		dev_dbg(&bus->dev, "fixups for bus\n");
2068 		pcibios_fixup_bus(bus);
2069 		bus->is_added = 1;
2070 	}
2071 
2072 	for (pass = 0; pass < 2; pass++)
2073 		list_for_each_entry(dev, &bus->devices, bus_list) {
2074 			if (pci_is_bridge(dev))
2075 				max = pci_scan_bridge(bus, dev, max, pass);
2076 		}
2077 
2078 	/*
2079 	 * We've scanned the bus and so we know all about what's on
2080 	 * the other side of any bridges that may be on this bus plus
2081 	 * any devices.
2082 	 *
2083 	 * Return how far we've got finding sub-buses.
2084 	 */
2085 	dev_dbg(&bus->dev, "bus scan returning with max=%02x\n", max);
2086 	return max;
2087 }
2088 EXPORT_SYMBOL_GPL(pci_scan_child_bus);
2089 
2090 /**
2091  * pcibios_root_bridge_prepare - Platform-specific host bridge setup.
2092  * @bridge: Host bridge to set up.
2093  *
2094  * Default empty implementation.  Replace with an architecture-specific setup
2095  * routine, if necessary.
2096  */
2097 int __weak pcibios_root_bridge_prepare(struct pci_host_bridge *bridge)
2098 {
2099 	return 0;
2100 }
2101 
2102 void __weak pcibios_add_bus(struct pci_bus *bus)
2103 {
2104 }
2105 
2106 void __weak pcibios_remove_bus(struct pci_bus *bus)
2107 {
2108 }
2109 
2110 struct pci_bus *pci_create_root_bus(struct device *parent, int bus,
2111 		struct pci_ops *ops, void *sysdata, struct list_head *resources)
2112 {
2113 	int error;
2114 	struct pci_host_bridge *bridge;
2115 	struct pci_bus *b, *b2;
2116 	struct resource_entry *window, *n;
2117 	struct resource *res;
2118 	resource_size_t offset;
2119 	char bus_addr[64];
2120 	char *fmt;
2121 
2122 	b = pci_alloc_bus(NULL);
2123 	if (!b)
2124 		return NULL;
2125 
2126 	b->sysdata = sysdata;
2127 	b->ops = ops;
2128 	b->number = b->busn_res.start = bus;
2129 	pci_bus_assign_domain_nr(b, parent);
2130 	b2 = pci_find_bus(pci_domain_nr(b), bus);
2131 	if (b2) {
2132 		/* If we already got to this bus through a different bridge, ignore it */
2133 		dev_dbg(&b2->dev, "bus already known\n");
2134 		goto err_out;
2135 	}
2136 
2137 	bridge = pci_alloc_host_bridge(b);
2138 	if (!bridge)
2139 		goto err_out;
2140 
2141 	bridge->dev.parent = parent;
2142 	bridge->dev.release = pci_release_host_bridge_dev;
2143 	dev_set_name(&bridge->dev, "pci%04x:%02x", pci_domain_nr(b), bus);
2144 	error = pcibios_root_bridge_prepare(bridge);
2145 	if (error) {
2146 		kfree(bridge);
2147 		goto err_out;
2148 	}
2149 
2150 	error = device_register(&bridge->dev);
2151 	if (error) {
2152 		put_device(&bridge->dev);
2153 		goto err_out;
2154 	}
2155 	b->bridge = get_device(&bridge->dev);
2156 	device_enable_async_suspend(b->bridge);
2157 	pci_set_bus_of_node(b);
2158 	pci_set_bus_msi_domain(b);
2159 
2160 	if (!parent)
2161 		set_dev_node(b->bridge, pcibus_to_node(b));
2162 
2163 	b->dev.class = &pcibus_class;
2164 	b->dev.parent = b->bridge;
2165 	dev_set_name(&b->dev, "%04x:%02x", pci_domain_nr(b), bus);
2166 	error = device_register(&b->dev);
2167 	if (error)
2168 		goto class_dev_reg_err;
2169 
2170 	pcibios_add_bus(b);
2171 
2172 	/* Create legacy_io and legacy_mem files for this bus */
2173 	pci_create_legacy_files(b);
2174 
2175 	if (parent)
2176 		dev_info(parent, "PCI host bridge to bus %s\n", dev_name(&b->dev));
2177 	else
2178 		printk(KERN_INFO "PCI host bridge to bus %s\n", dev_name(&b->dev));
2179 
2180 	/* Add initial resources to the bus */
2181 	resource_list_for_each_entry_safe(window, n, resources) {
2182 		list_move_tail(&window->node, &bridge->windows);
2183 		res = window->res;
2184 		offset = window->offset;
2185 		if (res->flags & IORESOURCE_BUS)
2186 			pci_bus_insert_busn_res(b, bus, res->end);
2187 		else
2188 			pci_bus_add_resource(b, res, 0);
2189 		if (offset) {
2190 			if (resource_type(res) == IORESOURCE_IO)
2191 				fmt = " (bus address [%#06llx-%#06llx])";
2192 			else
2193 				fmt = " (bus address [%#010llx-%#010llx])";
2194 			snprintf(bus_addr, sizeof(bus_addr), fmt,
2195 				 (unsigned long long) (res->start - offset),
2196 				 (unsigned long long) (res->end - offset));
2197 		} else
2198 			bus_addr[0] = '\0';
2199 		dev_info(&b->dev, "root bus resource %pR%s\n", res, bus_addr);
2200 	}
2201 
2202 	down_write(&pci_bus_sem);
2203 	list_add_tail(&b->node, &pci_root_buses);
2204 	up_write(&pci_bus_sem);
2205 
2206 	return b;
2207 
2208 class_dev_reg_err:
2209 	put_device(&bridge->dev);
2210 	device_unregister(&bridge->dev);
2211 err_out:
2212 	kfree(b);
2213 	return NULL;
2214 }
2215 EXPORT_SYMBOL_GPL(pci_create_root_bus);
2216 
2217 int pci_bus_insert_busn_res(struct pci_bus *b, int bus, int bus_max)
2218 {
2219 	struct resource *res = &b->busn_res;
2220 	struct resource *parent_res, *conflict;
2221 
2222 	res->start = bus;
2223 	res->end = bus_max;
2224 	res->flags = IORESOURCE_BUS;
2225 
2226 	if (!pci_is_root_bus(b))
2227 		parent_res = &b->parent->busn_res;
2228 	else {
2229 		parent_res = get_pci_domain_busn_res(pci_domain_nr(b));
2230 		res->flags |= IORESOURCE_PCI_FIXED;
2231 	}
2232 
2233 	conflict = request_resource_conflict(parent_res, res);
2234 
2235 	if (conflict)
2236 		dev_printk(KERN_DEBUG, &b->dev,
2237 			   "busn_res: can not insert %pR under %s%pR (conflicts with %s %pR)\n",
2238 			    res, pci_is_root_bus(b) ? "domain " : "",
2239 			    parent_res, conflict->name, conflict);
2240 
2241 	return conflict == NULL;
2242 }
2243 
2244 int pci_bus_update_busn_res_end(struct pci_bus *b, int bus_max)
2245 {
2246 	struct resource *res = &b->busn_res;
2247 	struct resource old_res = *res;
2248 	resource_size_t size;
2249 	int ret;
2250 
2251 	if (res->start > bus_max)
2252 		return -EINVAL;
2253 
2254 	size = bus_max - res->start + 1;
2255 	ret = adjust_resource(res, res->start, size);
2256 	dev_printk(KERN_DEBUG, &b->dev,
2257 			"busn_res: %pR end %s updated to %02x\n",
2258 			&old_res, ret ? "can not be" : "is", bus_max);
2259 
2260 	if (!ret && !res->parent)
2261 		pci_bus_insert_busn_res(b, res->start, res->end);
2262 
2263 	return ret;
2264 }
2265 
2266 void pci_bus_release_busn_res(struct pci_bus *b)
2267 {
2268 	struct resource *res = &b->busn_res;
2269 	int ret;
2270 
2271 	if (!res->flags || !res->parent)
2272 		return;
2273 
2274 	ret = release_resource(res);
2275 	dev_printk(KERN_DEBUG, &b->dev,
2276 			"busn_res: %pR %s released\n",
2277 			res, ret ? "can not be" : "is");
2278 }
2279 
2280 struct pci_bus *pci_scan_root_bus_msi(struct device *parent, int bus,
2281 		struct pci_ops *ops, void *sysdata,
2282 		struct list_head *resources, struct msi_controller *msi)
2283 {
2284 	struct resource_entry *window;
2285 	bool found = false;
2286 	struct pci_bus *b;
2287 	int max;
2288 
2289 	resource_list_for_each_entry(window, resources)
2290 		if (window->res->flags & IORESOURCE_BUS) {
2291 			found = true;
2292 			break;
2293 		}
2294 
2295 	b = pci_create_root_bus(parent, bus, ops, sysdata, resources);
2296 	if (!b)
2297 		return NULL;
2298 
2299 	b->msi = msi;
2300 
2301 	if (!found) {
2302 		dev_info(&b->dev,
2303 		 "No busn resource found for root bus, will use [bus %02x-ff]\n",
2304 			bus);
2305 		pci_bus_insert_busn_res(b, bus, 255);
2306 	}
2307 
2308 	max = pci_scan_child_bus(b);
2309 
2310 	if (!found)
2311 		pci_bus_update_busn_res_end(b, max);
2312 
2313 	return b;
2314 }
2315 
2316 struct pci_bus *pci_scan_root_bus(struct device *parent, int bus,
2317 		struct pci_ops *ops, void *sysdata, struct list_head *resources)
2318 {
2319 	return pci_scan_root_bus_msi(parent, bus, ops, sysdata, resources,
2320 				     NULL);
2321 }
2322 EXPORT_SYMBOL(pci_scan_root_bus);
2323 
2324 struct pci_bus *pci_scan_bus(int bus, struct pci_ops *ops,
2325 					void *sysdata)
2326 {
2327 	LIST_HEAD(resources);
2328 	struct pci_bus *b;
2329 
2330 	pci_add_resource(&resources, &ioport_resource);
2331 	pci_add_resource(&resources, &iomem_resource);
2332 	pci_add_resource(&resources, &busn_resource);
2333 	b = pci_create_root_bus(NULL, bus, ops, sysdata, &resources);
2334 	if (b) {
2335 		pci_scan_child_bus(b);
2336 	} else {
2337 		pci_free_resource_list(&resources);
2338 	}
2339 	return b;
2340 }
2341 EXPORT_SYMBOL(pci_scan_bus);
2342 
2343 /**
2344  * pci_rescan_bus_bridge_resize - scan a PCI bus for devices.
2345  * @bridge: PCI bridge for the bus to scan
2346  *
2347  * Scan a PCI bus and child buses for new devices, add them,
2348  * and enable them, resizing bridge mmio/io resource if necessary
2349  * and possible.  The caller must ensure the child devices are already
2350  * removed for resizing to occur.
2351  *
2352  * Returns the max number of subordinate bus discovered.
2353  */
2354 unsigned int pci_rescan_bus_bridge_resize(struct pci_dev *bridge)
2355 {
2356 	unsigned int max;
2357 	struct pci_bus *bus = bridge->subordinate;
2358 
2359 	max = pci_scan_child_bus(bus);
2360 
2361 	pci_assign_unassigned_bridge_resources(bridge);
2362 
2363 	pci_bus_add_devices(bus);
2364 
2365 	return max;
2366 }
2367 
2368 /**
2369  * pci_rescan_bus - scan a PCI bus for devices.
2370  * @bus: PCI bus to scan
2371  *
2372  * Scan a PCI bus and child buses for new devices, adds them,
2373  * and enables them.
2374  *
2375  * Returns the max number of subordinate bus discovered.
2376  */
2377 unsigned int pci_rescan_bus(struct pci_bus *bus)
2378 {
2379 	unsigned int max;
2380 
2381 	max = pci_scan_child_bus(bus);
2382 	pci_assign_unassigned_bus_resources(bus);
2383 	pci_bus_add_devices(bus);
2384 
2385 	return max;
2386 }
2387 EXPORT_SYMBOL_GPL(pci_rescan_bus);
2388 
2389 /*
2390  * pci_rescan_bus(), pci_rescan_bus_bridge_resize() and PCI device removal
2391  * routines should always be executed under this mutex.
2392  */
2393 static DEFINE_MUTEX(pci_rescan_remove_lock);
2394 
2395 void pci_lock_rescan_remove(void)
2396 {
2397 	mutex_lock(&pci_rescan_remove_lock);
2398 }
2399 EXPORT_SYMBOL_GPL(pci_lock_rescan_remove);
2400 
2401 void pci_unlock_rescan_remove(void)
2402 {
2403 	mutex_unlock(&pci_rescan_remove_lock);
2404 }
2405 EXPORT_SYMBOL_GPL(pci_unlock_rescan_remove);
2406 
2407 static int __init pci_sort_bf_cmp(const struct device *d_a,
2408 				  const struct device *d_b)
2409 {
2410 	const struct pci_dev *a = to_pci_dev(d_a);
2411 	const struct pci_dev *b = to_pci_dev(d_b);
2412 
2413 	if      (pci_domain_nr(a->bus) < pci_domain_nr(b->bus)) return -1;
2414 	else if (pci_domain_nr(a->bus) > pci_domain_nr(b->bus)) return  1;
2415 
2416 	if      (a->bus->number < b->bus->number) return -1;
2417 	else if (a->bus->number > b->bus->number) return  1;
2418 
2419 	if      (a->devfn < b->devfn) return -1;
2420 	else if (a->devfn > b->devfn) return  1;
2421 
2422 	return 0;
2423 }
2424 
2425 void __init pci_sort_breadthfirst(void)
2426 {
2427 	bus_sort_breadthfirst(&pci_bus_type, &pci_sort_bf_cmp);
2428 }
2429