2 * drivers/staging/android/ion/ion_system_heap.c
4 * Copyright (C) 2011 Google, Inc.
6 * This software is licensed under the terms of the GNU General Public
7 * License version 2, as published by the Free Software Foundation, and
8 * may be copied, distributed, and modified under those terms.
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
18 #include <linux/dma-mapping.h>
19 #include <linux/err.h>
20 #include <linux/highmem.h>
22 #include <linux/scatterlist.h>
23 #include <linux/seq_file.h>
24 #include <linux/slab.h>
25 #include <linux/vmalloc.h>
29 static gfp_t high_order_gfp_flags = (GFP_HIGHUSER | __GFP_ZERO | __GFP_NOWARN |
30 __GFP_NORETRY) & ~__GFP_DIRECT_RECLAIM;
31 static gfp_t low_order_gfp_flags = (GFP_HIGHUSER | __GFP_ZERO | __GFP_NOWARN);
32 static const unsigned int orders[] = {8, 4, 0};
33 static const int num_orders = ARRAY_SIZE(orders);
34 static int order_to_index(unsigned int order)
38 for (i = 0; i < num_orders; i++)
39 if (order == orders[i])
45 static inline unsigned int order_to_size(int order)
47 return PAGE_SIZE << order;
50 struct ion_system_heap {
52 struct ion_page_pool *pools[0];
55 static struct page *alloc_buffer_page(struct ion_system_heap *heap,
56 struct ion_buffer *buffer,
59 bool cached = ion_buffer_cached(buffer);
60 struct ion_page_pool *pool = heap->pools[order_to_index(order)];
64 page = ion_page_pool_alloc(pool);
66 gfp_t gfp_flags = low_order_gfp_flags;
69 gfp_flags = high_order_gfp_flags;
70 page = alloc_pages(gfp_flags | __GFP_COMP, order);
73 ion_pages_sync_for_device(NULL, page, PAGE_SIZE << order,
80 static void free_buffer_page(struct ion_system_heap *heap,
81 struct ion_buffer *buffer, struct page *page)
83 unsigned int order = compound_order(page);
84 bool cached = ion_buffer_cached(buffer);
86 if (!cached && !(buffer->private_flags & ION_PRIV_FLAG_SHRINKER_FREE)) {
87 struct ion_page_pool *pool = heap->pools[order_to_index(order)];
88 if (buffer->private_flags & ION_PRIV_FLAG_SHRINKER_FREE)
89 ion_page_pool_free_immediate(pool, page);
91 ion_page_pool_free(pool, page);
93 __free_pages(page, order);
98 static struct page *alloc_largest_available(struct ion_system_heap *heap,
99 struct ion_buffer *buffer,
101 unsigned int max_order)
106 for (i = 0; i < num_orders; i++) {
107 if (size < order_to_size(orders[i]))
109 if (max_order < orders[i])
112 page = alloc_buffer_page(heap, buffer, orders[i]);
122 static int ion_system_heap_allocate(struct ion_heap *heap,
123 struct ion_buffer *buffer,
124 unsigned long size, unsigned long align,
127 struct ion_system_heap *sys_heap = container_of(heap,
128 struct ion_system_heap,
130 struct sg_table *table;
131 struct scatterlist *sg;
132 struct list_head pages;
133 struct page *page, *tmp_page;
135 unsigned long size_remaining = PAGE_ALIGN(size);
136 unsigned int max_order = orders[0];
138 if (align > PAGE_SIZE)
141 if (size / PAGE_SIZE > totalram_pages / 2)
144 INIT_LIST_HEAD(&pages);
145 while (size_remaining > 0) {
146 page = alloc_largest_available(sys_heap, buffer, size_remaining,
150 list_add_tail(&page->lru, &pages);
151 size_remaining -= PAGE_SIZE << compound_order(page);
152 max_order = compound_order(page);
155 table = kmalloc(sizeof(struct sg_table), GFP_KERNEL);
159 if (sg_alloc_table(table, i, GFP_KERNEL))
163 list_for_each_entry_safe(page, tmp_page, &pages, lru) {
164 sg_set_page(sg, page, PAGE_SIZE << compound_order(page), 0);
166 list_del(&page->lru);
169 buffer->priv_virt = table;
175 list_for_each_entry_safe(page, tmp_page, &pages, lru)
176 free_buffer_page(sys_heap, buffer, page);
180 static void ion_system_heap_free(struct ion_buffer *buffer)
182 struct ion_system_heap *sys_heap = container_of(buffer->heap,
183 struct ion_system_heap,
185 struct sg_table *table = buffer->sg_table;
186 bool cached = ion_buffer_cached(buffer);
187 struct scatterlist *sg;
191 * uncached pages come from the page pools, zero them before returning
192 * for security purposes (other allocations are zerod at
195 if (!cached && !(buffer->private_flags & ION_PRIV_FLAG_SHRINKER_FREE))
196 ion_heap_buffer_zero(buffer);
198 for_each_sg(table->sgl, sg, table->nents, i)
199 free_buffer_page(sys_heap, buffer, sg_page(sg));
200 sg_free_table(table);
204 static struct sg_table *ion_system_heap_map_dma(struct ion_heap *heap,
205 struct ion_buffer *buffer)
207 return buffer->priv_virt;
210 static void ion_system_heap_unmap_dma(struct ion_heap *heap,
211 struct ion_buffer *buffer)
215 static int ion_system_heap_shrink(struct ion_heap *heap, gfp_t gfp_mask,
218 struct ion_system_heap *sys_heap;
223 sys_heap = container_of(heap, struct ion_system_heap, heap);
228 for (i = 0; i < num_orders; i++) {
229 struct ion_page_pool *pool = sys_heap->pools[i];
231 nr_freed = ion_page_pool_shrink(pool, gfp_mask, nr_to_scan);
232 nr_total += nr_freed;
235 nr_to_scan -= nr_freed;
236 /* shrink completed */
245 static struct ion_heap_ops system_heap_ops = {
246 .allocate = ion_system_heap_allocate,
247 .free = ion_system_heap_free,
248 .map_dma = ion_system_heap_map_dma,
249 .unmap_dma = ion_system_heap_unmap_dma,
250 .map_kernel = ion_heap_map_kernel,
251 .unmap_kernel = ion_heap_unmap_kernel,
252 .map_user = ion_heap_map_user,
253 .shrink = ion_system_heap_shrink,
256 static int ion_system_heap_debug_show(struct ion_heap *heap, struct seq_file *s,
260 struct ion_system_heap *sys_heap = container_of(heap,
261 struct ion_system_heap,
265 for (i = 0; i < num_orders; i++) {
266 struct ion_page_pool *pool = sys_heap->pools[i];
268 seq_printf(s, "%d order %u highmem pages in pool = %lu total\n",
269 pool->high_count, pool->order,
270 (PAGE_SIZE << pool->order) * pool->high_count);
271 seq_printf(s, "%d order %u lowmem pages in pool = %lu total\n",
272 pool->low_count, pool->order,
273 (PAGE_SIZE << pool->order) * pool->low_count);
278 struct ion_heap *ion_system_heap_create(struct ion_platform_heap *unused)
280 struct ion_system_heap *heap;
283 heap = kzalloc(sizeof(struct ion_system_heap) +
284 sizeof(struct ion_page_pool *) * num_orders,
287 return ERR_PTR(-ENOMEM);
288 heap->heap.ops = &system_heap_ops;
289 heap->heap.type = ION_HEAP_TYPE_SYSTEM;
290 heap->heap.flags = ION_HEAP_FLAG_DEFER_FREE;
292 for (i = 0; i < num_orders; i++) {
293 struct ion_page_pool *pool;
294 gfp_t gfp_flags = low_order_gfp_flags;
297 gfp_flags = high_order_gfp_flags;
298 pool = ion_page_pool_create(gfp_flags, orders[i]);
301 heap->pools[i] = pool;
304 heap->heap.debug_show = ion_system_heap_debug_show;
309 ion_page_pool_destroy(heap->pools[i]);
311 return ERR_PTR(-ENOMEM);
314 void ion_system_heap_destroy(struct ion_heap *heap)
316 struct ion_system_heap *sys_heap = container_of(heap,
317 struct ion_system_heap,
321 for (i = 0; i < num_orders; i++)
322 ion_page_pool_destroy(sys_heap->pools[i]);
326 static int ion_system_contig_heap_allocate(struct ion_heap *heap,
327 struct ion_buffer *buffer,
332 int order = get_order(len);
334 struct sg_table *table;
338 if (align > (PAGE_SIZE << order))
341 page = alloc_pages(low_order_gfp_flags, order);
345 split_page(page, order);
347 len = PAGE_ALIGN(len);
348 for (i = len >> PAGE_SHIFT; i < (1 << order); i++)
349 __free_page(page + i);
351 table = kmalloc(sizeof(struct sg_table), GFP_KERNEL);
357 ret = sg_alloc_table(table, 1, GFP_KERNEL);
361 sg_set_page(table->sgl, page, len, 0);
363 buffer->priv_virt = table;
365 ion_pages_sync_for_device(NULL, page, len, DMA_BIDIRECTIONAL);
372 for (i = 0; i < len >> PAGE_SHIFT; i++)
373 __free_page(page + i);
378 static void ion_system_contig_heap_free(struct ion_buffer *buffer)
380 struct sg_table *table = buffer->priv_virt;
381 struct page *page = sg_page(table->sgl);
382 unsigned long pages = PAGE_ALIGN(buffer->size) >> PAGE_SHIFT;
385 for (i = 0; i < pages; i++)
386 __free_page(page + i);
387 sg_free_table(table);
391 static int ion_system_contig_heap_phys(struct ion_heap *heap,
392 struct ion_buffer *buffer,
393 ion_phys_addr_t *addr, size_t *len)
395 struct sg_table *table = buffer->priv_virt;
396 struct page *page = sg_page(table->sgl);
397 *addr = page_to_phys(page);
402 static struct sg_table *ion_system_contig_heap_map_dma(struct ion_heap *heap,
403 struct ion_buffer *buffer)
405 return buffer->priv_virt;
408 static void ion_system_contig_heap_unmap_dma(struct ion_heap *heap,
409 struct ion_buffer *buffer)
413 static struct ion_heap_ops kmalloc_ops = {
414 .allocate = ion_system_contig_heap_allocate,
415 .free = ion_system_contig_heap_free,
416 .phys = ion_system_contig_heap_phys,
417 .map_dma = ion_system_contig_heap_map_dma,
418 .unmap_dma = ion_system_contig_heap_unmap_dma,
419 .map_kernel = ion_heap_map_kernel,
420 .unmap_kernel = ion_heap_unmap_kernel,
421 .map_user = ion_heap_map_user,
424 struct ion_heap *ion_system_contig_heap_create(struct ion_platform_heap *unused)
426 struct ion_heap *heap;
428 heap = kzalloc(sizeof(struct ion_heap), GFP_KERNEL);
430 return ERR_PTR(-ENOMEM);
431 heap->ops = &kmalloc_ops;
432 heap->type = ION_HEAP_TYPE_SYSTEM_CONTIG;
436 void ion_system_contig_heap_destroy(struct ion_heap *heap)