1
2
3
4
5
6
7
8
9
10
11#include <linux/bug.h>
12#include <linux/kernel.h>
13#include <linux/mm.h>
14#include <linux/memblock.h>
15#include <linux/export.h>
16#include <linux/init.h>
17#include <linux/types.h>
18#include <linux/pci.h>
19#include <linux/of_address.h>
20
21#include <asm/cpu-info.h>
22
23
24
25
26
27
28
29
30
31static LIST_HEAD(controllers);
32
33static int pci_initialized;
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48resource_size_t
49pcibios_align_resource(void *data, const struct resource *res,
50 resource_size_t size, resource_size_t align)
51{
52 struct pci_dev *dev = data;
53 struct pci_controller *hose = dev->sysdata;
54 resource_size_t start = res->start;
55
56 if (res->flags & IORESOURCE_IO) {
57
58 if (start < PCIBIOS_MIN_IO + hose->io_resource->start)
59 start = PCIBIOS_MIN_IO + hose->io_resource->start;
60
61
62
63
64 if (start & 0x300)
65 start = (start + 0x3ff) & ~0x3ff;
66 } else if (res->flags & IORESOURCE_MEM) {
67
68 if (start < PCIBIOS_MIN_MEM + hose->mem_resource->start)
69 start = PCIBIOS_MIN_MEM + hose->mem_resource->start;
70 }
71
72 return start;
73}
74
75static void pcibios_scanbus(struct pci_controller *hose)
76{
77 static int next_busno;
78 static int need_domain_info;
79 LIST_HEAD(resources);
80 struct pci_bus *bus;
81 struct pci_host_bridge *bridge;
82 int ret;
83
84 bridge = pci_alloc_host_bridge(0);
85 if (!bridge)
86 return;
87
88 if (hose->get_busno && pci_has_flag(PCI_PROBE_ONLY))
89 next_busno = (*hose->get_busno)();
90
91 pci_add_resource_offset(&resources,
92 hose->mem_resource, hose->mem_offset);
93 pci_add_resource_offset(&resources,
94 hose->io_resource, hose->io_offset);
95 pci_add_resource(&resources, hose->busn_resource);
96 list_splice_init(&resources, &bridge->windows);
97 bridge->dev.parent = NULL;
98 bridge->sysdata = hose;
99 bridge->busnr = next_busno;
100 bridge->ops = hose->pci_ops;
101 bridge->swizzle_irq = pci_common_swizzle;
102 bridge->map_irq = pcibios_map_irq;
103 ret = pci_scan_root_bus_bridge(bridge);
104 if (ret) {
105 pci_free_host_bridge(bridge);
106 return;
107 }
108
109 hose->bus = bus = bridge->bus;
110
111 need_domain_info = need_domain_info || pci_domain_nr(bus);
112 set_pci_need_domain_info(hose, need_domain_info);
113
114 next_busno = bus->busn_res.end + 1;
115
116
117 if (next_busno > 224) {
118 next_busno = 0;
119 need_domain_info = 1;
120 }
121
122
123
124
125
126
127 if (pci_has_flag(PCI_PROBE_ONLY)) {
128 pci_bus_claim_resources(bus);
129 } else {
130 pci_bus_size_bridges(bus);
131 pci_bus_assign_resources(bus);
132 }
133 pci_bus_add_devices(bus);
134}
135
136#ifdef CONFIG_OF
137void pci_load_of_ranges(struct pci_controller *hose, struct device_node *node)
138{
139 struct of_pci_range range;
140 struct of_pci_range_parser parser;
141
142 pr_info("PCI host bridge %pOF ranges:\n", node);
143 hose->of_node = node;
144
145 if (of_pci_range_parser_init(&parser, node))
146 return;
147
148 for_each_of_pci_range(&parser, &range) {
149 struct resource *res = NULL;
150
151 switch (range.flags & IORESOURCE_TYPE_BITS) {
152 case IORESOURCE_IO:
153 pr_info(" IO 0x%016llx..0x%016llx\n",
154 range.cpu_addr,
155 range.cpu_addr + range.size - 1);
156 hose->io_map_base =
157 (unsigned long)ioremap(range.cpu_addr,
158 range.size);
159 res = hose->io_resource;
160 break;
161 case IORESOURCE_MEM:
162 pr_info(" MEM 0x%016llx..0x%016llx\n",
163 range.cpu_addr,
164 range.cpu_addr + range.size - 1);
165 res = hose->mem_resource;
166 break;
167 }
168 if (res != NULL)
169 of_pci_range_to_resource(&range, node, res);
170 }
171}
172
173struct device_node *pcibios_get_phb_of_node(struct pci_bus *bus)
174{
175 struct pci_controller *hose = bus->sysdata;
176
177 return of_node_get(hose->of_node);
178}
179#endif
180
181static DEFINE_MUTEX(pci_scan_mutex);
182
183void register_pci_controller(struct pci_controller *hose)
184{
185 struct resource *parent;
186
187 parent = hose->mem_resource->parent;
188 if (!parent)
189 parent = &iomem_resource;
190
191 if (request_resource(parent, hose->mem_resource) < 0)
192 goto out;
193
194 parent = hose->io_resource->parent;
195 if (!parent)
196 parent = &ioport_resource;
197
198 if (request_resource(parent, hose->io_resource) < 0) {
199 release_resource(hose->mem_resource);
200 goto out;
201 }
202
203 INIT_LIST_HEAD(&hose->list);
204 list_add_tail(&hose->list, &controllers);
205
206
207
208
209 if (!hose->io_map_base) {
210 printk(KERN_WARNING
211 "registering PCI controller with io_map_base unset\n");
212 }
213
214
215
216
217
218 if (pci_initialized) {
219 mutex_lock(&pci_scan_mutex);
220 pcibios_scanbus(hose);
221 mutex_unlock(&pci_scan_mutex);
222 }
223
224 return;
225
226out:
227 printk(KERN_WARNING
228 "Skipping PCI bus scan due to resource conflict\n");
229}
230
231static int __init pcibios_init(void)
232{
233 struct pci_controller *hose;
234
235
236 list_for_each_entry(hose, &controllers, list)
237 pcibios_scanbus(hose);
238
239 pci_initialized = 1;
240
241 return 0;
242}
243
244subsys_initcall(pcibios_init);
245
246static int pcibios_enable_resources(struct pci_dev *dev, int mask)
247{
248 u16 cmd, old_cmd;
249 int idx;
250 struct resource *r;
251
252 pci_read_config_word(dev, PCI_COMMAND, &cmd);
253 old_cmd = cmd;
254 for (idx=0; idx < PCI_NUM_RESOURCES; idx++) {
255
256 if (!(mask & (1<<idx)))
257 continue;
258
259 r = &dev->resource[idx];
260 if (!(r->flags & (IORESOURCE_IO | IORESOURCE_MEM)))
261 continue;
262 if ((idx == PCI_ROM_RESOURCE) &&
263 (!(r->flags & IORESOURCE_ROM_ENABLE)))
264 continue;
265 if (!r->start && r->end) {
266 pci_err(dev,
267 "can't enable device: resource collisions\n");
268 return -EINVAL;
269 }
270 if (r->flags & IORESOURCE_IO)
271 cmd |= PCI_COMMAND_IO;
272 if (r->flags & IORESOURCE_MEM)
273 cmd |= PCI_COMMAND_MEMORY;
274 }
275 if (cmd != old_cmd) {
276 pci_info(dev, "enabling device (%04x -> %04x)\n", old_cmd, cmd);
277 pci_write_config_word(dev, PCI_COMMAND, cmd);
278 }
279 return 0;
280}
281
282int pcibios_enable_device(struct pci_dev *dev, int mask)
283{
284 int err;
285
286 if ((err = pcibios_enable_resources(dev, mask)) < 0)
287 return err;
288
289 return pcibios_plat_dev_init(dev);
290}
291
292void pcibios_fixup_bus(struct pci_bus *bus)
293{
294 struct pci_dev *dev = bus->self;
295
296 if (pci_has_flag(PCI_PROBE_ONLY) && dev &&
297 (dev->class >> 8) == PCI_CLASS_BRIDGE_PCI) {
298 pci_read_bridge_bases(bus);
299 }
300}
301
302char * (*pcibios_plat_setup)(char *str) __initdata;
303
304char *__init pcibios_setup(char *str)
305{
306 if (pcibios_plat_setup)
307 return pcibios_plat_setup(str);
308 return str;
309}
310