]>
Commit | Line | Data |
---|---|---|
83d290c5 | 1 | // SPDX-License-Identifier: GPL-2.0+ |
c609719b WD |
2 | /* |
3 | * (C) Copyright 2001 Sysgo Real-Time Solutions, GmbH <www.elinos.com> | |
4 | * Andreas Heppel <[email protected]> | |
5 | * | |
f07771cc | 6 | * (C) Copyright 2002, 2003 |
c609719b | 7 | * Wolfgang Denk, DENX Software Engineering, [email protected]. |
c609719b WD |
8 | */ |
9 | ||
10 | /* | |
2b81e8a3 SG |
11 | * Old PCI routines |
12 | * | |
13 | * Do not change this file. Instead, convert your board to use CONFIG_DM_PCI | |
14 | * and change pci-uclass.c. | |
c609719b WD |
15 | */ |
16 | ||
17 | #include <common.h> | |
2cf431c2 | 18 | #include <init.h> |
f7ae49fc | 19 | #include <log.h> |
c05ed00a | 20 | #include <linux/delay.h> |
c609719b | 21 | |
c609719b | 22 | #include <command.h> |
7b51b576 | 23 | #include <env.h> |
250e039d | 24 | #include <errno.h> |
c609719b WD |
25 | #include <asm/processor.h> |
26 | #include <asm/io.h> | |
27 | #include <pci.h> | |
28 | ||
8f9052fd BM |
29 | DECLARE_GLOBAL_DATA_PTR; |
30 | ||
f07771cc | 31 | #define PCI_HOSE_OP(rw, size, type) \ |
53677ef1 WD |
32 | int pci_hose_##rw##_config_##size(struct pci_controller *hose, \ |
33 | pci_dev_t dev, \ | |
f07771cc WD |
34 | int offset, type value) \ |
35 | { \ | |
36 | return hose->rw##_##size(hose, dev, offset, value); \ | |
c609719b WD |
37 | } |
38 | ||
39 | PCI_HOSE_OP(read, byte, u8 *) | |
40 | PCI_HOSE_OP(read, word, u16 *) | |
41 | PCI_HOSE_OP(read, dword, u32 *) | |
42 | PCI_HOSE_OP(write, byte, u8) | |
43 | PCI_HOSE_OP(write, word, u16) | |
44 | PCI_HOSE_OP(write, dword, u32) | |
45 | ||
f07771cc WD |
46 | #define PCI_OP(rw, size, type, error_code) \ |
47 | int pci_##rw##_config_##size(pci_dev_t dev, int offset, type value) \ | |
48 | { \ | |
49 | struct pci_controller *hose = pci_bus_to_hose(PCI_BUS(dev)); \ | |
50 | \ | |
51 | if (!hose) \ | |
52 | { \ | |
53 | error_code; \ | |
54 | return -1; \ | |
55 | } \ | |
56 | \ | |
57 | return pci_hose_##rw##_config_##size(hose, dev, offset, value); \ | |
c609719b WD |
58 | } |
59 | ||
60 | PCI_OP(read, byte, u8 *, *value = 0xff) | |
61 | PCI_OP(read, word, u16 *, *value = 0xffff) | |
62 | PCI_OP(read, dword, u32 *, *value = 0xffffffff) | |
63 | PCI_OP(write, byte, u8, ) | |
64 | PCI_OP(write, word, u16, ) | |
65 | PCI_OP(write, dword, u32, ) | |
66 | ||
f07771cc WD |
67 | #define PCI_READ_VIA_DWORD_OP(size, type, off_mask) \ |
68 | int pci_hose_read_config_##size##_via_dword(struct pci_controller *hose,\ | |
53677ef1 | 69 | pci_dev_t dev, \ |
f07771cc WD |
70 | int offset, type val) \ |
71 | { \ | |
72 | u32 val32; \ | |
73 | \ | |
815b5bd5 SK |
74 | if (pci_hose_read_config_dword(hose, dev, offset & 0xfc, &val32) < 0) { \ |
75 | *val = -1; \ | |
f07771cc | 76 | return -1; \ |
815b5bd5 | 77 | } \ |
f07771cc WD |
78 | \ |
79 | *val = (val32 >> ((offset & (int)off_mask) * 8)); \ | |
80 | \ | |
81 | return 0; \ | |
c609719b WD |
82 | } |
83 | ||
f07771cc WD |
84 | #define PCI_WRITE_VIA_DWORD_OP(size, type, off_mask, val_mask) \ |
85 | int pci_hose_write_config_##size##_via_dword(struct pci_controller *hose,\ | |
53677ef1 | 86 | pci_dev_t dev, \ |
f07771cc WD |
87 | int offset, type val) \ |
88 | { \ | |
498b8db7 | 89 | u32 val32, mask, ldata, shift; \ |
f07771cc WD |
90 | \ |
91 | if (pci_hose_read_config_dword(hose, dev, offset & 0xfc, &val32) < 0)\ | |
92 | return -1; \ | |
93 | \ | |
498b8db7 WD |
94 | shift = ((offset & (int)off_mask) * 8); \ |
95 | ldata = (((unsigned long)val) & val_mask) << shift; \ | |
96 | mask = val_mask << shift; \ | |
f07771cc WD |
97 | val32 = (val32 & ~mask) | ldata; \ |
98 | \ | |
99 | if (pci_hose_write_config_dword(hose, dev, offset & 0xfc, val32) < 0)\ | |
100 | return -1; \ | |
101 | \ | |
102 | return 0; \ | |
c609719b WD |
103 | } |
104 | ||
105 | PCI_READ_VIA_DWORD_OP(byte, u8 *, 0x03) | |
106 | PCI_READ_VIA_DWORD_OP(word, u16 *, 0x02) | |
107 | PCI_WRITE_VIA_DWORD_OP(byte, u8, 0x03, 0x000000ff) | |
108 | PCI_WRITE_VIA_DWORD_OP(word, u16, 0x02, 0x0000ffff) | |
109 | ||
110 | /* | |
111 | * | |
112 | */ | |
113 | ||
96d61603 | 114 | static struct pci_controller* hose_head; |
c609719b | 115 | |
8f9052fd BM |
116 | struct pci_controller *pci_get_hose_head(void) |
117 | { | |
118 | if (gd->hose) | |
119 | return gd->hose; | |
120 | ||
121 | return hose_head; | |
122 | } | |
123 | ||
c609719b WD |
124 | void pci_register_hose(struct pci_controller* hose) |
125 | { | |
126 | struct pci_controller **phose = &hose_head; | |
127 | ||
128 | while(*phose) | |
129 | phose = &(*phose)->next; | |
130 | ||
131 | hose->next = NULL; | |
132 | ||
133 | *phose = hose; | |
134 | } | |
135 | ||
cb2bf931 | 136 | struct pci_controller *pci_bus_to_hose(int bus) |
c609719b WD |
137 | { |
138 | struct pci_controller *hose; | |
139 | ||
8f9052fd | 140 | for (hose = pci_get_hose_head(); hose; hose = hose->next) { |
f07771cc | 141 | if (bus >= hose->first_busno && bus <= hose->last_busno) |
c609719b | 142 | return hose; |
cb2bf931 | 143 | } |
c609719b | 144 | |
6902df56 | 145 | printf("pci_bus_to_hose() failed\n"); |
c609719b WD |
146 | return NULL; |
147 | } | |
148 | ||
3a0e3c27 KG |
149 | struct pci_controller *find_hose_by_cfg_addr(void *cfg_addr) |
150 | { | |
151 | struct pci_controller *hose; | |
152 | ||
8f9052fd | 153 | for (hose = pci_get_hose_head(); hose; hose = hose->next) { |
3a0e3c27 KG |
154 | if (hose->cfg_addr == cfg_addr) |
155 | return hose; | |
156 | } | |
157 | ||
158 | return NULL; | |
159 | } | |
160 | ||
cc2a8c77 AV |
161 | int pci_last_busno(void) |
162 | { | |
8f9052fd | 163 | struct pci_controller *hose = pci_get_hose_head(); |
cc2a8c77 AV |
164 | |
165 | if (!hose) | |
166 | return -1; | |
167 | ||
168 | while (hose->next) | |
169 | hose = hose->next; | |
170 | ||
171 | return hose->last_busno; | |
172 | } | |
173 | ||
c609719b WD |
174 | pci_dev_t pci_find_devices(struct pci_device_id *ids, int index) |
175 | { | |
176 | struct pci_controller * hose; | |
c609719b | 177 | pci_dev_t bdf; |
aab6724c | 178 | int bus; |
c609719b | 179 | |
8f9052fd | 180 | for (hose = pci_get_hose_head(); hose; hose = hose->next) { |
aab6724c | 181 | for (bus = hose->first_busno; bus <= hose->last_busno; bus++) { |
aab6724c SG |
182 | bdf = pci_hose_find_devices(hose, bus, ids, &index); |
183 | if (bdf != -1) | |
250e039d | 184 | return bdf; |
250e039d SG |
185 | } |
186 | } | |
187 | ||
aab6724c | 188 | return -1; |
c609719b WD |
189 | } |
190 | ||
11503be4 SG |
191 | static int pci_hose_config_device(struct pci_controller *hose, pci_dev_t dev, |
192 | ulong io, pci_addr_t mem, ulong command) | |
c609719b | 193 | { |
cf5787f2 | 194 | u32 bar_response; |
af778c6d | 195 | unsigned int old_command; |
30e76d5e KG |
196 | pci_addr_t bar_value; |
197 | pci_size_t bar_size; | |
c609719b WD |
198 | unsigned char pin; |
199 | int bar, found_mem64; | |
200 | ||
cb2bf931 AS |
201 | debug("PCI Config: I/O=0x%lx, Memory=0x%llx, Command=0x%lx\n", io, |
202 | (u64)mem, command); | |
c609719b | 203 | |
cb2bf931 | 204 | pci_hose_write_config_dword(hose, dev, PCI_COMMAND, 0); |
c609719b | 205 | |
252b404d | 206 | for (bar = PCI_BASE_ADDRESS_0; bar <= PCI_BASE_ADDRESS_5; bar += 4) { |
cb2bf931 AS |
207 | pci_hose_write_config_dword(hose, dev, bar, 0xffffffff); |
208 | pci_hose_read_config_dword(hose, dev, bar, &bar_response); | |
c609719b WD |
209 | |
210 | if (!bar_response) | |
211 | continue; | |
212 | ||
213 | found_mem64 = 0; | |
214 | ||
215 | /* Check the BAR type and set our address mask */ | |
f07771cc | 216 | if (bar_response & PCI_BASE_ADDRESS_SPACE) { |
c609719b | 217 | bar_size = ~(bar_response & PCI_BASE_ADDRESS_IO_MASK) + 1; |
f07771cc | 218 | /* round up region base address to a multiple of size */ |
c609719b | 219 | io = ((io - 1) | (bar_size - 1)) + 1; |
f07771cc WD |
220 | bar_value = io; |
221 | /* compute new region base address */ | |
222 | io = io + bar_size; | |
223 | } else { | |
224 | if ((bar_response & PCI_BASE_ADDRESS_MEM_TYPE_MASK) == | |
30e76d5e KG |
225 | PCI_BASE_ADDRESS_MEM_TYPE_64) { |
226 | u32 bar_response_upper; | |
227 | u64 bar64; | |
cb2bf931 AS |
228 | pci_hose_write_config_dword(hose, dev, bar + 4, |
229 | 0xffffffff); | |
230 | pci_hose_read_config_dword(hose, dev, bar + 4, | |
231 | &bar_response_upper); | |
30e76d5e KG |
232 | |
233 | bar64 = ((u64)bar_response_upper << 32) | bar_response; | |
c609719b | 234 | |
30e76d5e KG |
235 | bar_size = ~(bar64 & PCI_BASE_ADDRESS_MEM_MASK) + 1; |
236 | found_mem64 = 1; | |
237 | } else { | |
238 | bar_size = (u32)(~(bar_response & PCI_BASE_ADDRESS_MEM_MASK) + 1); | |
239 | } | |
c609719b | 240 | |
f07771cc | 241 | /* round up region base address to multiple of size */ |
c609719b | 242 | mem = ((mem - 1) | (bar_size - 1)) + 1; |
f07771cc WD |
243 | bar_value = mem; |
244 | /* compute new region base address */ | |
245 | mem = mem + bar_size; | |
c609719b WD |
246 | } |
247 | ||
248 | /* Write it out and update our limit */ | |
30e76d5e | 249 | pci_hose_write_config_dword (hose, dev, bar, (u32)bar_value); |
c609719b | 250 | |
f07771cc | 251 | if (found_mem64) { |
c609719b | 252 | bar += 4; |
30e76d5e | 253 | #ifdef CONFIG_SYS_PCI_64BIT |
cb2bf931 AS |
254 | pci_hose_write_config_dword(hose, dev, bar, |
255 | (u32)(bar_value >> 32)); | |
30e76d5e | 256 | #else |
cb2bf931 | 257 | pci_hose_write_config_dword(hose, dev, bar, 0x00000000); |
30e76d5e | 258 | #endif |
c609719b WD |
259 | } |
260 | } | |
261 | ||
262 | /* Configure Cache Line Size Register */ | |
cb2bf931 | 263 | pci_hose_write_config_byte(hose, dev, PCI_CACHE_LINE_SIZE, 0x08); |
c609719b WD |
264 | |
265 | /* Configure Latency Timer */ | |
cb2bf931 | 266 | pci_hose_write_config_byte(hose, dev, PCI_LATENCY_TIMER, 0x80); |
c609719b WD |
267 | |
268 | /* Disable interrupt line, if device says it wants to use interrupts */ | |
cb2bf931 | 269 | pci_hose_read_config_byte(hose, dev, PCI_INTERRUPT_PIN, &pin); |
f07771cc | 270 | if (pin != 0) { |
5f48d798 SG |
271 | pci_hose_write_config_byte(hose, dev, PCI_INTERRUPT_LINE, |
272 | PCI_INTERRUPT_LINE_DISABLE); | |
c609719b WD |
273 | } |
274 | ||
cb2bf931 AS |
275 | pci_hose_read_config_dword(hose, dev, PCI_COMMAND, &old_command); |
276 | pci_hose_write_config_dword(hose, dev, PCI_COMMAND, | |
f07771cc | 277 | (old_command & 0xffff0000) | command); |
c609719b WD |
278 | |
279 | return 0; | |
280 | } | |
281 | ||
282 | /* | |
283 | * | |
284 | */ | |
285 | ||
286 | struct pci_config_table *pci_find_config(struct pci_controller *hose, | |
287 | unsigned short class, | |
288 | unsigned int vendor, | |
289 | unsigned int device, | |
290 | unsigned int bus, | |
291 | unsigned int dev, | |
292 | unsigned int func) | |
293 | { | |
294 | struct pci_config_table *table; | |
295 | ||
f07771cc | 296 | for (table = hose->config_table; table && table->vendor; table++) { |
c609719b WD |
297 | if ((table->vendor == PCI_ANY_ID || table->vendor == vendor) && |
298 | (table->device == PCI_ANY_ID || table->device == device) && | |
299 | (table->class == PCI_ANY_ID || table->class == class) && | |
300 | (table->bus == PCI_ANY_ID || table->bus == bus) && | |
301 | (table->dev == PCI_ANY_ID || table->dev == dev) && | |
f07771cc | 302 | (table->func == PCI_ANY_ID || table->func == func)) { |
c609719b WD |
303 | return table; |
304 | } | |
305 | } | |
306 | ||
307 | return NULL; | |
308 | } | |
309 | ||
310 | void pci_cfgfunc_config_device(struct pci_controller *hose, | |
311 | pci_dev_t dev, | |
312 | struct pci_config_table *entry) | |
313 | { | |
cb2bf931 AS |
314 | pci_hose_config_device(hose, dev, entry->priv[0], entry->priv[1], |
315 | entry->priv[2]); | |
c609719b WD |
316 | } |
317 | ||
318 | void pci_cfgfunc_do_nothing(struct pci_controller *hose, | |
319 | pci_dev_t dev, struct pci_config_table *entry) | |
320 | { | |
321 | } | |
322 | ||
323 | /* | |
cb2bf931 | 324 | * HJF: Changed this to return int. I think this is required |
c7de829c WD |
325 | * to get the correct result when scanning bridges |
326 | */ | |
327 | extern int pciauto_config_device(struct pci_controller *hose, pci_dev_t dev); | |
c609719b | 328 | |
dc1da42f | 329 | #ifdef CONFIG_PCI_SCAN_SHOW |
7b19fd6d | 330 | __weak int pci_print_dev(struct pci_controller *hose, pci_dev_t dev) |
dc1da42f SR |
331 | { |
332 | if (dev == PCI_BDF(hose->first_busno, 0, 0)) | |
333 | return 0; | |
334 | ||
335 | return 1; | |
336 | } | |
dc1da42f SR |
337 | #endif /* CONFIG_PCI_SCAN_SHOW */ |
338 | ||
c609719b WD |
339 | int pci_hose_scan_bus(struct pci_controller *hose, int bus) |
340 | { | |
cb2bf931 | 341 | unsigned int sub_bus, found_multi = 0; |
c609719b WD |
342 | unsigned short vendor, device, class; |
343 | unsigned char header_type; | |
03992ac2 | 344 | #ifndef CONFIG_PCI_PNP |
c609719b | 345 | struct pci_config_table *cfg; |
03992ac2 | 346 | #endif |
c609719b | 347 | pci_dev_t dev; |
009884ae PT |
348 | #ifdef CONFIG_PCI_SCAN_SHOW |
349 | static int indent = 0; | |
350 | #endif | |
c609719b WD |
351 | |
352 | sub_bus = bus; | |
353 | ||
354 | for (dev = PCI_BDF(bus,0,0); | |
cb2bf931 AS |
355 | dev < PCI_BDF(bus, PCI_MAX_PCI_DEVICES - 1, |
356 | PCI_MAX_PCI_FUNCTIONS - 1); | |
357 | dev += PCI_BDF(0, 0, 1)) { | |
dc1da42f SR |
358 | |
359 | if (pci_skip_dev(hose, dev)) | |
360 | continue; | |
c609719b WD |
361 | |
362 | if (PCI_FUNC(dev) && !found_multi) | |
363 | continue; | |
364 | ||
365 | pci_hose_read_config_byte(hose, dev, PCI_HEADER_TYPE, &header_type); | |
366 | ||
367 | pci_hose_read_config_word(hose, dev, PCI_VENDOR_ID, &vendor); | |
368 | ||
983eb9d1 PT |
369 | if (vendor == 0xffff || vendor == 0x0000) |
370 | continue; | |
c609719b | 371 | |
983eb9d1 PT |
372 | if (!PCI_FUNC(dev)) |
373 | found_multi = header_type & 0x80; | |
c609719b | 374 | |
cb2bf931 AS |
375 | debug("PCI Scan: Found Bus %d, Device %d, Function %d\n", |
376 | PCI_BUS(dev), PCI_DEV(dev), PCI_FUNC(dev)); | |
c609719b | 377 | |
983eb9d1 PT |
378 | pci_hose_read_config_word(hose, dev, PCI_DEVICE_ID, &device); |
379 | pci_hose_read_config_word(hose, dev, PCI_CLASS_DEVICE, &class); | |
c609719b | 380 | |
0991866c TH |
381 | #ifdef CONFIG_PCI_FIXUP_DEV |
382 | board_pci_fixup_dev(hose, dev, vendor, device, class); | |
383 | #endif | |
384 | ||
a38d216e | 385 | #ifdef CONFIG_PCI_SCAN_SHOW |
009884ae PT |
386 | indent++; |
387 | ||
388 | /* Print leading space, including bus indentation */ | |
389 | printf("%*c", indent + 1, ' '); | |
390 | ||
a38d216e | 391 | if (pci_print_dev(hose, dev)) { |
009884ae PT |
392 | printf("%02x:%02x.%-*x - %04x:%04x - %s\n", |
393 | PCI_BUS(dev), PCI_DEV(dev), 6 - indent, PCI_FUNC(dev), | |
a38d216e PT |
394 | vendor, device, pci_class_str(class >> 8)); |
395 | } | |
396 | #endif | |
397 | ||
03992ac2 | 398 | #ifdef CONFIG_PCI_PNP |
b4141195 MY |
399 | sub_bus = max((unsigned int)pciauto_config_device(hose, dev), |
400 | sub_bus); | |
03992ac2 | 401 | #else |
983eb9d1 PT |
402 | cfg = pci_find_config(hose, class, vendor, device, |
403 | PCI_BUS(dev), PCI_DEV(dev), PCI_FUNC(dev)); | |
404 | if (cfg) { | |
405 | cfg->config_device(hose, dev, cfg); | |
b4141195 MY |
406 | sub_bus = max(sub_bus, |
407 | (unsigned int)hose->current_busno); | |
983eb9d1 | 408 | } |
03992ac2 | 409 | #endif |
a38d216e | 410 | |
009884ae PT |
411 | #ifdef CONFIG_PCI_SCAN_SHOW |
412 | indent--; | |
413 | #endif | |
414 | ||
983eb9d1 PT |
415 | if (hose->fixup_irq) |
416 | hose->fixup_irq(hose, dev); | |
c609719b WD |
417 | } |
418 | ||
419 | return sub_bus; | |
420 | } | |
421 | ||
422 | int pci_hose_scan(struct pci_controller *hose) | |
423 | { | |
0da1fb03 | 424 | #if defined(CONFIG_PCI_BOOTDELAY) |
0da1fb03 AG |
425 | char *s; |
426 | int i; | |
427 | ||
8f9052fd | 428 | if (!gd->pcidelay_done) { |
0da1fb03 | 429 | /* wait "pcidelay" ms (if defined)... */ |
00caae6d | 430 | s = env_get("pcidelay"); |
0da1fb03 AG |
431 | if (s) { |
432 | int val = simple_strtoul(s, NULL, 10); | |
433 | for (i = 0; i < val; i++) | |
434 | udelay(1000); | |
435 | } | |
8f9052fd | 436 | gd->pcidelay_done = 1; |
0da1fb03 AG |
437 | } |
438 | #endif /* CONFIG_PCI_BOOTDELAY */ | |
439 | ||
0373a7e9 TH |
440 | #ifdef CONFIG_PCI_SCAN_SHOW |
441 | puts("PCI:\n"); | |
442 | #endif | |
443 | ||
cb2bf931 AS |
444 | /* |
445 | * Start scan at current_busno. | |
40e81add ES |
446 | * PCIe will start scan at first_busno+1. |
447 | */ | |
cb2bf931 | 448 | /* For legacy support, ensure current >= first */ |
40e81add ES |
449 | if (hose->first_busno > hose->current_busno) |
450 | hose->current_busno = hose->first_busno; | |
c609719b WD |
451 | #ifdef CONFIG_PCI_PNP |
452 | pciauto_config_init(hose); | |
453 | #endif | |
40e81add | 454 | return pci_hose_scan_bus(hose, hose->current_busno); |
c609719b WD |
455 | } |
456 | ||
b9f6d0f7 | 457 | int pci_init(void) |
ad10dd9a | 458 | { |
96d61603 JS |
459 | hose_head = NULL; |
460 | ||
ec21aee6 | 461 | /* allow env to disable pci init/enum */ |
00caae6d | 462 | if (env_get("pcidisable") != NULL) |
b9f6d0f7 | 463 | return 0; |
ec21aee6 | 464 | |
ad10dd9a SR |
465 | /* now call board specific pci_init()... */ |
466 | pci_init_board(); | |
b9f6d0f7 OP |
467 | |
468 | return 0; | |
ad10dd9a | 469 | } |
287df01e ZQ |
470 | |
471 | /* Returns the address of the requested capability structure within the | |
472 | * device's PCI configuration space or 0 in case the device does not | |
473 | * support it. | |
474 | * */ | |
475 | int pci_hose_find_capability(struct pci_controller *hose, pci_dev_t dev, | |
476 | int cap) | |
477 | { | |
478 | int pos; | |
479 | u8 hdr_type; | |
480 | ||
481 | pci_hose_read_config_byte(hose, dev, PCI_HEADER_TYPE, &hdr_type); | |
482 | ||
483 | pos = pci_hose_find_cap_start(hose, dev, hdr_type & 0x7F); | |
484 | ||
485 | if (pos) | |
486 | pos = pci_find_cap(hose, dev, pos, cap); | |
487 | ||
488 | return pos; | |
489 | } | |
490 | ||
491 | /* Find the header pointer to the Capabilities*/ | |
492 | int pci_hose_find_cap_start(struct pci_controller *hose, pci_dev_t dev, | |
493 | u8 hdr_type) | |
494 | { | |
495 | u16 status; | |
496 | ||
497 | pci_hose_read_config_word(hose, dev, PCI_STATUS, &status); | |
498 | ||
499 | if (!(status & PCI_STATUS_CAP_LIST)) | |
500 | return 0; | |
501 | ||
502 | switch (hdr_type) { | |
503 | case PCI_HEADER_TYPE_NORMAL: | |
504 | case PCI_HEADER_TYPE_BRIDGE: | |
505 | return PCI_CAPABILITY_LIST; | |
506 | case PCI_HEADER_TYPE_CARDBUS: | |
507 | return PCI_CB_CAPABILITY_LIST; | |
508 | default: | |
509 | return 0; | |
510 | } | |
511 | } | |
512 | ||
513 | int pci_find_cap(struct pci_controller *hose, pci_dev_t dev, int pos, int cap) | |
514 | { | |
515 | int ttl = PCI_FIND_CAP_TTL; | |
516 | u8 id; | |
517 | u8 next_pos; | |
518 | ||
519 | while (ttl--) { | |
520 | pci_hose_read_config_byte(hose, dev, pos, &next_pos); | |
521 | if (next_pos < CAP_START_POS) | |
522 | break; | |
523 | next_pos &= ~3; | |
524 | pos = (int) next_pos; | |
525 | pci_hose_read_config_byte(hose, dev, | |
526 | pos + PCI_CAP_LIST_ID, &id); | |
527 | if (id == 0xff) | |
528 | break; | |
529 | if (id == cap) | |
530 | return pos; | |
531 | pos += PCI_CAP_LIST_NEXT; | |
532 | } | |
533 | return 0; | |
534 | } | |
ed5b580b ML |
535 | |
536 | /** | |
537 | * pci_find_next_ext_capability - Find an extended capability | |
538 | * | |
539 | * Returns the address of the next matching extended capability structure | |
540 | * within the device's PCI configuration space or 0 if the device does | |
541 | * not support it. Some capabilities can occur several times, e.g., the | |
542 | * vendor-specific capability, and this provides a way to find them all. | |
543 | */ | |
544 | int pci_find_next_ext_capability(struct pci_controller *hose, pci_dev_t dev, | |
545 | int start, int cap) | |
546 | { | |
547 | u32 header; | |
548 | int ttl, pos = PCI_CFG_SPACE_SIZE; | |
549 | ||
550 | /* minimum 8 bytes per capability */ | |
551 | ttl = (PCI_CFG_SPACE_EXP_SIZE - PCI_CFG_SPACE_SIZE) / 8; | |
552 | ||
553 | if (start) | |
554 | pos = start; | |
555 | ||
556 | pci_hose_read_config_dword(hose, dev, pos, &header); | |
557 | if (header == 0xffffffff || header == 0) | |
558 | return 0; | |
559 | ||
560 | while (ttl-- > 0) { | |
561 | if (PCI_EXT_CAP_ID(header) == cap && pos != start) | |
562 | return pos; | |
563 | ||
564 | pos = PCI_EXT_CAP_NEXT(header); | |
565 | if (pos < PCI_CFG_SPACE_SIZE) | |
566 | break; | |
567 | ||
568 | pci_hose_read_config_dword(hose, dev, pos, &header); | |
569 | if (header == 0xffffffff || header == 0) | |
570 | break; | |
571 | } | |
572 | ||
573 | return 0; | |
574 | } | |
575 | ||
576 | /** | |
577 | * pci_hose_find_ext_capability - Find an extended capability | |
578 | * | |
579 | * Returns the address of the requested extended capability structure | |
580 | * within the device's PCI configuration space or 0 if the device does | |
581 | * not support it. | |
582 | */ | |
583 | int pci_hose_find_ext_capability(struct pci_controller *hose, pci_dev_t dev, | |
584 | int cap) | |
585 | { | |
586 | return pci_find_next_ext_capability(hose, dev, 0, cap); | |
587 | } |