Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 1199919b authored by Olof Johansson's avatar Olof Johansson Committed by Paul Mackerras
Browse files

[POWERPC] pasemi: Idle loops 



Powersave support on PA6T. Right now it only uses 'doze' mode, and
will default to no savings (spin).

Signed-off-by: default avatarOlof Johansson <olof@lixom.net>
Acked-by: default avatarArnd Bergmann <arnd@arndb.de>
Signed-off-by: default avatarPaul Mackerras <paulus@samba.org>
parent bfed9d32

arch/powerpc/kernel/Makefile

+1 −0
Original line number Diff line number Diff line
@@ -17,6 +17,7 @@ obj-y += vdso32/ 
obj-$(CONFIG_PPC64)		+= setup_64.o binfmt_elf32.o sys_ppc32.o \

				   signal_64.o ptrace32.o \

				   paca.o cpu_setup_ppc970.o \

				   cpu_setup_pa6t.o \

				   firmware.o sysfs.o nvram_64.o

obj-$(CONFIG_PPC64)		+= vdso64/

obj-$(CONFIG_ALTIVEC)		+= vecemu.o vector.o

arch/powerpc/kernel/cpu_setup_pa6t.S

0 → 100644
+44 −0
Original line number Diff line number Diff line 
/*

 * Copyright (C) 2006-2007 PA Semi, Inc

 *

 * Maintained by: Olof Johansson <olof@lixom.net>

 *

 * 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.

 *

 * This program is distributed in the hope that it will be useful,

 * but WITHOUT ANY WARRANTY; without even the implied warranty of

 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

 * GNU General Public License for more details.

 *

 * You should have received a copy of the GNU General Public License

 * along with this program; if not, write to the Free Software

 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA

 *

 */



#include <asm/processor.h>

#include <asm/page.h>

#include <asm/cputable.h>

#include <asm/ppc_asm.h>

#include <asm/asm-offsets.h>

#include <asm/cache.h>



/* Right now, restore and setup are the same thing */

_GLOBAL(__restore_cpu_pa6t)

_GLOBAL(__setup_cpu_pa6t)

	/* Do nothing if not running in HV mode */

	mfmsr	r0

	rldicl.	r0,r0,4,63

	beqlr



	mfspr	r0,SPRN_HID5

	ori	r0,r0,0x30

	mtspr	SPRN_HID5,r0



	mfspr	r0,SPRN_LPCR

	ori	r0,r0,0x7000

	mtspr	SPRN_LPCR,r0



	blr

arch/powerpc/kernel/cputable.c

+4 −0
Original line number Diff line number Diff line
@@ -43,6 +43,8 @@ extern void __setup_cpu_745x(unsigned long offset, struct cpu_spec* spec); 
#ifdef CONFIG_PPC64

extern void __setup_cpu_ppc970(unsigned long offset, struct cpu_spec* spec);

extern void __setup_cpu_ppc970MP(unsigned long offset, struct cpu_spec* spec);

extern void __setup_cpu_pa6t(unsigned long offset, struct cpu_spec* spec);

extern void __restore_cpu_pa6t(unsigned long offset, struct cpu_spec* spec);

extern void __restore_cpu_ppc970(void);

#endif /* CONFIG_PPC64 */
@@ -369,6 +371,8 @@ static struct cpu_spec cpu_specs[] = { 
		.dcache_bsize		= 64,

		.num_pmcs		= 6,

		.pmc_type		= PPC_PMC_PA6T,

		.cpu_setup		= __setup_cpu_pa6t,

		.cpu_restore		= __restore_cpu_pa6t,

		.platform		= "pa6t",

	},

	{	/* default match */

arch/powerpc/platforms/pasemi/Makefile

+2 −1
Original line number Diff line number Diff line 
obj-y	+= setup.o pci.o time.o
 
obj-y	+= setup.o pci.o time.o idle.o powersave.o

arch/powerpc/platforms/pasemi/idle.c

0 → 100644
+88 −0
Original line number Diff line number Diff line 
/*

 * Copyright (C) 2006-2007 PA Semi, Inc

 *

 * Maintained by: Olof Johansson <olof@lixom.net>

 *

 * 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.

 *

 * This program is distributed in the hope that it will be useful,

 * but WITHOUT ANY WARRANTY; without even the implied warranty of

 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

 * GNU General Public License for more details.

 *

 * You should have received a copy of the GNU General Public License

 * along with this program; if not, write to the Free Software

 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA

 *

 */



#undef DEBUG



#include <linux/kernel.h>

#include <linux/string.h>



#include <asm/machdep.h>

#include <asm/reg.h>



#include "pasemi.h"



struct sleep_mode {

	char *name;

	void (*entry)(void);

};



static struct sleep_mode modes[] = {

	{ .name = "spin", .entry = &idle_spin },

	{ .name = "doze", .entry = &idle_doze },

};



static int current_mode = 0;



static int pasemi_system_reset_exception(struct pt_regs *regs)

{

	/* If we were woken up from power savings, we need to return

	 * to the calling function, since nip is not saved across

	 * all modes.

	 */



	if (regs->msr & SRR1_WAKEMASK)

		regs->nip = regs->link;



	switch (regs->msr & SRR1_WAKEMASK) {

	case SRR1_WAKEEE:

		do_IRQ(regs);

		break;

	case SRR1_WAKEDEC:

		timer_interrupt(regs);

		break;

	default:

		/* do system reset */

		return 0;

	}

	/* everything handled */

	regs->msr |= MSR_RI;

	return 1;

}



void __init pasemi_idle_init(void)

{

	ppc_md.system_reset_exception = pasemi_system_reset_exception;

	ppc_md.power_save = modes[current_mode].entry;

	printk(KERN_INFO "Using PA6T idle loop (%s)\n", modes[current_mode].name);

}



static int __init idle_param(char *p)

{

	int i;

	for (i = 0; i < sizeof(modes)/sizeof(struct sleep_mode); i++) {

		if (!strcmp(modes[i].name, p)) {

			current_mode = i;

			break;

		}

	}

	return 0;

}



early_param("idle", idle_param);