[deliverable/linux.git] / arch / mips / lantiq / xway / reset.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 <linux/delay.h>
#include <linux/of_address.h>
#include <linux/of_platform.h>

#include <asm/reboot.h>

#include <lantiq_soc.h>

#include "../prom.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))

/* reset request register */
#define RCU_RST_REQ		0x0010
/* reset status register */
#define RCU_RST_STAT		0x0014

/* reboot bit */
#define RCU_RD_SRST		BIT(30)
/* reset cause */
#define RCU_STAT_SHIFT		26
/* boot selection */
#define RCU_BOOT_SEL_SHIFT	26
#define RCU_BOOT_SEL_MASK	0x7

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(RCU_RST_STAT);
	return val >> RCU_STAT_SHIFT;
}
EXPORT_SYMBOL_GPL(ltq_reset_cause);

/* allow platform code to find out what source we booted from */
unsigned char ltq_boot_select(void)
{
	u32 val = ltq_rcu_r32(RCU_RST_STAT);
	return (val >> RCU_BOOT_SEL_SHIFT) & RCU_BOOT_SEL_MASK;
}

/* reset a io domain for u micro seconds */
void ltq_reset_once(unsigned int module, ulong u)
{
	ltq_rcu_w32(ltq_rcu_r32(RCU_RST_REQ) | module, RCU_RST_REQ);
	udelay(u);
	ltq_rcu_w32(ltq_rcu_r32(RCU_RST_REQ) & ~module, RCU_RST_REQ);
}

static void ltq_machine_restart(char *command)
{
	local_irq_disable();
	ltq_rcu_w32(ltq_rcu_r32(RCU_RST_REQ) | RCU_RD_SRST, RCU_RST_REQ);
	unreachable();
}

static void ltq_machine_halt(void)
{
	local_irq_disable();
	unreachable();
}

static void ltq_machine_power_off(void)
{
	local_irq_disable();
	unreachable();
}

static int __init mips_reboot_setup(void)
{
	/* insert and request the memory region */
	if (insert_resource(&iomem_resource, &ltq_rcu_resource) < 0)
		panic("Failed to insert rcu memory");

	if (request_mem_region(ltq_rcu_resource.start,
			resource_size(&ltq_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(&ltq_rcu_resource));
	if (!ltq_rcu_membase)
		panic("Failed to remap core 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);
Commit	Line	Data
8ec6d935 JC	1	/*
	2	* This program is free software; you can redistribute it and/or modify it
	3	* under the terms of the GNU General Public License version 2 as published
	4	* by the Free Software Foundation.
	5	*
	6	* Copyright (C) 2010 John Crispin <blogic@openwrt.org>
	7	*/
	8
	9	#include <linux/init.h>
	10	#include <linux/io.h>
	11	#include <linux/ioport.h>
	12	#include <linux/pm.h>
4af92e7a	13	#include <linux/export.h>
6697c693 JC	14	#include <linux/delay.h>
	15	#include <linux/of_address.h>
	16	#include <linux/of_platform.h>
	17
8ec6d935 JC	18	#include <asm/reboot.h>
	19
	20	#include <lantiq_soc.h>
	21
6697c693 JC	22	#include "../prom.h"
6697c693 JC	23
8ec6d935 JC	24	#define ltq_rcu_w32(x, y) ltq_w32((x), ltq_rcu_membase + (y))
	25	#define ltq_rcu_r32(x) ltq_r32(ltq_rcu_membase + (x))
	26
6697c693 JC	27	/* reset request register */
	28	#define RCU_RST_REQ 0x0010
	29	/* reset status register */
	30	#define RCU_RST_STAT 0x0014
8ec6d935	31
6697c693 JC	32	/* reboot bit */
	33	#define RCU_RD_SRST BIT(30)
	34	/* reset cause */
	35	#define RCU_STAT_SHIFT 26
	36	/* boot selection */
	37	#define RCU_BOOT_SEL_SHIFT 26
	38	#define RCU_BOOT_SEL_MASK 0x7
8ec6d935 JC	39
	40	static struct resource ltq_rcu_resource = {
	41	.name = "rcu",
	42	.start = LTQ_RCU_BASE_ADDR,
	43	.end = LTQ_RCU_BASE_ADDR + LTQ_RCU_SIZE - 1,
	44	.flags = IORESOURCE_MEM,
	45	};
	46
	47	/* remapped base addr of the reset control unit */
	48	static void __iomem *ltq_rcu_membase;
	49
	50	/* This function is used by the watchdog driver */
	51	int ltq_reset_cause(void)
	52	{
6697c693 JC	53	u32 val = ltq_rcu_r32(RCU_RST_STAT);
6697c693 JC	54	return val >> RCU_STAT_SHIFT;
8ec6d935 JC	55	}
	56	EXPORT_SYMBOL_GPL(ltq_reset_cause);
	57
6697c693 JC	58	/* allow platform code to find out what source we booted from */
	59	unsigned char ltq_boot_select(void)
	60	{
	61	u32 val = ltq_rcu_r32(RCU_RST_STAT);
	62	return (val >> RCU_BOOT_SEL_SHIFT) & RCU_BOOT_SEL_MASK;
	63	}
	64
	65	/* reset a io domain for u micro seconds */
	66	void ltq_reset_once(unsigned int module, ulong u)
	67	{
	68	ltq_rcu_w32(ltq_rcu_r32(RCU_RST_REQ) \| module, RCU_RST_REQ);
	69	udelay(u);
	70	ltq_rcu_w32(ltq_rcu_r32(RCU_RST_REQ) & ~module, RCU_RST_REQ);
	71	}
	72
8ec6d935 JC	73	static void ltq_machine_restart(char *command)
8ec6d935 JC	74	{
8ec6d935	75	local_irq_disable();
6697c693	76	ltq_rcu_w32(ltq_rcu_r32(RCU_RST_REQ) \| RCU_RD_SRST, RCU_RST_REQ);
8ec6d935 JC	77	unreachable();
	78	}
	79
	80	static void ltq_machine_halt(void)
	81	{
8ec6d935 JC	82	local_irq_disable();
	83	unreachable();
	84	}
	85
	86	static void ltq_machine_power_off(void)
	87	{
8ec6d935 JC	88	local_irq_disable();
	89	unreachable();
	90	}
	91
	92	static int __init mips_reboot_setup(void)
	93	{
	94	/* insert and request the memory region */
	95	if (insert_resource(&iomem_resource, &ltq_rcu_resource) < 0)
ab75dc02	96	panic("Failed to insert rcu memory");
8ec6d935 JC	97
	98	if (request_mem_region(ltq_rcu_resource.start,
	99	resource_size(&ltq_rcu_resource), "rcu") < 0)
ab75dc02	100	panic("Failed to request rcu memory");
8ec6d935 JC	101
	102	/* remap rcu register range */
	103	ltq_rcu_membase = ioremap_nocache(ltq_rcu_resource.start,
	104	resource_size(&ltq_rcu_resource));
	105	if (!ltq_rcu_membase)
6697c693	106	panic("Failed to remap core memory");
8ec6d935 JC	107
	108	_machine_restart = ltq_machine_restart;
	109	_machine_halt = ltq_machine_halt;
	110	pm_power_off = ltq_machine_power_off;
	111
	112	return 0;
	113	}
	114
	115	arch_initcall(mips_reboot_setup);