| /* | |
| * This file is subject to the terms and conditions of the GNU General Public | |
| * License. See the file "COPYING" in the main directory of this archive | |
| * for more details. | |
| * | |
| * Copyright (C) 2001 Keith M Wesolowski | |
| * Copyright (C) 2001 Paul Mundt | |
| * Copyright (C) 2003 Guido Guenther <agx@sigxcpu.org> | |
| */ | |
| #include <linux/compiler.h> | |
| #include <linux/init.h> | |
| #include <linux/kernel.h> | |
| #include <linux/module.h> | |
| #include <linux/sched.h> | |
| #include <linux/notifier.h> | |
| #include <linux/delay.h> | |
| #include <linux/rtc/ds1685.h> | |
| #include <linux/interrupt.h> | |
| #include <linux/pm.h> | |
| #include <asm/addrspace.h> | |
| #include <asm/irq.h> | |
| #include <asm/reboot.h> | |
| #include <asm/wbflush.h> | |
| #include <asm/ip32/mace.h> | |
| #include <asm/ip32/crime.h> | |
| #include <asm/ip32/ip32_ints.h> | |
| #define POWERDOWN_TIMEOUT 120 | |
| /* | |
| * Blink frequency during reboot grace period and when panicked. | |
| */ | |
| #define POWERDOWN_FREQ (HZ / 4) | |
| #define PANIC_FREQ (HZ / 8) | |
| extern struct platform_device ip32_rtc_device; | |
| static struct timer_list power_timer, blink_timer; | |
| static int has_panicked, shutting_down; | |
| static __noreturn void ip32_poweroff(void *data) | |
| { | |
| void (*poweroff_func)(struct platform_device *) = | |
| symbol_get(ds1685_rtc_poweroff); | |
| #ifdef CONFIG_MODULES | |
| /* If the first __symbol_get failed, our module wasn't loaded. */ | |
| if (!poweroff_func) { | |
| request_module("rtc-ds1685"); | |
| poweroff_func = symbol_get(ds1685_rtc_poweroff); | |
| } | |
| #endif | |
| if (!poweroff_func) | |
| pr_emerg("RTC not available for power-off. Spinning forever ...\n"); | |
| else { | |
| (*poweroff_func)((struct platform_device *)data); | |
| symbol_put(ds1685_rtc_poweroff); | |
| } | |
| unreachable(); | |
| } | |
| static void ip32_machine_restart(char *cmd) __noreturn; | |
| static void ip32_machine_restart(char *cmd) | |
| { | |
| msleep(20); | |
| crime->control = CRIME_CONTROL_HARD_RESET; | |
| unreachable(); | |
| } | |
| static void blink_timeout(unsigned long data) | |
| { | |
| unsigned long led = mace->perif.ctrl.misc ^ MACEISA_LED_RED; | |
| mace->perif.ctrl.misc = led; | |
| mod_timer(&blink_timer, jiffies + data); | |
| } | |
| static void ip32_machine_halt(void) | |
| { | |
| ip32_poweroff(&ip32_rtc_device); | |
| } | |
| static void power_timeout(unsigned long data) | |
| { | |
| ip32_poweroff(&ip32_rtc_device); | |
| } | |
| void ip32_prepare_poweroff(void) | |
| { | |
| if (has_panicked) | |
| return; | |
| if (shutting_down || kill_cad_pid(SIGINT, 1)) { | |
| /* No init process or button pressed twice. */ | |
| ip32_poweroff(&ip32_rtc_device); | |
| } | |
| shutting_down = 1; | |
| blink_timer.data = POWERDOWN_FREQ; | |
| blink_timeout(POWERDOWN_FREQ); | |
| init_timer(&power_timer); | |
| power_timer.function = power_timeout; | |
| power_timer.expires = jiffies + POWERDOWN_TIMEOUT * HZ; | |
| add_timer(&power_timer); | |
| } | |
| static int panic_event(struct notifier_block *this, unsigned long event, | |
| void *ptr) | |
| { | |
| unsigned long led; | |
| if (has_panicked) | |
| return NOTIFY_DONE; | |
| has_panicked = 1; | |
| /* turn off the green LED */ | |
| led = mace->perif.ctrl.misc | MACEISA_LED_GREEN; | |
| mace->perif.ctrl.misc = led; | |
| blink_timer.data = PANIC_FREQ; | |
| blink_timeout(PANIC_FREQ); | |
| return NOTIFY_DONE; | |
| } | |
| static struct notifier_block panic_block = { | |
| .notifier_call = panic_event, | |
| }; | |
| static __init int ip32_reboot_setup(void) | |
| { | |
| /* turn on the green led only */ | |
| unsigned long led = mace->perif.ctrl.misc; | |
| led |= MACEISA_LED_RED; | |
| led &= ~MACEISA_LED_GREEN; | |
| mace->perif.ctrl.misc = led; | |
| _machine_restart = ip32_machine_restart; | |
| _machine_halt = ip32_machine_halt; | |
| pm_power_off = ip32_machine_halt; | |
| init_timer(&blink_timer); | |
| blink_timer.function = blink_timeout; | |
| atomic_notifier_chain_register(&panic_notifier_list, &panic_block); | |
| return 0; | |
| } | |
| subsys_initcall(ip32_reboot_setup); |