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