/* $Id: power.c,v 1.10 2001/12/11 01:57:16 davem Exp $ * power.c: Power management driver. * * Copyright (C) 1999 David S. Miller (davem@redhat.com) */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include /* * sysctl - toggle power-off restriction for serial console * systems in machine_power_off() */ int scons_pwroff = 1; #ifdef CONFIG_PCI #include static void __iomem *power_reg; static DECLARE_WAIT_QUEUE_HEAD(powerd_wait); static int button_pressed; static irqreturn_t power_handler(int irq, void *dev_id) { if (button_pressed == 0) { button_pressed = 1; wake_up(&powerd_wait); } /* FIXME: Check registers for status... */ return IRQ_HANDLED; } #endif /* CONFIG_PCI */ extern void machine_halt(void); extern void machine_alt_power_off(void); static void (*poweroff_method)(void) = machine_alt_power_off; void machine_power_off(void) { if (!serial_console || scons_pwroff) { #ifdef CONFIG_PCI if (power_reg) { /* Both register bits seem to have the * same effect, so until I figure out * what the difference is... */ writel(AUXIO_PCIO_CPWR_OFF | AUXIO_PCIO_SPWR_OFF, power_reg); } else #endif /* CONFIG_PCI */ if (poweroff_method != NULL) { poweroff_method(); /* not reached */ } } machine_halt(); } void (*pm_power_off)(void) = machine_power_off; EXPORT_SYMBOL(pm_power_off); #ifdef CONFIG_PCI static int powerd(void *__unused) { static char *envp[] = { "HOME=/", "TERM=linux", "PATH=/sbin:/usr/sbin:/bin:/usr/bin", NULL }; char *argv[] = { "/sbin/shutdown", "-h", "now", NULL }; DECLARE_WAITQUEUE(wait, current); daemonize("powerd"); add_wait_queue(&powerd_wait, &wait); again: for (;;) { set_task_state(current, TASK_INTERRUPTIBLE); if (button_pressed) break; flush_signals(current); schedule(); } __set_current_state(TASK_RUNNING); remove_wait_queue(&powerd_wait, &wait); /* Ok, down we go... */ button_pressed = 0; if (kernel_execve("/sbin/shutdown", argv, envp) < 0) { printk("powerd: shutdown execution failed\n"); add_wait_queue(&powerd_wait, &wait); goto again; } return 0; } static int __init has_button_interrupt(unsigned int irq, struct device_node *dp) { if (irq == PCI_IRQ_NONE) return 0; if (!of_find_property(dp, "button", NULL)) return 0; return 1; } static int __devinit power_probe(struct of_device *op, const struct of_device_id *match) { struct resource *res = &op->resource[0]; unsigned int irq= op->irqs[0]; power_reg = of_ioremap(res, 0, 0x4, "power"); printk("%s: Control reg at %lx ... ", op->node->name, res->start); poweroff_method = machine_halt; /* able to use the standard halt */ if (has_button_interrupt(irq, op->node)) { if (kernel_thread(powerd, NULL, CLONE_FS) < 0) { printk("Failed to start power daemon.\n"); return 0; } printk("powerd running.\n"); if (request_irq(irq, power_handler, 0, "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 */