1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
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
31unsigned int pci_flags;
32
33struct 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
44static 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
56
57
58
59
60
61
62
63static 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
88static 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
102static 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
124static 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
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
170 list_add_tail(&tmp->list, n);
171 }
172}
173
174static void __dev_sort_resources(struct pci_dev *dev,
175 struct list_head *head)
176{
177 u16 class = dev->class >> 8;
178
179
180 if (class == PCI_CLASS_NOT_DEFINED || class == PCI_CLASS_BRIDGE_HOST)
181 return;
182
183
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
194static inline void reset_resource(struct resource *res)
195{
196 res->start = 0;
197 res->end = 0;
198 res->flags = 0;
199}
200
201
202
203
204
205
206
207
208
209
210
211
212
213static 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
227 if (!res->flags)
228 goto out;
229
230
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)
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 }
258out:
259 list_del(&add_res->list);
260 kfree(add_res);
261 }
262}
263
264
265
266
267
268
269
270
271
272
273
274static 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 && !pci_is_root_bus(dev_res->dev->bus)) {
287
288
289
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 ,
296 0 );
297 }
298 reset_resource(res);
299 }
300 }
301}
302
303static void __assign_resources_sorted(struct list_head *head,
304 struct list_head *realloc_head,
305 struct list_head *fail_head)
306{
307
308
309
310
311
312
313
314
315
316 LIST_HEAD(save_head);
317 LIST_HEAD(local_fail_head);
318 struct pci_dev_resource *save_res;
319 struct pci_dev_resource *dev_res;
320
321
322 if (!realloc_head || list_empty(realloc_head))
323 goto requested_and_reassign;
324
325
326 list_for_each_entry(dev_res, head, list) {
327 if (add_to_list(&save_head, dev_res->dev, dev_res->res, 0, 0)) {
328 free_list(&save_head);
329 goto requested_and_reassign;
330 }
331 }
332
333
334 list_for_each_entry(dev_res, head, list)
335 dev_res->res->end += get_res_add_size(realloc_head,
336 dev_res->res);
337
338
339 assign_requested_resources_sorted(head, &local_fail_head);
340
341
342 if (list_empty(&local_fail_head)) {
343
344 list_for_each_entry(dev_res, head, list)
345 remove_from_list(realloc_head, dev_res->res);
346 free_list(&save_head);
347 free_list(head);
348 return;
349 }
350
351 free_list(&local_fail_head);
352
353 list_for_each_entry(dev_res, head, list)
354 if (dev_res->res->parent)
355 release_resource(dev_res->res);
356
357 list_for_each_entry(save_res, &save_head, list) {
358 struct resource *res = save_res->res;
359
360 res->start = save_res->start;
361 res->end = save_res->end;
362 res->flags = save_res->flags;
363 }
364 free_list(&save_head);
365
366requested_and_reassign:
367
368 assign_requested_resources_sorted(head, fail_head);
369
370
371
372 if (realloc_head)
373 reassign_resources_sorted(realloc_head, head);
374 free_list(head);
375}
376
377static void pdev_assign_resources_sorted(struct pci_dev *dev,
378 struct list_head *add_head,
379 struct list_head *fail_head)
380{
381 LIST_HEAD(head);
382
383 __dev_sort_resources(dev, &head);
384 __assign_resources_sorted(&head, add_head, fail_head);
385
386}
387
388static void pbus_assign_resources_sorted(const struct pci_bus *bus,
389 struct list_head *realloc_head,
390 struct list_head *fail_head)
391{
392 struct pci_dev *dev;
393 LIST_HEAD(head);
394
395 list_for_each_entry(dev, &bus->devices, bus_list)
396 __dev_sort_resources(dev, &head);
397
398 __assign_resources_sorted(&head, realloc_head, fail_head);
399}
400
401void pci_setup_cardbus(struct pci_bus *bus)
402{
403 struct pci_dev *bridge = bus->self;
404 struct resource *res;
405 struct pci_bus_region region;
406
407 dev_info(&bridge->dev, "CardBus bridge to %pR\n",
408 &bus->busn_res);
409
410 res = bus->resource[0];
411 pcibios_resource_to_bus(bridge, ®ion, res);
412 if (res->flags & IORESOURCE_IO) {
413
414
415
416
417 dev_info(&bridge->dev, " bridge window %pR\n", res);
418 pci_write_config_dword(bridge, PCI_CB_IO_BASE_0,
419 region.start);
420 pci_write_config_dword(bridge, PCI_CB_IO_LIMIT_0,
421 region.end);
422 }
423
424 res = bus->resource[1];
425 pcibios_resource_to_bus(bridge, ®ion, res);
426 if (res->flags & IORESOURCE_IO) {
427 dev_info(&bridge->dev, " bridge window %pR\n", res);
428 pci_write_config_dword(bridge, PCI_CB_IO_BASE_1,
429 region.start);
430 pci_write_config_dword(bridge, PCI_CB_IO_LIMIT_1,
431 region.end);
432 }
433
434 res = bus->resource[2];
435 pcibios_resource_to_bus(bridge, ®ion, res);
436 if (res->flags & IORESOURCE_MEM) {
437 dev_info(&bridge->dev, " bridge window %pR\n", res);
438 pci_write_config_dword(bridge, PCI_CB_MEMORY_BASE_0,
439 region.start);
440 pci_write_config_dword(bridge, PCI_CB_MEMORY_LIMIT_0,
441 region.end);
442 }
443
444 res = bus->resource[3];
445 pcibios_resource_to_bus(bridge, ®ion, res);
446 if (res->flags & IORESOURCE_MEM) {
447 dev_info(&bridge->dev, " bridge window %pR\n", res);
448 pci_write_config_dword(bridge, PCI_CB_MEMORY_BASE_1,
449 region.start);
450 pci_write_config_dword(bridge, PCI_CB_MEMORY_LIMIT_1,
451 region.end);
452 }
453}
454EXPORT_SYMBOL(pci_setup_cardbus);
455
456
457
458
459
460
461
462
463
464
465
466
467static void pci_setup_bridge_io(struct pci_bus *bus)
468{
469 struct pci_dev *bridge = bus->self;
470 struct resource *res;
471 struct pci_bus_region region;
472 unsigned long io_mask;
473 u8 io_base_lo, io_limit_lo;
474 u32 l, io_upper16;
475
476 io_mask = PCI_IO_RANGE_MASK;
477 if (bridge->io_window_1k)
478 io_mask = PCI_IO_1K_RANGE_MASK;
479
480
481 res = bus->resource[0];
482 pcibios_resource_to_bus(bridge, ®ion, res);
483 if (res->flags & IORESOURCE_IO) {
484 pci_read_config_dword(bridge, PCI_IO_BASE, &l);
485 l &= 0xffff0000;
486 io_base_lo = (region.start >> 8) & io_mask;
487 io_limit_lo = (region.end >> 8) & io_mask;
488 l |= ((u32) io_limit_lo << 8) | io_base_lo;
489
490 io_upper16 = (region.end & 0xffff0000) | (region.start >> 16);
491 dev_info(&bridge->dev, " bridge window %pR\n", res);
492 } else {
493
494 io_upper16 = 0;
495 l = 0x00f0;
496 }
497
498 pci_write_config_dword(bridge, PCI_IO_BASE_UPPER16, 0x0000ffff);
499
500 pci_write_config_dword(bridge, PCI_IO_BASE, l);
501
502 pci_write_config_dword(bridge, PCI_IO_BASE_UPPER16, io_upper16);
503}
504
505static void pci_setup_bridge_mmio(struct pci_bus *bus)
506{
507 struct pci_dev *bridge = bus->self;
508 struct resource *res;
509 struct pci_bus_region region;
510 u32 l;
511
512
513 res = bus->resource[1];
514 pcibios_resource_to_bus(bridge, ®ion, res);
515 if (res->flags & IORESOURCE_MEM) {
516 l = (region.start >> 16) & 0xfff0;
517 l |= region.end & 0xfff00000;
518 dev_info(&bridge->dev, " bridge window %pR\n", res);
519 } else {
520 l = 0x0000fff0;
521 }
522 pci_write_config_dword(bridge, PCI_MEMORY_BASE, l);
523}
524
525static void pci_setup_bridge_mmio_pref(struct pci_bus *bus)
526{
527 struct pci_dev *bridge = bus->self;
528 struct resource *res;
529 struct pci_bus_region region;
530 u32 l, bu, lu;
531
532
533
534
535 pci_write_config_dword(bridge, PCI_PREF_LIMIT_UPPER32, 0);
536
537
538 bu = lu = 0;
539 res = bus->resource[2];
540 pcibios_resource_to_bus(bridge, ®ion, res);
541 if (res->flags & IORESOURCE_PREFETCH) {
542 l = (region.start >> 16) & 0xfff0;
543 l |= region.end & 0xfff00000;
544 if (res->flags & IORESOURCE_MEM_64) {
545 bu = upper_32_bits(region.start);
546 lu = upper_32_bits(region.end);
547 }
548 dev_info(&bridge->dev, " bridge window %pR\n", res);
549 } else {
550 l = 0x0000fff0;
551 }
552 pci_write_config_dword(bridge, PCI_PREF_MEMORY_BASE, l);
553
554
555 pci_write_config_dword(bridge, PCI_PREF_BASE_UPPER32, bu);
556 pci_write_config_dword(bridge, PCI_PREF_LIMIT_UPPER32, lu);
557}
558
559static void __pci_setup_bridge(struct pci_bus *bus, unsigned long type)
560{
561 struct pci_dev *bridge = bus->self;
562
563 dev_info(&bridge->dev, "PCI bridge to %pR\n",
564 &bus->busn_res);
565
566 if (type & IORESOURCE_IO)
567 pci_setup_bridge_io(bus);
568
569 if (type & IORESOURCE_MEM)
570 pci_setup_bridge_mmio(bus);
571
572 if (type & IORESOURCE_PREFETCH)
573 pci_setup_bridge_mmio_pref(bus);
574
575 pci_write_config_word(bridge, PCI_BRIDGE_CONTROL, bus->bridge_ctl);
576}
577
578void pci_setup_bridge(struct pci_bus *bus)
579{
580 unsigned long type = IORESOURCE_IO | IORESOURCE_MEM |
581 IORESOURCE_PREFETCH;
582
583 __pci_setup_bridge(bus, type);
584}
585
586
587
588
589static void pci_bridge_check_ranges(struct pci_bus *bus)
590{
591 u16 io;
592 u32 pmem;
593 struct pci_dev *bridge = bus->self;
594 struct resource *b_res;
595
596 b_res = &bridge->resource[PCI_BRIDGE_RESOURCES];
597 b_res[1].flags |= IORESOURCE_MEM;
598
599 pci_read_config_word(bridge, PCI_IO_BASE, &io);
600 if (!io) {
601 pci_write_config_word(bridge, PCI_IO_BASE, 0xf0f0);
602 pci_read_config_word(bridge, PCI_IO_BASE, &io);
603 pci_write_config_word(bridge, PCI_IO_BASE, 0x0);
604 }
605 if (io)
606 b_res[0].flags |= IORESOURCE_IO;
607
608
609
610 if (bridge->vendor == PCI_VENDOR_ID_DEC && bridge->device == 0x0001)
611 return;
612 pci_read_config_dword(bridge, PCI_PREF_MEMORY_BASE, &pmem);
613 if (!pmem) {
614 pci_write_config_dword(bridge, PCI_PREF_MEMORY_BASE,
615 0xfff0fff0);
616 pci_read_config_dword(bridge, PCI_PREF_MEMORY_BASE, &pmem);
617 pci_write_config_dword(bridge, PCI_PREF_MEMORY_BASE, 0x0);
618 }
619 if (pmem) {
620 b_res[2].flags |= IORESOURCE_MEM | IORESOURCE_PREFETCH;
621 if ((pmem & PCI_PREF_RANGE_TYPE_MASK) ==
622 PCI_PREF_RANGE_TYPE_64) {
623 b_res[2].flags |= IORESOURCE_MEM_64;
624 b_res[2].flags |= PCI_PREF_RANGE_TYPE_64;
625 }
626 }
627
628
629 if (b_res[2].flags & IORESOURCE_MEM_64) {
630 u32 mem_base_hi, tmp;
631 pci_read_config_dword(bridge, PCI_PREF_BASE_UPPER32,
632 &mem_base_hi);
633 pci_write_config_dword(bridge, PCI_PREF_BASE_UPPER32,
634 0xffffffff);
635 pci_read_config_dword(bridge, PCI_PREF_BASE_UPPER32, &tmp);
636 if (!tmp)
637 b_res[2].flags &= ~IORESOURCE_MEM_64;
638 pci_write_config_dword(bridge, PCI_PREF_BASE_UPPER32,
639 mem_base_hi);
640 }
641}
642
643
644
645
646
647static struct resource *find_free_bus_resource(struct pci_bus *bus, unsigned long type)
648{
649 int i;
650 struct resource *r;
651 unsigned long type_mask = IORESOURCE_IO | IORESOURCE_MEM |
652 IORESOURCE_PREFETCH;
653
654 pci_bus_for_each_resource(bus, r, i) {
655 if (r == &ioport_resource || r == &iomem_resource)
656 continue;
657 if (r && (r->flags & type_mask) == type && !r->parent)
658 return r;
659 }
660 return NULL;
661}
662
663static resource_size_t calculate_iosize(resource_size_t size,
664 resource_size_t min_size,
665 resource_size_t size1,
666 resource_size_t old_size,
667 resource_size_t align)
668{
669 if (size < min_size)
670 size = min_size;
671 if (old_size == 1 )
672 old_size = 0;
673
674
675#if defined(CONFIG_ISA) || defined(CONFIG_EISA)
676 size = (size & 0xff) + ((size & ~0xffUL) << 2);
677#endif
678 size = ALIGN(size + size1, align);
679 if (size < old_size)
680 size = old_size;
681 return size;
682}
683
684static resource_size_t calculate_memsize(resource_size_t size,
685 resource_size_t min_size,
686 resource_size_t size1,
687 resource_size_t old_size,
688 resource_size_t align)
689{
690 if (size < min_size)
691 size = min_size;
692 if (old_size == 1 )
693 old_size = 0;
694 if (size < old_size)
695 size = old_size;
696 size = ALIGN(size + size1, align);
697 return size;
698}
699
700
701
702
703
704
705
706
707
708
709
710
711
712
713static void pbus_size_io(struct pci_bus *bus, resource_size_t min_size,
714 resource_size_t add_size, struct list_head *realloc_head)
715{
716 struct pci_dev *dev;
717 struct resource *b_res = find_free_bus_resource(bus, IORESOURCE_IO);
718 unsigned long size = 0, size0 = 0, size1 = 0;
719 resource_size_t children_add_size = 0;
720 resource_size_t min_align = 4096, align;
721
722 if (!b_res)
723 return;
724
725
726
727
728
729 if (bus->self->io_window_1k)
730 min_align = 1024;
731 list_for_each_entry(dev, &bus->devices, bus_list) {
732 int i;
733
734 for (i = 0; i < PCI_NUM_RESOURCES; i++) {
735 struct resource *r = &dev->resource[i];
736 unsigned long r_size;
737
738 if (r->parent || !(r->flags & IORESOURCE_IO))
739 continue;
740 r_size = resource_size(r);
741
742 if (r_size < 0x400)
743
744 size += r_size;
745 else
746 size1 += r_size;
747
748 align = pci_resource_alignment(dev, r);
749 if (align > min_align)
750 min_align = align;
751
752 if (realloc_head)
753 children_add_size += get_res_add_size(realloc_head, r);
754 }
755 }
756
757 if (min_align > 4096)
758 min_align = 4096;
759
760 size0 = calculate_iosize(size, min_size, size1,
761 resource_size(b_res), min_align);
762 if (children_add_size > add_size)
763 add_size = children_add_size;
764 size1 = (!realloc_head || (realloc_head && !add_size)) ? size0 :
765 calculate_iosize(size, min_size, add_size + size1,
766 resource_size(b_res), min_align);
767 if (!size0 && !size1) {
768 if (b_res->start || b_res->end)
769 dev_info(&bus->self->dev, "disabling bridge window "
770 "%pR to %pR (unused)\n", b_res,
771 &bus->busn_res);
772 b_res->flags = 0;
773 return;
774 }
775
776 b_res->start = min_align;
777 b_res->end = b_res->start + size0 - 1;
778 b_res->flags |= IORESOURCE_STARTALIGN;
779 if (size1 > size0 && realloc_head) {
780 add_to_list(realloc_head, bus->self, b_res, size1-size0,
781 min_align);
782 dev_printk(KERN_DEBUG, &bus->self->dev, "bridge window "
783 "%pR to %pR add_size %lx\n", b_res,
784 &bus->busn_res, size1-size0);
785 }
786}
787
788
789
790
791
792
793
794
795
796
797
798
799static int pbus_size_mem(struct pci_bus *bus, unsigned long mask,
800 unsigned long type, resource_size_t min_size,
801 resource_size_t add_size,
802 struct list_head *realloc_head)
803{
804 struct pci_dev *dev;
805 resource_size_t min_align, align, size, size0, size1;
806 resource_size_t aligns[12];
807 int order, max_order;
808 struct resource *b_res = find_free_bus_resource(bus, type);
809 unsigned int mem64_mask = 0;
810 resource_size_t children_add_size = 0;
811
812 if (!b_res)
813 return 0;
814
815 memset(aligns, 0, sizeof(aligns));
816 max_order = 0;
817 size = 0;
818
819 mem64_mask = b_res->flags & IORESOURCE_MEM_64;
820 b_res->flags &= ~IORESOURCE_MEM_64;
821
822 list_for_each_entry(dev, &bus->devices, bus_list) {
823 int i;
824
825 for (i = 0; i < PCI_NUM_RESOURCES; i++) {
826 struct resource *r = &dev->resource[i];
827 resource_size_t r_size;
828
829 if (r->parent || (r->flags & mask) != type)
830 continue;
831 r_size = resource_size(r);
832#ifdef CONFIG_PCI_IOV
833
834 if (realloc_head && i >= PCI_IOV_RESOURCES &&
835 i <= PCI_IOV_RESOURCE_END) {
836 r->end = r->start - 1;
837 add_to_list(realloc_head, dev, r, r_size, 0);
838 children_add_size += r_size;
839 continue;
840 }
841#endif
842
843 align = pci_resource_alignment(dev, r);
844 order = __ffs(align) - 20;
845 if (order > 11) {
846 dev_warn(&dev->dev, "disabling BAR %d: %pR "
847 "(bad alignment %#llx)\n", i, r,
848 (unsigned long long) align);
849 r->flags = 0;
850 continue;
851 }
852 size += r_size;
853 if (order < 0)
854 order = 0;
855
856
857 if (r_size == align)
858 aligns[order] += align;
859 if (order > max_order)
860 max_order = order;
861 mem64_mask &= r->flags & IORESOURCE_MEM_64;
862
863 if (realloc_head)
864 children_add_size += get_res_add_size(realloc_head, r);
865 }
866 }
867 align = 0;
868 min_align = 0;
869 for (order = 0; order <= max_order; order++) {
870 resource_size_t align1 = 1;
871
872 align1 <<= (order + 20);
873
874 if (!align)
875 min_align = align1;
876 else if (ALIGN(align + min_align, min_align) < align1)
877 min_align = align1 >> 1;
878 align += aligns[order];
879 }
880 size0 = calculate_memsize(size, min_size, 0, resource_size(b_res), min_align);
881 if (children_add_size > add_size)
882 add_size = children_add_size;
883 size1 = (!realloc_head || (realloc_head && !add_size)) ? size0 :
884 calculate_memsize(size, min_size, add_size,
885 resource_size(b_res), min_align);
886 if (!size0 && !size1) {
887 if (b_res->start || b_res->end)
888 dev_info(&bus->self->dev, "disabling bridge window "
889 "%pR to %pR (unused)\n", b_res,
890 &bus->busn_res);
891 b_res->flags = 0;
892 return 1;
893 }
894 b_res->start = min_align;
895 b_res->end = size0 + min_align - 1;
896 b_res->flags |= IORESOURCE_STARTALIGN | mem64_mask;
897 if (size1 > size0 && realloc_head) {
898 add_to_list(realloc_head, bus->self, b_res, size1-size0, min_align);
899 dev_printk(KERN_DEBUG, &bus->self->dev, "bridge window "
900 "%pR to %pR add_size %llx\n", b_res,
901 &bus->busn_res, (unsigned long long)size1-size0);
902 }
903 return 1;
904}
905
906unsigned long pci_cardbus_resource_alignment(struct resource *res)
907{
908 if (res->flags & IORESOURCE_IO)
909 return pci_cardbus_io_size;
910 if (res->flags & IORESOURCE_MEM)
911 return pci_cardbus_mem_size;
912 return 0;
913}
914
915static void pci_bus_size_cardbus(struct pci_bus *bus,
916 struct list_head *realloc_head)
917{
918 struct pci_dev *bridge = bus->self;
919 struct resource *b_res = &bridge->resource[PCI_BRIDGE_RESOURCES];
920 resource_size_t b_res_3_size = pci_cardbus_mem_size * 2;
921 u16 ctrl;
922
923 if (b_res[0].parent)
924 goto handle_b_res_1;
925
926
927
928
929 b_res[0].start = pci_cardbus_io_size;
930 b_res[0].end = b_res[0].start + pci_cardbus_io_size - 1;
931 b_res[0].flags |= IORESOURCE_IO | IORESOURCE_STARTALIGN;
932 if (realloc_head) {
933 b_res[0].end -= pci_cardbus_io_size;
934 add_to_list(realloc_head, bridge, b_res, pci_cardbus_io_size,
935 pci_cardbus_io_size);
936 }
937
938handle_b_res_1:
939 if (b_res[1].parent)
940 goto handle_b_res_2;
941 b_res[1].start = pci_cardbus_io_size;
942 b_res[1].end = b_res[1].start + pci_cardbus_io_size - 1;
943 b_res[1].flags |= IORESOURCE_IO | IORESOURCE_STARTALIGN;
944 if (realloc_head) {
945 b_res[1].end -= pci_cardbus_io_size;
946 add_to_list(realloc_head, bridge, b_res+1, pci_cardbus_io_size,
947 pci_cardbus_io_size);
948 }
949
950handle_b_res_2:
951
952 pci_read_config_word(bridge, PCI_CB_BRIDGE_CONTROL, &ctrl);
953 if (ctrl & PCI_CB_BRIDGE_CTL_PREFETCH_MEM1) {
954 ctrl &= ~PCI_CB_BRIDGE_CTL_PREFETCH_MEM1;
955 pci_write_config_word(bridge, PCI_CB_BRIDGE_CONTROL, ctrl);
956 pci_read_config_word(bridge, PCI_CB_BRIDGE_CONTROL, &ctrl);
957 }
958
959
960
961
962
963 pci_read_config_word(bridge, PCI_CB_BRIDGE_CONTROL, &ctrl);
964 if (!(ctrl & PCI_CB_BRIDGE_CTL_PREFETCH_MEM0)) {
965 ctrl |= PCI_CB_BRIDGE_CTL_PREFETCH_MEM0;
966 pci_write_config_word(bridge, PCI_CB_BRIDGE_CONTROL, ctrl);
967 pci_read_config_word(bridge, PCI_CB_BRIDGE_CONTROL, &ctrl);
968 }
969
970 if (b_res[2].parent)
971 goto handle_b_res_3;
972
973
974
975
976
977 if (ctrl & PCI_CB_BRIDGE_CTL_PREFETCH_MEM0) {
978 b_res[2].start = pci_cardbus_mem_size;
979 b_res[2].end = b_res[2].start + pci_cardbus_mem_size - 1;
980 b_res[2].flags |= IORESOURCE_MEM | IORESOURCE_PREFETCH |
981 IORESOURCE_STARTALIGN;
982 if (realloc_head) {
983 b_res[2].end -= pci_cardbus_mem_size;
984 add_to_list(realloc_head, bridge, b_res+2,
985 pci_cardbus_mem_size, pci_cardbus_mem_size);
986 }
987
988
989 b_res_3_size = pci_cardbus_mem_size;
990 }
991
992handle_b_res_3:
993 if (b_res[3].parent)
994 goto handle_done;
995 b_res[3].start = pci_cardbus_mem_size;
996 b_res[3].end = b_res[3].start + b_res_3_size - 1;
997 b_res[3].flags |= IORESOURCE_MEM | IORESOURCE_STARTALIGN;
998 if (realloc_head) {
999 b_res[3].end -= b_res_3_size;
1000 add_to_list(realloc_head, bridge, b_res+3, b_res_3_size,
1001 pci_cardbus_mem_size);
1002 }
1003
1004handle_done:
1005 ;
1006}
1007
1008void __ref __pci_bus_size_bridges(struct pci_bus *bus,
1009 struct list_head *realloc_head)
1010{
1011 struct pci_dev *dev;
1012 unsigned long mask, prefmask;
1013 resource_size_t additional_mem_size = 0, additional_io_size = 0;
1014
1015 list_for_each_entry(dev, &bus->devices, bus_list) {
1016 struct pci_bus *b = dev->subordinate;
1017 if (!b)
1018 continue;
1019
1020 switch (dev->class >> 8) {
1021 case PCI_CLASS_BRIDGE_CARDBUS:
1022 pci_bus_size_cardbus(b, realloc_head);
1023 break;
1024
1025 case PCI_CLASS_BRIDGE_PCI:
1026 default:
1027 __pci_bus_size_bridges(b, realloc_head);
1028 break;
1029 }
1030 }
1031
1032
1033 if (!bus->self)
1034 return;
1035
1036 switch (bus->self->class >> 8) {
1037 case PCI_CLASS_BRIDGE_CARDBUS:
1038
1039 break;
1040
1041 case PCI_CLASS_BRIDGE_PCI:
1042 pci_bridge_check_ranges(bus);
1043 if (bus->self->is_hotplug_bridge) {
1044 additional_io_size = pci_hotplug_io_size;
1045 additional_mem_size = pci_hotplug_mem_size;
1046 }
1047
1048
1049
1050 default:
1051 pbus_size_io(bus, realloc_head ? 0 : additional_io_size,
1052 additional_io_size, realloc_head);
1053
1054
1055
1056
1057
1058 mask = IORESOURCE_MEM;
1059 prefmask = IORESOURCE_MEM | IORESOURCE_PREFETCH;
1060 if (pbus_size_mem(bus, prefmask, prefmask,
1061 realloc_head ? 0 : additional_mem_size,
1062 additional_mem_size, realloc_head))
1063 mask = prefmask;
1064 else
1065 additional_mem_size += additional_mem_size;
1066 pbus_size_mem(bus, mask, IORESOURCE_MEM,
1067 realloc_head ? 0 : additional_mem_size,
1068 additional_mem_size, realloc_head);
1069 break;
1070 }
1071}
1072
1073void __ref pci_bus_size_bridges(struct pci_bus *bus)
1074{
1075 __pci_bus_size_bridges(bus, NULL);
1076}
1077EXPORT_SYMBOL(pci_bus_size_bridges);
1078
1079static void __ref __pci_bus_assign_resources(const struct pci_bus *bus,
1080 struct list_head *realloc_head,
1081 struct list_head *fail_head)
1082{
1083 struct pci_bus *b;
1084 struct pci_dev *dev;
1085
1086 pbus_assign_resources_sorted(bus, realloc_head, fail_head);
1087
1088 list_for_each_entry(dev, &bus->devices, bus_list) {
1089 b = dev->subordinate;
1090 if (!b)
1091 continue;
1092
1093 __pci_bus_assign_resources(b, realloc_head, fail_head);
1094
1095 switch (dev->class >> 8) {
1096 case PCI_CLASS_BRIDGE_PCI:
1097 if (!pci_is_enabled(dev))
1098 pci_setup_bridge(b);
1099 break;
1100
1101 case PCI_CLASS_BRIDGE_CARDBUS:
1102 pci_setup_cardbus(b);
1103 break;
1104
1105 default:
1106 dev_info(&dev->dev, "not setting up bridge for bus "
1107 "%04x:%02x\n", pci_domain_nr(b), b->number);
1108 break;
1109 }
1110 }
1111}
1112
1113void __ref pci_bus_assign_resources(const struct pci_bus *bus)
1114{
1115 __pci_bus_assign_resources(bus, NULL, NULL);
1116}
1117EXPORT_SYMBOL(pci_bus_assign_resources);
1118
1119static void __ref __pci_bridge_assign_resources(const struct pci_dev *bridge,
1120 struct list_head *add_head,
1121 struct list_head *fail_head)
1122{
1123 struct pci_bus *b;
1124
1125 pdev_assign_resources_sorted((struct pci_dev *)bridge,
1126 add_head, fail_head);
1127
1128 b = bridge->subordinate;
1129 if (!b)
1130 return;
1131
1132 __pci_bus_assign_resources(b, add_head, fail_head);
1133
1134 switch (bridge->class >> 8) {
1135 case PCI_CLASS_BRIDGE_PCI:
1136 pci_setup_bridge(b);
1137 break;
1138
1139 case PCI_CLASS_BRIDGE_CARDBUS:
1140 pci_setup_cardbus(b);
1141 break;
1142
1143 default:
1144 dev_info(&bridge->dev, "not setting up bridge for bus "
1145 "%04x:%02x\n", pci_domain_nr(b), b->number);
1146 break;
1147 }
1148}
1149static void pci_bridge_release_resources(struct pci_bus *bus,
1150 unsigned long type)
1151{
1152 int idx;
1153 bool changed = false;
1154 struct pci_dev *dev;
1155 struct resource *r;
1156 unsigned long type_mask = IORESOURCE_IO | IORESOURCE_MEM |
1157 IORESOURCE_PREFETCH;
1158
1159 dev = bus->self;
1160 for (idx = PCI_BRIDGE_RESOURCES; idx <= PCI_BRIDGE_RESOURCE_END;
1161 idx++) {
1162 r = &dev->resource[idx];
1163 if ((r->flags & type_mask) != type)
1164 continue;
1165 if (!r->parent)
1166 continue;
1167
1168
1169
1170
1171 release_child_resources(r);
1172 if (!release_resource(r)) {
1173 dev_printk(KERN_DEBUG, &dev->dev,
1174 "resource %d %pR released\n", idx, r);
1175
1176 r->end = resource_size(r) - 1;
1177 r->start = 0;
1178 r->flags = 0;
1179 changed = true;
1180 }
1181 }
1182
1183 if (changed) {
1184
1185 if (type & IORESOURCE_PREFETCH)
1186 type = IORESOURCE_PREFETCH;
1187 __pci_setup_bridge(bus, type);
1188 }
1189}
1190
1191enum release_type {
1192 leaf_only,
1193 whole_subtree,
1194};
1195
1196
1197
1198
1199static void __ref pci_bus_release_bridge_resources(struct pci_bus *bus,
1200 unsigned long type,
1201 enum release_type rel_type)
1202{
1203 struct pci_dev *dev;
1204 bool is_leaf_bridge = true;
1205
1206 list_for_each_entry(dev, &bus->devices, bus_list) {
1207 struct pci_bus *b = dev->subordinate;
1208 if (!b)
1209 continue;
1210
1211 is_leaf_bridge = false;
1212
1213 if ((dev->class >> 8) != PCI_CLASS_BRIDGE_PCI)
1214 continue;
1215
1216 if (rel_type == whole_subtree)
1217 pci_bus_release_bridge_resources(b, type,
1218 whole_subtree);
1219 }
1220
1221 if (pci_is_root_bus(bus))
1222 return;
1223
1224 if ((bus->self->class >> 8) != PCI_CLASS_BRIDGE_PCI)
1225 return;
1226
1227 if ((rel_type == whole_subtree) || is_leaf_bridge)
1228 pci_bridge_release_resources(bus, type);
1229}
1230
1231static void pci_bus_dump_res(struct pci_bus *bus)
1232{
1233 struct resource *res;
1234 int i;
1235
1236 pci_bus_for_each_resource(bus, res, i) {
1237 if (!res || !res->end || !res->flags)
1238 continue;
1239
1240 dev_printk(KERN_DEBUG, &bus->dev, "resource %d %pR\n", i, res);
1241 }
1242}
1243
1244static void pci_bus_dump_resources(struct pci_bus *bus)
1245{
1246 struct pci_bus *b;
1247 struct pci_dev *dev;
1248
1249
1250 pci_bus_dump_res(bus);
1251
1252 list_for_each_entry(dev, &bus->devices, bus_list) {
1253 b = dev->subordinate;
1254 if (!b)
1255 continue;
1256
1257 pci_bus_dump_resources(b);
1258 }
1259}
1260
1261static int __init pci_bus_get_depth(struct pci_bus *bus)
1262{
1263 int depth = 0;
1264 struct pci_dev *dev;
1265
1266 list_for_each_entry(dev, &bus->devices, bus_list) {
1267 int ret;
1268 struct pci_bus *b = dev->subordinate;
1269 if (!b)
1270 continue;
1271
1272 ret = pci_bus_get_depth(b);
1273 if (ret + 1 > depth)
1274 depth = ret + 1;
1275 }
1276
1277 return depth;
1278}
1279static int __init pci_get_max_depth(void)
1280{
1281 int depth = 0;
1282 struct pci_bus *bus;
1283
1284 list_for_each_entry(bus, &pci_root_buses, node) {
1285 int ret;
1286
1287 ret = pci_bus_get_depth(bus);
1288 if (ret > depth)
1289 depth = ret;
1290 }
1291
1292 return depth;
1293}
1294
1295
1296
1297
1298
1299
1300
1301
1302enum enable_type {
1303 undefined = -1,
1304 user_disabled,
1305 auto_disabled,
1306 user_enabled,
1307 auto_enabled,
1308};
1309
1310static enum enable_type pci_realloc_enable __initdata = undefined;
1311void __init pci_realloc_get_opt(char *str)
1312{
1313 if (!strncmp(str, "off", 3))
1314 pci_realloc_enable = user_disabled;
1315 else if (!strncmp(str, "on", 2))
1316 pci_realloc_enable = user_enabled;
1317}
1318static bool __init pci_realloc_enabled(void)
1319{
1320 return pci_realloc_enable >= user_enabled;
1321}
1322
1323static void __init pci_realloc_detect(void)
1324{
1325#if defined(CONFIG_PCI_IOV) && defined(CONFIG_PCI_REALLOC_ENABLE_AUTO)
1326 struct pci_dev *dev = NULL;
1327
1328 if (pci_realloc_enable != undefined)
1329 return;
1330
1331 for_each_pci_dev(dev) {
1332 int i;
1333
1334 for (i = PCI_IOV_RESOURCES; i <= PCI_IOV_RESOURCE_END; i++) {
1335 struct resource *r = &dev->resource[i];
1336
1337
1338 if (r->flags && !r->start) {
1339 pci_realloc_enable = auto_enabled;
1340
1341 return;
1342 }
1343 }
1344 }
1345#endif
1346}
1347
1348
1349
1350
1351
1352
1353void __init
1354pci_assign_unassigned_resources(void)
1355{
1356 struct pci_bus *bus;
1357 LIST_HEAD(realloc_head);
1358
1359 struct list_head *add_list = NULL;
1360 int tried_times = 0;
1361 enum release_type rel_type = leaf_only;
1362 LIST_HEAD(fail_head);
1363 struct pci_dev_resource *fail_res;
1364 unsigned long type_mask = IORESOURCE_IO | IORESOURCE_MEM |
1365 IORESOURCE_PREFETCH;
1366 int pci_try_num = 1;
1367
1368
1369 pci_realloc_detect();
1370 if (pci_realloc_enabled()) {
1371 int max_depth = pci_get_max_depth();
1372
1373 pci_try_num = max_depth + 1;
1374 printk(KERN_DEBUG "PCI: max bus depth: %d pci_try_num: %d\n",
1375 max_depth, pci_try_num);
1376 }
1377
1378again:
1379
1380
1381
1382
1383 if (tried_times + 1 == pci_try_num)
1384 add_list = &realloc_head;
1385
1386
1387 list_for_each_entry(bus, &pci_root_buses, node)
1388 __pci_bus_size_bridges(bus, add_list);
1389
1390
1391 list_for_each_entry(bus, &pci_root_buses, node)
1392 __pci_bus_assign_resources(bus, add_list, &fail_head);
1393 if (add_list)
1394 BUG_ON(!list_empty(add_list));
1395 tried_times++;
1396
1397
1398 if (list_empty(&fail_head))
1399 goto enable_and_dump;
1400
1401 if (tried_times >= pci_try_num) {
1402 if (pci_realloc_enable == undefined)
1403 printk(KERN_INFO "Some PCI device resources are unassigned, try booting with pci=realloc\n");
1404 else if (pci_realloc_enable == auto_enabled)
1405 printk(KERN_INFO "Automatically enabled pci realloc, if you have problem, try booting with pci=realloc=off\n");
1406
1407 free_list(&fail_head);
1408 goto enable_and_dump;
1409 }
1410
1411 printk(KERN_DEBUG "PCI: No. %d try to assign unassigned res\n",
1412 tried_times + 1);
1413
1414
1415 if ((tried_times + 1) > 2)
1416 rel_type = whole_subtree;
1417
1418
1419
1420
1421
1422 list_for_each_entry(fail_res, &fail_head, list) {
1423 bus = fail_res->dev->bus;
1424 pci_bus_release_bridge_resources(bus,
1425 fail_res->flags & type_mask,
1426 rel_type);
1427 }
1428
1429 list_for_each_entry(fail_res, &fail_head, list) {
1430 struct resource *res = fail_res->res;
1431
1432 res->start = fail_res->start;
1433 res->end = fail_res->end;
1434 res->flags = fail_res->flags;
1435 if (fail_res->dev->subordinate)
1436 res->flags = 0;
1437 }
1438 free_list(&fail_head);
1439
1440 goto again;
1441
1442enable_and_dump:
1443
1444 list_for_each_entry(bus, &pci_root_buses, node)
1445 pci_enable_bridges(bus);
1446
1447
1448 list_for_each_entry(bus, &pci_root_buses, node)
1449 pci_bus_dump_resources(bus);
1450}
1451
1452void pci_assign_unassigned_bridge_resources(struct pci_dev *bridge)
1453{
1454 struct pci_bus *parent = bridge->subordinate;
1455 LIST_HEAD(add_list);
1456
1457 int tried_times = 0;
1458 LIST_HEAD(fail_head);
1459 struct pci_dev_resource *fail_res;
1460 int retval;
1461 unsigned long type_mask = IORESOURCE_IO | IORESOURCE_MEM |
1462 IORESOURCE_PREFETCH;
1463
1464again:
1465 __pci_bus_size_bridges(parent, &add_list);
1466 __pci_bridge_assign_resources(bridge, &add_list, &fail_head);
1467 BUG_ON(!list_empty(&add_list));
1468 tried_times++;
1469
1470 if (list_empty(&fail_head))
1471 goto enable_all;
1472
1473 if (tried_times >= 2) {
1474
1475 free_list(&fail_head);
1476 goto enable_all;
1477 }
1478
1479 printk(KERN_DEBUG "PCI: No. %d try to assign unassigned res\n",
1480 tried_times + 1);
1481
1482
1483
1484
1485
1486 list_for_each_entry(fail_res, &fail_head, list) {
1487 struct pci_bus *bus = fail_res->dev->bus;
1488 unsigned long flags = fail_res->flags;
1489
1490 pci_bus_release_bridge_resources(bus, flags & type_mask,
1491 whole_subtree);
1492 }
1493
1494 list_for_each_entry(fail_res, &fail_head, list) {
1495 struct resource *res = fail_res->res;
1496
1497 res->start = fail_res->start;
1498 res->end = fail_res->end;
1499 res->flags = fail_res->flags;
1500 if (fail_res->dev->subordinate)
1501 res->flags = 0;
1502 }
1503 free_list(&fail_head);
1504
1505 goto again;
1506
1507enable_all:
1508 retval = pci_reenable_device(bridge);
1509 pci_set_master(bridge);
1510 pci_enable_bridges(parent);
1511}
1512EXPORT_SYMBOL_GPL(pci_assign_unassigned_bridge_resources);
1513
1514#ifdef CONFIG_HOTPLUG
1515
1516
1517
1518
1519
1520
1521
1522
1523
1524unsigned int __ref pci_rescan_bus(struct pci_bus *bus)
1525{
1526 unsigned int max;
1527 struct pci_dev *dev;
1528 LIST_HEAD(add_list);
1529
1530
1531 max = pci_scan_child_bus(bus);
1532
1533 down_read(&pci_bus_sem);
1534 list_for_each_entry(dev, &bus->devices, bus_list)
1535 if (dev->hdr_type == PCI_HEADER_TYPE_BRIDGE ||
1536 dev->hdr_type == PCI_HEADER_TYPE_CARDBUS)
1537 if (dev->subordinate)
1538 __pci_bus_size_bridges(dev->subordinate,
1539 &add_list);
1540 up_read(&pci_bus_sem);
1541 __pci_bus_assign_resources(bus, &add_list, NULL);
1542 BUG_ON(!list_empty(&add_list));
1543
1544 pci_enable_bridges(bus);
1545 pci_bus_add_devices(bus);
1546
1547 return max;
1548}
1549EXPORT_SYMBOL_GPL(pci_rescan_bus);
1550#endif
1551