Loading...
1/*
2 * linux/arch/arm/mm/pgd.c
3 *
4 * Copyright (C) 1998-2005 Russell King
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2 as
8 * published by the Free Software Foundation.
9 */
10#include <linux/mm.h>
11#include <linux/gfp.h>
12#include <linux/highmem.h>
13#include <linux/slab.h>
14
15#include <asm/cp15.h>
16#include <asm/pgalloc.h>
17#include <asm/page.h>
18#include <asm/tlbflush.h>
19
20#include "mm.h"
21
22#ifdef CONFIG_ARM_LPAE
23#define __pgd_alloc() kmalloc(PTRS_PER_PGD * sizeof(pgd_t), GFP_KERNEL)
24#define __pgd_free(pgd) kfree(pgd)
25#else
26#define __pgd_alloc() (pgd_t *)__get_free_pages(GFP_KERNEL | __GFP_REPEAT, 2)
27#define __pgd_free(pgd) free_pages((unsigned long)pgd, 2)
28#endif
29
30/*
31 * need to get a 16k page for level 1
32 */
33pgd_t *pgd_alloc(struct mm_struct *mm)
34{
35 pgd_t *new_pgd, *init_pgd;
36 pud_t *new_pud, *init_pud;
37 pmd_t *new_pmd, *init_pmd;
38 pte_t *new_pte, *init_pte;
39
40 new_pgd = __pgd_alloc();
41 if (!new_pgd)
42 goto no_pgd;
43
44 memset(new_pgd, 0, USER_PTRS_PER_PGD * sizeof(pgd_t));
45
46 /*
47 * Copy over the kernel and IO PGD entries
48 */
49 init_pgd = pgd_offset_k(0);
50 memcpy(new_pgd + USER_PTRS_PER_PGD, init_pgd + USER_PTRS_PER_PGD,
51 (PTRS_PER_PGD - USER_PTRS_PER_PGD) * sizeof(pgd_t));
52
53 clean_dcache_area(new_pgd, PTRS_PER_PGD * sizeof(pgd_t));
54
55#ifdef CONFIG_ARM_LPAE
56 /*
57 * Allocate PMD table for modules and pkmap mappings.
58 */
59 new_pud = pud_alloc(mm, new_pgd + pgd_index(MODULES_VADDR),
60 MODULES_VADDR);
61 if (!new_pud)
62 goto no_pud;
63
64 new_pmd = pmd_alloc(mm, new_pud, 0);
65 if (!new_pmd)
66 goto no_pmd;
67#endif
68
69 if (!vectors_high()) {
70 /*
71 * On ARM, first page must always be allocated since it
72 * contains the machine vectors. The vectors are always high
73 * with LPAE.
74 */
75 new_pud = pud_alloc(mm, new_pgd, 0);
76 if (!new_pud)
77 goto no_pud;
78
79 new_pmd = pmd_alloc(mm, new_pud, 0);
80 if (!new_pmd)
81 goto no_pmd;
82
83 new_pte = pte_alloc_map(mm, new_pmd, 0);
84 if (!new_pte)
85 goto no_pte;
86
87#ifndef CONFIG_ARM_LPAE
88 /*
89 * Modify the PTE pointer to have the correct domain. This
90 * needs to be the vectors domain to avoid the low vectors
91 * being unmapped.
92 */
93 pmd_val(*new_pmd) &= ~PMD_DOMAIN_MASK;
94 pmd_val(*new_pmd) |= PMD_DOMAIN(DOMAIN_VECTORS);
95#endif
96
97 init_pud = pud_offset(init_pgd, 0);
98 init_pmd = pmd_offset(init_pud, 0);
99 init_pte = pte_offset_map(init_pmd, 0);
100 set_pte_ext(new_pte + 0, init_pte[0], 0);
101 set_pte_ext(new_pte + 1, init_pte[1], 0);
102 pte_unmap(init_pte);
103 pte_unmap(new_pte);
104 }
105
106 return new_pgd;
107
108no_pte:
109 pmd_free(mm, new_pmd);
110 mm_dec_nr_pmds(mm);
111no_pmd:
112 pud_free(mm, new_pud);
113no_pud:
114 __pgd_free(new_pgd);
115no_pgd:
116 return NULL;
117}
118
119void pgd_free(struct mm_struct *mm, pgd_t *pgd_base)
120{
121 pgd_t *pgd;
122 pud_t *pud;
123 pmd_t *pmd;
124 pgtable_t pte;
125
126 if (!pgd_base)
127 return;
128
129 pgd = pgd_base + pgd_index(0);
130 if (pgd_none_or_clear_bad(pgd))
131 goto no_pgd;
132
133 pud = pud_offset(pgd, 0);
134 if (pud_none_or_clear_bad(pud))
135 goto no_pud;
136
137 pmd = pmd_offset(pud, 0);
138 if (pmd_none_or_clear_bad(pmd))
139 goto no_pmd;
140
141 pte = pmd_pgtable(*pmd);
142 pmd_clear(pmd);
143 pte_free(mm, pte);
144 atomic_long_dec(&mm->nr_ptes);
145no_pmd:
146 pud_clear(pud);
147 pmd_free(mm, pmd);
148 mm_dec_nr_pmds(mm);
149no_pud:
150 pgd_clear(pgd);
151 pud_free(mm, pud);
152no_pgd:
153#ifdef CONFIG_ARM_LPAE
154 /*
155 * Free modules/pkmap or identity pmd tables.
156 */
157 for (pgd = pgd_base; pgd < pgd_base + PTRS_PER_PGD; pgd++) {
158 if (pgd_none_or_clear_bad(pgd))
159 continue;
160 if (pgd_val(*pgd) & L_PGD_SWAPPER)
161 continue;
162 pud = pud_offset(pgd, 0);
163 if (pud_none_or_clear_bad(pud))
164 continue;
165 pmd = pmd_offset(pud, 0);
166 pud_clear(pud);
167 pmd_free(mm, pmd);
168 mm_dec_nr_pmds(mm);
169 pgd_clear(pgd);
170 pud_free(mm, pud);
171 }
172#endif
173 __pgd_free(pgd_base);
174}
1// SPDX-License-Identifier: GPL-2.0-only
2/*
3 * linux/arch/arm/mm/pgd.c
4 *
5 * Copyright (C) 1998-2005 Russell King
6 */
7#include <linux/mm.h>
8#include <linux/gfp.h>
9#include <linux/highmem.h>
10#include <linux/slab.h>
11
12#include <asm/cp15.h>
13#include <asm/pgalloc.h>
14#include <asm/page.h>
15#include <asm/tlbflush.h>
16
17#include "mm.h"
18
19#ifdef CONFIG_ARM_LPAE
20#define __pgd_alloc() kmalloc_array(PTRS_PER_PGD, sizeof(pgd_t), GFP_KERNEL)
21#define __pgd_free(pgd) kfree(pgd)
22#else
23#define __pgd_alloc() (pgd_t *)__get_free_pages(GFP_KERNEL, 2)
24#define __pgd_free(pgd) free_pages((unsigned long)pgd, 2)
25#endif
26
27/*
28 * need to get a 16k page for level 1
29 */
30pgd_t *pgd_alloc(struct mm_struct *mm)
31{
32 pgd_t *new_pgd, *init_pgd;
33 p4d_t *new_p4d, *init_p4d;
34 pud_t *new_pud, *init_pud;
35 pmd_t *new_pmd, *init_pmd;
36 pte_t *new_pte, *init_pte;
37
38 new_pgd = __pgd_alloc();
39 if (!new_pgd)
40 goto no_pgd;
41
42 memset(new_pgd, 0, USER_PTRS_PER_PGD * sizeof(pgd_t));
43
44 /*
45 * Copy over the kernel and IO PGD entries
46 */
47 init_pgd = pgd_offset_k(0);
48 memcpy(new_pgd + USER_PTRS_PER_PGD, init_pgd + USER_PTRS_PER_PGD,
49 (PTRS_PER_PGD - USER_PTRS_PER_PGD) * sizeof(pgd_t));
50
51 clean_dcache_area(new_pgd, PTRS_PER_PGD * sizeof(pgd_t));
52
53#ifdef CONFIG_ARM_LPAE
54 /*
55 * Allocate PMD table for modules and pkmap mappings.
56 */
57 new_p4d = p4d_alloc(mm, new_pgd + pgd_index(MODULES_VADDR),
58 MODULES_VADDR);
59 if (!new_p4d)
60 goto no_p4d;
61
62 new_pud = pud_alloc(mm, new_p4d, MODULES_VADDR);
63 if (!new_pud)
64 goto no_pud;
65
66 new_pmd = pmd_alloc(mm, new_pud, 0);
67 if (!new_pmd)
68 goto no_pmd;
69#endif
70
71 if (!vectors_high()) {
72 /*
73 * On ARM, first page must always be allocated since it
74 * contains the machine vectors. The vectors are always high
75 * with LPAE.
76 */
77 new_p4d = p4d_alloc(mm, new_pgd, 0);
78 if (!new_p4d)
79 goto no_p4d;
80
81 new_pud = pud_alloc(mm, new_p4d, 0);
82 if (!new_pud)
83 goto no_pud;
84
85 new_pmd = pmd_alloc(mm, new_pud, 0);
86 if (!new_pmd)
87 goto no_pmd;
88
89 new_pte = pte_alloc_map(mm, new_pmd, 0);
90 if (!new_pte)
91 goto no_pte;
92
93#ifndef CONFIG_ARM_LPAE
94 /*
95 * Modify the PTE pointer to have the correct domain. This
96 * needs to be the vectors domain to avoid the low vectors
97 * being unmapped.
98 */
99 pmd_val(*new_pmd) &= ~PMD_DOMAIN_MASK;
100 pmd_val(*new_pmd) |= PMD_DOMAIN(DOMAIN_VECTORS);
101#endif
102
103 init_p4d = p4d_offset(init_pgd, 0);
104 init_pud = pud_offset(init_p4d, 0);
105 init_pmd = pmd_offset(init_pud, 0);
106 init_pte = pte_offset_map(init_pmd, 0);
107 set_pte_ext(new_pte + 0, init_pte[0], 0);
108 set_pte_ext(new_pte + 1, init_pte[1], 0);
109 pte_unmap(init_pte);
110 pte_unmap(new_pte);
111 }
112
113 return new_pgd;
114
115no_pte:
116 pmd_free(mm, new_pmd);
117 mm_dec_nr_pmds(mm);
118no_pmd:
119 pud_free(mm, new_pud);
120no_pud:
121 p4d_free(mm, new_p4d);
122no_p4d:
123 __pgd_free(new_pgd);
124no_pgd:
125 return NULL;
126}
127
128void pgd_free(struct mm_struct *mm, pgd_t *pgd_base)
129{
130 pgd_t *pgd;
131 p4d_t *p4d;
132 pud_t *pud;
133 pmd_t *pmd;
134 pgtable_t pte;
135
136 if (!pgd_base)
137 return;
138
139 pgd = pgd_base + pgd_index(0);
140 if (pgd_none_or_clear_bad(pgd))
141 goto no_pgd;
142
143 p4d = p4d_offset(pgd, 0);
144 if (p4d_none_or_clear_bad(p4d))
145 goto no_p4d;
146
147 pud = pud_offset(p4d, 0);
148 if (pud_none_or_clear_bad(pud))
149 goto no_pud;
150
151 pmd = pmd_offset(pud, 0);
152 if (pmd_none_or_clear_bad(pmd))
153 goto no_pmd;
154
155 pte = pmd_pgtable(*pmd);
156 pmd_clear(pmd);
157 pte_free(mm, pte);
158 mm_dec_nr_ptes(mm);
159no_pmd:
160 pud_clear(pud);
161 pmd_free(mm, pmd);
162 mm_dec_nr_pmds(mm);
163no_pud:
164 p4d_clear(p4d);
165 pud_free(mm, pud);
166no_p4d:
167 pgd_clear(pgd);
168 p4d_free(mm, p4d);
169no_pgd:
170#ifdef CONFIG_ARM_LPAE
171 /*
172 * Free modules/pkmap or identity pmd tables.
173 */
174 for (pgd = pgd_base; pgd < pgd_base + PTRS_PER_PGD; pgd++) {
175 if (pgd_none_or_clear_bad(pgd))
176 continue;
177 if (pgd_val(*pgd) & L_PGD_SWAPPER)
178 continue;
179 p4d = p4d_offset(pgd, 0);
180 if (p4d_none_or_clear_bad(p4d))
181 continue;
182 pud = pud_offset(p4d, 0);
183 if (pud_none_or_clear_bad(pud))
184 continue;
185 pmd = pmd_offset(pud, 0);
186 pud_clear(pud);
187 pmd_free(mm, pmd);
188 mm_dec_nr_pmds(mm);
189 p4d_clear(p4d);
190 pud_free(mm, pud);
191 mm_dec_nr_puds(mm);
192 pgd_clear(pgd);
193 p4d_free(mm, p4d);
194 }
195#endif
196 __pgd_free(pgd_base);
197}