Commit | Line | Data |
---|---|---|
3610cce8 | 1 | /* |
239a6425 | 2 | * Copyright IBM Corp. 2007,2009 |
3610cce8 MS |
3 | * Author(s): Martin Schwidefsky <schwidefsky@de.ibm.com> |
4 | */ | |
5 | ||
6 | #include <linux/sched.h> | |
7 | #include <linux/kernel.h> | |
8 | #include <linux/errno.h> | |
5a0e3ad6 | 9 | #include <linux/gfp.h> |
3610cce8 MS |
10 | #include <linux/mm.h> |
11 | #include <linux/swap.h> | |
12 | #include <linux/smp.h> | |
13 | #include <linux/highmem.h> | |
3610cce8 MS |
14 | #include <linux/pagemap.h> |
15 | #include <linux/spinlock.h> | |
16 | #include <linux/module.h> | |
17 | #include <linux/quicklist.h> | |
80217147 | 18 | #include <linux/rcupdate.h> |
e5992f2e | 19 | #include <linux/slab.h> |
3610cce8 MS |
20 | |
21 | #include <asm/system.h> | |
22 | #include <asm/pgtable.h> | |
23 | #include <asm/pgalloc.h> | |
24 | #include <asm/tlb.h> | |
25 | #include <asm/tlbflush.h> | |
6252d702 | 26 | #include <asm/mmu_context.h> |
3610cce8 MS |
27 | |
28 | #ifndef CONFIG_64BIT | |
29 | #define ALLOC_ORDER 1 | |
36409f63 | 30 | #define FRAG_MASK 0x0f |
3610cce8 MS |
31 | #else |
32 | #define ALLOC_ORDER 2 | |
36409f63 | 33 | #define FRAG_MASK 0x03 |
3610cce8 MS |
34 | #endif |
35 | ||
239a6425 HC |
36 | unsigned long VMALLOC_START = VMALLOC_END - VMALLOC_SIZE; |
37 | EXPORT_SYMBOL(VMALLOC_START); | |
38 | ||
39 | static int __init parse_vmalloc(char *arg) | |
40 | { | |
41 | if (!arg) | |
42 | return -EINVAL; | |
43 | VMALLOC_START = (VMALLOC_END - memparse(arg, &arg)) & PAGE_MASK; | |
44 | return 0; | |
45 | } | |
46 | early_param("vmalloc", parse_vmalloc); | |
47 | ||
043d0708 | 48 | unsigned long *crst_table_alloc(struct mm_struct *mm) |
3610cce8 MS |
49 | { |
50 | struct page *page = alloc_pages(GFP_KERNEL, ALLOC_ORDER); | |
51 | ||
52 | if (!page) | |
53 | return NULL; | |
3610cce8 MS |
54 | return (unsigned long *) page_to_phys(page); |
55 | } | |
56 | ||
80217147 MS |
57 | void crst_table_free(struct mm_struct *mm, unsigned long *table) |
58 | { | |
043d0708 | 59 | free_pages((unsigned long) table, ALLOC_ORDER); |
80217147 MS |
60 | } |
61 | ||
6252d702 MS |
62 | #ifdef CONFIG_64BIT |
63 | int crst_table_upgrade(struct mm_struct *mm, unsigned long limit) | |
64 | { | |
65 | unsigned long *table, *pgd; | |
66 | unsigned long entry; | |
67 | ||
68 | BUG_ON(limit > (1UL << 53)); | |
69 | repeat: | |
043d0708 | 70 | table = crst_table_alloc(mm); |
6252d702 MS |
71 | if (!table) |
72 | return -ENOMEM; | |
80217147 | 73 | spin_lock_bh(&mm->page_table_lock); |
6252d702 MS |
74 | if (mm->context.asce_limit < limit) { |
75 | pgd = (unsigned long *) mm->pgd; | |
76 | if (mm->context.asce_limit <= (1UL << 31)) { | |
77 | entry = _REGION3_ENTRY_EMPTY; | |
78 | mm->context.asce_limit = 1UL << 42; | |
79 | mm->context.asce_bits = _ASCE_TABLE_LENGTH | | |
80 | _ASCE_USER_BITS | | |
81 | _ASCE_TYPE_REGION3; | |
82 | } else { | |
83 | entry = _REGION2_ENTRY_EMPTY; | |
84 | mm->context.asce_limit = 1UL << 53; | |
85 | mm->context.asce_bits = _ASCE_TABLE_LENGTH | | |
86 | _ASCE_USER_BITS | | |
87 | _ASCE_TYPE_REGION2; | |
88 | } | |
89 | crst_table_init(table, entry); | |
90 | pgd_populate(mm, (pgd_t *) table, (pud_t *) pgd); | |
91 | mm->pgd = (pgd_t *) table; | |
f481bfaf | 92 | mm->task_size = mm->context.asce_limit; |
6252d702 MS |
93 | table = NULL; |
94 | } | |
80217147 | 95 | spin_unlock_bh(&mm->page_table_lock); |
6252d702 MS |
96 | if (table) |
97 | crst_table_free(mm, table); | |
98 | if (mm->context.asce_limit < limit) | |
99 | goto repeat; | |
100 | update_mm(mm, current); | |
101 | return 0; | |
102 | } | |
103 | ||
104 | void crst_table_downgrade(struct mm_struct *mm, unsigned long limit) | |
105 | { | |
106 | pgd_t *pgd; | |
107 | ||
108 | if (mm->context.asce_limit <= limit) | |
109 | return; | |
110 | __tlb_flush_mm(mm); | |
111 | while (mm->context.asce_limit > limit) { | |
112 | pgd = mm->pgd; | |
113 | switch (pgd_val(*pgd) & _REGION_ENTRY_TYPE_MASK) { | |
114 | case _REGION_ENTRY_TYPE_R2: | |
115 | mm->context.asce_limit = 1UL << 42; | |
116 | mm->context.asce_bits = _ASCE_TABLE_LENGTH | | |
117 | _ASCE_USER_BITS | | |
118 | _ASCE_TYPE_REGION3; | |
119 | break; | |
120 | case _REGION_ENTRY_TYPE_R3: | |
121 | mm->context.asce_limit = 1UL << 31; | |
122 | mm->context.asce_bits = _ASCE_TABLE_LENGTH | | |
123 | _ASCE_USER_BITS | | |
124 | _ASCE_TYPE_SEGMENT; | |
125 | break; | |
126 | default: | |
127 | BUG(); | |
128 | } | |
129 | mm->pgd = (pgd_t *) (pgd_val(*pgd) & _REGION_ENTRY_ORIGIN); | |
f481bfaf | 130 | mm->task_size = mm->context.asce_limit; |
6252d702 MS |
131 | crst_table_free(mm, (unsigned long *) pgd); |
132 | } | |
133 | update_mm(mm, current); | |
134 | } | |
135 | #endif | |
136 | ||
e5992f2e MS |
137 | #ifdef CONFIG_PGSTE |
138 | ||
139 | /** | |
140 | * gmap_alloc - allocate a guest address space | |
141 | * @mm: pointer to the parent mm_struct | |
142 | * | |
143 | * Returns a guest address space structure. | |
144 | */ | |
145 | struct gmap *gmap_alloc(struct mm_struct *mm) | |
36409f63 | 146 | { |
e5992f2e MS |
147 | struct gmap *gmap; |
148 | struct page *page; | |
149 | unsigned long *table; | |
36409f63 | 150 | |
e5992f2e MS |
151 | gmap = kzalloc(sizeof(struct gmap), GFP_KERNEL); |
152 | if (!gmap) | |
153 | goto out; | |
154 | INIT_LIST_HEAD(&gmap->crst_list); | |
155 | gmap->mm = mm; | |
156 | page = alloc_pages(GFP_KERNEL, ALLOC_ORDER); | |
157 | if (!page) | |
158 | goto out_free; | |
159 | list_add(&page->lru, &gmap->crst_list); | |
160 | table = (unsigned long *) page_to_phys(page); | |
161 | crst_table_init(table, _REGION1_ENTRY_EMPTY); | |
162 | gmap->table = table; | |
480e5926 CB |
163 | gmap->asce = _ASCE_TYPE_REGION1 | _ASCE_TABLE_LENGTH | |
164 | _ASCE_USER_BITS | __pa(table); | |
e5992f2e MS |
165 | list_add(&gmap->list, &mm->context.gmap_list); |
166 | return gmap; | |
167 | ||
168 | out_free: | |
169 | kfree(gmap); | |
170 | out: | |
171 | return NULL; | |
36409f63 | 172 | } |
e5992f2e | 173 | EXPORT_SYMBOL_GPL(gmap_alloc); |
36409f63 | 174 | |
e5992f2e MS |
175 | static int gmap_unlink_segment(struct gmap *gmap, unsigned long *table) |
176 | { | |
177 | struct gmap_pgtable *mp; | |
178 | struct gmap_rmap *rmap; | |
179 | struct page *page; | |
180 | ||
181 | if (*table & _SEGMENT_ENTRY_INV) | |
182 | return 0; | |
183 | page = pfn_to_page(*table >> PAGE_SHIFT); | |
184 | mp = (struct gmap_pgtable *) page->index; | |
185 | list_for_each_entry(rmap, &mp->mapper, list) { | |
186 | if (rmap->entry != table) | |
187 | continue; | |
188 | list_del(&rmap->list); | |
189 | kfree(rmap); | |
190 | break; | |
191 | } | |
192 | *table = _SEGMENT_ENTRY_INV | _SEGMENT_ENTRY_RO | mp->vmaddr; | |
193 | return 1; | |
194 | } | |
195 | ||
196 | static void gmap_flush_tlb(struct gmap *gmap) | |
197 | { | |
198 | if (MACHINE_HAS_IDTE) | |
199 | __tlb_flush_idte((unsigned long) gmap->table | | |
200 | _ASCE_TYPE_REGION1); | |
201 | else | |
202 | __tlb_flush_global(); | |
203 | } | |
204 | ||
205 | /** | |
206 | * gmap_free - free a guest address space | |
207 | * @gmap: pointer to the guest address space structure | |
3610cce8 | 208 | */ |
e5992f2e MS |
209 | void gmap_free(struct gmap *gmap) |
210 | { | |
211 | struct page *page, *next; | |
212 | unsigned long *table; | |
213 | int i; | |
214 | ||
215 | ||
216 | /* Flush tlb. */ | |
217 | if (MACHINE_HAS_IDTE) | |
218 | __tlb_flush_idte((unsigned long) gmap->table | | |
219 | _ASCE_TYPE_REGION1); | |
220 | else | |
221 | __tlb_flush_global(); | |
222 | ||
223 | /* Free all segment & region tables. */ | |
224 | down_read(&gmap->mm->mmap_sem); | |
cc772456 | 225 | spin_lock(&gmap->mm->page_table_lock); |
e5992f2e MS |
226 | list_for_each_entry_safe(page, next, &gmap->crst_list, lru) { |
227 | table = (unsigned long *) page_to_phys(page); | |
228 | if ((*table & _REGION_ENTRY_TYPE_MASK) == 0) | |
229 | /* Remove gmap rmap structures for segment table. */ | |
230 | for (i = 0; i < PTRS_PER_PMD; i++, table++) | |
231 | gmap_unlink_segment(gmap, table); | |
232 | __free_pages(page, ALLOC_ORDER); | |
233 | } | |
cc772456 | 234 | spin_unlock(&gmap->mm->page_table_lock); |
e5992f2e MS |
235 | up_read(&gmap->mm->mmap_sem); |
236 | list_del(&gmap->list); | |
237 | kfree(gmap); | |
238 | } | |
239 | EXPORT_SYMBOL_GPL(gmap_free); | |
240 | ||
241 | /** | |
242 | * gmap_enable - switch primary space to the guest address space | |
243 | * @gmap: pointer to the guest address space structure | |
244 | */ | |
245 | void gmap_enable(struct gmap *gmap) | |
246 | { | |
e5992f2e MS |
247 | S390_lowcore.gmap = (unsigned long) gmap; |
248 | } | |
249 | EXPORT_SYMBOL_GPL(gmap_enable); | |
250 | ||
251 | /** | |
252 | * gmap_disable - switch back to the standard primary address space | |
253 | * @gmap: pointer to the guest address space structure | |
254 | */ | |
255 | void gmap_disable(struct gmap *gmap) | |
256 | { | |
e5992f2e MS |
257 | S390_lowcore.gmap = 0UL; |
258 | } | |
259 | EXPORT_SYMBOL_GPL(gmap_disable); | |
260 | ||
a9162f23 CO |
261 | /* |
262 | * gmap_alloc_table is assumed to be called with mmap_sem held | |
263 | */ | |
e5992f2e MS |
264 | static int gmap_alloc_table(struct gmap *gmap, |
265 | unsigned long *table, unsigned long init) | |
266 | { | |
267 | struct page *page; | |
268 | unsigned long *new; | |
269 | ||
270 | page = alloc_pages(GFP_KERNEL, ALLOC_ORDER); | |
271 | if (!page) | |
272 | return -ENOMEM; | |
273 | new = (unsigned long *) page_to_phys(page); | |
274 | crst_table_init(new, init); | |
e5992f2e MS |
275 | if (*table & _REGION_ENTRY_INV) { |
276 | list_add(&page->lru, &gmap->crst_list); | |
277 | *table = (unsigned long) new | _REGION_ENTRY_LENGTH | | |
278 | (*table & _REGION_ENTRY_TYPE_MASK); | |
279 | } else | |
280 | __free_pages(page, ALLOC_ORDER); | |
e5992f2e MS |
281 | return 0; |
282 | } | |
283 | ||
284 | /** | |
285 | * gmap_unmap_segment - unmap segment from the guest address space | |
286 | * @gmap: pointer to the guest address space structure | |
287 | * @addr: address in the guest address space | |
288 | * @len: length of the memory area to unmap | |
289 | * | |
290 | * Returns 0 if the unmap succeded, -EINVAL if not. | |
291 | */ | |
292 | int gmap_unmap_segment(struct gmap *gmap, unsigned long to, unsigned long len) | |
293 | { | |
294 | unsigned long *table; | |
295 | unsigned long off; | |
296 | int flush; | |
297 | ||
298 | if ((to | len) & (PMD_SIZE - 1)) | |
299 | return -EINVAL; | |
300 | if (len == 0 || to + len < to) | |
301 | return -EINVAL; | |
302 | ||
303 | flush = 0; | |
304 | down_read(&gmap->mm->mmap_sem); | |
cc772456 | 305 | spin_lock(&gmap->mm->page_table_lock); |
e5992f2e MS |
306 | for (off = 0; off < len; off += PMD_SIZE) { |
307 | /* Walk the guest addr space page table */ | |
308 | table = gmap->table + (((to + off) >> 53) & 0x7ff); | |
309 | if (*table & _REGION_ENTRY_INV) | |
05873df9 | 310 | goto out; |
e5992f2e MS |
311 | table = (unsigned long *)(*table & _REGION_ENTRY_ORIGIN); |
312 | table = table + (((to + off) >> 42) & 0x7ff); | |
313 | if (*table & _REGION_ENTRY_INV) | |
05873df9 | 314 | goto out; |
e5992f2e MS |
315 | table = (unsigned long *)(*table & _REGION_ENTRY_ORIGIN); |
316 | table = table + (((to + off) >> 31) & 0x7ff); | |
317 | if (*table & _REGION_ENTRY_INV) | |
05873df9 | 318 | goto out; |
e5992f2e MS |
319 | table = (unsigned long *)(*table & _REGION_ENTRY_ORIGIN); |
320 | table = table + (((to + off) >> 20) & 0x7ff); | |
321 | ||
322 | /* Clear segment table entry in guest address space. */ | |
323 | flush |= gmap_unlink_segment(gmap, table); | |
324 | *table = _SEGMENT_ENTRY_INV; | |
325 | } | |
05873df9 | 326 | out: |
cc772456 | 327 | spin_unlock(&gmap->mm->page_table_lock); |
e5992f2e MS |
328 | up_read(&gmap->mm->mmap_sem); |
329 | if (flush) | |
330 | gmap_flush_tlb(gmap); | |
331 | return 0; | |
332 | } | |
333 | EXPORT_SYMBOL_GPL(gmap_unmap_segment); | |
334 | ||
335 | /** | |
336 | * gmap_mmap_segment - map a segment to the guest address space | |
337 | * @gmap: pointer to the guest address space structure | |
338 | * @from: source address in the parent address space | |
339 | * @to: target address in the guest address space | |
340 | * | |
341 | * Returns 0 if the mmap succeded, -EINVAL or -ENOMEM if not. | |
342 | */ | |
343 | int gmap_map_segment(struct gmap *gmap, unsigned long from, | |
344 | unsigned long to, unsigned long len) | |
345 | { | |
346 | unsigned long *table; | |
347 | unsigned long off; | |
348 | int flush; | |
349 | ||
350 | if ((from | to | len) & (PMD_SIZE - 1)) | |
351 | return -EINVAL; | |
352 | if (len == 0 || from + len > PGDIR_SIZE || | |
353 | from + len < from || to + len < to) | |
354 | return -EINVAL; | |
355 | ||
356 | flush = 0; | |
357 | down_read(&gmap->mm->mmap_sem); | |
cc772456 | 358 | spin_lock(&gmap->mm->page_table_lock); |
e5992f2e MS |
359 | for (off = 0; off < len; off += PMD_SIZE) { |
360 | /* Walk the gmap address space page table */ | |
361 | table = gmap->table + (((to + off) >> 53) & 0x7ff); | |
362 | if ((*table & _REGION_ENTRY_INV) && | |
363 | gmap_alloc_table(gmap, table, _REGION2_ENTRY_EMPTY)) | |
364 | goto out_unmap; | |
365 | table = (unsigned long *)(*table & _REGION_ENTRY_ORIGIN); | |
366 | table = table + (((to + off) >> 42) & 0x7ff); | |
367 | if ((*table & _REGION_ENTRY_INV) && | |
368 | gmap_alloc_table(gmap, table, _REGION3_ENTRY_EMPTY)) | |
369 | goto out_unmap; | |
370 | table = (unsigned long *)(*table & _REGION_ENTRY_ORIGIN); | |
371 | table = table + (((to + off) >> 31) & 0x7ff); | |
372 | if ((*table & _REGION_ENTRY_INV) && | |
373 | gmap_alloc_table(gmap, table, _SEGMENT_ENTRY_EMPTY)) | |
374 | goto out_unmap; | |
375 | table = (unsigned long *) (*table & _REGION_ENTRY_ORIGIN); | |
376 | table = table + (((to + off) >> 20) & 0x7ff); | |
377 | ||
378 | /* Store 'from' address in an invalid segment table entry. */ | |
379 | flush |= gmap_unlink_segment(gmap, table); | |
380 | *table = _SEGMENT_ENTRY_INV | _SEGMENT_ENTRY_RO | (from + off); | |
381 | } | |
cc772456 | 382 | spin_unlock(&gmap->mm->page_table_lock); |
e5992f2e MS |
383 | up_read(&gmap->mm->mmap_sem); |
384 | if (flush) | |
385 | gmap_flush_tlb(gmap); | |
386 | return 0; | |
387 | ||
388 | out_unmap: | |
cc772456 | 389 | spin_unlock(&gmap->mm->page_table_lock); |
e5992f2e MS |
390 | up_read(&gmap->mm->mmap_sem); |
391 | gmap_unmap_segment(gmap, to, len); | |
392 | return -ENOMEM; | |
393 | } | |
394 | EXPORT_SYMBOL_GPL(gmap_map_segment); | |
395 | ||
396 | unsigned long gmap_fault(unsigned long address, struct gmap *gmap) | |
397 | { | |
398 | unsigned long *table, vmaddr, segment; | |
399 | struct mm_struct *mm; | |
400 | struct gmap_pgtable *mp; | |
401 | struct gmap_rmap *rmap; | |
402 | struct vm_area_struct *vma; | |
403 | struct page *page; | |
404 | pgd_t *pgd; | |
405 | pud_t *pud; | |
406 | pmd_t *pmd; | |
407 | ||
408 | current->thread.gmap_addr = address; | |
409 | mm = gmap->mm; | |
410 | /* Walk the gmap address space page table */ | |
411 | table = gmap->table + ((address >> 53) & 0x7ff); | |
412 | if (unlikely(*table & _REGION_ENTRY_INV)) | |
413 | return -EFAULT; | |
414 | table = (unsigned long *)(*table & _REGION_ENTRY_ORIGIN); | |
415 | table = table + ((address >> 42) & 0x7ff); | |
416 | if (unlikely(*table & _REGION_ENTRY_INV)) | |
417 | return -EFAULT; | |
418 | table = (unsigned long *)(*table & _REGION_ENTRY_ORIGIN); | |
419 | table = table + ((address >> 31) & 0x7ff); | |
420 | if (unlikely(*table & _REGION_ENTRY_INV)) | |
421 | return -EFAULT; | |
422 | table = (unsigned long *)(*table & _REGION_ENTRY_ORIGIN); | |
423 | table = table + ((address >> 20) & 0x7ff); | |
424 | ||
425 | /* Convert the gmap address to an mm address. */ | |
426 | segment = *table; | |
427 | if (likely(!(segment & _SEGMENT_ENTRY_INV))) { | |
428 | page = pfn_to_page(segment >> PAGE_SHIFT); | |
429 | mp = (struct gmap_pgtable *) page->index; | |
430 | return mp->vmaddr | (address & ~PMD_MASK); | |
431 | } else if (segment & _SEGMENT_ENTRY_RO) { | |
432 | vmaddr = segment & _SEGMENT_ENTRY_ORIGIN; | |
433 | vma = find_vma(mm, vmaddr); | |
434 | if (!vma || vma->vm_start > vmaddr) | |
435 | return -EFAULT; | |
436 | ||
437 | /* Walk the parent mm page table */ | |
438 | pgd = pgd_offset(mm, vmaddr); | |
439 | pud = pud_alloc(mm, pgd, vmaddr); | |
440 | if (!pud) | |
441 | return -ENOMEM; | |
442 | pmd = pmd_alloc(mm, pud, vmaddr); | |
443 | if (!pmd) | |
444 | return -ENOMEM; | |
445 | if (!pmd_present(*pmd) && | |
446 | __pte_alloc(mm, vma, pmd, vmaddr)) | |
447 | return -ENOMEM; | |
448 | /* pmd now points to a valid segment table entry. */ | |
449 | rmap = kmalloc(sizeof(*rmap), GFP_KERNEL|__GFP_REPEAT); | |
450 | if (!rmap) | |
451 | return -ENOMEM; | |
452 | /* Link gmap segment table entry location to page table. */ | |
453 | page = pmd_page(*pmd); | |
454 | mp = (struct gmap_pgtable *) page->index; | |
455 | rmap->entry = table; | |
cc772456 | 456 | spin_lock(&mm->page_table_lock); |
e5992f2e | 457 | list_add(&rmap->list, &mp->mapper); |
cc772456 | 458 | spin_unlock(&mm->page_table_lock); |
e5992f2e MS |
459 | /* Set gmap segment table entry to page table. */ |
460 | *table = pmd_val(*pmd) & PAGE_MASK; | |
461 | return vmaddr | (address & ~PMD_MASK); | |
462 | } | |
463 | return -EFAULT; | |
464 | ||
465 | } | |
466 | EXPORT_SYMBOL_GPL(gmap_fault); | |
467 | ||
468 | void gmap_unmap_notifier(struct mm_struct *mm, unsigned long *table) | |
469 | { | |
470 | struct gmap_rmap *rmap, *next; | |
471 | struct gmap_pgtable *mp; | |
472 | struct page *page; | |
473 | int flush; | |
474 | ||
475 | flush = 0; | |
476 | spin_lock(&mm->page_table_lock); | |
477 | page = pfn_to_page(__pa(table) >> PAGE_SHIFT); | |
478 | mp = (struct gmap_pgtable *) page->index; | |
479 | list_for_each_entry_safe(rmap, next, &mp->mapper, list) { | |
480 | *rmap->entry = | |
481 | _SEGMENT_ENTRY_INV | _SEGMENT_ENTRY_RO | mp->vmaddr; | |
482 | list_del(&rmap->list); | |
483 | kfree(rmap); | |
484 | flush = 1; | |
485 | } | |
486 | spin_unlock(&mm->page_table_lock); | |
487 | if (flush) | |
488 | __tlb_flush_global(); | |
489 | } | |
490 | ||
491 | static inline unsigned long *page_table_alloc_pgste(struct mm_struct *mm, | |
492 | unsigned long vmaddr) | |
36409f63 MS |
493 | { |
494 | struct page *page; | |
495 | unsigned long *table; | |
e5992f2e | 496 | struct gmap_pgtable *mp; |
36409f63 MS |
497 | |
498 | page = alloc_page(GFP_KERNEL|__GFP_REPEAT); | |
499 | if (!page) | |
500 | return NULL; | |
e5992f2e MS |
501 | mp = kmalloc(sizeof(*mp), GFP_KERNEL|__GFP_REPEAT); |
502 | if (!mp) { | |
503 | __free_page(page); | |
504 | return NULL; | |
505 | } | |
36409f63 | 506 | pgtable_page_ctor(page); |
e5992f2e MS |
507 | mp->vmaddr = vmaddr & PMD_MASK; |
508 | INIT_LIST_HEAD(&mp->mapper); | |
509 | page->index = (unsigned long) mp; | |
36409f63 MS |
510 | atomic_set(&page->_mapcount, 3); |
511 | table = (unsigned long *) page_to_phys(page); | |
512 | clear_table(table, _PAGE_TYPE_EMPTY, PAGE_SIZE/2); | |
513 | clear_table(table + PTRS_PER_PTE, 0, PAGE_SIZE/2); | |
514 | return table; | |
515 | } | |
516 | ||
517 | static inline void page_table_free_pgste(unsigned long *table) | |
518 | { | |
519 | struct page *page; | |
e5992f2e | 520 | struct gmap_pgtable *mp; |
36409f63 MS |
521 | |
522 | page = pfn_to_page(__pa(table) >> PAGE_SHIFT); | |
e5992f2e MS |
523 | mp = (struct gmap_pgtable *) page->index; |
524 | BUG_ON(!list_empty(&mp->mapper)); | |
36409f63 MS |
525 | pgtable_page_ctor(page); |
526 | atomic_set(&page->_mapcount, -1); | |
e5992f2e | 527 | kfree(mp); |
36409f63 MS |
528 | __free_page(page); |
529 | } | |
36409f63 | 530 | |
e5992f2e MS |
531 | #else /* CONFIG_PGSTE */ |
532 | ||
533 | static inline unsigned long *page_table_alloc_pgste(struct mm_struct *mm, | |
534 | unsigned long vmaddr) | |
535 | { | |
944291de | 536 | return NULL; |
e5992f2e MS |
537 | } |
538 | ||
539 | static inline void page_table_free_pgste(unsigned long *table) | |
540 | { | |
541 | } | |
542 | ||
543 | static inline void gmap_unmap_notifier(struct mm_struct *mm, | |
544 | unsigned long *table) | |
545 | { | |
546 | } | |
547 | ||
548 | #endif /* CONFIG_PGSTE */ | |
549 | ||
550 | static inline unsigned int atomic_xor_bits(atomic_t *v, unsigned int bits) | |
551 | { | |
552 | unsigned int old, new; | |
553 | ||
554 | do { | |
555 | old = atomic_read(v); | |
556 | new = old ^ bits; | |
557 | } while (atomic_cmpxchg(v, old, new) != old); | |
558 | return new; | |
559 | } | |
560 | ||
561 | /* | |
562 | * page table entry allocation/free routines. | |
563 | */ | |
564 | unsigned long *page_table_alloc(struct mm_struct *mm, unsigned long vmaddr) | |
3610cce8 | 565 | { |
146e4b3c | 566 | struct page *page; |
3610cce8 | 567 | unsigned long *table; |
36409f63 | 568 | unsigned int mask, bit; |
3610cce8 | 569 | |
36409f63 | 570 | if (mm_has_pgste(mm)) |
e5992f2e | 571 | return page_table_alloc_pgste(mm, vmaddr); |
36409f63 | 572 | /* Allocate fragments of a 4K page as 1K/2K page table */ |
80217147 | 573 | spin_lock_bh(&mm->context.list_lock); |
36409f63 | 574 | mask = FRAG_MASK; |
146e4b3c MS |
575 | if (!list_empty(&mm->context.pgtable_list)) { |
576 | page = list_first_entry(&mm->context.pgtable_list, | |
577 | struct page, lru); | |
36409f63 MS |
578 | table = (unsigned long *) page_to_phys(page); |
579 | mask = atomic_read(&page->_mapcount); | |
580 | mask = mask | (mask >> 4); | |
146e4b3c | 581 | } |
36409f63 | 582 | if ((mask & FRAG_MASK) == FRAG_MASK) { |
80217147 | 583 | spin_unlock_bh(&mm->context.list_lock); |
146e4b3c MS |
584 | page = alloc_page(GFP_KERNEL|__GFP_REPEAT); |
585 | if (!page) | |
3610cce8 | 586 | return NULL; |
146e4b3c | 587 | pgtable_page_ctor(page); |
36409f63 | 588 | atomic_set(&page->_mapcount, 1); |
146e4b3c | 589 | table = (unsigned long *) page_to_phys(page); |
36409f63 | 590 | clear_table(table, _PAGE_TYPE_EMPTY, PAGE_SIZE); |
80217147 | 591 | spin_lock_bh(&mm->context.list_lock); |
146e4b3c | 592 | list_add(&page->lru, &mm->context.pgtable_list); |
36409f63 MS |
593 | } else { |
594 | for (bit = 1; mask & bit; bit <<= 1) | |
595 | table += PTRS_PER_PTE; | |
596 | mask = atomic_xor_bits(&page->_mapcount, bit); | |
597 | if ((mask & FRAG_MASK) == FRAG_MASK) | |
598 | list_del(&page->lru); | |
3610cce8 | 599 | } |
80217147 | 600 | spin_unlock_bh(&mm->context.list_lock); |
3610cce8 MS |
601 | return table; |
602 | } | |
603 | ||
36409f63 | 604 | void page_table_free(struct mm_struct *mm, unsigned long *table) |
80217147 MS |
605 | { |
606 | struct page *page; | |
36409f63 | 607 | unsigned int bit, mask; |
80217147 | 608 | |
e5992f2e MS |
609 | if (mm_has_pgste(mm)) { |
610 | gmap_unmap_notifier(mm, table); | |
36409f63 | 611 | return page_table_free_pgste(table); |
e5992f2e | 612 | } |
36409f63 | 613 | /* Free 1K/2K page table fragment of a 4K page */ |
80217147 | 614 | page = pfn_to_page(__pa(table) >> PAGE_SHIFT); |
36409f63 MS |
615 | bit = 1 << ((__pa(table) & ~PAGE_MASK)/(PTRS_PER_PTE*sizeof(pte_t))); |
616 | spin_lock_bh(&mm->context.list_lock); | |
617 | if ((atomic_read(&page->_mapcount) & FRAG_MASK) != FRAG_MASK) | |
618 | list_del(&page->lru); | |
619 | mask = atomic_xor_bits(&page->_mapcount, bit); | |
620 | if (mask & FRAG_MASK) | |
621 | list_add(&page->lru, &mm->context.pgtable_list); | |
622 | spin_unlock_bh(&mm->context.list_lock); | |
623 | if (mask == 0) { | |
80217147 | 624 | pgtable_page_dtor(page); |
36409f63 | 625 | atomic_set(&page->_mapcount, -1); |
80217147 MS |
626 | __free_page(page); |
627 | } | |
628 | } | |
629 | ||
36409f63 MS |
630 | #ifdef CONFIG_HAVE_RCU_TABLE_FREE |
631 | ||
632 | static void __page_table_free_rcu(void *table, unsigned bit) | |
3610cce8 | 633 | { |
146e4b3c | 634 | struct page *page; |
3610cce8 | 635 | |
36409f63 MS |
636 | if (bit == FRAG_MASK) |
637 | return page_table_free_pgste(table); | |
36409f63 | 638 | /* Free 1K/2K page table fragment of a 4K page */ |
146e4b3c | 639 | page = pfn_to_page(__pa(table) >> PAGE_SHIFT); |
36409f63 | 640 | if (atomic_xor_bits(&page->_mapcount, bit) == 0) { |
146e4b3c | 641 | pgtable_page_dtor(page); |
36409f63 | 642 | atomic_set(&page->_mapcount, -1); |
146e4b3c MS |
643 | __free_page(page); |
644 | } | |
645 | } | |
3610cce8 | 646 | |
36409f63 | 647 | void page_table_free_rcu(struct mmu_gather *tlb, unsigned long *table) |
80217147 | 648 | { |
36409f63 | 649 | struct mm_struct *mm; |
80217147 | 650 | struct page *page; |
36409f63 | 651 | unsigned int bit, mask; |
80217147 | 652 | |
36409f63 | 653 | mm = tlb->mm; |
36409f63 | 654 | if (mm_has_pgste(mm)) { |
e5992f2e | 655 | gmap_unmap_notifier(mm, table); |
36409f63 MS |
656 | table = (unsigned long *) (__pa(table) | FRAG_MASK); |
657 | tlb_remove_table(tlb, table); | |
658 | return; | |
80217147 | 659 | } |
36409f63 | 660 | bit = 1 << ((__pa(table) & ~PAGE_MASK) / (PTRS_PER_PTE*sizeof(pte_t))); |
80217147 MS |
661 | page = pfn_to_page(__pa(table) >> PAGE_SHIFT); |
662 | spin_lock_bh(&mm->context.list_lock); | |
36409f63 MS |
663 | if ((atomic_read(&page->_mapcount) & FRAG_MASK) != FRAG_MASK) |
664 | list_del(&page->lru); | |
665 | mask = atomic_xor_bits(&page->_mapcount, bit | (bit << 4)); | |
666 | if (mask & FRAG_MASK) | |
667 | list_add_tail(&page->lru, &mm->context.pgtable_list); | |
80217147 | 668 | spin_unlock_bh(&mm->context.list_lock); |
36409f63 MS |
669 | table = (unsigned long *) (__pa(table) | (bit << 4)); |
670 | tlb_remove_table(tlb, table); | |
671 | } | |
672 | ||
673 | void __tlb_remove_table(void *_table) | |
674 | { | |
e73b7fff MS |
675 | const unsigned long mask = (FRAG_MASK << 4) | FRAG_MASK; |
676 | void *table = (void *)((unsigned long) _table & ~mask); | |
677 | unsigned type = (unsigned long) _table & mask; | |
36409f63 MS |
678 | |
679 | if (type) | |
680 | __page_table_free_rcu(table, type); | |
681 | else | |
682 | free_pages((unsigned long) table, ALLOC_ORDER); | |
80217147 MS |
683 | } |
684 | ||
36409f63 MS |
685 | #endif |
686 | ||
402b0862 CO |
687 | /* |
688 | * switch on pgstes for its userspace process (for kvm) | |
689 | */ | |
690 | int s390_enable_sie(void) | |
691 | { | |
692 | struct task_struct *tsk = current; | |
74b6b522 | 693 | struct mm_struct *mm, *old_mm; |
402b0862 | 694 | |
702d9e58 | 695 | /* Do we have switched amode? If no, we cannot do sie */ |
b11b5334 | 696 | if (user_mode == HOME_SPACE_MODE) |
702d9e58 CO |
697 | return -EINVAL; |
698 | ||
74b6b522 | 699 | /* Do we have pgstes? if yes, we are done */ |
36409f63 | 700 | if (mm_has_pgste(tsk->mm)) |
74b6b522 | 701 | return 0; |
402b0862 | 702 | |
74b6b522 CB |
703 | /* lets check if we are allowed to replace the mm */ |
704 | task_lock(tsk); | |
402b0862 | 705 | if (!tsk->mm || atomic_read(&tsk->mm->mm_users) > 1 || |
52a21f2c MS |
706 | #ifdef CONFIG_AIO |
707 | !hlist_empty(&tsk->mm->ioctx_list) || | |
708 | #endif | |
709 | tsk->mm != tsk->active_mm) { | |
74b6b522 CB |
710 | task_unlock(tsk); |
711 | return -EINVAL; | |
712 | } | |
713 | task_unlock(tsk); | |
402b0862 | 714 | |
250cf776 CB |
715 | /* we copy the mm and let dup_mm create the page tables with_pgstes */ |
716 | tsk->mm->context.alloc_pgste = 1; | |
402b0862 | 717 | mm = dup_mm(tsk); |
250cf776 | 718 | tsk->mm->context.alloc_pgste = 0; |
402b0862 | 719 | if (!mm) |
74b6b522 CB |
720 | return -ENOMEM; |
721 | ||
250cf776 | 722 | /* Now lets check again if something happened */ |
74b6b522 CB |
723 | task_lock(tsk); |
724 | if (!tsk->mm || atomic_read(&tsk->mm->mm_users) > 1 || | |
52a21f2c MS |
725 | #ifdef CONFIG_AIO |
726 | !hlist_empty(&tsk->mm->ioctx_list) || | |
727 | #endif | |
728 | tsk->mm != tsk->active_mm) { | |
74b6b522 CB |
729 | mmput(mm); |
730 | task_unlock(tsk); | |
731 | return -EINVAL; | |
732 | } | |
733 | ||
734 | /* ok, we are alone. No ptrace, no threads, etc. */ | |
735 | old_mm = tsk->mm; | |
402b0862 CO |
736 | tsk->mm = tsk->active_mm = mm; |
737 | preempt_disable(); | |
738 | update_mm(mm, tsk); | |
e05ef9bd CB |
739 | atomic_inc(&mm->context.attach_count); |
740 | atomic_dec(&old_mm->context.attach_count); | |
005f8eee | 741 | cpumask_set_cpu(smp_processor_id(), mm_cpumask(mm)); |
402b0862 | 742 | preempt_enable(); |
402b0862 | 743 | task_unlock(tsk); |
74b6b522 CB |
744 | mmput(old_mm); |
745 | return 0; | |
402b0862 CO |
746 | } |
747 | EXPORT_SYMBOL_GPL(s390_enable_sie); | |
7db11a36 | 748 | |
87458ff4 | 749 | #if defined(CONFIG_DEBUG_PAGEALLOC) && defined(CONFIG_HIBERNATION) |
7db11a36 HJP |
750 | bool kernel_page_present(struct page *page) |
751 | { | |
752 | unsigned long addr; | |
753 | int cc; | |
754 | ||
755 | addr = page_to_phys(page); | |
87458ff4 HC |
756 | asm volatile( |
757 | " lra %1,0(%1)\n" | |
758 | " ipm %0\n" | |
759 | " srl %0,28" | |
760 | : "=d" (cc), "+a" (addr) : : "cc"); | |
7db11a36 HJP |
761 | return cc == 0; |
762 | } | |
87458ff4 | 763 | #endif /* CONFIG_HIBERNATION && CONFIG_DEBUG_PAGEALLOC */ |