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_WAIT;
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)];
89 ion_page_pool_free(pool, page);
91 __free_pages(page, order);
96 static struct page *alloc_largest_available(struct ion_system_heap *heap,
97 struct ion_buffer *buffer,
99 unsigned int max_order)
104 for (i = 0; i < num_orders; i++) {
105 if (size < order_to_size(orders[i]))
107 if (max_order < orders[i])
110 page = alloc_buffer_page(heap, buffer, orders[i]);
120 static int ion_system_heap_allocate(struct ion_heap *heap,
121 struct ion_buffer *buffer,
122 unsigned long size, unsigned long align,
125 struct ion_system_heap *sys_heap = container_of(heap,
126 struct ion_system_heap,
128 struct sg_table *table;
129 struct scatterlist *sg;
130 struct list_head pages;
131 struct page *page, *tmp_page;
133 unsigned long size_remaining = PAGE_ALIGN(size);
134 unsigned int max_order = orders[0];
136 if (align > PAGE_SIZE)
139 if (size / PAGE_SIZE > totalram_pages / 2)
142 INIT_LIST_HEAD(&pages);
143 while (size_remaining > 0) {
144 page = alloc_largest_available(sys_heap, buffer, size_remaining,
148 list_add_tail(&page->lru, &pages);
149 size_remaining -= PAGE_SIZE << compound_order(page);
150 max_order = compound_order(page);
153 table = kmalloc(sizeof(struct sg_table), GFP_KERNEL);
157 if (sg_alloc_table(table, i, GFP_KERNEL))
161 list_for_each_entry_safe(page, tmp_page, &pages, lru) {
162 sg_set_page(sg, page, PAGE_SIZE << compound_order(page), 0);
164 list_del(&page->lru);
167 buffer->priv_virt = table;
173 list_for_each_entry_safe(page, tmp_page, &pages, lru)
174 free_buffer_page(sys_heap, buffer, page);
178 static void ion_system_heap_free(struct ion_buffer *buffer)
180 struct ion_system_heap *sys_heap = container_of(buffer->heap,
181 struct ion_system_heap,
183 struct sg_table *table = buffer->sg_table;
184 bool cached = ion_buffer_cached(buffer);
185 struct scatterlist *sg;
188 /* uncached pages come from the page pools, zero them before returning
189 for security purposes (other allocations are zerod at alloc time */
190 if (!cached && !(buffer->private_flags & ION_PRIV_FLAG_SHRINKER_FREE))
191 ion_heap_buffer_zero(buffer);
193 for_each_sg(table->sgl, sg, table->nents, i)
194 free_buffer_page(sys_heap, buffer, sg_page(sg));
195 sg_free_table(table);
199 static struct sg_table *ion_system_heap_map_dma(struct ion_heap *heap,
200 struct ion_buffer *buffer)
202 return buffer->priv_virt;
205 static void ion_system_heap_unmap_dma(struct ion_heap *heap,
206 struct ion_buffer *buffer)
210 static int ion_system_heap_shrink(struct ion_heap *heap, gfp_t gfp_mask,
213 struct ion_system_heap *sys_heap;
218 sys_heap = container_of(heap, struct ion_system_heap, heap);
223 for (i = 0; i < num_orders; i++) {
224 struct ion_page_pool *pool = sys_heap->pools[i];
226 nr_freed = ion_page_pool_shrink(pool, gfp_mask, nr_to_scan);
227 nr_total += nr_freed;
230 nr_to_scan -= nr_freed;
231 /* shrink completed */
240 static struct ion_heap_ops system_heap_ops = {
241 .allocate = ion_system_heap_allocate,
242 .free = ion_system_heap_free,
243 .map_dma = ion_system_heap_map_dma,
244 .unmap_dma = ion_system_heap_unmap_dma,
245 .map_kernel = ion_heap_map_kernel,
246 .unmap_kernel = ion_heap_unmap_kernel,
247 .map_user = ion_heap_map_user,
248 .shrink = ion_system_heap_shrink,
251 static int ion_system_heap_debug_show(struct ion_heap *heap, struct seq_file *s,
255 struct ion_system_heap *sys_heap = container_of(heap,
256 struct ion_system_heap,
260 for (i = 0; i < num_orders; i++) {
261 struct ion_page_pool *pool = sys_heap->pools[i];
263 seq_printf(s, "%d order %u highmem pages in pool = %lu total\n",
264 pool->high_count, pool->order,
265 (PAGE_SIZE << pool->order) * pool->high_count);
266 seq_printf(s, "%d order %u lowmem pages in pool = %lu total\n",
267 pool->low_count, pool->order,
268 (PAGE_SIZE << pool->order) * pool->low_count);
273 struct ion_heap *ion_system_heap_create(struct ion_platform_heap *unused)
275 struct ion_system_heap *heap;
278 heap = kzalloc(sizeof(struct ion_system_heap) +
279 sizeof(struct ion_page_pool *) * num_orders,
282 return ERR_PTR(-ENOMEM);
283 heap->heap.ops = &system_heap_ops;
284 heap->heap.type = ION_HEAP_TYPE_SYSTEM;
285 heap->heap.flags = ION_HEAP_FLAG_DEFER_FREE;
287 for (i = 0; i < num_orders; i++) {
288 struct ion_page_pool *pool;
289 gfp_t gfp_flags = low_order_gfp_flags;
292 gfp_flags = high_order_gfp_flags;
293 pool = ion_page_pool_create(gfp_flags, orders[i]);
296 heap->pools[i] = pool;
299 heap->heap.debug_show = ion_system_heap_debug_show;
304 ion_page_pool_destroy(heap->pools[i]);
306 return ERR_PTR(-ENOMEM);
309 void ion_system_heap_destroy(struct ion_heap *heap)
311 struct ion_system_heap *sys_heap = container_of(heap,
312 struct ion_system_heap,
316 for (i = 0; i < num_orders; i++)
317 ion_page_pool_destroy(sys_heap->pools[i]);
321 static int ion_system_contig_heap_allocate(struct ion_heap *heap,
322 struct ion_buffer *buffer,
327 int order = get_order(len);
329 struct sg_table *table;
333 if (align > (PAGE_SIZE << order))
336 page = alloc_pages(low_order_gfp_flags, order);
340 split_page(page, order);
342 len = PAGE_ALIGN(len);
343 for (i = len >> PAGE_SHIFT; i < (1 << order); i++)
344 __free_page(page + i);
346 table = kmalloc(sizeof(struct sg_table), GFP_KERNEL);
352 ret = sg_alloc_table(table, 1, GFP_KERNEL);
356 sg_set_page(table->sgl, page, len, 0);
358 buffer->priv_virt = table;
360 ion_pages_sync_for_device(NULL, page, len, DMA_BIDIRECTIONAL);
367 for (i = 0; i < len >> PAGE_SHIFT; i++)
368 __free_page(page + i);
373 static void ion_system_contig_heap_free(struct ion_buffer *buffer)
375 struct sg_table *table = buffer->priv_virt;
376 struct page *page = sg_page(table->sgl);
377 unsigned long pages = PAGE_ALIGN(buffer->size) >> PAGE_SHIFT;
380 for (i = 0; i < pages; i++)
381 __free_page(page + i);
382 sg_free_table(table);
386 static int ion_system_contig_heap_phys(struct ion_heap *heap,
387 struct ion_buffer *buffer,
388 ion_phys_addr_t *addr, size_t *len)
390 struct sg_table *table = buffer->priv_virt;
391 struct page *page = sg_page(table->sgl);
392 *addr = page_to_phys(page);
397 static struct sg_table *ion_system_contig_heap_map_dma(struct ion_heap *heap,
398 struct ion_buffer *buffer)
400 return buffer->priv_virt;
403 static void ion_system_contig_heap_unmap_dma(struct ion_heap *heap,
404 struct ion_buffer *buffer)
408 static struct ion_heap_ops kmalloc_ops = {
409 .allocate = ion_system_contig_heap_allocate,
410 .free = ion_system_contig_heap_free,
411 .phys = ion_system_contig_heap_phys,
412 .map_dma = ion_system_contig_heap_map_dma,
413 .unmap_dma = ion_system_contig_heap_unmap_dma,
414 .map_kernel = ion_heap_map_kernel,
415 .unmap_kernel = ion_heap_unmap_kernel,
416 .map_user = ion_heap_map_user,
419 struct ion_heap *ion_system_contig_heap_create(struct ion_platform_heap *unused)
421 struct ion_heap *heap;
423 heap = kzalloc(sizeof(struct ion_heap), GFP_KERNEL);
425 return ERR_PTR(-ENOMEM);
426 heap->ops = &kmalloc_ops;
427 heap->type = ION_HEAP_TYPE_SYSTEM_CONTIG;
431 void ion_system_contig_heap_destroy(struct ion_heap *heap)