Subversion Repositories or1k_soc_on_altera_embedded_dev_kit

/*
 *  linux/arch/or32/kernel/idle.c
 *
 *  or32 version
 *    author(s): Matjaz Breskvar (phoenix@bsemi.com)
 *
 *  derived from cris, i386, m68k, ppc, sh ports.
 *
 *  changes:
 *  18. 11. 2003: Matjaz Breskvar (phoenix@bsemi.com)
 *    initial port to or32 architecture
 *
 * Idle daemon for or32.  Idle daemon will handle any action
 * that needs to be taken when the system becomes idle.
 *
 * Based on:
 * arch/ppc/kernel/idle.c
 * Written by Cort Dougan (cort@cs.nmt.edu)
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License
 * as published by the Free Software Foundation; either version
 * 2 of the License, or (at your option) any later version.
 */
 
#include <linux/errno.h>
#include <linux/sched.h>
#include <linux/kernel.h>
#include <linux/mm.h>
#include <linux/smp.h>
#include <linux/smp_lock.h>
#include <linux/stddef.h>
#include <linux/unistd.h>
#include <linux/ptrace.h>
#include <linux/slab.h>
 
#include <asm/pgtable.h>
#include <asm/uaccess.h>
#include <asm/system.h>
#include <asm/io.h>
#include <asm/processor.h>
#include <asm/mmu.h>
#include <asm/cache.h>
 
void (*powersave)(void) = NULL;
 
void cpu_idle(void)
{
	int spr_sr;
 
	for (;;) {
 
// __PHX__ TODO: make an config option or something
#if 1
		if (!(SPR_SR_TEE & (spr_sr = mfspr(SPR_SR)))) {
			printk("idled: tick timer disabled, enabling...\n");
			printk("idled: SR 0x%lx, ESR 0x%lx, EPCR 0x%lx, EEAR 0x%lx\n",
			       mfspr(SPR_SR), mfspr(SPR_ESR_BASE), 
			       mfspr(SPR_EPCR_BASE), mfspr(SPR_EEAR_BASE));
 
			mtspr(SPR_SR, spr_sr | SPR_SR_TEE);
			// __PHX__ TODO: add trace
		}
#endif
 
		if (!need_resched()) {
			if (powersave != NULL) {
				powersave();
			}
		}
#if 0
		if (need_resched())
			schedule();
 
#else
	schedule();
#endif
 
	}
}