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