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