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