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