2005-04-16 22:20:36 +00:00
|
|
|
/*
|
|
|
|
* Cobalt Reset operations
|
|
|
|
*
|
|
|
|
* 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) 1995, 1996, 1997 by Ralf Baechle
|
|
|
|
* Copyright (C) 2001 by Liam Davies (ldavies@agile.tv)
|
|
|
|
*/
|
2007-10-01 10:45:05 +00:00
|
|
|
#include <linux/init.h>
|
2007-10-02 14:17:38 +00:00
|
|
|
#include <linux/io.h>
|
2007-03-06 12:34:44 +00:00
|
|
|
#include <linux/jiffies.h>
|
2007-10-01 10:45:05 +00:00
|
|
|
#include <linux/leds.h>
|
2007-03-06 12:34:44 +00:00
|
|
|
|
|
|
|
#include <cobalt.h>
|
2005-04-16 22:20:36 +00:00
|
|
|
|
2007-10-02 14:17:38 +00:00
|
|
|
#define RESET_PORT ((void __iomem *)CKSEG1ADDR(0x1c000000))
|
|
|
|
#define RESET 0x0f
|
|
|
|
|
2007-10-01 10:45:05 +00:00
|
|
|
DEFINE_LED_TRIGGER(power_off_led_trigger);
|
|
|
|
|
|
|
|
static int __init ledtrig_power_off_init(void)
|
|
|
|
{
|
|
|
|
led_trigger_register_simple("power-off", &power_off_led_trigger);
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
device_initcall(ledtrig_power_off_init);
|
|
|
|
|
2005-02-21 16:18:36 +00:00
|
|
|
void cobalt_machine_halt(void)
|
2005-04-16 22:20:36 +00:00
|
|
|
{
|
2005-02-21 16:18:36 +00:00
|
|
|
int state, last, diff;
|
|
|
|
unsigned long mark;
|
2005-04-16 22:20:36 +00:00
|
|
|
|
|
|
|
/*
|
2007-10-01 10:45:05 +00:00
|
|
|
* turn on power off LED on RaQ
|
2005-02-21 16:18:36 +00:00
|
|
|
*
|
|
|
|
* restart if ENTER and SELECT are pressed
|
2005-04-16 22:20:36 +00:00
|
|
|
*/
|
|
|
|
|
2005-02-21 16:18:36 +00:00
|
|
|
last = COBALT_KEY_PORT;
|
2005-04-16 22:20:36 +00:00
|
|
|
|
2007-10-01 10:45:05 +00:00
|
|
|
led_trigger_event(power_off_led_trigger, LED_FULL);
|
2005-02-21 16:18:36 +00:00
|
|
|
|
2007-10-01 10:45:05 +00:00
|
|
|
for (state = 0;;) {
|
2005-02-21 16:18:36 +00:00
|
|
|
diff = COBALT_KEY_PORT ^ last;
|
|
|
|
last ^= diff;
|
2005-04-16 22:20:36 +00:00
|
|
|
|
2005-02-21 16:18:36 +00:00
|
|
|
if((diff & (COBALT_KEY_ENTER | COBALT_KEY_SELECT)) && !(~last & (COBALT_KEY_ENTER | COBALT_KEY_SELECT)))
|
2007-10-02 14:17:38 +00:00
|
|
|
writeb(RESET, RESET_PORT);
|
2005-02-21 16:18:36 +00:00
|
|
|
|
|
|
|
for (mark = jiffies; jiffies - mark < HZ;)
|
|
|
|
;
|
2005-04-16 22:20:36 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2005-02-21 16:18:36 +00:00
|
|
|
void cobalt_machine_restart(char *command)
|
|
|
|
{
|
2007-10-02 14:17:38 +00:00
|
|
|
writeb(RESET, RESET_PORT);
|
2005-02-21 16:18:36 +00:00
|
|
|
|
|
|
|
/* we should never get here */
|
|
|
|
cobalt_machine_halt();
|
|
|
|
}
|