X-Git-Url: http://git.onelab.eu/?p=linux-2.6.git;a=blobdiff_plain;f=arch%2Fsparc64%2Fkernel%2Fpower.c;fp=arch%2Fsparc64%2Fkernel%2Fpower.c;h=30bcaf58e3abd5dae329bc363072d9c946259bc5;hp=e55466c77b61efaf0a8c13172e0dc100bcf3a2a1;hb=64ba3f394c830ec48a1c31b53dcae312c56f1604;hpb=be1e6109ac94a859551f8e1774eb9a8469fe055c diff --git a/arch/sparc64/kernel/power.c b/arch/sparc64/kernel/power.c index e55466c77..30bcaf58e 100644 --- a/arch/sparc64/kernel/power.c +++ b/arch/sparc64/kernel/power.c @@ -6,6 +6,7 @@ #define __KERNEL_SYSCALLS__ +#include #include #include #include @@ -16,10 +17,9 @@ #include #include +#include +#include #include -#include -#include -#include #include @@ -30,7 +30,6 @@ int scons_pwroff = 1; #ifdef CONFIG_PCI -#include static void __iomem *power_reg; static DECLARE_WAIT_QUEUE_HEAD(powerd_wait); @@ -106,61 +105,87 @@ again: return 0; } -static int __init has_button_interrupt(unsigned int irq, struct device_node *dp) +static int __init has_button_interrupt(unsigned int irq, int prom_node) { if (irq == PCI_IRQ_NONE) return 0; - if (!of_find_property(dp, "button", NULL)) + if (!prom_node_has_property(prom_node, "button")) return 0; return 1; } -static int __devinit power_probe(struct of_device *op, const struct of_device_id *match) +static int __init power_probe_ebus(struct resource **resp, unsigned int *irq_p, int *prom_node_p) { - struct resource *res = &op->resource[0]; - unsigned int irq= op->irqs[0]; + struct linux_ebus *ebus; + struct linux_ebus_device *edev; + + for_each_ebus(ebus) { + for_each_ebusdev(edev, ebus) { + if (!strcmp(edev->prom_name, "power")) { + *resp = &edev->resource[0]; + *irq_p = edev->irqs[0]; + *prom_node_p = edev->prom_node; + return 0; + } + } + } + return -ENODEV; +} - power_reg = of_ioremap(res, 0, 0x4, "power"); +static int __init power_probe_isa(struct resource **resp, unsigned int *irq_p, int *prom_node_p) +{ + struct sparc_isa_bridge *isa_bus; + struct sparc_isa_device *isa_dev; + + for_each_isa(isa_bus) { + for_each_isadev(isa_dev, isa_bus) { + if (!strcmp(isa_dev->prom_name, "power")) { + *resp = &isa_dev->resource; + *irq_p = isa_dev->irq; + *prom_node_p = isa_dev->prom_node; + return 0; + } + } + } + return -ENODEV; +} + +void __init power_init(void) +{ + struct resource *res = NULL; + unsigned int irq; + int prom_node; + static int invoked; - printk("%s: Control reg at %lx ... ", - op->node->name, res->start); + if (invoked) + return; + invoked = 1; - poweroff_method = machine_halt; /* able to use the standard halt */ + if (!power_probe_ebus(&res, &irq, &prom_node)) + goto found; - if (has_button_interrupt(irq, op->node)) { + if (!power_probe_isa(&res, &irq, &prom_node)) + goto found; + + return; + +found: + power_reg = ioremap(res->start, 0x4); + printk("power: Control reg at %p ... ", power_reg); + poweroff_method = machine_halt; /* able to use the standard halt */ + if (has_button_interrupt(irq, prom_node)) { if (kernel_thread(powerd, NULL, CLONE_FS) < 0) { printk("Failed to start power daemon.\n"); - return 0; + return; } printk("powerd running.\n"); if (request_irq(irq, - power_handler, 0, "power", NULL) < 0) + power_handler, SA_SHIRQ, "power", NULL) < 0) printk("power: Error, cannot register IRQ handler.\n"); } else { printk("not using powerd.\n"); } - - return 0; -} - -static struct of_device_id power_match[] = { - { - .name = "power", - }, - {}, -}; - -static struct of_platform_driver power_driver = { - .name = "power", - .match_table = power_match, - .probe = power_probe, -}; - -void __init power_init(void) -{ - of_register_driver(&power_driver, &of_bus_type); - return; } #endif /* CONFIG_PCI */