1
2
3
4
5
6
7
8
9
10#include <linux/module.h>
11#include <linux/kernel.h>
12#include <linux/pci.h>
13#include <linux/errno.h>
14#include <linux/ioport.h>
15#include <linux/proc_fs.h>
16#include <linux/init.h>
17#include <linux/slab.h>
18
19#include "pci.h"
20
21void pci_add_resource_offset(struct list_head *resources, struct resource *res,
22 resource_size_t offset)
23{
24 struct pci_host_bridge_window *window;
25
26 window = kzalloc(sizeof(struct pci_host_bridge_window), GFP_KERNEL);
27 if (!window) {
28 printk(KERN_ERR "PCI: can't add host bridge window %pR\n", res);
29 return;
30 }
31
32 window->res = res;
33 window->offset = offset;
34 list_add_tail(&window->list, resources);
35}
36EXPORT_SYMBOL(pci_add_resource_offset);
37
38void pci_add_resource(struct list_head *resources, struct resource *res)
39{
40 pci_add_resource_offset(resources, res, 0);
41}
42EXPORT_SYMBOL(pci_add_resource);
43
44void pci_free_resource_list(struct list_head *resources)
45{
46 struct pci_host_bridge_window *window, *tmp;
47
48 list_for_each_entry_safe(window, tmp, resources, list) {
49 list_del(&window->list);
50 kfree(window);
51 }
52}
53EXPORT_SYMBOL(pci_free_resource_list);
54
55void pci_bus_add_resource(struct pci_bus *bus, struct resource *res,
56 unsigned int flags)
57{
58 struct pci_bus_resource *bus_res;
59
60 bus_res = kzalloc(sizeof(struct pci_bus_resource), GFP_KERNEL);
61 if (!bus_res) {
62 dev_err(&bus->dev, "can't add %pR resource\n", res);
63 return;
64 }
65
66 bus_res->res = res;
67 bus_res->flags = flags;
68 list_add_tail(&bus_res->list, &bus->resources);
69}
70
71struct resource *pci_bus_resource_n(const struct pci_bus *bus, int n)
72{
73 struct pci_bus_resource *bus_res;
74
75 if (n < PCI_BRIDGE_RESOURCE_NUM)
76 return bus->resource[n];
77
78 n -= PCI_BRIDGE_RESOURCE_NUM;
79 list_for_each_entry(bus_res, &bus->resources, list) {
80 if (n-- == 0)
81 return bus_res->res;
82 }
83 return NULL;
84}
85EXPORT_SYMBOL_GPL(pci_bus_resource_n);
86
87void pci_bus_remove_resources(struct pci_bus *bus)
88{
89 int i;
90 struct pci_bus_resource *bus_res, *tmp;
91
92 for (i = 0; i < PCI_BRIDGE_RESOURCE_NUM; i++)
93 bus->resource[i] = NULL;
94
95 list_for_each_entry_safe(bus_res, tmp, &bus->resources, list) {
96 list_del(&bus_res->list);
97 kfree(bus_res);
98 }
99}
100
101static struct pci_bus_region pci_32_bit = {0, 0xffffffffULL};
102#ifdef CONFIG_ARCH_DMA_ADDR_T_64BIT
103static struct pci_bus_region pci_64_bit = {0,
104 (dma_addr_t) 0xffffffffffffffffULL};
105static struct pci_bus_region pci_high = {(dma_addr_t) 0x100000000ULL,
106 (dma_addr_t) 0xffffffffffffffffULL};
107#endif
108
109
110
111
112
113
114
115static void pci_clip_resource_to_region(struct pci_bus *bus,
116 struct resource *res,
117 struct pci_bus_region *region)
118{
119 struct pci_bus_region r;
120
121 pcibios_resource_to_bus(bus, &r, res);
122 if (r.start < region->start)
123 r.start = region->start;
124 if (r.end > region->end)
125 r.end = region->end;
126
127 if (r.end < r.start)
128 res->end = res->start - 1;
129 else
130 pcibios_bus_to_resource(bus, res, &r);
131}
132
133static int pci_bus_alloc_from_region(struct pci_bus *bus, struct resource *res,
134 resource_size_t size, resource_size_t align,
135 resource_size_t min, unsigned int type_mask,
136 resource_size_t (*alignf)(void *,
137 const struct resource *,
138 resource_size_t,
139 resource_size_t),
140 void *alignf_data,
141 struct pci_bus_region *region)
142{
143 int i, ret;
144 struct resource *r, avail;
145 resource_size_t max;
146
147 type_mask |= IORESOURCE_IO | IORESOURCE_MEM;
148
149 pci_bus_for_each_resource(bus, r, i) {
150 if (!r)
151 continue;
152
153
154 if ((res->flags ^ r->flags) & type_mask)
155 continue;
156
157
158
159 if ((r->flags & IORESOURCE_PREFETCH) &&
160 !(res->flags & IORESOURCE_PREFETCH))
161 continue;
162
163 avail = *r;
164 pci_clip_resource_to_region(bus, &avail, region);
165
166
167
168
169
170
171
172 if (avail.start)
173 min = avail.start;
174
175 max = avail.end;
176
177
178 ret = allocate_resource(r, res, size, min, max,
179 align, alignf, alignf_data);
180 if (ret == 0)
181 return 0;
182 }
183 return -ENOMEM;
184}
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201int pci_bus_alloc_resource(struct pci_bus *bus, struct resource *res,
202 resource_size_t size, resource_size_t align,
203 resource_size_t min, unsigned int type_mask,
204 resource_size_t (*alignf)(void *,
205 const struct resource *,
206 resource_size_t,
207 resource_size_t),
208 void *alignf_data)
209{
210#ifdef CONFIG_ARCH_DMA_ADDR_T_64BIT
211 int rc;
212
213 if (res->flags & IORESOURCE_MEM_64) {
214 rc = pci_bus_alloc_from_region(bus, res, size, align, min,
215 type_mask, alignf, alignf_data,
216 &pci_high);
217 if (rc == 0)
218 return 0;
219
220 return pci_bus_alloc_from_region(bus, res, size, align, min,
221 type_mask, alignf, alignf_data,
222 &pci_64_bit);
223 }
224#endif
225
226 return pci_bus_alloc_from_region(bus, res, size, align, min,
227 type_mask, alignf, alignf_data,
228 &pci_32_bit);
229}
230
231void __weak pcibios_resource_survey_bus(struct pci_bus *bus) { }
232
233
234
235
236
237
238
239int pci_bus_add_device(struct pci_dev *dev)
240{
241 int retval;
242
243
244
245
246
247 pci_fixup_device(pci_fixup_final, dev);
248 pci_create_sysfs_dev_files(dev);
249 pci_proc_attach_device(dev);
250
251 dev->match_driver = true;
252 retval = device_attach(&dev->dev);
253 WARN_ON(retval < 0);
254
255 dev->is_added = 1;
256
257 return 0;
258}
259
260
261
262
263
264
265
266void pci_bus_add_devices(const struct pci_bus *bus)
267{
268 struct pci_dev *dev;
269 struct pci_bus *child;
270 int retval;
271
272 list_for_each_entry(dev, &bus->devices, bus_list) {
273
274 if (dev->is_added)
275 continue;
276 retval = pci_bus_add_device(dev);
277 if (retval)
278 dev_err(&dev->dev, "Error adding device (%d)\n",
279 retval);
280 }
281
282 list_for_each_entry(dev, &bus->devices, bus_list) {
283 BUG_ON(!dev->is_added);
284 child = dev->subordinate;
285 if (child)
286 pci_bus_add_devices(child);
287 }
288}
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303void pci_walk_bus(struct pci_bus *top, int (*cb)(struct pci_dev *, void *),
304 void *userdata)
305{
306 struct pci_dev *dev;
307 struct pci_bus *bus;
308 struct list_head *next;
309 int retval;
310
311 bus = top;
312 down_read(&pci_bus_sem);
313 next = top->devices.next;
314 for (;;) {
315 if (next == &bus->devices) {
316
317 if (bus == top)
318 break;
319 next = bus->self->bus_list.next;
320 bus = bus->self->bus;
321 continue;
322 }
323 dev = list_entry(next, struct pci_dev, bus_list);
324 if (dev->subordinate) {
325
326 next = dev->subordinate->devices.next;
327 bus = dev->subordinate;
328 } else
329 next = dev->bus_list.next;
330
331 retval = cb(dev, userdata);
332 if (retval)
333 break;
334 }
335 up_read(&pci_bus_sem);
336}
337EXPORT_SYMBOL_GPL(pci_walk_bus);
338
339struct pci_bus *pci_bus_get(struct pci_bus *bus)
340{
341 if (bus)
342 get_device(&bus->dev);
343 return bus;
344}
345EXPORT_SYMBOL(pci_bus_get);
346
347void pci_bus_put(struct pci_bus *bus)
348{
349 if (bus)
350 put_device(&bus->dev);
351}
352EXPORT_SYMBOL(pci_bus_put);
353
354EXPORT_SYMBOL(pci_bus_alloc_resource);
355EXPORT_SYMBOL_GPL(pci_bus_add_device);
356EXPORT_SYMBOL(pci_bus_add_devices);
357