| Catalin Marinas | 1b6ba46 | 2011-11-22 17:30:29 +0000 | [diff] [blame] | 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 |  */ | 
 | 22 |  | 
 | 23 | #define TTB_IRGN_NC	(0 << 8) | 
 | 24 | #define TTB_IRGN_WBWA	(1 << 8) | 
 | 25 | #define TTB_IRGN_WT	(2 << 8) | 
 | 26 | #define TTB_IRGN_WB	(3 << 8) | 
 | 27 | #define TTB_RGN_NC	(0 << 10) | 
 | 28 | #define TTB_RGN_OC_WBWA	(1 << 10) | 
 | 29 | #define TTB_RGN_OC_WT	(2 << 10) | 
 | 30 | #define TTB_RGN_OC_WB	(3 << 10) | 
 | 31 | #define TTB_S		(3 << 12) | 
 | 32 | #define TTB_EAE		(1 << 31) | 
 | 33 |  | 
 | 34 | /* PTWs cacheable, inner WB not shareable, outer WB not shareable */ | 
 | 35 | #define TTB_FLAGS_UP	(TTB_IRGN_WB|TTB_RGN_OC_WB) | 
 | 36 | #define PMD_FLAGS_UP	(PMD_SECT_WB) | 
 | 37 |  | 
 | 38 | /* PTWs cacheable, inner WBWA shareable, outer WBWA not shareable */ | 
 | 39 | #define TTB_FLAGS_SMP	(TTB_IRGN_WBWA|TTB_S|TTB_RGN_OC_WBWA) | 
 | 40 | #define PMD_FLAGS_SMP	(PMD_SECT_WBWA|PMD_SECT_S) | 
 | 41 |  | 
 | 42 | /* | 
 | 43 |  * cpu_v7_switch_mm(pgd_phys, tsk) | 
 | 44 |  * | 
 | 45 |  * Set the translation table base pointer to be pgd_phys (physical address of | 
 | 46 |  * the new TTB). | 
 | 47 |  */ | 
 | 48 | ENTRY(cpu_v7_switch_mm) | 
 | 49 | #ifdef CONFIG_MMU | 
| Ben Dooks | 251019f | 2013-02-11 12:25:05 +0100 | [diff] [blame] | 50 | 	mmid	r1, r1				@ get mm->context.id | 
| Catalin Marinas | 1b6ba46 | 2011-11-22 17:30:29 +0000 | [diff] [blame] | 51 | 	and	r3, r1, #0xff | 
 | 52 | 	mov	r3, r3, lsl #(48 - 32)		@ ASID | 
 | 53 | 	mcrr	p15, 0, r0, r3, c2		@ set TTB 0 | 
 | 54 | 	isb | 
 | 55 | #endif | 
 | 56 | 	mov	pc, lr | 
 | 57 | ENDPROC(cpu_v7_switch_mm) | 
 | 58 |  | 
 | 59 | /* | 
 | 60 |  * cpu_v7_set_pte_ext(ptep, pte) | 
 | 61 |  * | 
 | 62 |  * Set a level 2 translation table entry. | 
 | 63 |  * - ptep - pointer to level 3 translation table entry | 
 | 64 |  * - pte - PTE value to store (64-bit in r2 and r3) | 
 | 65 |  */ | 
 | 66 | ENTRY(cpu_v7_set_pte_ext) | 
 | 67 | #ifdef CONFIG_MMU | 
| Will Deacon | dbf62d5 | 2012-07-19 11:51:05 +0100 | [diff] [blame] | 68 | 	tst	r2, #L_PTE_VALID | 
| Catalin Marinas | 1b6ba46 | 2011-11-22 17:30:29 +0000 | [diff] [blame] | 69 | 	beq	1f | 
| Will Deacon | 26ffd0d | 2012-09-01 05:22:12 +0100 | [diff] [blame] | 70 | 	tst	r3, #1 << (57 - 32)		@ L_PTE_NONE | 
 | 71 | 	bicne	r2, #L_PTE_VALID | 
 | 72 | 	bne	1f | 
| Catalin Marinas | 1b6ba46 | 2011-11-22 17:30:29 +0000 | [diff] [blame] | 73 | 	tst	r3, #1 << (55 - 32)		@ L_PTE_DIRTY | 
 | 74 | 	orreq	r2, #L_PTE_RDONLY | 
 | 75 | 1:	strd	r2, r3, [r0] | 
 | 76 | 	mcr	p15, 0, r0, c7, c10, 1		@ flush_pte | 
 | 77 | #endif | 
 | 78 | 	mov	pc, lr | 
 | 79 | ENDPROC(cpu_v7_set_pte_ext) | 
 | 80 |  | 
 | 81 | 	/* | 
 | 82 | 	 * Memory region attributes for LPAE (defined in pgtable-3level.h): | 
 | 83 | 	 * | 
 | 84 | 	 *   n = AttrIndx[2:0] | 
 | 85 | 	 * | 
 | 86 | 	 *			n	MAIR | 
 | 87 | 	 *   UNCACHED		000	00000000 | 
 | 88 | 	 *   BUFFERABLE		001	01000100 | 
 | 89 | 	 *   DEV_WC		001	01000100 | 
 | 90 | 	 *   WRITETHROUGH	010	10101010 | 
 | 91 | 	 *   WRITEBACK		011	11101110 | 
 | 92 | 	 *   DEV_CACHED		011	11101110 | 
 | 93 | 	 *   DEV_SHARED		100	00000100 | 
 | 94 | 	 *   DEV_NONSHARED	100	00000100 | 
 | 95 | 	 *   unused		101 | 
 | 96 | 	 *   unused		110 | 
 | 97 | 	 *   WRITEALLOC		111	11111111 | 
 | 98 | 	 */ | 
 | 99 | .equ	PRRR,	0xeeaa4400			@ MAIR0 | 
 | 100 | .equ	NMRR,	0xff000004			@ MAIR1 | 
 | 101 |  | 
 | 102 | 	/* | 
 | 103 | 	 * Macro for setting up the TTBRx and TTBCR registers. | 
 | 104 | 	 * - \ttbr1 updated. | 
 | 105 | 	 */ | 
 | 106 | 	.macro	v7_ttb_setup, zero, ttbr0, ttbr1, tmp | 
 | 107 | 	ldr	\tmp, =swapper_pg_dir		@ swapper_pg_dir virtual address | 
 | 108 | 	cmp	\ttbr1, \tmp			@ PHYS_OFFSET > PAGE_OFFSET? (branch below) | 
 | 109 | 	mrc	p15, 0, \tmp, c2, c0, 2		@ TTB control register | 
 | 110 | 	orr	\tmp, \tmp, #TTB_EAE | 
 | 111 | 	ALT_SMP(orr	\tmp, \tmp, #TTB_FLAGS_SMP) | 
 | 112 | 	ALT_UP(orr	\tmp, \tmp, #TTB_FLAGS_UP) | 
 | 113 | 	ALT_SMP(orr	\tmp, \tmp, #TTB_FLAGS_SMP << 16) | 
 | 114 | 	ALT_UP(orr	\tmp, \tmp, #TTB_FLAGS_UP << 16) | 
 | 115 | 	/* | 
 | 116 | 	 * TTBR0/TTBR1 split (PAGE_OFFSET): | 
 | 117 | 	 *   0x40000000: T0SZ = 2, T1SZ = 0 (not used) | 
 | 118 | 	 *   0x80000000: T0SZ = 0, T1SZ = 1 | 
 | 119 | 	 *   0xc0000000: T0SZ = 0, T1SZ = 2 | 
 | 120 | 	 * | 
 | 121 | 	 * Only use this feature if PHYS_OFFSET <= PAGE_OFFSET, otherwise | 
 | 122 | 	 * booting secondary CPUs would end up using TTBR1 for the identity | 
 | 123 | 	 * mapping set up in TTBR0. | 
 | 124 | 	 */ | 
 | 125 | 	bhi	9001f				@ PHYS_OFFSET > PAGE_OFFSET? | 
 | 126 | 	orr	\tmp, \tmp, #(((PAGE_OFFSET >> 30) - 1) << 16) @ TTBCR.T1SZ | 
 | 127 | #if defined CONFIG_VMSPLIT_2G | 
 | 128 | 	/* PAGE_OFFSET == 0x80000000, T1SZ == 1 */ | 
 | 129 | 	add	\ttbr1, \ttbr1, #1 << 4		@ skip two L1 entries | 
 | 130 | #elif defined CONFIG_VMSPLIT_3G | 
 | 131 | 	/* PAGE_OFFSET == 0xc0000000, T1SZ == 2 */ | 
 | 132 | 	add	\ttbr1, \ttbr1, #4096 * (1 + 3)	@ only L2 used, skip pgd+3*pmd | 
 | 133 | #endif | 
 | 134 | 	/* CONFIG_VMSPLIT_1G does not need TTBR1 adjustment */ | 
 | 135 | 9001:	mcr	p15, 0, \tmp, c2, c0, 2		@ TTB control register | 
 | 136 | 	mcrr	p15, 1, \ttbr1, \zero, c2	@ load TTBR1 | 
 | 137 | 	.endm | 
 | 138 |  | 
 | 139 | 	__CPUINIT | 
 | 140 |  | 
 | 141 | 	/* | 
 | 142 | 	 *   AT | 
 | 143 | 	 *  TFR   EV X F   IHD LR    S | 
 | 144 | 	 * .EEE ..EE PUI. .TAT 4RVI ZWRS BLDP WCAM | 
 | 145 | 	 * rxxx rrxx xxx0 0101 xxxx xxxx x111 xxxx < forced | 
 | 146 | 	 *   11    0 110    1  0011 1100 .111 1101 < we want | 
 | 147 | 	 */ | 
 | 148 | 	.align	2 | 
 | 149 | 	.type	v7_crval, #object | 
 | 150 | v7_crval: | 
 | 151 | 	crval	clear=0x0120c302, mmuset=0x30c23c7d, ucset=0x00c01c7c | 
 | 152 |  | 
 | 153 | 	.previous |