[deliverable/linux.git] / arch / arm / mach-sa1100 / pm.c

/*
 * SA1100 Power Management Routines
 *
 * Copyright (c) 2001 Cliff Brake <cbrake@accelent.com>
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License.
 *
 * History:
 *
 * 2001-02-06:	Cliff Brake         Initial code
 *
 * 2001-02-25:	Sukjae Cho <sjcho@east.isi.edu> &
 * 		Chester Kuo <chester@linux.org.tw>
 * 			Save more value for the resume function! Support
 * 			Bitsy/Assabet/Freebird board
 *
 * 2001-08-29:	Nicolas Pitre <nico@fluxnic.net>
 * 			Cleaned up, pushed platform dependent stuff
 * 			in the platform specific files.
 *
 * 2002-05-27:	Nicolas Pitre	Killed sleep.h and the kmalloced save array.
 * 				Storage is local on the stack now.
 */
#include <linux/init.h>
#include <linux/io.h>
#include <linux/suspend.h>
#include <linux/errno.h>
#include <linux/time.h>

#include <mach/hardware.h>
#include <asm/memory.h>
#include <asm/suspend.h>
#include <asm/mach/time.h>

extern int sa1100_finish_suspend(unsigned long);

#define SAVE(x)		sleep_save[SLEEP_SAVE_##x] = x
#define RESTORE(x)	x = sleep_save[SLEEP_SAVE_##x]

/*
 * List of global SA11x0 peripheral registers to preserve.
 * More ones like CP and general purpose register values are preserved
 * on the stack and then the stack pointer is stored last in sleep.S.
 */
enum {	SLEEP_SAVE_GPDR, SLEEP_SAVE_GAFR,
	SLEEP_SAVE_PPDR, SLEEP_SAVE_PPSR, SLEEP_SAVE_PPAR, SLEEP_SAVE_PSDR,

	SLEEP_SAVE_Ser1SDCR0,

	SLEEP_SAVE_COUNT
};


static int sa11x0_pm_enter(suspend_state_t state)
{
	unsigned long gpio, sleep_save[SLEEP_SAVE_COUNT];

	gpio = GPLR;

	/* save vital registers */
	SAVE(GPDR);
	SAVE(GAFR);

	SAVE(PPDR);
	SAVE(PPSR);
	SAVE(PPAR);
	SAVE(PSDR);

	SAVE(Ser1SDCR0);

	/* Clear previous reset status */
	RCSR = RCSR_HWR | RCSR_SWR | RCSR_WDR | RCSR_SMR;

	/* set resume return address */
	PSPR = virt_to_phys(cpu_resume);

	/* go zzz */
	cpu_suspend(0, sa1100_finish_suspend);

	/*
	 * Ensure not to come back here if it wasn't intended
	 */
	RCSR = RCSR_SMR;
	PSPR = 0;

	/*
	 * Ensure interrupt sources are disabled; we will re-init
	 * the interrupt subsystem via the device manager.
	 */
	ICLR = 0;
	ICCR = 1;
	ICMR = 0;

	/* restore registers */
	RESTORE(GPDR);
	RESTORE(GAFR);

	RESTORE(PPDR);
	RESTORE(PPSR);
	RESTORE(PPAR);
	RESTORE(PSDR);

	RESTORE(Ser1SDCR0);

	GPSR = gpio;
	GPCR = ~gpio;

	/*
	 * Clear the peripheral sleep-hold bit.
	 */
	PSSR = PSSR_PH;

	return 0;
}

static const struct platform_suspend_ops sa11x0_pm_ops = {
	.enter		= sa11x0_pm_enter,
	.valid		= suspend_valid_only_mem,
};

int __init sa11x0_pm_init(void)
{
	suspend_set_ops(&sa11x0_pm_ops);
	return 0;
}
Commit	Line	Data
1da177e4 LT	1	/*
	2	* SA1100 Power Management Routines
	3	*
	4	* Copyright (c) 2001 Cliff Brake <cbrake@accelent.com>
	5	*
	6	* This program is free software; you can redistribute it and/or
	7	* modify it under the terms of the GNU General Public License.
	8	*
	9	* History:
	10	*
	11	* 2001-02-06: Cliff Brake Initial code
	12	*
	13	* 2001-02-25: Sukjae Cho <sjcho@east.isi.edu> &
	14	* Chester Kuo <chester@linux.org.tw>
	15	* Save more value for the resume function! Support
	16	* Bitsy/Assabet/Freebird board
	17	*
2f82af08	18	* 2001-08-29: Nicolas Pitre <nico@fluxnic.net>
1da177e4 LT	19	* Cleaned up, pushed platform dependent stuff
	20	* in the platform specific files.
	21	*
	22	* 2002-05-27: Nicolas Pitre Killed sleep.h and the kmalloced save array.
	23	* Storage is local on the stack now.
	24	*/
	25	#include <linux/init.h>
3169663a	26	#include <linux/io.h>
1da177e4 LT	27	#include <linux/suspend.h>
	28	#include <linux/errno.h>
	29	#include <linux/time.h>
	30
a09e64fb	31	#include <mach/hardware.h>
1da177e4	32	#include <asm/memory.h>
2c74a0ce	33	#include <asm/suspend.h>
1da177e4 LT	34	#include <asm/mach/time.h>
1da177e4 LT	35
29cb3cd2	36	extern int sa1100_finish_suspend(unsigned long);
1da177e4 LT	37
	38	#define SAVE(x) sleep_save[SLEEP_SAVE_##x] = x
	39	#define RESTORE(x) x = sleep_save[SLEEP_SAVE_##x]
	40
	41	/*
	42	* List of global SA11x0 peripheral registers to preserve.
	43	* More ones like CP and general purpose register values are preserved
	44	* on the stack and then the stack pointer is stored last in sleep.S.
	45	*/
649de51b	46	enum { SLEEP_SAVE_GPDR, SLEEP_SAVE_GAFR,
1da177e4 LT	47	SLEEP_SAVE_PPDR, SLEEP_SAVE_PPSR, SLEEP_SAVE_PPAR, SLEEP_SAVE_PSDR,
	48
	49	SLEEP_SAVE_Ser1SDCR0,
	50
649de51b	51	SLEEP_SAVE_COUNT
1da177e4 LT	52	};
	53
	54
	55	static int sa11x0_pm_enter(suspend_state_t state)
	56	{
649de51b	57	unsigned long gpio, sleep_save[SLEEP_SAVE_COUNT];
1da177e4	58
1da177e4 LT	59	gpio = GPLR;
	60
	61	/* save vital registers */
	62	SAVE(GPDR);
	63	SAVE(GAFR);
	64
	65	SAVE(PPDR);
	66	SAVE(PPSR);
	67	SAVE(PPAR);
	68	SAVE(PSDR);
	69
	70	SAVE(Ser1SDCR0);
	71
	72	/* Clear previous reset status */
	73	RCSR = RCSR_HWR \| RCSR_SWR \| RCSR_WDR \| RCSR_SMR;
	74
	75	/* set resume return address */
96c20015	76	PSPR = virt_to_phys(cpu_resume);
1da177e4 LT	77
1da177e4 LT	78	/* go zzz */
2c74a0ce	79	cpu_suspend(0, sa1100_finish_suspend);
1da177e4 LT	80
	81	/*
	82	* Ensure not to come back here if it wasn't intended
	83	*/
e461894d	84	RCSR = RCSR_SMR;
1da177e4 LT	85	PSPR = 0;
	86
	87	/*
	88	* Ensure interrupt sources are disabled; we will re-init
	89	* the interrupt subsystem via the device manager.
	90	*/
	91	ICLR = 0;
	92	ICCR = 1;
	93	ICMR = 0;
	94
	95	/* restore registers */
	96	RESTORE(GPDR);
	97	RESTORE(GAFR);
	98
	99	RESTORE(PPDR);
	100	RESTORE(PPSR);
	101	RESTORE(PPAR);
	102	RESTORE(PSDR);
	103
	104	RESTORE(Ser1SDCR0);
	105
	106	GPSR = gpio;
	107	GPCR = ~gpio;
	108
	109	/*
	110	* Clear the peripheral sleep-hold bit.
	111	*/
	112	PSSR = PSSR_PH;
	113
1da177e4 LT	114	return 0;
	115	}
	116
2f55ac07	117	static const struct platform_suspend_ops sa11x0_pm_ops = {
1da177e4	118	.enter = sa11x0_pm_enter,
26398a70	119	.valid = suspend_valid_only_mem,
1da177e4 LT	120	};
1da177e4 LT	121
7fea1ba5	122	int __init sa11x0_pm_init(void)
1da177e4	123	{
26398a70	124	suspend_set_ops(&sa11x0_pm_ops);
1da177e4 LT	125	return 0;
1da177e4 LT	126	}