1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20#include <linux/kernel.h>
21#include <linux/export.h>
22#include <linux/pci.h>
23#include <linux/errno.h>
24#include <linux/ioport.h>
25#include <linux/cache.h>
26#include <linux/slab.h>
27#include "pci.h"
28
29static void pci_std_update_resource(struct pci_dev *dev, int resno)
30{
31 struct pci_bus_region region;
32 bool disable;
33 u16 cmd;
34 u32 new, check, mask;
35 int reg;
36 struct resource *res = dev->resource + resno;
37
38
39 if (dev->is_virtfn)
40 return;
41
42
43
44
45
46 if (!res->flags)
47 return;
48
49 if (res->flags & IORESOURCE_UNSET)
50 return;
51
52
53
54
55
56
57 if (res->flags & IORESOURCE_PCI_FIXED)
58 return;
59
60 pcibios_resource_to_bus(dev->bus, ®ion, res);
61 new = region.start;
62
63 if (res->flags & IORESOURCE_IO) {
64 mask = (u32)PCI_BASE_ADDRESS_IO_MASK;
65 new |= res->flags & ~PCI_BASE_ADDRESS_IO_MASK;
66 } else if (resno == PCI_ROM_RESOURCE) {
67 mask = PCI_ROM_ADDRESS_MASK;
68 } else {
69 mask = (u32)PCI_BASE_ADDRESS_MEM_MASK;
70 new |= res->flags & ~PCI_BASE_ADDRESS_MEM_MASK;
71 }
72
73 if (resno < PCI_ROM_RESOURCE) {
74 reg = PCI_BASE_ADDRESS_0 + 4 * resno;
75 } else if (resno == PCI_ROM_RESOURCE) {
76
77
78
79
80
81
82 if (!(res->flags & IORESOURCE_ROM_ENABLE))
83 return;
84
85 reg = dev->rom_base_reg;
86 new |= PCI_ROM_ADDRESS_ENABLE;
87 } else
88 return;
89
90
91
92
93
94
95 disable = (res->flags & IORESOURCE_MEM_64) && !dev->mmio_always_on;
96 if (disable) {
97 pci_read_config_word(dev, PCI_COMMAND, &cmd);
98 pci_write_config_word(dev, PCI_COMMAND,
99 cmd & ~PCI_COMMAND_MEMORY);
100 }
101
102 pci_write_config_dword(dev, reg, new);
103 pci_read_config_dword(dev, reg, &check);
104
105 if ((new ^ check) & mask) {
106 dev_err(&dev->dev, "BAR %d: error updating (%#08x != %#08x)\n",
107 resno, new, check);
108 }
109
110 if (res->flags & IORESOURCE_MEM_64) {
111 new = region.start >> 16 >> 16;
112 pci_write_config_dword(dev, reg + 4, new);
113 pci_read_config_dword(dev, reg + 4, &check);
114 if (check != new) {
115 dev_err(&dev->dev, "BAR %d: error updating (high %#08x != %#08x)\n",
116 resno, new, check);
117 }
118 }
119
120 if (disable)
121 pci_write_config_word(dev, PCI_COMMAND, cmd);
122}
123
124void pci_update_resource(struct pci_dev *dev, int resno)
125{
126 if (resno <= PCI_ROM_RESOURCE)
127 pci_std_update_resource(dev, resno);
128#ifdef CONFIG_PCI_IOV
129 else if (resno >= PCI_IOV_RESOURCES && resno <= PCI_IOV_RESOURCE_END)
130 pci_iov_update_resource(dev, resno);
131#endif
132}
133
134int pci_claim_resource(struct pci_dev *dev, int resource)
135{
136 struct resource *res = &dev->resource[resource];
137 struct resource *root, *conflict;
138
139 if (res->flags & IORESOURCE_UNSET) {
140 dev_info(&dev->dev, "can't claim BAR %d %pR: no address assigned\n",
141 resource, res);
142 return -EINVAL;
143 }
144
145
146
147
148
149
150 if (res->flags & IORESOURCE_ROM_SHADOW)
151 return 0;
152
153 root = pci_find_parent_resource(dev, res);
154 if (!root) {
155 dev_info(&dev->dev, "can't claim BAR %d %pR: no compatible bridge window\n",
156 resource, res);
157 res->flags |= IORESOURCE_UNSET;
158 return -EINVAL;
159 }
160
161 conflict = request_resource_conflict(root, res);
162 if (conflict) {
163 dev_info(&dev->dev, "can't claim BAR %d %pR: address conflict with %s %pR\n",
164 resource, res, conflict->name, conflict);
165 res->flags |= IORESOURCE_UNSET;
166 return -EBUSY;
167 }
168
169 return 0;
170}
171EXPORT_SYMBOL(pci_claim_resource);
172
173void pci_disable_bridge_window(struct pci_dev *dev)
174{
175 dev_info(&dev->dev, "disabling bridge mem windows\n");
176
177
178 pci_write_config_dword(dev, PCI_MEMORY_BASE, 0x0000fff0);
179
180
181 pci_write_config_dword(dev, PCI_PREF_LIMIT_UPPER32, 0);
182 pci_write_config_dword(dev, PCI_PREF_MEMORY_BASE, 0x0000fff0);
183 pci_write_config_dword(dev, PCI_PREF_BASE_UPPER32, 0xffffffff);
184}
185
186
187
188
189
190
191
192
193
194
195resource_size_t __weak pcibios_retrieve_fw_addr(struct pci_dev *dev, int idx)
196{
197 return 0;
198}
199
200static int pci_revert_fw_address(struct resource *res, struct pci_dev *dev,
201 int resno, resource_size_t size)
202{
203 struct resource *root, *conflict;
204 resource_size_t fw_addr, start, end;
205
206 fw_addr = pcibios_retrieve_fw_addr(dev, resno);
207 if (!fw_addr)
208 return -ENOMEM;
209
210 start = res->start;
211 end = res->end;
212 res->start = fw_addr;
213 res->end = res->start + size - 1;
214 res->flags &= ~IORESOURCE_UNSET;
215
216 root = pci_find_parent_resource(dev, res);
217 if (!root) {
218 if (res->flags & IORESOURCE_IO)
219 root = &ioport_resource;
220 else
221 root = &iomem_resource;
222 }
223
224 dev_info(&dev->dev, "BAR %d: trying firmware assignment %pR\n",
225 resno, res);
226 conflict = request_resource_conflict(root, res);
227 if (conflict) {
228 dev_info(&dev->dev, "BAR %d: %pR conflicts with %s %pR\n",
229 resno, res, conflict->name, conflict);
230 res->start = start;
231 res->end = end;
232 res->flags |= IORESOURCE_UNSET;
233 return -EBUSY;
234 }
235 return 0;
236}
237
238
239
240
241
242
243resource_size_t __weak pcibios_align_resource(void *data,
244 const struct resource *res,
245 resource_size_t size,
246 resource_size_t align)
247{
248 return res->start;
249}
250
251static int __pci_assign_resource(struct pci_bus *bus, struct pci_dev *dev,
252 int resno, resource_size_t size, resource_size_t align)
253{
254 struct resource *res = dev->resource + resno;
255 resource_size_t min;
256 int ret;
257
258 min = (res->flags & IORESOURCE_IO) ? PCIBIOS_MIN_IO : PCIBIOS_MIN_MEM;
259
260
261
262
263
264
265
266
267 ret = pci_bus_alloc_resource(bus, res, size, align, min,
268 IORESOURCE_PREFETCH | IORESOURCE_MEM_64,
269 pcibios_align_resource, dev);
270 if (ret == 0)
271 return 0;
272
273
274
275
276
277 if ((res->flags & (IORESOURCE_PREFETCH | IORESOURCE_MEM_64)) ==
278 (IORESOURCE_PREFETCH | IORESOURCE_MEM_64)) {
279 ret = pci_bus_alloc_resource(bus, res, size, align, min,
280 IORESOURCE_PREFETCH,
281 pcibios_align_resource, dev);
282 if (ret == 0)
283 return 0;
284 }
285
286
287
288
289
290
291
292 if (res->flags & (IORESOURCE_PREFETCH | IORESOURCE_MEM_64))
293 ret = pci_bus_alloc_resource(bus, res, size, align, min, 0,
294 pcibios_align_resource, dev);
295
296 return ret;
297}
298
299static int _pci_assign_resource(struct pci_dev *dev, int resno,
300 resource_size_t size, resource_size_t min_align)
301{
302 struct pci_bus *bus;
303 int ret;
304
305 bus = dev->bus;
306 while ((ret = __pci_assign_resource(bus, dev, resno, size, min_align))) {
307 if (!bus->parent || !bus->self->transparent)
308 break;
309 bus = bus->parent;
310 }
311
312 return ret;
313}
314
315int pci_assign_resource(struct pci_dev *dev, int resno)
316{
317 struct resource *res = dev->resource + resno;
318 resource_size_t align, size;
319 int ret;
320
321 if (res->flags & IORESOURCE_PCI_FIXED)
322 return 0;
323
324 res->flags |= IORESOURCE_UNSET;
325 align = pci_resource_alignment(dev, res);
326 if (!align) {
327 dev_info(&dev->dev, "BAR %d: can't assign %pR (bogus alignment)\n",
328 resno, res);
329 return -EINVAL;
330 }
331
332 size = resource_size(res);
333 ret = _pci_assign_resource(dev, resno, size, align);
334
335
336
337
338
339
340 if (ret < 0) {
341 dev_info(&dev->dev, "BAR %d: no space for %pR\n", resno, res);
342 ret = pci_revert_fw_address(res, dev, resno, size);
343 }
344
345 if (ret < 0) {
346 dev_info(&dev->dev, "BAR %d: failed to assign %pR\n", resno,
347 res);
348 return ret;
349 }
350
351 res->flags &= ~IORESOURCE_UNSET;
352 res->flags &= ~IORESOURCE_STARTALIGN;
353 dev_info(&dev->dev, "BAR %d: assigned %pR\n", resno, res);
354 if (resno < PCI_BRIDGE_RESOURCES)
355 pci_update_resource(dev, resno);
356
357 return 0;
358}
359EXPORT_SYMBOL(pci_assign_resource);
360
361int pci_reassign_resource(struct pci_dev *dev, int resno, resource_size_t addsize,
362 resource_size_t min_align)
363{
364 struct resource *res = dev->resource + resno;
365 unsigned long flags;
366 resource_size_t new_size;
367 int ret;
368
369 if (res->flags & IORESOURCE_PCI_FIXED)
370 return 0;
371
372 flags = res->flags;
373 res->flags |= IORESOURCE_UNSET;
374 if (!res->parent) {
375 dev_info(&dev->dev, "BAR %d: can't reassign an unassigned resource %pR\n",
376 resno, res);
377 return -EINVAL;
378 }
379
380
381 new_size = resource_size(res) + addsize;
382 ret = _pci_assign_resource(dev, resno, new_size, min_align);
383 if (ret) {
384 res->flags = flags;
385 dev_info(&dev->dev, "BAR %d: %pR (failed to expand by %#llx)\n",
386 resno, res, (unsigned long long) addsize);
387 return ret;
388 }
389
390 res->flags &= ~IORESOURCE_UNSET;
391 res->flags &= ~IORESOURCE_STARTALIGN;
392 dev_info(&dev->dev, "BAR %d: reassigned %pR (expanded by %#llx)\n",
393 resno, res, (unsigned long long) addsize);
394 if (resno < PCI_BRIDGE_RESOURCES)
395 pci_update_resource(dev, resno);
396
397 return 0;
398}
399
400int pci_enable_resources(struct pci_dev *dev, int mask)
401{
402 u16 cmd, old_cmd;
403 int i;
404 struct resource *r;
405
406 pci_read_config_word(dev, PCI_COMMAND, &cmd);
407 old_cmd = cmd;
408
409 for (i = 0; i < PCI_NUM_RESOURCES; i++) {
410 if (!(mask & (1 << i)))
411 continue;
412
413 r = &dev->resource[i];
414
415 if (!(r->flags & (IORESOURCE_IO | IORESOURCE_MEM)))
416 continue;
417 if ((i == PCI_ROM_RESOURCE) &&
418 (!(r->flags & IORESOURCE_ROM_ENABLE)))
419 continue;
420
421 if (r->flags & IORESOURCE_UNSET) {
422 dev_err(&dev->dev, "can't enable device: BAR %d %pR not assigned\n",
423 i, r);
424 return -EINVAL;
425 }
426
427 if (!r->parent) {
428 dev_err(&dev->dev, "can't enable device: BAR %d %pR not claimed\n",
429 i, r);
430 return -EINVAL;
431 }
432
433 if (r->flags & IORESOURCE_IO)
434 cmd |= PCI_COMMAND_IO;
435 if (r->flags & IORESOURCE_MEM)
436 cmd |= PCI_COMMAND_MEMORY;
437 }
438
439 if (cmd != old_cmd) {
440 dev_info(&dev->dev, "enabling device (%04x -> %04x)\n",
441 old_cmd, cmd);
442 pci_write_config_word(dev, PCI_COMMAND, cmd);
443 }
444 return 0;
445}
446