xref: /openbmc/linux/drivers/pci/setup-bus.c (revision e6c81cce)
1 /*
2  *	drivers/pci/setup-bus.c
3  *
4  * Extruded from code written by
5  *      Dave Rusling (david.rusling@reo.mts.dec.com)
6  *      David Mosberger (davidm@cs.arizona.edu)
7  *	David Miller (davem@redhat.com)
8  *
9  * Support routines for initializing a PCI subsystem.
10  */
11 
12 /*
13  * Nov 2000, Ivan Kokshaysky <ink@jurassic.park.msu.ru>
14  *	     PCI-PCI bridges cleanup, sorted resource allocation.
15  * Feb 2002, Ivan Kokshaysky <ink@jurassic.park.msu.ru>
16  *	     Converted to allocation in 3 passes, which gives
17  *	     tighter packing. Prefetchable range support.
18  */
19 
20 #include <linux/init.h>
21 #include <linux/kernel.h>
22 #include <linux/module.h>
23 #include <linux/pci.h>
24 #include <linux/errno.h>
25 #include <linux/ioport.h>
26 #include <linux/cache.h>
27 #include <linux/slab.h>
28 #include <asm-generic/pci-bridge.h>
29 #include "pci.h"
30 
31 unsigned int pci_flags;
32 
33 struct pci_dev_resource {
34 	struct list_head list;
35 	struct resource *res;
36 	struct pci_dev *dev;
37 	resource_size_t start;
38 	resource_size_t end;
39 	resource_size_t add_size;
40 	resource_size_t min_align;
41 	unsigned long flags;
42 };
43 
44 static void free_list(struct list_head *head)
45 {
46 	struct pci_dev_resource *dev_res, *tmp;
47 
48 	list_for_each_entry_safe(dev_res, tmp, head, list) {
49 		list_del(&dev_res->list);
50 		kfree(dev_res);
51 	}
52 }
53 
54 /**
55  * add_to_list() - add a new resource tracker to the list
56  * @head:	Head of the list
57  * @dev:	device corresponding to which the resource
58  *		belongs
59  * @res:	The resource to be tracked
60  * @add_size:	additional size to be optionally added
61  *              to the resource
62  */
63 static int add_to_list(struct list_head *head,
64 		 struct pci_dev *dev, struct resource *res,
65 		 resource_size_t add_size, resource_size_t min_align)
66 {
67 	struct pci_dev_resource *tmp;
68 
69 	tmp = kzalloc(sizeof(*tmp), GFP_KERNEL);
70 	if (!tmp) {
71 		pr_warn("add_to_list: kmalloc() failed!\n");
72 		return -ENOMEM;
73 	}
74 
75 	tmp->res = res;
76 	tmp->dev = dev;
77 	tmp->start = res->start;
78 	tmp->end = res->end;
79 	tmp->flags = res->flags;
80 	tmp->add_size = add_size;
81 	tmp->min_align = min_align;
82 
83 	list_add(&tmp->list, head);
84 
85 	return 0;
86 }
87 
88 static void remove_from_list(struct list_head *head,
89 				 struct resource *res)
90 {
91 	struct pci_dev_resource *dev_res, *tmp;
92 
93 	list_for_each_entry_safe(dev_res, tmp, head, list) {
94 		if (dev_res->res == res) {
95 			list_del(&dev_res->list);
96 			kfree(dev_res);
97 			break;
98 		}
99 	}
100 }
101 
102 static struct pci_dev_resource *res_to_dev_res(struct list_head *head,
103 					       struct resource *res)
104 {
105 	struct pci_dev_resource *dev_res;
106 
107 	list_for_each_entry(dev_res, head, list) {
108 		if (dev_res->res == res) {
109 			int idx = res - &dev_res->dev->resource[0];
110 
111 			dev_printk(KERN_DEBUG, &dev_res->dev->dev,
112 				 "res[%d]=%pR res_to_dev_res add_size %llx min_align %llx\n",
113 				 idx, dev_res->res,
114 				 (unsigned long long)dev_res->add_size,
115 				 (unsigned long long)dev_res->min_align);
116 
117 			return dev_res;
118 		}
119 	}
120 
121 	return NULL;
122 }
123 
124 static resource_size_t get_res_add_size(struct list_head *head,
125 					struct resource *res)
126 {
127 	struct pci_dev_resource *dev_res;
128 
129 	dev_res = res_to_dev_res(head, res);
130 	return dev_res ? dev_res->add_size : 0;
131 }
132 
133 static resource_size_t get_res_add_align(struct list_head *head,
134 					 struct resource *res)
135 {
136 	struct pci_dev_resource *dev_res;
137 
138 	dev_res = res_to_dev_res(head, res);
139 	return dev_res ? dev_res->min_align : 0;
140 }
141 
142 
143 /* Sort resources by alignment */
144 static void pdev_sort_resources(struct pci_dev *dev, struct list_head *head)
145 {
146 	int i;
147 
148 	for (i = 0; i < PCI_NUM_RESOURCES; i++) {
149 		struct resource *r;
150 		struct pci_dev_resource *dev_res, *tmp;
151 		resource_size_t r_align;
152 		struct list_head *n;
153 
154 		r = &dev->resource[i];
155 
156 		if (r->flags & IORESOURCE_PCI_FIXED)
157 			continue;
158 
159 		if (!(r->flags) || r->parent)
160 			continue;
161 
162 		r_align = pci_resource_alignment(dev, r);
163 		if (!r_align) {
164 			dev_warn(&dev->dev, "BAR %d: %pR has bogus alignment\n",
165 				 i, r);
166 			continue;
167 		}
168 
169 		tmp = kzalloc(sizeof(*tmp), GFP_KERNEL);
170 		if (!tmp)
171 			panic("pdev_sort_resources(): kmalloc() failed!\n");
172 		tmp->res = r;
173 		tmp->dev = dev;
174 
175 		/* fallback is smallest one or list is empty*/
176 		n = head;
177 		list_for_each_entry(dev_res, head, list) {
178 			resource_size_t align;
179 
180 			align = pci_resource_alignment(dev_res->dev,
181 							 dev_res->res);
182 
183 			if (r_align > align) {
184 				n = &dev_res->list;
185 				break;
186 			}
187 		}
188 		/* Insert it just before n*/
189 		list_add_tail(&tmp->list, n);
190 	}
191 }
192 
193 static void __dev_sort_resources(struct pci_dev *dev,
194 				 struct list_head *head)
195 {
196 	u16 class = dev->class >> 8;
197 
198 	/* Don't touch classless devices or host bridges or ioapics.  */
199 	if (class == PCI_CLASS_NOT_DEFINED || class == PCI_CLASS_BRIDGE_HOST)
200 		return;
201 
202 	/* Don't touch ioapic devices already enabled by firmware */
203 	if (class == PCI_CLASS_SYSTEM_PIC) {
204 		u16 command;
205 		pci_read_config_word(dev, PCI_COMMAND, &command);
206 		if (command & (PCI_COMMAND_IO | PCI_COMMAND_MEMORY))
207 			return;
208 	}
209 
210 	pdev_sort_resources(dev, head);
211 }
212 
213 static inline void reset_resource(struct resource *res)
214 {
215 	res->start = 0;
216 	res->end = 0;
217 	res->flags = 0;
218 }
219 
220 /**
221  * reassign_resources_sorted() - satisfy any additional resource requests
222  *
223  * @realloc_head : head of the list tracking requests requiring additional
224  *             resources
225  * @head     : head of the list tracking requests with allocated
226  *             resources
227  *
228  * Walk through each element of the realloc_head and try to procure
229  * additional resources for the element, provided the element
230  * is in the head list.
231  */
232 static void reassign_resources_sorted(struct list_head *realloc_head,
233 		struct list_head *head)
234 {
235 	struct resource *res;
236 	struct pci_dev_resource *add_res, *tmp;
237 	struct pci_dev_resource *dev_res;
238 	resource_size_t add_size, align;
239 	int idx;
240 
241 	list_for_each_entry_safe(add_res, tmp, realloc_head, list) {
242 		bool found_match = false;
243 
244 		res = add_res->res;
245 		/* skip resource that has been reset */
246 		if (!res->flags)
247 			goto out;
248 
249 		/* skip this resource if not found in head list */
250 		list_for_each_entry(dev_res, head, list) {
251 			if (dev_res->res == res) {
252 				found_match = true;
253 				break;
254 			}
255 		}
256 		if (!found_match)/* just skip */
257 			continue;
258 
259 		idx = res - &add_res->dev->resource[0];
260 		add_size = add_res->add_size;
261 		align = add_res->min_align;
262 		if (!resource_size(res)) {
263 			res->start = align;
264 			res->end = res->start + add_size - 1;
265 			if (pci_assign_resource(add_res->dev, idx))
266 				reset_resource(res);
267 		} else {
268 			res->flags |= add_res->flags &
269 				 (IORESOURCE_STARTALIGN|IORESOURCE_SIZEALIGN);
270 			if (pci_reassign_resource(add_res->dev, idx,
271 						  add_size, align))
272 				dev_printk(KERN_DEBUG, &add_res->dev->dev,
273 					   "failed to add %llx res[%d]=%pR\n",
274 					   (unsigned long long)add_size,
275 					   idx, res);
276 		}
277 out:
278 		list_del(&add_res->list);
279 		kfree(add_res);
280 	}
281 }
282 
283 /**
284  * assign_requested_resources_sorted() - satisfy resource requests
285  *
286  * @head : head of the list tracking requests for resources
287  * @fail_head : head of the list tracking requests that could
288  *		not be allocated
289  *
290  * Satisfy resource requests of each element in the list. Add
291  * requests that could not satisfied to the failed_list.
292  */
293 static void assign_requested_resources_sorted(struct list_head *head,
294 				 struct list_head *fail_head)
295 {
296 	struct resource *res;
297 	struct pci_dev_resource *dev_res;
298 	int idx;
299 
300 	list_for_each_entry(dev_res, head, list) {
301 		res = dev_res->res;
302 		idx = res - &dev_res->dev->resource[0];
303 		if (resource_size(res) &&
304 		    pci_assign_resource(dev_res->dev, idx)) {
305 			if (fail_head) {
306 				/*
307 				 * if the failed res is for ROM BAR, and it will
308 				 * be enabled later, don't add it to the list
309 				 */
310 				if (!((idx == PCI_ROM_RESOURCE) &&
311 				      (!(res->flags & IORESOURCE_ROM_ENABLE))))
312 					add_to_list(fail_head,
313 						    dev_res->dev, res,
314 						    0 /* don't care */,
315 						    0 /* don't care */);
316 			}
317 			reset_resource(res);
318 		}
319 	}
320 }
321 
322 static unsigned long pci_fail_res_type_mask(struct list_head *fail_head)
323 {
324 	struct pci_dev_resource *fail_res;
325 	unsigned long mask = 0;
326 
327 	/* check failed type */
328 	list_for_each_entry(fail_res, fail_head, list)
329 		mask |= fail_res->flags;
330 
331 	/*
332 	 * one pref failed resource will set IORESOURCE_MEM,
333 	 * as we can allocate pref in non-pref range.
334 	 * Will release all assigned non-pref sibling resources
335 	 * according to that bit.
336 	 */
337 	return mask & (IORESOURCE_IO | IORESOURCE_MEM | IORESOURCE_PREFETCH);
338 }
339 
340 static bool pci_need_to_release(unsigned long mask, struct resource *res)
341 {
342 	if (res->flags & IORESOURCE_IO)
343 		return !!(mask & IORESOURCE_IO);
344 
345 	/* check pref at first */
346 	if (res->flags & IORESOURCE_PREFETCH) {
347 		if (mask & IORESOURCE_PREFETCH)
348 			return true;
349 		/* count pref if its parent is non-pref */
350 		else if ((mask & IORESOURCE_MEM) &&
351 			 !(res->parent->flags & IORESOURCE_PREFETCH))
352 			return true;
353 		else
354 			return false;
355 	}
356 
357 	if (res->flags & IORESOURCE_MEM)
358 		return !!(mask & IORESOURCE_MEM);
359 
360 	return false;	/* should not get here */
361 }
362 
363 static void __assign_resources_sorted(struct list_head *head,
364 				 struct list_head *realloc_head,
365 				 struct list_head *fail_head)
366 {
367 	/*
368 	 * Should not assign requested resources at first.
369 	 *   they could be adjacent, so later reassign can not reallocate
370 	 *   them one by one in parent resource window.
371 	 * Try to assign requested + add_size at beginning
372 	 *  if could do that, could get out early.
373 	 *  if could not do that, we still try to assign requested at first,
374 	 *    then try to reassign add_size for some resources.
375 	 *
376 	 * Separate three resource type checking if we need to release
377 	 * assigned resource after requested + add_size try.
378 	 *	1. if there is io port assign fail, will release assigned
379 	 *	   io port.
380 	 *	2. if there is pref mmio assign fail, release assigned
381 	 *	   pref mmio.
382 	 *	   if assigned pref mmio's parent is non-pref mmio and there
383 	 *	   is non-pref mmio assign fail, will release that assigned
384 	 *	   pref mmio.
385 	 *	3. if there is non-pref mmio assign fail or pref mmio
386 	 *	   assigned fail, will release assigned non-pref mmio.
387 	 */
388 	LIST_HEAD(save_head);
389 	LIST_HEAD(local_fail_head);
390 	struct pci_dev_resource *save_res;
391 	struct pci_dev_resource *dev_res, *tmp_res, *dev_res2;
392 	unsigned long fail_type;
393 	resource_size_t add_align, align;
394 
395 	/* Check if optional add_size is there */
396 	if (!realloc_head || list_empty(realloc_head))
397 		goto requested_and_reassign;
398 
399 	/* Save original start, end, flags etc at first */
400 	list_for_each_entry(dev_res, head, list) {
401 		if (add_to_list(&save_head, dev_res->dev, dev_res->res, 0, 0)) {
402 			free_list(&save_head);
403 			goto requested_and_reassign;
404 		}
405 	}
406 
407 	/* Update res in head list with add_size in realloc_head list */
408 	list_for_each_entry_safe(dev_res, tmp_res, head, list) {
409 		dev_res->res->end += get_res_add_size(realloc_head,
410 							dev_res->res);
411 
412 		/*
413 		 * There are two kinds of additional resources in the list:
414 		 * 1. bridge resource  -- IORESOURCE_STARTALIGN
415 		 * 2. SR-IOV resource   -- IORESOURCE_SIZEALIGN
416 		 * Here just fix the additional alignment for bridge
417 		 */
418 		if (!(dev_res->res->flags & IORESOURCE_STARTALIGN))
419 			continue;
420 
421 		add_align = get_res_add_align(realloc_head, dev_res->res);
422 
423 		/*
424 		 * The "head" list is sorted by the alignment to make sure
425 		 * resources with bigger alignment will be assigned first.
426 		 * After we change the alignment of a dev_res in "head" list,
427 		 * we need to reorder the list by alignment to make it
428 		 * consistent.
429 		 */
430 		if (add_align > dev_res->res->start) {
431 			dev_res->res->start = add_align;
432 			dev_res->res->end = add_align +
433 				            resource_size(dev_res->res);
434 
435 			list_for_each_entry(dev_res2, head, list) {
436 				align = pci_resource_alignment(dev_res2->dev,
437 							       dev_res2->res);
438 				if (add_align > align)
439 					list_move_tail(&dev_res->list,
440 						       &dev_res2->list);
441 			}
442                }
443 
444 	}
445 
446 	/* Try updated head list with add_size added */
447 	assign_requested_resources_sorted(head, &local_fail_head);
448 
449 	/* all assigned with add_size ? */
450 	if (list_empty(&local_fail_head)) {
451 		/* Remove head list from realloc_head list */
452 		list_for_each_entry(dev_res, head, list)
453 			remove_from_list(realloc_head, dev_res->res);
454 		free_list(&save_head);
455 		free_list(head);
456 		return;
457 	}
458 
459 	/* check failed type */
460 	fail_type = pci_fail_res_type_mask(&local_fail_head);
461 	/* remove not need to be released assigned res from head list etc */
462 	list_for_each_entry_safe(dev_res, tmp_res, head, list)
463 		if (dev_res->res->parent &&
464 		    !pci_need_to_release(fail_type, dev_res->res)) {
465 			/* remove it from realloc_head list */
466 			remove_from_list(realloc_head, dev_res->res);
467 			remove_from_list(&save_head, dev_res->res);
468 			list_del(&dev_res->list);
469 			kfree(dev_res);
470 		}
471 
472 	free_list(&local_fail_head);
473 	/* Release assigned resource */
474 	list_for_each_entry(dev_res, head, list)
475 		if (dev_res->res->parent)
476 			release_resource(dev_res->res);
477 	/* Restore start/end/flags from saved list */
478 	list_for_each_entry(save_res, &save_head, list) {
479 		struct resource *res = save_res->res;
480 
481 		res->start = save_res->start;
482 		res->end = save_res->end;
483 		res->flags = save_res->flags;
484 	}
485 	free_list(&save_head);
486 
487 requested_and_reassign:
488 	/* Satisfy the must-have resource requests */
489 	assign_requested_resources_sorted(head, fail_head);
490 
491 	/* Try to satisfy any additional optional resource
492 		requests */
493 	if (realloc_head)
494 		reassign_resources_sorted(realloc_head, head);
495 	free_list(head);
496 }
497 
498 static void pdev_assign_resources_sorted(struct pci_dev *dev,
499 				 struct list_head *add_head,
500 				 struct list_head *fail_head)
501 {
502 	LIST_HEAD(head);
503 
504 	__dev_sort_resources(dev, &head);
505 	__assign_resources_sorted(&head, add_head, fail_head);
506 
507 }
508 
509 static void pbus_assign_resources_sorted(const struct pci_bus *bus,
510 					 struct list_head *realloc_head,
511 					 struct list_head *fail_head)
512 {
513 	struct pci_dev *dev;
514 	LIST_HEAD(head);
515 
516 	list_for_each_entry(dev, &bus->devices, bus_list)
517 		__dev_sort_resources(dev, &head);
518 
519 	__assign_resources_sorted(&head, realloc_head, fail_head);
520 }
521 
522 void pci_setup_cardbus(struct pci_bus *bus)
523 {
524 	struct pci_dev *bridge = bus->self;
525 	struct resource *res;
526 	struct pci_bus_region region;
527 
528 	dev_info(&bridge->dev, "CardBus bridge to %pR\n",
529 		 &bus->busn_res);
530 
531 	res = bus->resource[0];
532 	pcibios_resource_to_bus(bridge->bus, &region, res);
533 	if (res->flags & IORESOURCE_IO) {
534 		/*
535 		 * The IO resource is allocated a range twice as large as it
536 		 * would normally need.  This allows us to set both IO regs.
537 		 */
538 		dev_info(&bridge->dev, "  bridge window %pR\n", res);
539 		pci_write_config_dword(bridge, PCI_CB_IO_BASE_0,
540 					region.start);
541 		pci_write_config_dword(bridge, PCI_CB_IO_LIMIT_0,
542 					region.end);
543 	}
544 
545 	res = bus->resource[1];
546 	pcibios_resource_to_bus(bridge->bus, &region, res);
547 	if (res->flags & IORESOURCE_IO) {
548 		dev_info(&bridge->dev, "  bridge window %pR\n", res);
549 		pci_write_config_dword(bridge, PCI_CB_IO_BASE_1,
550 					region.start);
551 		pci_write_config_dword(bridge, PCI_CB_IO_LIMIT_1,
552 					region.end);
553 	}
554 
555 	res = bus->resource[2];
556 	pcibios_resource_to_bus(bridge->bus, &region, res);
557 	if (res->flags & IORESOURCE_MEM) {
558 		dev_info(&bridge->dev, "  bridge window %pR\n", res);
559 		pci_write_config_dword(bridge, PCI_CB_MEMORY_BASE_0,
560 					region.start);
561 		pci_write_config_dword(bridge, PCI_CB_MEMORY_LIMIT_0,
562 					region.end);
563 	}
564 
565 	res = bus->resource[3];
566 	pcibios_resource_to_bus(bridge->bus, &region, res);
567 	if (res->flags & IORESOURCE_MEM) {
568 		dev_info(&bridge->dev, "  bridge window %pR\n", res);
569 		pci_write_config_dword(bridge, PCI_CB_MEMORY_BASE_1,
570 					region.start);
571 		pci_write_config_dword(bridge, PCI_CB_MEMORY_LIMIT_1,
572 					region.end);
573 	}
574 }
575 EXPORT_SYMBOL(pci_setup_cardbus);
576 
577 /* Initialize bridges with base/limit values we have collected.
578    PCI-to-PCI Bridge Architecture Specification rev. 1.1 (1998)
579    requires that if there is no I/O ports or memory behind the
580    bridge, corresponding range must be turned off by writing base
581    value greater than limit to the bridge's base/limit registers.
582 
583    Note: care must be taken when updating I/O base/limit registers
584    of bridges which support 32-bit I/O. This update requires two
585    config space writes, so it's quite possible that an I/O window of
586    the bridge will have some undesirable address (e.g. 0) after the
587    first write. Ditto 64-bit prefetchable MMIO.  */
588 static void pci_setup_bridge_io(struct pci_dev *bridge)
589 {
590 	struct resource *res;
591 	struct pci_bus_region region;
592 	unsigned long io_mask;
593 	u8 io_base_lo, io_limit_lo;
594 	u16 l;
595 	u32 io_upper16;
596 
597 	io_mask = PCI_IO_RANGE_MASK;
598 	if (bridge->io_window_1k)
599 		io_mask = PCI_IO_1K_RANGE_MASK;
600 
601 	/* Set up the top and bottom of the PCI I/O segment for this bus. */
602 	res = &bridge->resource[PCI_BRIDGE_RESOURCES + 0];
603 	pcibios_resource_to_bus(bridge->bus, &region, res);
604 	if (res->flags & IORESOURCE_IO) {
605 		pci_read_config_word(bridge, PCI_IO_BASE, &l);
606 		io_base_lo = (region.start >> 8) & io_mask;
607 		io_limit_lo = (region.end >> 8) & io_mask;
608 		l = ((u16) io_limit_lo << 8) | io_base_lo;
609 		/* Set up upper 16 bits of I/O base/limit. */
610 		io_upper16 = (region.end & 0xffff0000) | (region.start >> 16);
611 		dev_info(&bridge->dev, "  bridge window %pR\n", res);
612 	} else {
613 		/* Clear upper 16 bits of I/O base/limit. */
614 		io_upper16 = 0;
615 		l = 0x00f0;
616 	}
617 	/* Temporarily disable the I/O range before updating PCI_IO_BASE. */
618 	pci_write_config_dword(bridge, PCI_IO_BASE_UPPER16, 0x0000ffff);
619 	/* Update lower 16 bits of I/O base/limit. */
620 	pci_write_config_word(bridge, PCI_IO_BASE, l);
621 	/* Update upper 16 bits of I/O base/limit. */
622 	pci_write_config_dword(bridge, PCI_IO_BASE_UPPER16, io_upper16);
623 }
624 
625 static void pci_setup_bridge_mmio(struct pci_dev *bridge)
626 {
627 	struct resource *res;
628 	struct pci_bus_region region;
629 	u32 l;
630 
631 	/* Set up the top and bottom of the PCI Memory segment for this bus. */
632 	res = &bridge->resource[PCI_BRIDGE_RESOURCES + 1];
633 	pcibios_resource_to_bus(bridge->bus, &region, res);
634 	if (res->flags & IORESOURCE_MEM) {
635 		l = (region.start >> 16) & 0xfff0;
636 		l |= region.end & 0xfff00000;
637 		dev_info(&bridge->dev, "  bridge window %pR\n", res);
638 	} else {
639 		l = 0x0000fff0;
640 	}
641 	pci_write_config_dword(bridge, PCI_MEMORY_BASE, l);
642 }
643 
644 static void pci_setup_bridge_mmio_pref(struct pci_dev *bridge)
645 {
646 	struct resource *res;
647 	struct pci_bus_region region;
648 	u32 l, bu, lu;
649 
650 	/* Clear out the upper 32 bits of PREF limit.
651 	   If PCI_PREF_BASE_UPPER32 was non-zero, this temporarily
652 	   disables PREF range, which is ok. */
653 	pci_write_config_dword(bridge, PCI_PREF_LIMIT_UPPER32, 0);
654 
655 	/* Set up PREF base/limit. */
656 	bu = lu = 0;
657 	res = &bridge->resource[PCI_BRIDGE_RESOURCES + 2];
658 	pcibios_resource_to_bus(bridge->bus, &region, res);
659 	if (res->flags & IORESOURCE_PREFETCH) {
660 		l = (region.start >> 16) & 0xfff0;
661 		l |= region.end & 0xfff00000;
662 		if (res->flags & IORESOURCE_MEM_64) {
663 			bu = upper_32_bits(region.start);
664 			lu = upper_32_bits(region.end);
665 		}
666 		dev_info(&bridge->dev, "  bridge window %pR\n", res);
667 	} else {
668 		l = 0x0000fff0;
669 	}
670 	pci_write_config_dword(bridge, PCI_PREF_MEMORY_BASE, l);
671 
672 	/* Set the upper 32 bits of PREF base & limit. */
673 	pci_write_config_dword(bridge, PCI_PREF_BASE_UPPER32, bu);
674 	pci_write_config_dword(bridge, PCI_PREF_LIMIT_UPPER32, lu);
675 }
676 
677 static void __pci_setup_bridge(struct pci_bus *bus, unsigned long type)
678 {
679 	struct pci_dev *bridge = bus->self;
680 
681 	dev_info(&bridge->dev, "PCI bridge to %pR\n",
682 		 &bus->busn_res);
683 
684 	if (type & IORESOURCE_IO)
685 		pci_setup_bridge_io(bridge);
686 
687 	if (type & IORESOURCE_MEM)
688 		pci_setup_bridge_mmio(bridge);
689 
690 	if (type & IORESOURCE_PREFETCH)
691 		pci_setup_bridge_mmio_pref(bridge);
692 
693 	pci_write_config_word(bridge, PCI_BRIDGE_CONTROL, bus->bridge_ctl);
694 }
695 
696 void pci_setup_bridge(struct pci_bus *bus)
697 {
698 	unsigned long type = IORESOURCE_IO | IORESOURCE_MEM |
699 				  IORESOURCE_PREFETCH;
700 
701 	__pci_setup_bridge(bus, type);
702 }
703 
704 
705 int pci_claim_bridge_resource(struct pci_dev *bridge, int i)
706 {
707 	if (i < PCI_BRIDGE_RESOURCES || i > PCI_BRIDGE_RESOURCE_END)
708 		return 0;
709 
710 	if (pci_claim_resource(bridge, i) == 0)
711 		return 0;	/* claimed the window */
712 
713 	if ((bridge->class >> 8) != PCI_CLASS_BRIDGE_PCI)
714 		return 0;
715 
716 	if (!pci_bus_clip_resource(bridge, i))
717 		return -EINVAL;	/* clipping didn't change anything */
718 
719 	switch (i - PCI_BRIDGE_RESOURCES) {
720 	case 0:
721 		pci_setup_bridge_io(bridge);
722 		break;
723 	case 1:
724 		pci_setup_bridge_mmio(bridge);
725 		break;
726 	case 2:
727 		pci_setup_bridge_mmio_pref(bridge);
728 		break;
729 	default:
730 		return -EINVAL;
731 	}
732 
733 	if (pci_claim_resource(bridge, i) == 0)
734 		return 0;	/* claimed a smaller window */
735 
736 	return -EINVAL;
737 }
738 
739 /* Check whether the bridge supports optional I/O and
740    prefetchable memory ranges. If not, the respective
741    base/limit registers must be read-only and read as 0. */
742 static void pci_bridge_check_ranges(struct pci_bus *bus)
743 {
744 	u16 io;
745 	u32 pmem;
746 	struct pci_dev *bridge = bus->self;
747 	struct resource *b_res;
748 
749 	b_res = &bridge->resource[PCI_BRIDGE_RESOURCES];
750 	b_res[1].flags |= IORESOURCE_MEM;
751 
752 	pci_read_config_word(bridge, PCI_IO_BASE, &io);
753 	if (!io) {
754 		pci_write_config_word(bridge, PCI_IO_BASE, 0xe0f0);
755 		pci_read_config_word(bridge, PCI_IO_BASE, &io);
756 		pci_write_config_word(bridge, PCI_IO_BASE, 0x0);
757 	}
758 	if (io)
759 		b_res[0].flags |= IORESOURCE_IO;
760 
761 	/*  DECchip 21050 pass 2 errata: the bridge may miss an address
762 	    disconnect boundary by one PCI data phase.
763 	    Workaround: do not use prefetching on this device. */
764 	if (bridge->vendor == PCI_VENDOR_ID_DEC && bridge->device == 0x0001)
765 		return;
766 
767 	pci_read_config_dword(bridge, PCI_PREF_MEMORY_BASE, &pmem);
768 	if (!pmem) {
769 		pci_write_config_dword(bridge, PCI_PREF_MEMORY_BASE,
770 					       0xffe0fff0);
771 		pci_read_config_dword(bridge, PCI_PREF_MEMORY_BASE, &pmem);
772 		pci_write_config_dword(bridge, PCI_PREF_MEMORY_BASE, 0x0);
773 	}
774 	if (pmem) {
775 		b_res[2].flags |= IORESOURCE_MEM | IORESOURCE_PREFETCH;
776 		if ((pmem & PCI_PREF_RANGE_TYPE_MASK) ==
777 		    PCI_PREF_RANGE_TYPE_64) {
778 			b_res[2].flags |= IORESOURCE_MEM_64;
779 			b_res[2].flags |= PCI_PREF_RANGE_TYPE_64;
780 		}
781 	}
782 
783 	/* double check if bridge does support 64 bit pref */
784 	if (b_res[2].flags & IORESOURCE_MEM_64) {
785 		u32 mem_base_hi, tmp;
786 		pci_read_config_dword(bridge, PCI_PREF_BASE_UPPER32,
787 					 &mem_base_hi);
788 		pci_write_config_dword(bridge, PCI_PREF_BASE_UPPER32,
789 					       0xffffffff);
790 		pci_read_config_dword(bridge, PCI_PREF_BASE_UPPER32, &tmp);
791 		if (!tmp)
792 			b_res[2].flags &= ~IORESOURCE_MEM_64;
793 		pci_write_config_dword(bridge, PCI_PREF_BASE_UPPER32,
794 				       mem_base_hi);
795 	}
796 }
797 
798 /* Helper function for sizing routines: find first available
799    bus resource of a given type. Note: we intentionally skip
800    the bus resources which have already been assigned (that is,
801    have non-NULL parent resource). */
802 static struct resource *find_free_bus_resource(struct pci_bus *bus,
803 			 unsigned long type_mask, unsigned long type)
804 {
805 	int i;
806 	struct resource *r;
807 
808 	pci_bus_for_each_resource(bus, r, i) {
809 		if (r == &ioport_resource || r == &iomem_resource)
810 			continue;
811 		if (r && (r->flags & type_mask) == type && !r->parent)
812 			return r;
813 	}
814 	return NULL;
815 }
816 
817 static resource_size_t calculate_iosize(resource_size_t size,
818 		resource_size_t min_size,
819 		resource_size_t size1,
820 		resource_size_t old_size,
821 		resource_size_t align)
822 {
823 	if (size < min_size)
824 		size = min_size;
825 	if (old_size == 1)
826 		old_size = 0;
827 	/* To be fixed in 2.5: we should have sort of HAVE_ISA
828 	   flag in the struct pci_bus. */
829 #if defined(CONFIG_ISA) || defined(CONFIG_EISA)
830 	size = (size & 0xff) + ((size & ~0xffUL) << 2);
831 #endif
832 	size = ALIGN(size + size1, align);
833 	if (size < old_size)
834 		size = old_size;
835 	return size;
836 }
837 
838 static resource_size_t calculate_memsize(resource_size_t size,
839 		resource_size_t min_size,
840 		resource_size_t size1,
841 		resource_size_t old_size,
842 		resource_size_t align)
843 {
844 	if (size < min_size)
845 		size = min_size;
846 	if (old_size == 1)
847 		old_size = 0;
848 	if (size < old_size)
849 		size = old_size;
850 	size = ALIGN(size + size1, align);
851 	return size;
852 }
853 
854 resource_size_t __weak pcibios_window_alignment(struct pci_bus *bus,
855 						unsigned long type)
856 {
857 	return 1;
858 }
859 
860 #define PCI_P2P_DEFAULT_MEM_ALIGN	0x100000	/* 1MiB */
861 #define PCI_P2P_DEFAULT_IO_ALIGN	0x1000		/* 4KiB */
862 #define PCI_P2P_DEFAULT_IO_ALIGN_1K	0x400		/* 1KiB */
863 
864 static resource_size_t window_alignment(struct pci_bus *bus,
865 					unsigned long type)
866 {
867 	resource_size_t align = 1, arch_align;
868 
869 	if (type & IORESOURCE_MEM)
870 		align = PCI_P2P_DEFAULT_MEM_ALIGN;
871 	else if (type & IORESOURCE_IO) {
872 		/*
873 		 * Per spec, I/O windows are 4K-aligned, but some
874 		 * bridges have an extension to support 1K alignment.
875 		 */
876 		if (bus->self->io_window_1k)
877 			align = PCI_P2P_DEFAULT_IO_ALIGN_1K;
878 		else
879 			align = PCI_P2P_DEFAULT_IO_ALIGN;
880 	}
881 
882 	arch_align = pcibios_window_alignment(bus, type);
883 	return max(align, arch_align);
884 }
885 
886 /**
887  * pbus_size_io() - size the io window of a given bus
888  *
889  * @bus : the bus
890  * @min_size : the minimum io window that must to be allocated
891  * @add_size : additional optional io window
892  * @realloc_head : track the additional io window on this list
893  *
894  * Sizing the IO windows of the PCI-PCI bridge is trivial,
895  * since these windows have 1K or 4K granularity and the IO ranges
896  * of non-bridge PCI devices are limited to 256 bytes.
897  * We must be careful with the ISA aliasing though.
898  */
899 static void pbus_size_io(struct pci_bus *bus, resource_size_t min_size,
900 		resource_size_t add_size, struct list_head *realloc_head)
901 {
902 	struct pci_dev *dev;
903 	struct resource *b_res = find_free_bus_resource(bus, IORESOURCE_IO,
904 							IORESOURCE_IO);
905 	resource_size_t size = 0, size0 = 0, size1 = 0;
906 	resource_size_t children_add_size = 0;
907 	resource_size_t min_align, align;
908 
909 	if (!b_res)
910 		return;
911 
912 	min_align = window_alignment(bus, IORESOURCE_IO);
913 	list_for_each_entry(dev, &bus->devices, bus_list) {
914 		int i;
915 
916 		for (i = 0; i < PCI_NUM_RESOURCES; i++) {
917 			struct resource *r = &dev->resource[i];
918 			unsigned long r_size;
919 
920 			if (r->parent || !(r->flags & IORESOURCE_IO))
921 				continue;
922 			r_size = resource_size(r);
923 
924 			if (r_size < 0x400)
925 				/* Might be re-aligned for ISA */
926 				size += r_size;
927 			else
928 				size1 += r_size;
929 
930 			align = pci_resource_alignment(dev, r);
931 			if (align > min_align)
932 				min_align = align;
933 
934 			if (realloc_head)
935 				children_add_size += get_res_add_size(realloc_head, r);
936 		}
937 	}
938 
939 	size0 = calculate_iosize(size, min_size, size1,
940 			resource_size(b_res), min_align);
941 	if (children_add_size > add_size)
942 		add_size = children_add_size;
943 	size1 = (!realloc_head || (realloc_head && !add_size)) ? size0 :
944 		calculate_iosize(size, min_size, add_size + size1,
945 			resource_size(b_res), min_align);
946 	if (!size0 && !size1) {
947 		if (b_res->start || b_res->end)
948 			dev_info(&bus->self->dev, "disabling bridge window %pR to %pR (unused)\n",
949 				 b_res, &bus->busn_res);
950 		b_res->flags = 0;
951 		return;
952 	}
953 
954 	b_res->start = min_align;
955 	b_res->end = b_res->start + size0 - 1;
956 	b_res->flags |= IORESOURCE_STARTALIGN;
957 	if (size1 > size0 && realloc_head) {
958 		add_to_list(realloc_head, bus->self, b_res, size1-size0,
959 			    min_align);
960 		dev_printk(KERN_DEBUG, &bus->self->dev, "bridge window %pR to %pR add_size %llx\n",
961 			   b_res, &bus->busn_res,
962 			   (unsigned long long)size1-size0);
963 	}
964 }
965 
966 static inline resource_size_t calculate_mem_align(resource_size_t *aligns,
967 						  int max_order)
968 {
969 	resource_size_t align = 0;
970 	resource_size_t min_align = 0;
971 	int order;
972 
973 	for (order = 0; order <= max_order; order++) {
974 		resource_size_t align1 = 1;
975 
976 		align1 <<= (order + 20);
977 
978 		if (!align)
979 			min_align = align1;
980 		else if (ALIGN(align + min_align, min_align) < align1)
981 			min_align = align1 >> 1;
982 		align += aligns[order];
983 	}
984 
985 	return min_align;
986 }
987 
988 /**
989  * pbus_size_mem() - size the memory window of a given bus
990  *
991  * @bus : the bus
992  * @mask: mask the resource flag, then compare it with type
993  * @type: the type of free resource from bridge
994  * @type2: second match type
995  * @type3: third match type
996  * @min_size : the minimum memory window that must to be allocated
997  * @add_size : additional optional memory window
998  * @realloc_head : track the additional memory window on this list
999  *
1000  * Calculate the size of the bus and minimal alignment which
1001  * guarantees that all child resources fit in this size.
1002  *
1003  * Returns -ENOSPC if there's no available bus resource of the desired type.
1004  * Otherwise, sets the bus resource start/end to indicate the required
1005  * size, adds things to realloc_head (if supplied), and returns 0.
1006  */
1007 static int pbus_size_mem(struct pci_bus *bus, unsigned long mask,
1008 			 unsigned long type, unsigned long type2,
1009 			 unsigned long type3,
1010 			 resource_size_t min_size, resource_size_t add_size,
1011 			 struct list_head *realloc_head)
1012 {
1013 	struct pci_dev *dev;
1014 	resource_size_t min_align, align, size, size0, size1;
1015 	resource_size_t aligns[18];	/* Alignments from 1Mb to 128Gb */
1016 	int order, max_order;
1017 	struct resource *b_res = find_free_bus_resource(bus,
1018 					mask | IORESOURCE_PREFETCH, type);
1019 	resource_size_t children_add_size = 0;
1020 	resource_size_t children_add_align = 0;
1021 	resource_size_t add_align = 0;
1022 
1023 	if (!b_res)
1024 		return -ENOSPC;
1025 
1026 	memset(aligns, 0, sizeof(aligns));
1027 	max_order = 0;
1028 	size = 0;
1029 
1030 	list_for_each_entry(dev, &bus->devices, bus_list) {
1031 		int i;
1032 
1033 		for (i = 0; i < PCI_NUM_RESOURCES; i++) {
1034 			struct resource *r = &dev->resource[i];
1035 			resource_size_t r_size;
1036 
1037 			if (r->parent || ((r->flags & mask) != type &&
1038 					  (r->flags & mask) != type2 &&
1039 					  (r->flags & mask) != type3))
1040 				continue;
1041 			r_size = resource_size(r);
1042 #ifdef CONFIG_PCI_IOV
1043 			/* put SRIOV requested res to the optional list */
1044 			if (realloc_head && i >= PCI_IOV_RESOURCES &&
1045 					i <= PCI_IOV_RESOURCE_END) {
1046 				add_align = max(pci_resource_alignment(dev, r), add_align);
1047 				r->end = r->start - 1;
1048 				add_to_list(realloc_head, dev, r, r_size, 0/* don't care */);
1049 				children_add_size += r_size;
1050 				continue;
1051 			}
1052 #endif
1053 			/*
1054 			 * aligns[0] is for 1MB (since bridge memory
1055 			 * windows are always at least 1MB aligned), so
1056 			 * keep "order" from being negative for smaller
1057 			 * resources.
1058 			 */
1059 			align = pci_resource_alignment(dev, r);
1060 			order = __ffs(align) - 20;
1061 			if (order < 0)
1062 				order = 0;
1063 			if (order >= ARRAY_SIZE(aligns)) {
1064 				dev_warn(&dev->dev, "disabling BAR %d: %pR (bad alignment %#llx)\n",
1065 					 i, r, (unsigned long long) align);
1066 				r->flags = 0;
1067 				continue;
1068 			}
1069 			size += r_size;
1070 			/* Exclude ranges with size > align from
1071 			   calculation of the alignment. */
1072 			if (r_size == align)
1073 				aligns[order] += align;
1074 			if (order > max_order)
1075 				max_order = order;
1076 
1077 			if (realloc_head) {
1078 				children_add_size += get_res_add_size(realloc_head, r);
1079 				children_add_align = get_res_add_align(realloc_head, r);
1080 				add_align = max(add_align, children_add_align);
1081 			}
1082 		}
1083 	}
1084 
1085 	min_align = calculate_mem_align(aligns, max_order);
1086 	min_align = max(min_align, window_alignment(bus, b_res->flags));
1087 	size0 = calculate_memsize(size, min_size, 0, resource_size(b_res), min_align);
1088 	add_align = max(min_align, add_align);
1089 	if (children_add_size > add_size)
1090 		add_size = children_add_size;
1091 	size1 = (!realloc_head || (realloc_head && !add_size)) ? size0 :
1092 		calculate_memsize(size, min_size, add_size,
1093 				resource_size(b_res), add_align);
1094 	if (!size0 && !size1) {
1095 		if (b_res->start || b_res->end)
1096 			dev_info(&bus->self->dev, "disabling bridge window %pR to %pR (unused)\n",
1097 				 b_res, &bus->busn_res);
1098 		b_res->flags = 0;
1099 		return 0;
1100 	}
1101 	b_res->start = min_align;
1102 	b_res->end = size0 + min_align - 1;
1103 	b_res->flags |= IORESOURCE_STARTALIGN;
1104 	if (size1 > size0 && realloc_head) {
1105 		add_to_list(realloc_head, bus->self, b_res, size1-size0, add_align);
1106 		dev_printk(KERN_DEBUG, &bus->self->dev, "bridge window %pR to %pR add_size %llx add_align %llx\n",
1107 			   b_res, &bus->busn_res,
1108 			   (unsigned long long) (size1 - size0),
1109 			   (unsigned long long) add_align);
1110 	}
1111 	return 0;
1112 }
1113 
1114 unsigned long pci_cardbus_resource_alignment(struct resource *res)
1115 {
1116 	if (res->flags & IORESOURCE_IO)
1117 		return pci_cardbus_io_size;
1118 	if (res->flags & IORESOURCE_MEM)
1119 		return pci_cardbus_mem_size;
1120 	return 0;
1121 }
1122 
1123 static void pci_bus_size_cardbus(struct pci_bus *bus,
1124 			struct list_head *realloc_head)
1125 {
1126 	struct pci_dev *bridge = bus->self;
1127 	struct resource *b_res = &bridge->resource[PCI_BRIDGE_RESOURCES];
1128 	resource_size_t b_res_3_size = pci_cardbus_mem_size * 2;
1129 	u16 ctrl;
1130 
1131 	if (b_res[0].parent)
1132 		goto handle_b_res_1;
1133 	/*
1134 	 * Reserve some resources for CardBus.  We reserve
1135 	 * a fixed amount of bus space for CardBus bridges.
1136 	 */
1137 	b_res[0].start = pci_cardbus_io_size;
1138 	b_res[0].end = b_res[0].start + pci_cardbus_io_size - 1;
1139 	b_res[0].flags |= IORESOURCE_IO | IORESOURCE_STARTALIGN;
1140 	if (realloc_head) {
1141 		b_res[0].end -= pci_cardbus_io_size;
1142 		add_to_list(realloc_head, bridge, b_res, pci_cardbus_io_size,
1143 				pci_cardbus_io_size);
1144 	}
1145 
1146 handle_b_res_1:
1147 	if (b_res[1].parent)
1148 		goto handle_b_res_2;
1149 	b_res[1].start = pci_cardbus_io_size;
1150 	b_res[1].end = b_res[1].start + pci_cardbus_io_size - 1;
1151 	b_res[1].flags |= IORESOURCE_IO | IORESOURCE_STARTALIGN;
1152 	if (realloc_head) {
1153 		b_res[1].end -= pci_cardbus_io_size;
1154 		add_to_list(realloc_head, bridge, b_res+1, pci_cardbus_io_size,
1155 				 pci_cardbus_io_size);
1156 	}
1157 
1158 handle_b_res_2:
1159 	/* MEM1 must not be pref mmio */
1160 	pci_read_config_word(bridge, PCI_CB_BRIDGE_CONTROL, &ctrl);
1161 	if (ctrl & PCI_CB_BRIDGE_CTL_PREFETCH_MEM1) {
1162 		ctrl &= ~PCI_CB_BRIDGE_CTL_PREFETCH_MEM1;
1163 		pci_write_config_word(bridge, PCI_CB_BRIDGE_CONTROL, ctrl);
1164 		pci_read_config_word(bridge, PCI_CB_BRIDGE_CONTROL, &ctrl);
1165 	}
1166 
1167 	/*
1168 	 * Check whether prefetchable memory is supported
1169 	 * by this bridge.
1170 	 */
1171 	pci_read_config_word(bridge, PCI_CB_BRIDGE_CONTROL, &ctrl);
1172 	if (!(ctrl & PCI_CB_BRIDGE_CTL_PREFETCH_MEM0)) {
1173 		ctrl |= PCI_CB_BRIDGE_CTL_PREFETCH_MEM0;
1174 		pci_write_config_word(bridge, PCI_CB_BRIDGE_CONTROL, ctrl);
1175 		pci_read_config_word(bridge, PCI_CB_BRIDGE_CONTROL, &ctrl);
1176 	}
1177 
1178 	if (b_res[2].parent)
1179 		goto handle_b_res_3;
1180 	/*
1181 	 * If we have prefetchable memory support, allocate
1182 	 * two regions.  Otherwise, allocate one region of
1183 	 * twice the size.
1184 	 */
1185 	if (ctrl & PCI_CB_BRIDGE_CTL_PREFETCH_MEM0) {
1186 		b_res[2].start = pci_cardbus_mem_size;
1187 		b_res[2].end = b_res[2].start + pci_cardbus_mem_size - 1;
1188 		b_res[2].flags |= IORESOURCE_MEM | IORESOURCE_PREFETCH |
1189 				  IORESOURCE_STARTALIGN;
1190 		if (realloc_head) {
1191 			b_res[2].end -= pci_cardbus_mem_size;
1192 			add_to_list(realloc_head, bridge, b_res+2,
1193 				 pci_cardbus_mem_size, pci_cardbus_mem_size);
1194 		}
1195 
1196 		/* reduce that to half */
1197 		b_res_3_size = pci_cardbus_mem_size;
1198 	}
1199 
1200 handle_b_res_3:
1201 	if (b_res[3].parent)
1202 		goto handle_done;
1203 	b_res[3].start = pci_cardbus_mem_size;
1204 	b_res[3].end = b_res[3].start + b_res_3_size - 1;
1205 	b_res[3].flags |= IORESOURCE_MEM | IORESOURCE_STARTALIGN;
1206 	if (realloc_head) {
1207 		b_res[3].end -= b_res_3_size;
1208 		add_to_list(realloc_head, bridge, b_res+3, b_res_3_size,
1209 				 pci_cardbus_mem_size);
1210 	}
1211 
1212 handle_done:
1213 	;
1214 }
1215 
1216 void __pci_bus_size_bridges(struct pci_bus *bus, struct list_head *realloc_head)
1217 {
1218 	struct pci_dev *dev;
1219 	unsigned long mask, prefmask, type2 = 0, type3 = 0;
1220 	resource_size_t additional_mem_size = 0, additional_io_size = 0;
1221 	struct resource *b_res;
1222 	int ret;
1223 
1224 	list_for_each_entry(dev, &bus->devices, bus_list) {
1225 		struct pci_bus *b = dev->subordinate;
1226 		if (!b)
1227 			continue;
1228 
1229 		switch (dev->class >> 8) {
1230 		case PCI_CLASS_BRIDGE_CARDBUS:
1231 			pci_bus_size_cardbus(b, realloc_head);
1232 			break;
1233 
1234 		case PCI_CLASS_BRIDGE_PCI:
1235 		default:
1236 			__pci_bus_size_bridges(b, realloc_head);
1237 			break;
1238 		}
1239 	}
1240 
1241 	/* The root bus? */
1242 	if (pci_is_root_bus(bus))
1243 		return;
1244 
1245 	switch (bus->self->class >> 8) {
1246 	case PCI_CLASS_BRIDGE_CARDBUS:
1247 		/* don't size cardbuses yet. */
1248 		break;
1249 
1250 	case PCI_CLASS_BRIDGE_PCI:
1251 		pci_bridge_check_ranges(bus);
1252 		if (bus->self->is_hotplug_bridge) {
1253 			additional_io_size  = pci_hotplug_io_size;
1254 			additional_mem_size = pci_hotplug_mem_size;
1255 		}
1256 		/* Fall through */
1257 	default:
1258 		pbus_size_io(bus, realloc_head ? 0 : additional_io_size,
1259 			     additional_io_size, realloc_head);
1260 
1261 		/*
1262 		 * If there's a 64-bit prefetchable MMIO window, compute
1263 		 * the size required to put all 64-bit prefetchable
1264 		 * resources in it.
1265 		 */
1266 		b_res = &bus->self->resource[PCI_BRIDGE_RESOURCES];
1267 		mask = IORESOURCE_MEM;
1268 		prefmask = IORESOURCE_MEM | IORESOURCE_PREFETCH;
1269 		if (b_res[2].flags & IORESOURCE_MEM_64) {
1270 			prefmask |= IORESOURCE_MEM_64;
1271 			ret = pbus_size_mem(bus, prefmask, prefmask,
1272 				  prefmask, prefmask,
1273 				  realloc_head ? 0 : additional_mem_size,
1274 				  additional_mem_size, realloc_head);
1275 
1276 			/*
1277 			 * If successful, all non-prefetchable resources
1278 			 * and any 32-bit prefetchable resources will go in
1279 			 * the non-prefetchable window.
1280 			 */
1281 			if (ret == 0) {
1282 				mask = prefmask;
1283 				type2 = prefmask & ~IORESOURCE_MEM_64;
1284 				type3 = prefmask & ~IORESOURCE_PREFETCH;
1285 			}
1286 		}
1287 
1288 		/*
1289 		 * If there is no 64-bit prefetchable window, compute the
1290 		 * size required to put all prefetchable resources in the
1291 		 * 32-bit prefetchable window (if there is one).
1292 		 */
1293 		if (!type2) {
1294 			prefmask &= ~IORESOURCE_MEM_64;
1295 			ret = pbus_size_mem(bus, prefmask, prefmask,
1296 					 prefmask, prefmask,
1297 					 realloc_head ? 0 : additional_mem_size,
1298 					 additional_mem_size, realloc_head);
1299 
1300 			/*
1301 			 * If successful, only non-prefetchable resources
1302 			 * will go in the non-prefetchable window.
1303 			 */
1304 			if (ret == 0)
1305 				mask = prefmask;
1306 			else
1307 				additional_mem_size += additional_mem_size;
1308 
1309 			type2 = type3 = IORESOURCE_MEM;
1310 		}
1311 
1312 		/*
1313 		 * Compute the size required to put everything else in the
1314 		 * non-prefetchable window.  This includes:
1315 		 *
1316 		 *   - all non-prefetchable resources
1317 		 *   - 32-bit prefetchable resources if there's a 64-bit
1318 		 *     prefetchable window or no prefetchable window at all
1319 		 *   - 64-bit prefetchable resources if there's no
1320 		 *     prefetchable window at all
1321 		 *
1322 		 * Note that the strategy in __pci_assign_resource() must
1323 		 * match that used here.  Specifically, we cannot put a
1324 		 * 32-bit prefetchable resource in a 64-bit prefetchable
1325 		 * window.
1326 		 */
1327 		pbus_size_mem(bus, mask, IORESOURCE_MEM, type2, type3,
1328 				realloc_head ? 0 : additional_mem_size,
1329 				additional_mem_size, realloc_head);
1330 		break;
1331 	}
1332 }
1333 
1334 void pci_bus_size_bridges(struct pci_bus *bus)
1335 {
1336 	__pci_bus_size_bridges(bus, NULL);
1337 }
1338 EXPORT_SYMBOL(pci_bus_size_bridges);
1339 
1340 void __pci_bus_assign_resources(const struct pci_bus *bus,
1341 				struct list_head *realloc_head,
1342 				struct list_head *fail_head)
1343 {
1344 	struct pci_bus *b;
1345 	struct pci_dev *dev;
1346 
1347 	pbus_assign_resources_sorted(bus, realloc_head, fail_head);
1348 
1349 	list_for_each_entry(dev, &bus->devices, bus_list) {
1350 		b = dev->subordinate;
1351 		if (!b)
1352 			continue;
1353 
1354 		__pci_bus_assign_resources(b, realloc_head, fail_head);
1355 
1356 		switch (dev->class >> 8) {
1357 		case PCI_CLASS_BRIDGE_PCI:
1358 			if (!pci_is_enabled(dev))
1359 				pci_setup_bridge(b);
1360 			break;
1361 
1362 		case PCI_CLASS_BRIDGE_CARDBUS:
1363 			pci_setup_cardbus(b);
1364 			break;
1365 
1366 		default:
1367 			dev_info(&dev->dev, "not setting up bridge for bus %04x:%02x\n",
1368 				 pci_domain_nr(b), b->number);
1369 			break;
1370 		}
1371 	}
1372 }
1373 
1374 void pci_bus_assign_resources(const struct pci_bus *bus)
1375 {
1376 	__pci_bus_assign_resources(bus, NULL, NULL);
1377 }
1378 EXPORT_SYMBOL(pci_bus_assign_resources);
1379 
1380 static void __pci_bridge_assign_resources(const struct pci_dev *bridge,
1381 					  struct list_head *add_head,
1382 					  struct list_head *fail_head)
1383 {
1384 	struct pci_bus *b;
1385 
1386 	pdev_assign_resources_sorted((struct pci_dev *)bridge,
1387 					 add_head, fail_head);
1388 
1389 	b = bridge->subordinate;
1390 	if (!b)
1391 		return;
1392 
1393 	__pci_bus_assign_resources(b, add_head, fail_head);
1394 
1395 	switch (bridge->class >> 8) {
1396 	case PCI_CLASS_BRIDGE_PCI:
1397 		pci_setup_bridge(b);
1398 		break;
1399 
1400 	case PCI_CLASS_BRIDGE_CARDBUS:
1401 		pci_setup_cardbus(b);
1402 		break;
1403 
1404 	default:
1405 		dev_info(&bridge->dev, "not setting up bridge for bus %04x:%02x\n",
1406 			 pci_domain_nr(b), b->number);
1407 		break;
1408 	}
1409 }
1410 static void pci_bridge_release_resources(struct pci_bus *bus,
1411 					  unsigned long type)
1412 {
1413 	struct pci_dev *dev = bus->self;
1414 	struct resource *r;
1415 	unsigned long type_mask = IORESOURCE_IO | IORESOURCE_MEM |
1416 				  IORESOURCE_PREFETCH | IORESOURCE_MEM_64;
1417 	unsigned old_flags = 0;
1418 	struct resource *b_res;
1419 	int idx = 1;
1420 
1421 	b_res = &dev->resource[PCI_BRIDGE_RESOURCES];
1422 
1423 	/*
1424 	 *     1. if there is io port assign fail, will release bridge
1425 	 *	  io port.
1426 	 *     2. if there is non pref mmio assign fail, release bridge
1427 	 *	  nonpref mmio.
1428 	 *     3. if there is 64bit pref mmio assign fail, and bridge pref
1429 	 *	  is 64bit, release bridge pref mmio.
1430 	 *     4. if there is pref mmio assign fail, and bridge pref is
1431 	 *	  32bit mmio, release bridge pref mmio
1432 	 *     5. if there is pref mmio assign fail, and bridge pref is not
1433 	 *	  assigned, release bridge nonpref mmio.
1434 	 */
1435 	if (type & IORESOURCE_IO)
1436 		idx = 0;
1437 	else if (!(type & IORESOURCE_PREFETCH))
1438 		idx = 1;
1439 	else if ((type & IORESOURCE_MEM_64) &&
1440 		 (b_res[2].flags & IORESOURCE_MEM_64))
1441 		idx = 2;
1442 	else if (!(b_res[2].flags & IORESOURCE_MEM_64) &&
1443 		 (b_res[2].flags & IORESOURCE_PREFETCH))
1444 		idx = 2;
1445 	else
1446 		idx = 1;
1447 
1448 	r = &b_res[idx];
1449 
1450 	if (!r->parent)
1451 		return;
1452 
1453 	/*
1454 	 * if there are children under that, we should release them
1455 	 *  all
1456 	 */
1457 	release_child_resources(r);
1458 	if (!release_resource(r)) {
1459 		type = old_flags = r->flags & type_mask;
1460 		dev_printk(KERN_DEBUG, &dev->dev, "resource %d %pR released\n",
1461 					PCI_BRIDGE_RESOURCES + idx, r);
1462 		/* keep the old size */
1463 		r->end = resource_size(r) - 1;
1464 		r->start = 0;
1465 		r->flags = 0;
1466 
1467 		/* avoiding touch the one without PREF */
1468 		if (type & IORESOURCE_PREFETCH)
1469 			type = IORESOURCE_PREFETCH;
1470 		__pci_setup_bridge(bus, type);
1471 		/* for next child res under same bridge */
1472 		r->flags = old_flags;
1473 	}
1474 }
1475 
1476 enum release_type {
1477 	leaf_only,
1478 	whole_subtree,
1479 };
1480 /*
1481  * try to release pci bridge resources that is from leaf bridge,
1482  * so we can allocate big new one later
1483  */
1484 static void pci_bus_release_bridge_resources(struct pci_bus *bus,
1485 					     unsigned long type,
1486 					     enum release_type rel_type)
1487 {
1488 	struct pci_dev *dev;
1489 	bool is_leaf_bridge = true;
1490 
1491 	list_for_each_entry(dev, &bus->devices, bus_list) {
1492 		struct pci_bus *b = dev->subordinate;
1493 		if (!b)
1494 			continue;
1495 
1496 		is_leaf_bridge = false;
1497 
1498 		if ((dev->class >> 8) != PCI_CLASS_BRIDGE_PCI)
1499 			continue;
1500 
1501 		if (rel_type == whole_subtree)
1502 			pci_bus_release_bridge_resources(b, type,
1503 						 whole_subtree);
1504 	}
1505 
1506 	if (pci_is_root_bus(bus))
1507 		return;
1508 
1509 	if ((bus->self->class >> 8) != PCI_CLASS_BRIDGE_PCI)
1510 		return;
1511 
1512 	if ((rel_type == whole_subtree) || is_leaf_bridge)
1513 		pci_bridge_release_resources(bus, type);
1514 }
1515 
1516 static void pci_bus_dump_res(struct pci_bus *bus)
1517 {
1518 	struct resource *res;
1519 	int i;
1520 
1521 	pci_bus_for_each_resource(bus, res, i) {
1522 		if (!res || !res->end || !res->flags)
1523 			continue;
1524 
1525 		dev_printk(KERN_DEBUG, &bus->dev, "resource %d %pR\n", i, res);
1526 	}
1527 }
1528 
1529 static void pci_bus_dump_resources(struct pci_bus *bus)
1530 {
1531 	struct pci_bus *b;
1532 	struct pci_dev *dev;
1533 
1534 
1535 	pci_bus_dump_res(bus);
1536 
1537 	list_for_each_entry(dev, &bus->devices, bus_list) {
1538 		b = dev->subordinate;
1539 		if (!b)
1540 			continue;
1541 
1542 		pci_bus_dump_resources(b);
1543 	}
1544 }
1545 
1546 static int pci_bus_get_depth(struct pci_bus *bus)
1547 {
1548 	int depth = 0;
1549 	struct pci_bus *child_bus;
1550 
1551 	list_for_each_entry(child_bus, &bus->children, node) {
1552 		int ret;
1553 
1554 		ret = pci_bus_get_depth(child_bus);
1555 		if (ret + 1 > depth)
1556 			depth = ret + 1;
1557 	}
1558 
1559 	return depth;
1560 }
1561 
1562 /*
1563  * -1: undefined, will auto detect later
1564  *  0: disabled by user
1565  *  1: disabled by auto detect
1566  *  2: enabled by user
1567  *  3: enabled by auto detect
1568  */
1569 enum enable_type {
1570 	undefined = -1,
1571 	user_disabled,
1572 	auto_disabled,
1573 	user_enabled,
1574 	auto_enabled,
1575 };
1576 
1577 static enum enable_type pci_realloc_enable = undefined;
1578 void __init pci_realloc_get_opt(char *str)
1579 {
1580 	if (!strncmp(str, "off", 3))
1581 		pci_realloc_enable = user_disabled;
1582 	else if (!strncmp(str, "on", 2))
1583 		pci_realloc_enable = user_enabled;
1584 }
1585 static bool pci_realloc_enabled(enum enable_type enable)
1586 {
1587 	return enable >= user_enabled;
1588 }
1589 
1590 #if defined(CONFIG_PCI_IOV) && defined(CONFIG_PCI_REALLOC_ENABLE_AUTO)
1591 static int iov_resources_unassigned(struct pci_dev *dev, void *data)
1592 {
1593 	int i;
1594 	bool *unassigned = data;
1595 
1596 	for (i = PCI_IOV_RESOURCES; i <= PCI_IOV_RESOURCE_END; i++) {
1597 		struct resource *r = &dev->resource[i];
1598 		struct pci_bus_region region;
1599 
1600 		/* Not assigned or rejected by kernel? */
1601 		if (!r->flags)
1602 			continue;
1603 
1604 		pcibios_resource_to_bus(dev->bus, &region, r);
1605 		if (!region.start) {
1606 			*unassigned = true;
1607 			return 1; /* return early from pci_walk_bus() */
1608 		}
1609 	}
1610 
1611 	return 0;
1612 }
1613 
1614 static enum enable_type pci_realloc_detect(struct pci_bus *bus,
1615 			 enum enable_type enable_local)
1616 {
1617 	bool unassigned = false;
1618 
1619 	if (enable_local != undefined)
1620 		return enable_local;
1621 
1622 	pci_walk_bus(bus, iov_resources_unassigned, &unassigned);
1623 	if (unassigned)
1624 		return auto_enabled;
1625 
1626 	return enable_local;
1627 }
1628 #else
1629 static enum enable_type pci_realloc_detect(struct pci_bus *bus,
1630 			 enum enable_type enable_local)
1631 {
1632 	return enable_local;
1633 }
1634 #endif
1635 
1636 /*
1637  * first try will not touch pci bridge res
1638  * second and later try will clear small leaf bridge res
1639  * will stop till to the max depth if can not find good one
1640  */
1641 void pci_assign_unassigned_root_bus_resources(struct pci_bus *bus)
1642 {
1643 	LIST_HEAD(realloc_head); /* list of resources that
1644 					want additional resources */
1645 	struct list_head *add_list = NULL;
1646 	int tried_times = 0;
1647 	enum release_type rel_type = leaf_only;
1648 	LIST_HEAD(fail_head);
1649 	struct pci_dev_resource *fail_res;
1650 	unsigned long type_mask = IORESOURCE_IO | IORESOURCE_MEM |
1651 				  IORESOURCE_PREFETCH | IORESOURCE_MEM_64;
1652 	int pci_try_num = 1;
1653 	enum enable_type enable_local;
1654 
1655 	/* don't realloc if asked to do so */
1656 	enable_local = pci_realloc_detect(bus, pci_realloc_enable);
1657 	if (pci_realloc_enabled(enable_local)) {
1658 		int max_depth = pci_bus_get_depth(bus);
1659 
1660 		pci_try_num = max_depth + 1;
1661 		dev_printk(KERN_DEBUG, &bus->dev,
1662 			   "max bus depth: %d pci_try_num: %d\n",
1663 			   max_depth, pci_try_num);
1664 	}
1665 
1666 again:
1667 	/*
1668 	 * last try will use add_list, otherwise will try good to have as
1669 	 * must have, so can realloc parent bridge resource
1670 	 */
1671 	if (tried_times + 1 == pci_try_num)
1672 		add_list = &realloc_head;
1673 	/* Depth first, calculate sizes and alignments of all
1674 	   subordinate buses. */
1675 	__pci_bus_size_bridges(bus, add_list);
1676 
1677 	/* Depth last, allocate resources and update the hardware. */
1678 	__pci_bus_assign_resources(bus, add_list, &fail_head);
1679 	if (add_list)
1680 		BUG_ON(!list_empty(add_list));
1681 	tried_times++;
1682 
1683 	/* any device complain? */
1684 	if (list_empty(&fail_head))
1685 		goto dump;
1686 
1687 	if (tried_times >= pci_try_num) {
1688 		if (enable_local == undefined)
1689 			dev_info(&bus->dev, "Some PCI device resources are unassigned, try booting with pci=realloc\n");
1690 		else if (enable_local == auto_enabled)
1691 			dev_info(&bus->dev, "Automatically enabled pci realloc, if you have problem, try booting with pci=realloc=off\n");
1692 
1693 		free_list(&fail_head);
1694 		goto dump;
1695 	}
1696 
1697 	dev_printk(KERN_DEBUG, &bus->dev,
1698 		   "No. %d try to assign unassigned res\n", tried_times + 1);
1699 
1700 	/* third times and later will not check if it is leaf */
1701 	if ((tried_times + 1) > 2)
1702 		rel_type = whole_subtree;
1703 
1704 	/*
1705 	 * Try to release leaf bridge's resources that doesn't fit resource of
1706 	 * child device under that bridge
1707 	 */
1708 	list_for_each_entry(fail_res, &fail_head, list)
1709 		pci_bus_release_bridge_resources(fail_res->dev->bus,
1710 						 fail_res->flags & type_mask,
1711 						 rel_type);
1712 
1713 	/* restore size and flags */
1714 	list_for_each_entry(fail_res, &fail_head, list) {
1715 		struct resource *res = fail_res->res;
1716 
1717 		res->start = fail_res->start;
1718 		res->end = fail_res->end;
1719 		res->flags = fail_res->flags;
1720 		if (fail_res->dev->subordinate)
1721 			res->flags = 0;
1722 	}
1723 	free_list(&fail_head);
1724 
1725 	goto again;
1726 
1727 dump:
1728 	/* dump the resource on buses */
1729 	pci_bus_dump_resources(bus);
1730 }
1731 
1732 void __init pci_assign_unassigned_resources(void)
1733 {
1734 	struct pci_bus *root_bus;
1735 
1736 	list_for_each_entry(root_bus, &pci_root_buses, node)
1737 		pci_assign_unassigned_root_bus_resources(root_bus);
1738 }
1739 
1740 void pci_assign_unassigned_bridge_resources(struct pci_dev *bridge)
1741 {
1742 	struct pci_bus *parent = bridge->subordinate;
1743 	LIST_HEAD(add_list); /* list of resources that
1744 					want additional resources */
1745 	int tried_times = 0;
1746 	LIST_HEAD(fail_head);
1747 	struct pci_dev_resource *fail_res;
1748 	int retval;
1749 	unsigned long type_mask = IORESOURCE_IO | IORESOURCE_MEM |
1750 				  IORESOURCE_PREFETCH | IORESOURCE_MEM_64;
1751 
1752 again:
1753 	__pci_bus_size_bridges(parent, &add_list);
1754 	__pci_bridge_assign_resources(bridge, &add_list, &fail_head);
1755 	BUG_ON(!list_empty(&add_list));
1756 	tried_times++;
1757 
1758 	if (list_empty(&fail_head))
1759 		goto enable_all;
1760 
1761 	if (tried_times >= 2) {
1762 		/* still fail, don't need to try more */
1763 		free_list(&fail_head);
1764 		goto enable_all;
1765 	}
1766 
1767 	printk(KERN_DEBUG "PCI: No. %d try to assign unassigned res\n",
1768 			 tried_times + 1);
1769 
1770 	/*
1771 	 * Try to release leaf bridge's resources that doesn't fit resource of
1772 	 * child device under that bridge
1773 	 */
1774 	list_for_each_entry(fail_res, &fail_head, list)
1775 		pci_bus_release_bridge_resources(fail_res->dev->bus,
1776 						 fail_res->flags & type_mask,
1777 						 whole_subtree);
1778 
1779 	/* restore size and flags */
1780 	list_for_each_entry(fail_res, &fail_head, list) {
1781 		struct resource *res = fail_res->res;
1782 
1783 		res->start = fail_res->start;
1784 		res->end = fail_res->end;
1785 		res->flags = fail_res->flags;
1786 		if (fail_res->dev->subordinate)
1787 			res->flags = 0;
1788 	}
1789 	free_list(&fail_head);
1790 
1791 	goto again;
1792 
1793 enable_all:
1794 	retval = pci_reenable_device(bridge);
1795 	if (retval)
1796 		dev_err(&bridge->dev, "Error reenabling bridge (%d)\n", retval);
1797 	pci_set_master(bridge);
1798 }
1799 EXPORT_SYMBOL_GPL(pci_assign_unassigned_bridge_resources);
1800 
1801 void pci_assign_unassigned_bus_resources(struct pci_bus *bus)
1802 {
1803 	struct pci_dev *dev;
1804 	LIST_HEAD(add_list); /* list of resources that
1805 					want additional resources */
1806 
1807 	down_read(&pci_bus_sem);
1808 	list_for_each_entry(dev, &bus->devices, bus_list)
1809 		if (pci_is_bridge(dev) && pci_has_subordinate(dev))
1810 				__pci_bus_size_bridges(dev->subordinate,
1811 							 &add_list);
1812 	up_read(&pci_bus_sem);
1813 	__pci_bus_assign_resources(bus, &add_list, NULL);
1814 	BUG_ON(!list_empty(&add_list));
1815 }
1816 EXPORT_SYMBOL_GPL(pci_assign_unassigned_bus_resources);
1817