Quelle  pm.c   Sprache: 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/page.h>
#include <asm/suspend.h>
#include <asm/mach/time.h>

#include "generic.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 = __pa_symbol(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;
}