This source file includes following definitions.
- espfix_base_addr
- init_espfix_random
- init_espfix_bsp
- init_espfix_ap
   1 
   2 
   3 
   4 
   5 
   6 
   7 
   8 
   9 
  10 
  11 
  12 
  13 
  14 
  15 
  16 
  17 
  18 
  19 
  20 
  21 
  22 
  23 
  24 
  25 
  26 #include <linux/init.h>
  27 #include <linux/init_task.h>
  28 #include <linux/kernel.h>
  29 #include <linux/percpu.h>
  30 #include <linux/gfp.h>
  31 #include <linux/random.h>
  32 #include <asm/pgtable.h>
  33 #include <asm/pgalloc.h>
  34 #include <asm/setup.h>
  35 #include <asm/espfix.h>
  36 
  37 
  38 
  39 
  40 
  41 #define ESPFIX_STACK_SIZE       (8*8UL)
  42 #define ESPFIX_STACKS_PER_PAGE  (PAGE_SIZE/ESPFIX_STACK_SIZE)
  43 
  44 
  45 #define ESPFIX_PAGE_SPACE       (1UL << (P4D_SHIFT-PAGE_SHIFT-16))
  46 
  47 #define ESPFIX_MAX_CPUS         (ESPFIX_STACKS_PER_PAGE * ESPFIX_PAGE_SPACE)
  48 #if CONFIG_NR_CPUS > ESPFIX_MAX_CPUS
  49 # error "Need more virtual address space for the ESPFIX hack"
  50 #endif
  51 
  52 #define PGALLOC_GFP (GFP_KERNEL | __GFP_ZERO)
  53 
  54 
  55 DEFINE_PER_CPU_READ_MOSTLY(unsigned long, espfix_stack);
  56 DEFINE_PER_CPU_READ_MOSTLY(unsigned long, espfix_waddr);
  57 
  58 
  59 static DEFINE_MUTEX(espfix_init_mutex);
  60 
  61 
  62 #define ESPFIX_MAX_PAGES  DIV_ROUND_UP(CONFIG_NR_CPUS, ESPFIX_STACKS_PER_PAGE)
  63 static void *espfix_pages[ESPFIX_MAX_PAGES];
  64 
  65 static __page_aligned_bss pud_t espfix_pud_page[PTRS_PER_PUD]
  66         __aligned(PAGE_SIZE);
  67 
  68 static unsigned int page_random, slot_random;
  69 
  70 
  71 
  72 
  73 
  74 
  75 static inline unsigned long espfix_base_addr(unsigned int cpu)
  76 {
  77         unsigned long page, slot;
  78         unsigned long addr;
  79 
  80         page = (cpu / ESPFIX_STACKS_PER_PAGE) ^ page_random;
  81         slot = (cpu + slot_random) % ESPFIX_STACKS_PER_PAGE;
  82         addr = (page << PAGE_SHIFT) + (slot * ESPFIX_STACK_SIZE);
  83         addr = (addr & 0xffffUL) | ((addr & ~0xffffUL) << 16);
  84         addr += ESPFIX_BASE_ADDR;
  85         return addr;
  86 }
  87 
  88 #define PTE_STRIDE        (65536/PAGE_SIZE)
  89 #define ESPFIX_PTE_CLONES (PTRS_PER_PTE/PTE_STRIDE)
  90 #define ESPFIX_PMD_CLONES PTRS_PER_PMD
  91 #define ESPFIX_PUD_CLONES (65536/(ESPFIX_PTE_CLONES*ESPFIX_PMD_CLONES))
  92 
  93 #define PGTABLE_PROT      ((_KERNPG_TABLE & ~_PAGE_RW) | _PAGE_NX)
  94 
  95 static void init_espfix_random(void)
  96 {
  97         unsigned long rand;
  98 
  99         
 100 
 101 
 102 
 103         if (!arch_get_random_long(&rand)) {
 104                 
 105                 rand = rdtsc();
 106                 rand *= 0xc345c6b72fd16123UL;
 107         }
 108 
 109         slot_random = rand % ESPFIX_STACKS_PER_PAGE;
 110         page_random = (rand / ESPFIX_STACKS_PER_PAGE)
 111                 & (ESPFIX_PAGE_SPACE - 1);
 112 }
 113 
 114 void __init init_espfix_bsp(void)
 115 {
 116         pgd_t *pgd;
 117         p4d_t *p4d;
 118 
 119         
 120         pgd = &init_top_pgt[pgd_index(ESPFIX_BASE_ADDR)];
 121         p4d = p4d_alloc(&init_mm, pgd, ESPFIX_BASE_ADDR);
 122         p4d_populate(&init_mm, p4d, espfix_pud_page);
 123 
 124         
 125         init_espfix_random();
 126 
 127         
 128         init_espfix_ap(0);
 129 }
 130 
 131 void init_espfix_ap(int cpu)
 132 {
 133         unsigned int page;
 134         unsigned long addr;
 135         pud_t pud, *pud_p;
 136         pmd_t pmd, *pmd_p;
 137         pte_t pte, *pte_p;
 138         int n, node;
 139         void *stack_page;
 140         pteval_t ptemask;
 141 
 142         
 143         if (likely(per_cpu(espfix_stack, cpu)))
 144                 return;         
 145 
 146         addr = espfix_base_addr(cpu);
 147         page = cpu/ESPFIX_STACKS_PER_PAGE;
 148 
 149         
 150         stack_page = READ_ONCE(espfix_pages[page]);
 151         if (likely(stack_page))
 152                 goto done;
 153 
 154         mutex_lock(&espfix_init_mutex);
 155 
 156         
 157         stack_page = READ_ONCE(espfix_pages[page]);
 158         if (stack_page)
 159                 goto unlock_done;
 160 
 161         node = cpu_to_node(cpu);
 162         ptemask = __supported_pte_mask;
 163 
 164         pud_p = &espfix_pud_page[pud_index(addr)];
 165         pud = *pud_p;
 166         if (!pud_present(pud)) {
 167                 struct page *page = alloc_pages_node(node, PGALLOC_GFP, 0);
 168 
 169                 pmd_p = (pmd_t *)page_address(page);
 170                 pud = __pud(__pa(pmd_p) | (PGTABLE_PROT & ptemask));
 171                 paravirt_alloc_pmd(&init_mm, __pa(pmd_p) >> PAGE_SHIFT);
 172                 for (n = 0; n < ESPFIX_PUD_CLONES; n++)
 173                         set_pud(&pud_p[n], pud);
 174         }
 175 
 176         pmd_p = pmd_offset(&pud, addr);
 177         pmd = *pmd_p;
 178         if (!pmd_present(pmd)) {
 179                 struct page *page = alloc_pages_node(node, PGALLOC_GFP, 0);
 180 
 181                 pte_p = (pte_t *)page_address(page);
 182                 pmd = __pmd(__pa(pte_p) | (PGTABLE_PROT & ptemask));
 183                 paravirt_alloc_pte(&init_mm, __pa(pte_p) >> PAGE_SHIFT);
 184                 for (n = 0; n < ESPFIX_PMD_CLONES; n++)
 185                         set_pmd(&pmd_p[n], pmd);
 186         }
 187 
 188         pte_p = pte_offset_kernel(&pmd, addr);
 189         stack_page = page_address(alloc_pages_node(node, GFP_KERNEL, 0));
 190         
 191 
 192 
 193 
 194         pte = __pte(__pa(stack_page) | ((__PAGE_KERNEL_RO | _PAGE_ENC) & ptemask));
 195         for (n = 0; n < ESPFIX_PTE_CLONES; n++)
 196                 set_pte(&pte_p[n*PTE_STRIDE], pte);
 197 
 198         
 199         WRITE_ONCE(espfix_pages[page], stack_page);
 200 
 201 unlock_done:
 202         mutex_unlock(&espfix_init_mutex);
 203 done:
 204         per_cpu(espfix_stack, cpu) = addr;
 205         per_cpu(espfix_waddr, cpu) = (unsigned long)stack_page
 206                                       + (addr & ~PAGE_MASK);
 207 }