/* *  A2 specific assembly support code * *  Copyright 2009 Ben Herrenschmidt, IBM Corp. * *  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 <asm/asm-offsets.h>#include <asm/ppc_asm.h>#include <asm/ppc-opcode.h>#include <asm/processor.h>#include <asm/reg_a2.h>#include <asm/reg.h>#include <asm/thread_info.h> /* * Disable thdid and class fields in ERATs to bump PID to full 14 bits capacity. * This also prevents external LPID accesses but that isn't a problem when not a * guest. Under PV, this setting will be ignored and MMUCR will return the right * number of PID bits we can use. */#define MMUCR1_EXTEND_PID \	(MMUCR1_ICTID | MMUCR1_ITTID | MMUCR1_DCTID | \	 MMUCR1_DTTID | MMUCR1_DCCD) /* * Use extended PIDs if enabled. * Don't clear the ERATs on context sync events and enable I & D LRU. * Enable ERAT back invalidate when tlbwe overwrites an entry. */#define INITIAL_MMUCR1 \	(MMUCR1_EXTEND_PID | MMUCR1_CSINV_NEVER | MMUCR1_IRRE | \	 MMUCR1_DRRE | MMUCR1_TLBWE_BINV) _GLOBAL(__setup_cpu_a2)	/* Some of these are actually thread local and some are	 * core local but doing it always won't hurt	 */ #ifdef CONFIG_PPC_WSP_COPRO	/* Make sure ACOP starts out as zero */	li	r3,0	mtspr   SPRN_ACOP,r3 	/* Enable icswx instruction */	mfspr   r3,SPRN_A2_CCR2	ori     r3,r3,A2_CCR2_ENABLE_ICSWX	mtspr   SPRN_A2_CCR2,r3 	/* Unmask all CTs in HACOP */	li      r3,-1	mtspr   SPRN_HACOP,r3#endif /* CONFIG_PPC_WSP_COPRO */ 	/* Enable doorbell */	mfspr   r3,SPRN_A2_CCR2	oris     r3,r3,A2_CCR2_ENABLE_PC@h	mtspr   SPRN_A2_CCR2,r3	isync 	/* Setup CCR0 to disable power saving for now as it's busted	 * in the current implementations. Setup CCR1 to wake on	 * interrupts normally (we write the default value but who	 * knows what FW may have clobbered...)	 */	li	r3,0	mtspr	SPRN_A2_CCR0, r3	LOAD_REG_IMMEDIATE(r3,0x0f0f0f0f)	mtspr	SPRN_A2_CCR1, r3 	/* Initialise MMUCR1 */	lis	r3,INITIAL_MMUCR1@h	ori	r3,r3,INITIAL_MMUCR1@l	mtspr	SPRN_MMUCR1,r3 	/* Set MMUCR2 to enable 4K, 64K, 1M, 16M and 1G pages */	LOAD_REG_IMMEDIATE(r3, 0x000a7531)	mtspr	SPRN_MMUCR2,r3 	/* Set MMUCR3 to write all thids bit to the TLB */	LOAD_REG_IMMEDIATE(r3, 0x0000000f)	mtspr	SPRN_MMUCR3,r3 	/* Don't do ERAT stuff if running guest mode */	mfmsr	r3	andis.	r0,r3,MSR_GS@h	bne	1f 	/* Now set the I-ERAT watermark to 15 */	lis	r4,(MMUCR0_TLBSEL_I|MMUCR0_ECL)@h	mtspr	SPRN_MMUCR0, r4	li	r4,A2_IERAT_SIZE-1	PPC_ERATWE(r4,r4,3) 	/* Now set the D-ERAT watermark to 31 */	lis	r4,(MMUCR0_TLBSEL_D|MMUCR0_ECL)@h	mtspr	SPRN_MMUCR0, r4	li	r4,A2_DERAT_SIZE-1	PPC_ERATWE(r4,r4,3) 	/* And invalidate the beast just in case. That won't get rid of	 * a bolted entry though it will be in LRU and so will go away eventually	 * but let's not bother for now	 */	PPC_ERATILX(0,0,0)1:	blr _GLOBAL(__restore_cpu_a2)	b	__setup_cpu_a2