arch/arm/mm/proc-v7-3level.S

   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 #include <asm/assembler.h>
  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
  43 #ifndef __ARMEB__
  44 #  define rpgdl r0
  45 #  define rpgdh r1
  46 #else
  47 #  define rpgdl r1
  48 #  define rpgdh r0
  49 #endif
  50
  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
  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
  63         isb
  64 #endif
  65         ret     lr
  66 ENDPROC(cpu_v7_switch_mm)
  67
  68 #ifdef __ARMEB__
  69 #define rl r3
  70 #define rh r2
  71 #else
  72 #define rl r2
  73 #define rh r3
  74 #endif
  75
  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
  85         tst     rl, #L_PTE_VALID
  86         beq     1f
  87         tst     rh, #1 << (57 - 32)             @ L_PTE_NONE
  88         bicne   rl, #L_PTE_VALID
  89         bne     1f
  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
  97 1:      strd    r2, r3, [r0]
  98         ALT_SMP(W(nop))
  99         ALT_UP (mcr     p15, 0, r0, c7, c10, 1)         @ flush_pte
 100 #endif
 101         ret     lr
 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
 131         mov     \tmp, \tmp, lsr #ARCH_PGD_SHIFT
 132         cmp     \ttbr1, \tmp                    @ PHYS_OFFSET > PAGE_OFFSET?
 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         /*
 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.
 143          */
 144         orrls   \tmp, \tmp, #TTBR1_SIZE                         @ TTBCR.T1SZ
 145         mcr     p15, 0, \tmp, c2, c0, 2                         @ TTBCR
 146         mov     \tmp, \ttbr1, lsr #(32 - ARCH_PGD_SHIFT)        @ upper bits
 147         mov     \ttbr1, \ttbr1, lsl #ARCH_PGD_SHIFT             @ lower bits
 148         addls   \ttbr1, \ttbr1, #TTBR1_OFFSET
 149         mcrr    p15, 1, \ttbr1, \tmp, c2                        @ load TTBR1
 150         mov     \tmp, \ttbr0, lsr #(32 - ARCH_PGD_SHIFT)        @ upper bits
 151         mov     \ttbr0, \ttbr0, lsl #ARCH_PGD_SHIFT             @ lower bits
 152         mcrr    p15, 0, \ttbr0, \tmp, c2                        @ load TTBR0
 153         .endm
 154
 155         /*
 156          *   AT
 157          *  TFR   EV X F   IHD LR    S
 158          * .EEE ..EE PUI. .TAT 4RVI ZWRS BLDP WCAM
 159          * rxxx rrxx xxx0 0101 xxxx xxxx x111 xxxx < forced
 160          *   11    0 110    0  0011 1100 .111 1101 < we want
 161          */
 162         .align  2
 163         .type   v7_crval, #object
 164 v7_crval:
 165         crval   clear=0x0122c302, mmuset=0x30c03c7d, ucset=0x00c01c7c