blob: 2dbd96cce2d8469e82198ec3d29ae3604ef104de [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * drivers/pci/setup-res.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/* fixed for multiple pci buses, 1999 Andrea Arcangeli <andrea@suse.de> */
13
14/*
15 * Nov 2000, Ivan Kokshaysky <ink@jurassic.park.msu.ru>
16 * Resource sorting
17 */
18
19#include <linux/init.h>
20#include <linux/kernel.h>
21#include <linux/pci.h>
22#include <linux/errno.h>
23#include <linux/ioport.h>
24#include <linux/cache.h>
25#include <linux/slab.h>
26#include "pci.h"
27
28
Bjorn Helgaas80ccba12008-06-13 10:52:11 -060029void pci_update_resource(struct pci_dev *dev, struct resource *res, int resno)
Linus Torvalds1da177e2005-04-16 15:20:36 -070030{
31 struct pci_bus_region region;
32 u32 new, check, mask;
33 int reg;
34
Ralf Baechlefb0f2b42006-12-19 13:12:08 -080035 /*
36 * Ignore resources for unimplemented BARs and unused resource slots
37 * for 64 bit BARs.
38 */
Ivan Kokshayskycf7bee52005-08-07 13:49:59 +040039 if (!res->flags)
40 return;
41
Ralf Baechlefb0f2b42006-12-19 13:12:08 -080042 /*
43 * Ignore non-moveable resources. This might be legacy resources for
44 * which no functional BAR register exists or another important
Bjorn Helgaas80ccba12008-06-13 10:52:11 -060045 * system resource we shouldn't move around.
Ralf Baechlefb0f2b42006-12-19 13:12:08 -080046 */
47 if (res->flags & IORESOURCE_PCI_FIXED)
48 return;
49
Linus Torvalds1da177e2005-04-16 15:20:36 -070050 pcibios_resource_to_bus(dev, &region, res);
51
Benjamin Herrenschmidt096e6f62008-10-20 15:07:37 +110052 dev_dbg(&dev->dev, "BAR %d: got res %pR bus [%#llx-%#llx] "
53 "flags %#lx\n", resno, res,
Benjamin Herrenschmidt6015fbe2007-12-10 17:32:16 +110054 (unsigned long long)region.start,
55 (unsigned long long)region.end,
Bjorn Helgaas80ccba12008-06-13 10:52:11 -060056 (unsigned long)res->flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -070057
58 new = region.start | (res->flags & PCI_REGION_FLAG_MASK);
59 if (res->flags & IORESOURCE_IO)
60 mask = (u32)PCI_BASE_ADDRESS_IO_MASK;
61 else
62 mask = (u32)PCI_BASE_ADDRESS_MEM_MASK;
63
64 if (resno < 6) {
65 reg = PCI_BASE_ADDRESS_0 + 4 * resno;
66 } else if (resno == PCI_ROM_RESOURCE) {
Linus Torvalds755528c2005-08-26 10:49:22 -070067 if (!(res->flags & IORESOURCE_ROM_ENABLE))
68 return;
69 new |= PCI_ROM_ADDRESS_ENABLE;
Linus Torvalds1da177e2005-04-16 15:20:36 -070070 reg = dev->rom_base_reg;
71 } else {
72 /* Hmm, non-standard resource. */
73
74 return; /* kill uninitialised var warning */
75 }
76
77 pci_write_config_dword(dev, reg, new);
78 pci_read_config_dword(dev, reg, &check);
79
80 if ((new ^ check) & mask) {
Bjorn Helgaas80ccba12008-06-13 10:52:11 -060081 dev_err(&dev->dev, "BAR %d: error updating (%#08x != %#08x)\n",
82 resno, new, check);
Linus Torvalds1da177e2005-04-16 15:20:36 -070083 }
84
85 if ((new & (PCI_BASE_ADDRESS_SPACE|PCI_BASE_ADDRESS_MEM_TYPE_MASK)) ==
86 (PCI_BASE_ADDRESS_SPACE_MEMORY|PCI_BASE_ADDRESS_MEM_TYPE_64)) {
Ivan Kokshayskycf7bee52005-08-07 13:49:59 +040087 new = region.start >> 16 >> 16;
Linus Torvalds1da177e2005-04-16 15:20:36 -070088 pci_write_config_dword(dev, reg + 4, new);
89 pci_read_config_dword(dev, reg + 4, &check);
90 if (check != new) {
Bjorn Helgaas80ccba12008-06-13 10:52:11 -060091 dev_err(&dev->dev, "BAR %d: error updating "
92 "(high %#08x != %#08x)\n", resno, new, check);
Linus Torvalds1da177e2005-04-16 15:20:36 -070093 }
94 }
95 res->flags &= ~IORESOURCE_UNSET;
Bjorn Helgaas80ccba12008-06-13 10:52:11 -060096 dev_dbg(&dev->dev, "BAR %d: moved to bus [%#llx-%#llx] flags %#lx\n",
97 resno, (unsigned long long)region.start,
98 (unsigned long long)region.end, res->flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -070099}
100
Sam Ravnborg96bde062007-03-26 21:53:30 -0800101int pci_claim_resource(struct pci_dev *dev, int resource)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700102{
103 struct resource *res = &dev->resource[resource];
104 struct resource *root = NULL;
105 char *dtype = resource < PCI_BRIDGE_RESOURCES ? "device" : "bridge";
106 int err;
107
David S. Miller085ae412005-08-08 13:19:08 -0700108 root = pcibios_select_root(dev, res);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700109
110 err = -EINVAL;
111 if (root != NULL)
112 err = insert_resource(root, res);
113
114 if (err) {
Benjamin Herrenschmidt096e6f62008-10-20 15:07:37 +1100115 dev_err(&dev->dev, "BAR %d: %s of %s %pR\n",
Bjorn Helgaas80ccba12008-06-13 10:52:11 -0600116 resource,
117 root ? "address space collision on" :
118 "no parent found for",
Benjamin Herrenschmidt096e6f62008-10-20 15:07:37 +1100119 dtype, res);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700120 }
121
122 return err;
123}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700124
125int pci_assign_resource(struct pci_dev *dev, int resno)
126{
127 struct pci_bus *bus = dev->bus;
128 struct resource *res = dev->resource + resno;
Greg Kroah-Hartmane31dd6e2006-06-12 17:06:02 -0700129 resource_size_t size, min, align;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700130 int ret;
131
Zhao, Yu022edd82008-10-13 19:24:28 +0800132 size = resource_size(res);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700133 min = (res->flags & IORESOURCE_IO) ? PCIBIOS_MIN_IO : PCIBIOS_MIN_MEM;
Ivan Kokshaysky88452562008-03-30 19:50:14 +0400134
135 align = resource_alignment(res);
136 if (!align) {
Bjorn Helgaas80ccba12008-06-13 10:52:11 -0600137 dev_err(&dev->dev, "BAR %d: can't allocate resource (bogus "
Benjamin Herrenschmidt096e6f62008-10-20 15:07:37 +1100138 "alignment) %pR flags %#lx\n",
139 resno, res, res->flags);
Ivan Kokshaysky88452562008-03-30 19:50:14 +0400140 return -EINVAL;
141 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700142
143 /* First, try exact prefetching match.. */
144 ret = pci_bus_alloc_resource(bus, res, size, align, min,
145 IORESOURCE_PREFETCH,
146 pcibios_align_resource, dev);
147
148 if (ret < 0 && (res->flags & IORESOURCE_PREFETCH)) {
149 /*
150 * That failed.
151 *
152 * But a prefetching area can handle a non-prefetching
153 * window (it will just not perform as well).
154 */
155 ret = pci_bus_alloc_resource(bus, res, size, align, min, 0,
156 pcibios_align_resource, dev);
157 }
158
159 if (ret) {
Benjamin Herrenschmidt096e6f62008-10-20 15:07:37 +1100160 dev_err(&dev->dev, "BAR %d: can't allocate %s resource %pR\n",
161 resno, res->flags & IORESOURCE_IO ? "I/O" : "mem", res);
Ivan Kokshaysky88452562008-03-30 19:50:14 +0400162 } else {
163 res->flags &= ~IORESOURCE_STARTALIGN;
164 if (resno < PCI_BRIDGE_RESOURCES)
165 pci_update_resource(dev, res, resno);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700166 }
167
168 return ret;
169}
170
Adrian Bunk2baad5f2008-02-13 23:30:12 +0200171#if 0
Kumar Gala75acfeca2006-05-01 10:43:46 -0500172int pci_assign_resource_fixed(struct pci_dev *dev, int resno)
173{
174 struct pci_bus *bus = dev->bus;
175 struct resource *res = dev->resource + resno;
176 unsigned int type_mask;
177 int i, ret = -EBUSY;
178
179 type_mask = IORESOURCE_IO | IORESOURCE_MEM | IORESOURCE_PREFETCH;
180
181 for (i = 0; i < PCI_BUS_NUM_RESOURCES; i++) {
182 struct resource *r = bus->resource[i];
183 if (!r)
184 continue;
185
186 /* type_mask must match */
187 if ((res->flags ^ r->flags) & type_mask)
188 continue;
189
190 ret = request_resource(r, res);
191
192 if (ret == 0)
193 break;
194 }
195
196 if (ret) {
Benjamin Herrenschmidt096e6f62008-10-20 15:07:37 +1100197 dev_err(&dev->dev, "BAR %d: can't allocate %s resource %pR\n",
198 resno, res->flags & IORESOURCE_IO ? "I/O" : "mem", res);
Kumar Gala75acfeca2006-05-01 10:43:46 -0500199 } else if (resno < PCI_BRIDGE_RESOURCES) {
200 pci_update_resource(dev, res, resno);
201 }
202
203 return ret;
204}
205EXPORT_SYMBOL_GPL(pci_assign_resource_fixed);
206#endif
207
Linus Torvalds1da177e2005-04-16 15:20:36 -0700208/* Sort resources by alignment */
Sam Ravnborg96bde062007-03-26 21:53:30 -0800209void pdev_sort_resources(struct pci_dev *dev, struct resource_list *head)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700210{
211 int i;
212
213 for (i = 0; i < PCI_NUM_RESOURCES; i++) {
214 struct resource *r;
215 struct resource_list *list, *tmp;
Greg Kroah-Hartmane31dd6e2006-06-12 17:06:02 -0700216 resource_size_t r_align;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700217
218 r = &dev->resource[i];
Ralf Baechlefb0f2b42006-12-19 13:12:08 -0800219
220 if (r->flags & IORESOURCE_PCI_FIXED)
221 continue;
222
Linus Torvalds1da177e2005-04-16 15:20:36 -0700223 if (!(r->flags) || r->parent)
224 continue;
Ivan Kokshaysky88452562008-03-30 19:50:14 +0400225
226 r_align = resource_alignment(r);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700227 if (!r_align) {
Bjorn Helgaas80ccba12008-06-13 10:52:11 -0600228 dev_warn(&dev->dev, "BAR %d: bogus alignment "
Benjamin Herrenschmidt096e6f62008-10-20 15:07:37 +1100229 "%pR flags %#lx\n",
230 i, r, r->flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700231 continue;
232 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700233 for (list = head; ; list = list->next) {
Greg Kroah-Hartmane31dd6e2006-06-12 17:06:02 -0700234 resource_size_t align = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700235 struct resource_list *ln = list->next;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700236
Ivan Kokshaysky88452562008-03-30 19:50:14 +0400237 if (ln)
238 align = resource_alignment(ln->res);
239
Linus Torvalds1da177e2005-04-16 15:20:36 -0700240 if (r_align > align) {
241 tmp = kmalloc(sizeof(*tmp), GFP_KERNEL);
242 if (!tmp)
243 panic("pdev_sort_resources(): "
244 "kmalloc() failed!\n");
245 tmp->next = ln;
246 tmp->res = r;
247 tmp->dev = dev;
248 list->next = tmp;
249 break;
250 }
251 }
252 }
253}
Bjorn Helgaas842de402008-03-04 11:56:47 -0700254
255int pci_enable_resources(struct pci_dev *dev, int mask)
256{
257 u16 cmd, old_cmd;
258 int i;
259 struct resource *r;
260
261 pci_read_config_word(dev, PCI_COMMAND, &cmd);
262 old_cmd = cmd;
263
264 for (i = 0; i < PCI_NUM_RESOURCES; i++) {
265 if (!(mask & (1 << i)))
266 continue;
267
268 r = &dev->resource[i];
269
270 if (!(r->flags & (IORESOURCE_IO | IORESOURCE_MEM)))
271 continue;
272 if ((i == PCI_ROM_RESOURCE) &&
273 (!(r->flags & IORESOURCE_ROM_ENABLE)))
274 continue;
275
276 if (!r->parent) {
277 dev_err(&dev->dev, "device not available because of "
Benjamin Herrenschmidt096e6f62008-10-20 15:07:37 +1100278 "BAR %d %pR collisions\n", i, r);
Bjorn Helgaas842de402008-03-04 11:56:47 -0700279 return -EINVAL;
280 }
281
282 if (r->flags & IORESOURCE_IO)
283 cmd |= PCI_COMMAND_IO;
284 if (r->flags & IORESOURCE_MEM)
285 cmd |= PCI_COMMAND_MEMORY;
286 }
287
288 if (cmd != old_cmd) {
289 dev_info(&dev->dev, "enabling device (%04x -> %04x)\n",
290 old_cmd, cmd);
291 pci_write_config_word(dev, PCI_COMMAND, cmd);
292 }
293 return 0;
294}