projects/linux·blob v4.7 · refs

431 lines · 12.0 KiB

1/*
2 * Copyright(c) 2015 Intel Corporation. All rights reserved.
3 *
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of version 2 of the GNU General Public License as
6 * published by the Free Software Foundation.
7 *
8 * This program is distributed in the hope that it will be useful, but
9 * WITHOUT ANY WARRANTY; without even the implied warranty of
10 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
11 * General Public License for more details.
12 */
13#include <linux/radix-tree.h>
14#include <linux/memremap.h>
15#include <linux/device.h>
16#include <linux/types.h>
17#include <linux/pfn_t.h>
18#include <linux/io.h>
19#include <linux/mm.h>
20#include <linux/memory_hotplug.h>
21
22#ifndef ioremap_cache
23/* temporary while we convert existing ioremap_cache users to memremap */
24__weak void __iomem *ioremap_cache(resource_size_t offset, unsigned long size)
25{
26 return ioremap(offset, size);
27}
28#endif
29
30#ifndef arch_memremap_wb
31static void *arch_memremap_wb(resource_size_t offset, unsigned long size)
32{
33 return (__force void *)ioremap_cache(offset, size);
34}
35#endif
36
37static void *try_ram_remap(resource_size_t offset, size_t size)
38{
39 unsigned long pfn = PHYS_PFN(offset);
40
41 /* In the simple case just return the existing linear address */
42 if (pfn_valid(pfn) && !PageHighMem(pfn_to_page(pfn)))
43 return __va(offset);
44 return NULL; /* fallback to arch_memremap_wb */
45}
46
47/**
48 * memremap() - remap an iomem_resource as cacheable memory
49 * @offset: iomem resource start address
50 * @size: size of remap
51 * @flags: any of MEMREMAP_WB, MEMREMAP_WT and MEMREMAP_WC
52 *
53 * memremap() is "ioremap" for cases where it is known that the resource
54 * being mapped does not have i/o side effects and the __iomem
55 * annotation is not applicable. In the case of multiple flags, the different
56 * mapping types will be attempted in the order listed below until one of
57 * them succeeds.
58 *
59 * MEMREMAP_WB - matches the default mapping for System RAM on
60 * the architecture. This is usually a read-allocate write-back cache.
61 * Morever, if MEMREMAP_WB is specified and the requested remap region is RAM
62 * memremap() will bypass establishing a new mapping and instead return
63 * a pointer into the direct map.
64 *
65 * MEMREMAP_WT - establish a mapping whereby writes either bypass the
66 * cache or are written through to memory and never exist in a
67 * cache-dirty state with respect to program visibility. Attempts to
68 * map System RAM with this mapping type will fail.
69 *
70 * MEMREMAP_WC - establish a writecombine mapping, whereby writes may
71 * be coalesced together (e.g. in the CPU's write buffers), but is otherwise
72 * uncached. Attempts to map System RAM with this mapping type will fail.
73 */
74void *memremap(resource_size_t offset, size_t size, unsigned long flags)
75{
76 int is_ram = region_intersects(offset, size,
77 IORESOURCE_SYSTEM_RAM, IORES_DESC_NONE);
78 void *addr = NULL;
79
80 if (!flags)
81 return NULL;
82
83 if (is_ram == REGION_MIXED) {
84 WARN_ONCE(1, "memremap attempted on mixed range %pa size: %#lx\n",
85 &offset, (unsigned long) size);
86 return NULL;
87 }
88
89 /* Try all mapping types requested until one returns non-NULL */
90 if (flags & MEMREMAP_WB) {
91 /*
92 * MEMREMAP_WB is special in that it can be satisifed
93 * from the direct map. Some archs depend on the
94 * capability of memremap() to autodetect cases where
95 * the requested range is potentially in System RAM.
96 */
97 if (is_ram == REGION_INTERSECTS)
98 addr = try_ram_remap(offset, size);
99 if (!addr)
100 addr = arch_memremap_wb(offset, size);
101 }
102
103 /*
104 * If we don't have a mapping yet and other request flags are
105 * present then we will be attempting to establish a new virtual
106 * address mapping. Enforce that this mapping is not aliasing
107 * System RAM.
108 */
109 if (!addr && is_ram == REGION_INTERSECTS && flags != MEMREMAP_WB) {
110 WARN_ONCE(1, "memremap attempted on ram %pa size: %#lx\n",
111 &offset, (unsigned long) size);
112 return NULL;
113 }
114
115 if (!addr && (flags & MEMREMAP_WT))
116 addr = ioremap_wt(offset, size);
117
118 if (!addr && (flags & MEMREMAP_WC))
119 addr = ioremap_wc(offset, size);
120
121 return addr;
122}
123EXPORT_SYMBOL(memremap);
124
125void memunmap(void *addr)
126{
127 if (is_vmalloc_addr(addr))
128 iounmap((void __iomem *) addr);
129}
130EXPORT_SYMBOL(memunmap);
131
132static void devm_memremap_release(struct device *dev, void *res)
133{
134 memunmap(*(void **)res);
135}
136
137static int devm_memremap_match(struct device *dev, void *res, void *match_data)
138{
139 return *(void **)res == match_data;
140}
141
142void *devm_memremap(struct device *dev, resource_size_t offset,
143 size_t size, unsigned long flags)
144{
145 void **ptr, *addr;
146
147 ptr = devres_alloc_node(devm_memremap_release, sizeof(*ptr), GFP_KERNEL,
148 dev_to_node(dev));
149 if (!ptr)
150 return ERR_PTR(-ENOMEM);
151
152 addr = memremap(offset, size, flags);
153 if (addr) {
154 *ptr = addr;
155 devres_add(dev, ptr);
156 } else {
157 devres_free(ptr);
158 return ERR_PTR(-ENXIO);
159 }
160
161 return addr;
162}
163EXPORT_SYMBOL(devm_memremap);
164
165void devm_memunmap(struct device *dev, void *addr)
166{
167 WARN_ON(devres_release(dev, devm_memremap_release,
168 devm_memremap_match, addr));
169}
170EXPORT_SYMBOL(devm_memunmap);
171
172pfn_t phys_to_pfn_t(phys_addr_t addr, u64 flags)
173{
174 return __pfn_to_pfn_t(addr >> PAGE_SHIFT, flags);
175}
176EXPORT_SYMBOL(phys_to_pfn_t);
177
178#ifdef CONFIG_ZONE_DEVICE
179static DEFINE_MUTEX(pgmap_lock);
180static RADIX_TREE(pgmap_radix, GFP_KERNEL);
181#define SECTION_MASK ~((1UL << PA_SECTION_SHIFT) - 1)
182#define SECTION_SIZE (1UL << PA_SECTION_SHIFT)
183
184struct page_map {
185 struct resource res;
186 struct percpu_ref *ref;
187 struct dev_pagemap pgmap;
188 struct vmem_altmap altmap;
189};
190
191void get_zone_device_page(struct page *page)
192{
193 percpu_ref_get(page->pgmap->ref);
194}
195EXPORT_SYMBOL(get_zone_device_page);
196
197void put_zone_device_page(struct page *page)
198{
199 put_dev_pagemap(page->pgmap);
200}
201EXPORT_SYMBOL(put_zone_device_page);
202
203static void pgmap_radix_release(struct resource *res)
204{
205 resource_size_t key, align_start, align_size, align_end;
206
207 align_start = res->start & ~(SECTION_SIZE - 1);
208 align_size = ALIGN(resource_size(res), SECTION_SIZE);
209 align_end = align_start + align_size - 1;
210
211 mutex_lock(&pgmap_lock);
212 for (key = res->start; key <= res->end; key += SECTION_SIZE)
213 radix_tree_delete(&pgmap_radix, key >> PA_SECTION_SHIFT);
214 mutex_unlock(&pgmap_lock);
215}
216
217static unsigned long pfn_first(struct page_map *page_map)
218{
219 struct dev_pagemap *pgmap = &page_map->pgmap;
220 const struct resource *res = &page_map->res;
221 struct vmem_altmap *altmap = pgmap->altmap;
222 unsigned long pfn;
223
224 pfn = res->start >> PAGE_SHIFT;
225 if (altmap)
226 pfn += vmem_altmap_offset(altmap);
227 return pfn;
228}
229
230static unsigned long pfn_end(struct page_map *page_map)
231{
232 const struct resource *res = &page_map->res;
233
234 return (res->start + resource_size(res)) >> PAGE_SHIFT;
235}
236
237#define for_each_device_pfn(pfn, map) \
238 for (pfn = pfn_first(map); pfn < pfn_end(map); pfn++)
239
240static void devm_memremap_pages_release(struct device *dev, void *data)
241{
242 struct page_map *page_map = data;
243 struct resource *res = &page_map->res;
244 resource_size_t align_start, align_size;
245 struct dev_pagemap *pgmap = &page_map->pgmap;
246
247 if (percpu_ref_tryget_live(pgmap->ref)) {
248 dev_WARN(dev, "%s: page mapping is still live!\n", __func__);
249 percpu_ref_put(pgmap->ref);
250 }
251
252 /* pages are dead and unused, undo the arch mapping */
253 align_start = res->start & ~(SECTION_SIZE - 1);
254 align_size = ALIGN(resource_size(res), SECTION_SIZE);
255 arch_remove_memory(align_start, align_size);
256 pgmap_radix_release(res);
257 dev_WARN_ONCE(dev, pgmap->altmap && pgmap->altmap->alloc,
258 "%s: failed to free all reserved pages\n", __func__);
259}
260
261/* assumes rcu_read_lock() held at entry */
262struct dev_pagemap *find_dev_pagemap(resource_size_t phys)
263{
264 struct page_map *page_map;
265
266 WARN_ON_ONCE(!rcu_read_lock_held());
267
268 page_map = radix_tree_lookup(&pgmap_radix, phys >> PA_SECTION_SHIFT);
269 return page_map ? &page_map->pgmap : NULL;
270}
271
272/**
273 * devm_memremap_pages - remap and provide memmap backing for the given resource
274 * @dev: hosting device for @res
275 * @res: "host memory" address range
276 * @ref: a live per-cpu reference count
277 * @altmap: optional descriptor for allocating the memmap from @res
278 *
279 * Notes:
280 * 1/ @ref must be 'live' on entry and 'dead' before devm_memunmap_pages() time
281 * (or devm release event).
282 *
283 * 2/ @res is expected to be a host memory range that could feasibly be
284 * treated as a "System RAM" range, i.e. not a device mmio range, but
285 * this is not enforced.
286 */
287void *devm_memremap_pages(struct device *dev, struct resource *res,
288 struct percpu_ref *ref, struct vmem_altmap *altmap)
289{
290 resource_size_t key, align_start, align_size, align_end;
291 struct dev_pagemap *pgmap;
292 struct page_map *page_map;
293 int error, nid, is_ram;
294 unsigned long pfn;
295
296 align_start = res->start & ~(SECTION_SIZE - 1);
297 align_size = ALIGN(res->start + resource_size(res), SECTION_SIZE)
298 - align_start;
299 is_ram = region_intersects(align_start, align_size,
300 IORESOURCE_SYSTEM_RAM, IORES_DESC_NONE);
301
302 if (is_ram == REGION_MIXED) {
303 WARN_ONCE(1, "%s attempted on mixed region %pr\n",
304 __func__, res);
305 return ERR_PTR(-ENXIO);
306 }
307
308 if (is_ram == REGION_INTERSECTS)
309 return __va(res->start);
310
311 if (altmap && !IS_ENABLED(CONFIG_SPARSEMEM_VMEMMAP)) {
312 dev_err(dev, "%s: altmap requires CONFIG_SPARSEMEM_VMEMMAP=y\n",
313 __func__);
314 return ERR_PTR(-ENXIO);
315 }
316
317 if (!ref)
318 return ERR_PTR(-EINVAL);
319
320 page_map = devres_alloc_node(devm_memremap_pages_release,
321 sizeof(*page_map), GFP_KERNEL, dev_to_node(dev));
322 if (!page_map)
323 return ERR_PTR(-ENOMEM);
324 pgmap = &page_map->pgmap;
325
326 memcpy(&page_map->res, res, sizeof(*res));
327
328 pgmap->dev = dev;
329 if (altmap) {
330 memcpy(&page_map->altmap, altmap, sizeof(*altmap));
331 pgmap->altmap = &page_map->altmap;
332 }
333 pgmap->ref = ref;
334 pgmap->res = &page_map->res;
335
336 mutex_lock(&pgmap_lock);
337 error = 0;
338 align_end = align_start + align_size - 1;
339 for (key = align_start; key <= align_end; key += SECTION_SIZE) {
340 struct dev_pagemap *dup;
341
342 rcu_read_lock();
343 dup = find_dev_pagemap(key);
344 rcu_read_unlock();
345 if (dup) {
346 dev_err(dev, "%s: %pr collides with mapping for %s\n",
347 __func__, res, dev_name(dup->dev));
348 error = -EBUSY;
349 break;
350 }
351 error = radix_tree_insert(&pgmap_radix, key >> PA_SECTION_SHIFT,
352 page_map);
353 if (error) {
354 dev_err(dev, "%s: failed: %d\n", __func__, error);
355 break;
356 }
357 }
358 mutex_unlock(&pgmap_lock);
359 if (error)
360 goto err_radix;
361
362 nid = dev_to_node(dev);
363 if (nid < 0)
364 nid = numa_mem_id();
365
366 error = arch_add_memory(nid, align_start, align_size, true);
367 if (error)
368 goto err_add_memory;
369
370 for_each_device_pfn(pfn, page_map) {
371 struct page *page = pfn_to_page(pfn);
372
373 /*
374 * ZONE_DEVICE pages union ->lru with a ->pgmap back
375 * pointer. It is a bug if a ZONE_DEVICE page is ever
376 * freed or placed on a driver-private list. Seed the
377 * storage with LIST_POISON* values.
378 */
379 list_del(&page->lru);
380 page->pgmap = pgmap;
381 }
382 devres_add(dev, page_map);
383 return __va(res->start);
384
385 err_add_memory:
386 err_radix:
387 pgmap_radix_release(res);
388 devres_free(page_map);
389 return ERR_PTR(error);
390}
391EXPORT_SYMBOL(devm_memremap_pages);
392
393unsigned long vmem_altmap_offset(struct vmem_altmap *altmap)
394{
395 /* number of pfns from base where pfn_to_page() is valid */
396 return altmap->reserve + altmap->free;
397}
398
399void vmem_altmap_free(struct vmem_altmap *altmap, unsigned long nr_pfns)
400{
401 altmap->alloc -= nr_pfns;
402}
403
404#ifdef CONFIG_SPARSEMEM_VMEMMAP
405struct vmem_altmap *to_vmem_altmap(unsigned long memmap_start)
406{
407 /*
408 * 'memmap_start' is the virtual address for the first "struct
409 * page" in this range of the vmemmap array. In the case of
410 * CONFIG_SPARSEMEM_VMEMMAP a page_to_pfn conversion is simple
411 * pointer arithmetic, so we can perform this to_vmem_altmap()
412 * conversion without concern for the initialization state of
413 * the struct page fields.
414 */
415 struct page *page = (struct page *) memmap_start;
416 struct dev_pagemap *pgmap;
417
418 /*
419 * Unconditionally retrieve a dev_pagemap associated with the
420 * given physical address, this is only for use in the
421 * arch_{add|remove}_memory() for setting up and tearing down
422 * the memmap.
423 */
424 rcu_read_lock();
425 pgmap = find_dev_pagemap(__pfn_to_phys(page_to_pfn(page)));
426 rcu_read_unlock();
427
428 return pgmap ? pgmap->altmap : NULL;
429}
430#endif /* CONFIG_SPARSEMEM_VMEMMAP */
431#endif /* CONFIG_ZONE_DEVICE */