Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* |
| 2 | * Cobalt Reset operations |
| 3 | * |
| 4 | * This file is subject to the terms and conditions of the GNU General Public |
| 5 | * License. See the file "COPYING" in the main directory of this archive |
| 6 | * for more details. |
| 7 | * |
| 8 | * Copyright (C) 1995, 1996, 1997 by Ralf Baechle |
| 9 | * Copyright (C) 2001 by Liam Davies (ldavies@agile.tv) |
| 10 | */ |
Yoichi Yuasa | e86169f | 2007-10-01 19:45:05 +0900 | [diff] [blame] | 11 | #include <linux/init.h> |
Yoichi Yuasa | 3282bd3 | 2007-10-02 23:17:38 +0900 | [diff] [blame] | 12 | #include <linux/io.h> |
Yoichi Yuasa | cc50b67 | 2007-03-06 21:34:44 +0900 | [diff] [blame] | 13 | #include <linux/jiffies.h> |
Yoichi Yuasa | e86169f | 2007-10-01 19:45:05 +0900 | [diff] [blame] | 14 | #include <linux/leds.h> |
Yoichi Yuasa | cc50b67 | 2007-03-06 21:34:44 +0900 | [diff] [blame] | 15 | |
| 16 | #include <cobalt.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 17 | |
Yoichi Yuasa | 3282bd3 | 2007-10-02 23:17:38 +0900 | [diff] [blame] | 18 | #define RESET_PORT ((void __iomem *)CKSEG1ADDR(0x1c000000)) |
| 19 | #define RESET 0x0f |
| 20 | |
Yoichi Yuasa | e86169f | 2007-10-01 19:45:05 +0900 | [diff] [blame] | 21 | DEFINE_LED_TRIGGER(power_off_led_trigger); |
| 22 | |
| 23 | static int __init ledtrig_power_off_init(void) |
| 24 | { |
| 25 | led_trigger_register_simple("power-off", &power_off_led_trigger); |
| 26 | return 0; |
| 27 | } |
| 28 | device_initcall(ledtrig_power_off_init); |
| 29 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 30 | void cobalt_machine_halt(void) |
| 31 | { |
Ralf Baechle | c4ed38a | 2005-02-21 16:18:36 +0000 | [diff] [blame] | 32 | int state, last, diff; |
| 33 | unsigned long mark; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 34 | |
Ralf Baechle | c4ed38a | 2005-02-21 16:18:36 +0000 | [diff] [blame] | 35 | /* |
Yoichi Yuasa | e86169f | 2007-10-01 19:45:05 +0900 | [diff] [blame] | 36 | * turn on power off LED on RaQ |
Ralf Baechle | c4ed38a | 2005-02-21 16:18:36 +0000 | [diff] [blame] | 37 | * |
| 38 | * restart if ENTER and SELECT are pressed |
| 39 | */ |
| 40 | |
| 41 | last = COBALT_KEY_PORT; |
| 42 | |
Yoichi Yuasa | e86169f | 2007-10-01 19:45:05 +0900 | [diff] [blame] | 43 | led_trigger_event(power_off_led_trigger, LED_FULL); |
| 44 | |
Ralf Baechle | c4ed38a | 2005-02-21 16:18:36 +0000 | [diff] [blame] | 45 | for (state = 0;;) { |
Ralf Baechle | c4ed38a | 2005-02-21 16:18:36 +0000 | [diff] [blame] | 46 | diff = COBALT_KEY_PORT ^ last; |
| 47 | last ^= diff; |
| 48 | |
| 49 | if((diff & (COBALT_KEY_ENTER | COBALT_KEY_SELECT)) && !(~last & (COBALT_KEY_ENTER | COBALT_KEY_SELECT))) |
Yoichi Yuasa | 3282bd3 | 2007-10-02 23:17:38 +0900 | [diff] [blame] | 50 | writeb(RESET, RESET_PORT); |
Ralf Baechle | c4ed38a | 2005-02-21 16:18:36 +0000 | [diff] [blame] | 51 | |
| 52 | for (mark = jiffies; jiffies - mark < HZ;) |
| 53 | ; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 54 | } |
| 55 | } |
| 56 | |
Ralf Baechle | c4ed38a | 2005-02-21 16:18:36 +0000 | [diff] [blame] | 57 | void cobalt_machine_restart(char *command) |
| 58 | { |
Yoichi Yuasa | 3282bd3 | 2007-10-02 23:17:38 +0900 | [diff] [blame] | 59 | writeb(RESET, RESET_PORT); |
Ralf Baechle | c4ed38a | 2005-02-21 16:18:36 +0000 | [diff] [blame] | 60 | |
| 61 | /* we should never get here */ |
| 62 | cobalt_machine_halt(); |
| 63 | } |