92 lines
2.2 KiB
C
92 lines
2.2 KiB
C
/*
|
|
* This program is free software; you can redistribute it and/or modify it
|
|
* under the terms of the GNU General Public License version 2 as published
|
|
* by the Free Software Foundation.
|
|
*
|
|
* Copyright (C) 2010 John Crispin <blogic@openwrt.org>
|
|
*/
|
|
|
|
#include <linux/init.h>
|
|
#include <linux/io.h>
|
|
#include <linux/ioport.h>
|
|
#include <linux/pm.h>
|
|
#include <linux/export.h>
|
|
#include <asm/reboot.h>
|
|
|
|
#include <lantiq_soc.h>
|
|
|
|
#define ltq_rcu_w32(x, y) ltq_w32((x), ltq_rcu_membase + (y))
|
|
#define ltq_rcu_r32(x) ltq_r32(ltq_rcu_membase + (x))
|
|
|
|
/* register definitions */
|
|
#define LTQ_RCU_RST 0x0010
|
|
#define LTQ_RCU_RST_ALL 0x40000000
|
|
|
|
#define LTQ_RCU_RST_STAT 0x0014
|
|
#define LTQ_RCU_STAT_SHIFT 26
|
|
|
|
static struct resource ltq_rcu_resource = {
|
|
.name = "rcu",
|
|
.start = LTQ_RCU_BASE_ADDR,
|
|
.end = LTQ_RCU_BASE_ADDR + LTQ_RCU_SIZE - 1,
|
|
.flags = IORESOURCE_MEM,
|
|
};
|
|
|
|
/* remapped base addr of the reset control unit */
|
|
static void __iomem *ltq_rcu_membase;
|
|
|
|
/* This function is used by the watchdog driver */
|
|
int ltq_reset_cause(void)
|
|
{
|
|
u32 val = ltq_rcu_r32(LTQ_RCU_RST_STAT);
|
|
return val >> LTQ_RCU_STAT_SHIFT;
|
|
}
|
|
EXPORT_SYMBOL_GPL(ltq_reset_cause);
|
|
|
|
static void ltq_machine_restart(char *command)
|
|
{
|
|
pr_notice("System restart\n");
|
|
local_irq_disable();
|
|
ltq_rcu_w32(ltq_rcu_r32(LTQ_RCU_RST) | LTQ_RCU_RST_ALL, LTQ_RCU_RST);
|
|
unreachable();
|
|
}
|
|
|
|
static void ltq_machine_halt(void)
|
|
{
|
|
pr_notice("System halted.\n");
|
|
local_irq_disable();
|
|
unreachable();
|
|
}
|
|
|
|
static void ltq_machine_power_off(void)
|
|
{
|
|
pr_notice("Please turn off the power now.\n");
|
|
local_irq_disable();
|
|
unreachable();
|
|
}
|
|
|
|
static int __init mips_reboot_setup(void)
|
|
{
|
|
/* insert and request the memory region */
|
|
if (insert_resource(&iomem_resource, <q_rcu_resource) < 0)
|
|
panic("Failed to insert rcu memory");
|
|
|
|
if (request_mem_region(ltq_rcu_resource.start,
|
|
resource_size(<q_rcu_resource), "rcu") < 0)
|
|
panic("Failed to request rcu memory");
|
|
|
|
/* remap rcu register range */
|
|
ltq_rcu_membase = ioremap_nocache(ltq_rcu_resource.start,
|
|
resource_size(<q_rcu_resource));
|
|
if (!ltq_rcu_membase)
|
|
panic("Failed to remap rcu memory");
|
|
|
|
_machine_restart = ltq_machine_restart;
|
|
_machine_halt = ltq_machine_halt;
|
|
pm_power_off = ltq_machine_power_off;
|
|
|
|
return 0;
|
|
}
|
|
|
|
arch_initcall(mips_reboot_setup);
|