Linux Audio
Check our new training course
Embedded Linux Audio
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152
/* * 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);