diff options
Diffstat (limited to 'arch/sparc64/kernel/ebus.c')
-rw-r--r-- | arch/sparc64/kernel/ebus.c | 150 |
1 files changed, 33 insertions, 117 deletions
diff --git a/arch/sparc64/kernel/ebus.c b/arch/sparc64/kernel/ebus.c index 98e0a8cbeecd..aac014d15ad3 100644 --- a/arch/sparc64/kernel/ebus.c +++ b/arch/sparc64/kernel/ebus.c | |||
@@ -20,6 +20,8 @@ | |||
20 | #include <asm/pbm.h> | 20 | #include <asm/pbm.h> |
21 | #include <asm/ebus.h> | 21 | #include <asm/ebus.h> |
22 | #include <asm/oplib.h> | 22 | #include <asm/oplib.h> |
23 | #include <asm/prom.h> | ||
24 | #include <asm/of_device.h> | ||
23 | #include <asm/bpp.h> | 25 | #include <asm/bpp.h> |
24 | #include <asm/irq.h> | 26 | #include <asm/irq.h> |
25 | 27 | ||
@@ -279,45 +281,12 @@ static inline void *ebus_alloc(size_t size) | |||
279 | return mem; | 281 | return mem; |
280 | } | 282 | } |
281 | 283 | ||
282 | int __init ebus_intmap_match(struct linux_ebus *ebus, | 284 | static void __init fill_ebus_child(struct device_node *dp, |
283 | struct linux_prom_registers *reg, | 285 | struct linux_ebus_child *dev, |
284 | int *interrupt) | 286 | int non_standard_regs) |
285 | { | ||
286 | struct linux_prom_ebus_intmap *imap; | ||
287 | struct linux_prom_ebus_intmask *imask; | ||
288 | unsigned int hi, lo, irq; | ||
289 | int i, len, n_imap; | ||
290 | |||
291 | imap = of_get_property(ebus->prom_node, "interrupt-map", &len); | ||
292 | if (!imap) | ||
293 | return 0; | ||
294 | n_imap = len / sizeof(imap[0]); | ||
295 | |||
296 | imask = of_get_property(ebus->prom_node, "interrupt-map-mask", NULL); | ||
297 | if (!imask) | ||
298 | return 0; | ||
299 | |||
300 | hi = reg->which_io & imask->phys_hi; | ||
301 | lo = reg->phys_addr & imask->phys_lo; | ||
302 | irq = *interrupt & imask->interrupt; | ||
303 | for (i = 0; i < n_imap; i++) { | ||
304 | if ((imap[i].phys_hi == hi) && | ||
305 | (imap[i].phys_lo == lo) && | ||
306 | (imap[i].interrupt == irq)) { | ||
307 | *interrupt = imap[i].cinterrupt; | ||
308 | return 0; | ||
309 | } | ||
310 | } | ||
311 | return -1; | ||
312 | } | ||
313 | |||
314 | void __init fill_ebus_child(struct device_node *dp, | ||
315 | struct linux_prom_registers *preg, | ||
316 | struct linux_ebus_child *dev, | ||
317 | int non_standard_regs) | ||
318 | { | 287 | { |
288 | struct of_device *op; | ||
319 | int *regs; | 289 | int *regs; |
320 | int *irqs; | ||
321 | int i, len; | 290 | int i, len; |
322 | 291 | ||
323 | dev->prom_node = dp; | 292 | dev->prom_node = dp; |
@@ -354,12 +323,16 @@ void __init fill_ebus_child(struct device_node *dp, | |||
354 | } | 323 | } |
355 | } | 324 | } |
356 | 325 | ||
357 | for (i = 0; i < PROMINTR_MAX; i++) | 326 | op = of_find_device_by_node(dp); |
358 | dev->irqs[i] = PCI_IRQ_NONE; | 327 | if (!op) { |
359 | |||
360 | irqs = of_get_property(dp, "interrupts", &len); | ||
361 | if (!irqs) { | ||
362 | dev->num_irqs = 0; | 328 | dev->num_irqs = 0; |
329 | } else { | ||
330 | dev->num_irqs = op->num_irqs; | ||
331 | for (i = 0; i < dev->num_irqs; i++) | ||
332 | dev->irqs[i] = op->irqs[i]; | ||
333 | } | ||
334 | |||
335 | if (!dev->num_irqs) { | ||
363 | /* | 336 | /* |
364 | * Oh, well, some PROMs don't export interrupts | 337 | * Oh, well, some PROMs don't export interrupts |
365 | * property to children of EBus devices... | 338 | * property to children of EBus devices... |
@@ -375,23 +348,6 @@ void __init fill_ebus_child(struct device_node *dp, | |||
375 | dev->irqs[0] = dev->parent->irqs[1]; | 348 | dev->irqs[0] = dev->parent->irqs[1]; |
376 | } | 349 | } |
377 | } | 350 | } |
378 | } else { | ||
379 | dev->num_irqs = len / sizeof(irqs[0]); | ||
380 | for (i = 0; i < dev->num_irqs; i++) { | ||
381 | struct pci_pbm_info *pbm = dev->bus->parent; | ||
382 | struct pci_controller_info *p = pbm->parent; | ||
383 | |||
384 | if (ebus_intmap_match(dev->bus, preg, &irqs[i]) != -1) { | ||
385 | dev->irqs[i] = p->irq_build(pbm, | ||
386 | dev->bus->self, | ||
387 | irqs[i]); | ||
388 | } else { | ||
389 | /* If we get a bogus interrupt property, just | ||
390 | * record the raw value instead of punting. | ||
391 | */ | ||
392 | dev->irqs[i] = irqs[i]; | ||
393 | } | ||
394 | } | ||
395 | } | 351 | } |
396 | } | 352 | } |
397 | 353 | ||
@@ -403,72 +359,32 @@ static int __init child_regs_nonstandard(struct linux_ebus_device *dev) | |||
403 | return 0; | 359 | return 0; |
404 | } | 360 | } |
405 | 361 | ||
406 | void __init fill_ebus_device(struct device_node *dp, struct linux_ebus_device *dev) | 362 | static void __init fill_ebus_device(struct device_node *dp, struct linux_ebus_device *dev) |
407 | { | 363 | { |
408 | struct linux_prom_registers *regs; | ||
409 | struct linux_ebus_child *child; | 364 | struct linux_ebus_child *child; |
410 | int *irqs; | 365 | struct of_device *op; |
411 | int i, n, len; | 366 | int i, len; |
412 | 367 | ||
413 | dev->prom_node = dp; | 368 | dev->prom_node = dp; |
414 | 369 | ||
415 | printk(" [%s", dp->name); | 370 | printk(" [%s", dp->name); |
416 | 371 | ||
417 | regs = of_get_property(dp, "reg", &len); | 372 | op = of_find_device_by_node(dp); |
418 | if (!regs) { | 373 | if (!op) { |
419 | dev->num_addrs = 0; | 374 | dev->num_addrs = 0; |
420 | goto probe_interrupts; | ||
421 | } | ||
422 | |||
423 | if (len % sizeof(struct linux_prom_registers)) { | ||
424 | prom_printf("UGH: proplen for %s was %d, need multiple of %d\n", | ||
425 | dev->prom_node->name, len, | ||
426 | (int)sizeof(struct linux_prom_registers)); | ||
427 | prom_halt(); | ||
428 | } | ||
429 | dev->num_addrs = len / sizeof(struct linux_prom_registers); | ||
430 | |||
431 | for (i = 0; i < dev->num_addrs; i++) { | ||
432 | /* XXX Learn how to interpret ebus ranges... -DaveM */ | ||
433 | if (regs[i].which_io >= 0x10) | ||
434 | n = (regs[i].which_io - 0x10) >> 2; | ||
435 | else | ||
436 | n = regs[i].which_io; | ||
437 | |||
438 | dev->resource[i].start = dev->bus->self->resource[n].start; | ||
439 | dev->resource[i].start += (unsigned long)regs[i].phys_addr; | ||
440 | dev->resource[i].end = | ||
441 | (dev->resource[i].start + (unsigned long)regs[i].reg_size - 1UL); | ||
442 | dev->resource[i].flags = IORESOURCE_MEM; | ||
443 | dev->resource[i].name = dev->prom_node->name; | ||
444 | request_resource(&dev->bus->self->resource[n], | ||
445 | &dev->resource[i]); | ||
446 | } | ||
447 | |||
448 | probe_interrupts: | ||
449 | for (i = 0; i < PROMINTR_MAX; i++) | ||
450 | dev->irqs[i] = PCI_IRQ_NONE; | ||
451 | |||
452 | irqs = of_get_property(dp, "interrupts", &len); | ||
453 | if (!irqs) { | ||
454 | dev->num_irqs = 0; | 375 | dev->num_irqs = 0; |
455 | } else { | 376 | } else { |
456 | dev->num_irqs = len / sizeof(irqs[0]); | 377 | (void) of_get_property(dp, "reg", &len); |
457 | for (i = 0; i < dev->num_irqs; i++) { | 378 | dev->num_addrs = len / sizeof(struct linux_prom_registers); |
458 | struct pci_pbm_info *pbm = dev->bus->parent; | 379 | |
459 | struct pci_controller_info *p = pbm->parent; | 380 | for (i = 0; i < dev->num_addrs; i++) |
460 | 381 | memcpy(&dev->resource[i], | |
461 | if (ebus_intmap_match(dev->bus, ®s[0], &irqs[i]) != -1) { | 382 | &op->resource[i], |
462 | dev->irqs[i] = p->irq_build(pbm, | 383 | sizeof(struct resource)); |
463 | dev->bus->self, | 384 | |
464 | irqs[i]); | 385 | dev->num_irqs = op->num_irqs; |
465 | } else { | 386 | for (i = 0; i < dev->num_irqs; i++) |
466 | /* If we get a bogus interrupt property, just | 387 | dev->irqs[i] = op->irqs[i]; |
467 | * record the raw value instead of punting. | ||
468 | */ | ||
469 | dev->irqs[i] = irqs[i]; | ||
470 | } | ||
471 | } | ||
472 | } | 388 | } |
473 | 389 | ||
474 | dev->ofdev.node = dp; | 390 | dev->ofdev.node = dp; |
@@ -490,7 +406,7 @@ probe_interrupts: | |||
490 | child->next = NULL; | 406 | child->next = NULL; |
491 | child->parent = dev; | 407 | child->parent = dev; |
492 | child->bus = dev->bus; | 408 | child->bus = dev->bus; |
493 | fill_ebus_child(dp, regs, child, | 409 | fill_ebus_child(dp, child, |
494 | child_regs_nonstandard(dev)); | 410 | child_regs_nonstandard(dev)); |
495 | 411 | ||
496 | while ((dp = dp->sibling) != NULL) { | 412 | while ((dp = dp->sibling) != NULL) { |
@@ -500,7 +416,7 @@ probe_interrupts: | |||
500 | child->next = NULL; | 416 | child->next = NULL; |
501 | child->parent = dev; | 417 | child->parent = dev; |
502 | child->bus = dev->bus; | 418 | child->bus = dev->bus; |
503 | fill_ebus_child(dp, regs, child, | 419 | fill_ebus_child(dp, child, |
504 | child_regs_nonstandard(dev)); | 420 | child_regs_nonstandard(dev)); |
505 | } | 421 | } |
506 | } | 422 | } |