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