[deliverable/linux.git] / arch / arm / mm / proc-v7-3level.S

/*
 * arch/arm/mm/proc-v7-3level.S
 *
 * Copyright (C) 2001 Deep Blue Solutions Ltd.
 * Copyright (C) 2011 ARM Ltd.
 * Author: Catalin Marinas <catalin.marinas@arm.com>
 *   based on arch/arm/mm/proc-v7-2level.S
 *
 * 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/assembler.h>

#define TTB_IRGN_NC	(0 << 8)
#define TTB_IRGN_WBWA	(1 << 8)
#define TTB_IRGN_WT	(2 << 8)
#define TTB_IRGN_WB	(3 << 8)
#define TTB_RGN_NC	(0 << 10)
#define TTB_RGN_OC_WBWA	(1 << 10)
#define TTB_RGN_OC_WT	(2 << 10)
#define TTB_RGN_OC_WB	(3 << 10)
#define TTB_S		(3 << 12)
#define TTB_EAE		(1 << 31)

/* PTWs cacheable, inner WB not shareable, outer WB not shareable */
#define TTB_FLAGS_UP	(TTB_IRGN_WB|TTB_RGN_OC_WB)
#define PMD_FLAGS_UP	(PMD_SECT_WB)

/* PTWs cacheable, inner WBWA shareable, outer WBWA not shareable */
#define TTB_FLAGS_SMP	(TTB_IRGN_WBWA|TTB_S|TTB_RGN_OC_WBWA)
#define PMD_FLAGS_SMP	(PMD_SECT_WBWA|PMD_SECT_S)

#ifndef __ARMEB__
#  define rpgdl	r0
#  define rpgdh	r1
#else
#  define rpgdl	r1
#  define rpgdh	r0
#endif

/*
 * cpu_v7_switch_mm(pgd_phys, tsk)
 *
 * Set the translation table base pointer to be pgd_phys (physical address of
 * the new TTB).
 */
ENTRY(cpu_v7_switch_mm)
#ifdef CONFIG_MMU
	mmid	r2, r2
	asid	r2, r2
	orr	rpgdh, rpgdh, r2, lsl #(48 - 32)	@ upper 32-bits of pgd
	mcrr	p15, 0, rpgdl, rpgdh, c2		@ set TTB 0
	isb
#endif
	ret	lr
ENDPROC(cpu_v7_switch_mm)

#ifdef __ARMEB__
#define rl r3
#define rh r2
#else
#define rl r2
#define rh r3
#endif

/*
 * cpu_v7_set_pte_ext(ptep, pte)
 *
 * Set a level 2 translation table entry.
 * - ptep - pointer to level 3 translation table entry
 * - pte - PTE value to store (64-bit in r2 and r3)
 */
ENTRY(cpu_v7_set_pte_ext)
#ifdef CONFIG_MMU
	tst	rl, #L_PTE_VALID
	beq	1f
	tst	rh, #1 << (57 - 32)		@ L_PTE_NONE
	bicne	rl, #L_PTE_VALID
	bne	1f

	eor	ip, rh, #1 << (55 - 32)	@ toggle L_PTE_DIRTY in temp reg to
					@ test for !L_PTE_DIRTY || L_PTE_RDONLY
	tst	ip, #1 << (55 - 32) | 1 << (58 - 32)
	orrne	rl, #PTE_AP2
	biceq	rl, #PTE_AP2

1:	strd	r2, r3, [r0]
	ALT_SMP(W(nop))
	ALT_UP (mcr	p15, 0, r0, c7, c10, 1)		@ flush_pte
#endif
	ret	lr
ENDPROC(cpu_v7_set_pte_ext)

	/*
	 * Memory region attributes for LPAE (defined in pgtable-3level.h):
	 *
	 *   n = AttrIndx[2:0]
	 *
	 *			n	MAIR
	 *   UNCACHED		000	00000000
	 *   BUFFERABLE		001	01000100
	 *   DEV_WC		001	01000100
	 *   WRITETHROUGH	010	10101010
	 *   WRITEBACK		011	11101110
	 *   DEV_CACHED		011	11101110
	 *   DEV_SHARED		100	00000100
	 *   DEV_NONSHARED	100	00000100
	 *   unused		101
	 *   unused		110
	 *   WRITEALLOC		111	11111111
	 */
.equ	PRRR,	0xeeaa4400			@ MAIR0
.equ	NMRR,	0xff000004			@ MAIR1

	/*
	 * Macro for setting up the TTBRx and TTBCR registers.
	 * - \ttbr1 updated.
	 */
	.macro	v7_ttb_setup, zero, ttbr0, ttbr1, tmp
	ldr	\tmp, =swapper_pg_dir		@ swapper_pg_dir virtual address
	mov	\tmp, \tmp, lsr #ARCH_PGD_SHIFT
	cmp	\ttbr1, \tmp			@ PHYS_OFFSET > PAGE_OFFSET?
	mrc	p15, 0, \tmp, c2, c0, 2		@ TTB control register
	orr	\tmp, \tmp, #TTB_EAE
	ALT_SMP(orr	\tmp, \tmp, #TTB_FLAGS_SMP)
	ALT_UP(orr	\tmp, \tmp, #TTB_FLAGS_UP)
	ALT_SMP(orr	\tmp, \tmp, #TTB_FLAGS_SMP << 16)
	ALT_UP(orr	\tmp, \tmp, #TTB_FLAGS_UP << 16)
	/*
	 * Only use split TTBRs if PHYS_OFFSET <= PAGE_OFFSET (cmp above),
	 * otherwise booting secondary CPUs would end up using TTBR1 for the
	 * identity mapping set up in TTBR0.
	 */
	orrls	\tmp, \tmp, #TTBR1_SIZE				@ TTBCR.T1SZ
	mcr	p15, 0, \tmp, c2, c0, 2				@ TTBCR
	mov	\tmp, \ttbr1, lsr #(32 - ARCH_PGD_SHIFT)	@ upper bits
	mov	\ttbr1, \ttbr1, lsl #ARCH_PGD_SHIFT		@ lower bits
	addls	\ttbr1, \ttbr1, #TTBR1_OFFSET
	adcls	\tmp, \tmp, #0
	mcrr	p15, 1, \ttbr1, \tmp, c2			@ load TTBR1
	mov	\tmp, \ttbr0, lsr #(32 - ARCH_PGD_SHIFT)	@ upper bits
	mov	\ttbr0, \ttbr0, lsl #ARCH_PGD_SHIFT		@ lower bits
	mcrr	p15, 0, \ttbr0, \tmp, c2			@ load TTBR0
	.endm

	/*
	 *   AT
	 *  TFR   EV X F   IHD LR    S
	 * .EEE ..EE PUI. .TAT 4RVI ZWRS BLDP WCAM
	 * rxxx rrxx xxx0 0101 xxxx xxxx x111 xxxx < forced
	 *   11    0 110    1  0011 1100 .111 1101 < we want
	 */
	.align	2
	.type	v7_crval, #object
v7_crval:
	crval	clear=0x0120c302, mmuset=0x30c23c7d, ucset=0x00c01c7c
Commit	Line	Data
1b6ba46b CM	1	/*
	2	* arch/arm/mm/proc-v7-3level.S
	3	*
	4	* Copyright (C) 2001 Deep Blue Solutions Ltd.
	5	* Copyright (C) 2011 ARM Ltd.
	6	* Author: Catalin Marinas <catalin.marinas@arm.com>
	7	* based on arch/arm/mm/proc-v7-2level.S
	8	*
	9	* This program is free software; you can redistribute it and/or modify
	10	* it under the terms of the GNU General Public License version 2 as
	11	* published by the Free Software Foundation.
	12	*
	13	* This program is distributed in the hope that it will be useful,
	14	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	15	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	16	* GNU General Public License for more details.
	17	*
	18	* You should have received a copy of the GNU General Public License
	19	* along with this program; if not, write to the Free Software
	20	* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
	21	*/
6ebbf2ce	22	#include <asm/assembler.h>
1b6ba46b CM	23
	24	#define TTB_IRGN_NC (0 << 8)
	25	#define TTB_IRGN_WBWA (1 << 8)
	26	#define TTB_IRGN_WT (2 << 8)
	27	#define TTB_IRGN_WB (3 << 8)
	28	#define TTB_RGN_NC (0 << 10)
	29	#define TTB_RGN_OC_WBWA (1 << 10)
	30	#define TTB_RGN_OC_WT (2 << 10)
	31	#define TTB_RGN_OC_WB (3 << 10)
	32	#define TTB_S (3 << 12)
	33	#define TTB_EAE (1 << 31)
	34
	35	/* PTWs cacheable, inner WB not shareable, outer WB not shareable */
	36	#define TTB_FLAGS_UP (TTB_IRGN_WB\|TTB_RGN_OC_WB)
	37	#define PMD_FLAGS_UP (PMD_SECT_WB)
	38
	39	/* PTWs cacheable, inner WBWA shareable, outer WBWA not shareable */
	40	#define TTB_FLAGS_SMP (TTB_IRGN_WBWA\|TTB_S\|TTB_RGN_OC_WBWA)
	41	#define PMD_FLAGS_SMP (PMD_SECT_WBWA\|PMD_SECT_S)
	42
13f659b0 CC	43	#ifndef __ARMEB__
	44	# define rpgdl r0
	45	# define rpgdh r1
	46	#else
	47	# define rpgdl r1
	48	# define rpgdh r0
	49	#endif
	50
1b6ba46b CM	51	/*
	52	* cpu_v7_switch_mm(pgd_phys, tsk)
	53	*
	54	* Set the translation table base pointer to be pgd_phys (physical address of
	55	* the new TTB).
	56	*/
	57	ENTRY(cpu_v7_switch_mm)
	58	#ifdef CONFIG_MMU
13f659b0 CC	59	mmid r2, r2
	60	asid r2, r2
	61	orr rpgdh, rpgdh, r2, lsl #(48 - 32) @ upper 32-bits of pgd
	62	mcrr p15, 0, rpgdl, rpgdh, c2 @ set TTB 0
1b6ba46b CM	63	isb
1b6ba46b CM	64	#endif
6ebbf2ce	65	ret lr
1b6ba46b CM	66	ENDPROC(cpu_v7_switch_mm)
1b6ba46b CM	67
86f40622 JW	68	#ifdef __ARMEB__
	69	#define rl r3
	70	#define rh r2
	71	#else
	72	#define rl r2
	73	#define rh r3
	74	#endif
	75
1b6ba46b CM	76	/*
	77	* cpu_v7_set_pte_ext(ptep, pte)
	78	*
	79	* Set a level 2 translation table entry.
	80	* - ptep - pointer to level 3 translation table entry
	81	* - pte - PTE value to store (64-bit in r2 and r3)
	82	*/
	83	ENTRY(cpu_v7_set_pte_ext)
	84	#ifdef CONFIG_MMU
86f40622	85	tst rl, #L_PTE_VALID
1b6ba46b	86	beq 1f
86f40622 JW	87	tst rh, #1 << (57 - 32) @ L_PTE_NONE
86f40622 JW	88	bicne rl, #L_PTE_VALID
26ffd0d4	89	bne 1f
ded94779 SC	90
	91	eor ip, rh, #1 << (55 - 32) @ toggle L_PTE_DIRTY in temp reg to
	92	@ test for !L_PTE_DIRTY \|\| L_PTE_RDONLY
	93	tst ip, #1 << (55 - 32) \| 1 << (58 - 32)
	94	orrne rl, #PTE_AP2
	95	biceq rl, #PTE_AP2
	96
1b6ba46b	97	1: strd r2, r3, [r0]
bf3f0f33	98	ALT_SMP(W(nop))
ae8a8b95	99	ALT_UP (mcr p15, 0, r0, c7, c10, 1) @ flush_pte
1b6ba46b	100	#endif
6ebbf2ce	101	ret lr
1b6ba46b CM	102	ENDPROC(cpu_v7_set_pte_ext)
	103
	104	/*
	105	* Memory region attributes for LPAE (defined in pgtable-3level.h):
	106	*
	107	* n = AttrIndx[2:0]
	108	*
	109	* n MAIR
	110	* UNCACHED 000 00000000
	111	* BUFFERABLE 001 01000100
	112	* DEV_WC 001 01000100
	113	* WRITETHROUGH 010 10101010
	114	* WRITEBACK 011 11101110
	115	* DEV_CACHED 011 11101110
	116	* DEV_SHARED 100 00000100
	117	* DEV_NONSHARED 100 00000100
	118	* unused 101
	119	* unused 110
	120	* WRITEALLOC 111 11111111
	121	*/
	122	.equ PRRR, 0xeeaa4400 @ MAIR0
	123	.equ NMRR, 0xff000004 @ MAIR1
	124
	125	/*
	126	* Macro for setting up the TTBRx and TTBCR registers.
	127	* - \ttbr1 updated.
	128	*/
	129	.macro v7_ttb_setup, zero, ttbr0, ttbr1, tmp
	130	ldr \tmp, =swapper_pg_dir @ swapper_pg_dir virtual address
4756dcbf	131	mov \tmp, \tmp, lsr #ARCH_PGD_SHIFT
a7fbc0d6	132	cmp \ttbr1, \tmp @ PHYS_OFFSET > PAGE_OFFSET?
1b6ba46b CM	133	mrc p15, 0, \tmp, c2, c0, 2 @ TTB control register
	134	orr \tmp, \tmp, #TTB_EAE
	135	ALT_SMP(orr \tmp, \tmp, #TTB_FLAGS_SMP)
	136	ALT_UP(orr \tmp, \tmp, #TTB_FLAGS_UP)
	137	ALT_SMP(orr \tmp, \tmp, #TTB_FLAGS_SMP << 16)
	138	ALT_UP(orr \tmp, \tmp, #TTB_FLAGS_UP << 16)
	139	/*
a7fbc0d6 CC	140	* Only use split TTBRs if PHYS_OFFSET <= PAGE_OFFSET (cmp above),
	141	* otherwise booting secondary CPUs would end up using TTBR1 for the
	142	* identity mapping set up in TTBR0.
1b6ba46b	143	*/
a7fbc0d6 CC	144	orrls \tmp, \tmp, #TTBR1_SIZE @ TTBCR.T1SZ
a7fbc0d6 CC	145	mcr p15, 0, \tmp, c2, c0, 2 @ TTBCR
4756dcbf CC	146	mov \tmp, \ttbr1, lsr #(32 - ARCH_PGD_SHIFT) @ upper bits
4756dcbf CC	147	mov \ttbr1, \ttbr1, lsl #ARCH_PGD_SHIFT @ lower bits
a7fbc0d6	148	addls \ttbr1, \ttbr1, #TTBR1_OFFSET
7fb00c2f KK	149	adcls \tmp, \tmp, #0
7fb00c2f KK	150	mcrr p15, 1, \ttbr1, \tmp, c2 @ load TTBR1
4756dcbf CC	151	mov \tmp, \ttbr0, lsr #(32 - ARCH_PGD_SHIFT) @ upper bits
4756dcbf CC	152	mov \ttbr0, \ttbr0, lsl #ARCH_PGD_SHIFT @ lower bits
7fb00c2f	153	mcrr p15, 0, \ttbr0, \tmp, c2 @ load TTBR0
1b6ba46b CM	154	.endm
1b6ba46b CM	155
1b6ba46b CM	156	/*
	157	* AT
	158	* TFR EV X F IHD LR S
	159	* .EEE ..EE PUI. .TAT 4RVI ZWRS BLDP WCAM
	160	* rxxx rrxx xxx0 0101 xxxx xxxx x111 xxxx < forced
	161	* 11 0 110 1 0011 1100 .111 1101 < we want
	162	*/
	163	.align 2
	164	.type v7_crval, #object
	165	v7_crval:
	166	crval clear=0x0120c302, mmuset=0x30c23c7d, ucset=0x00c01c7c