2 * drivers/gpu/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>
26 #include <linux/rockchip-iovmm.h>
30 static gfp_t high_order_gfp_flags = (GFP_HIGHUSER | __GFP_ZERO | __GFP_NOWARN |
31 __GFP_NORETRY) & ~__GFP_WAIT;
32 static gfp_t low_order_gfp_flags = (GFP_HIGHUSER | __GFP_ZERO | __GFP_NOWARN);
33 static const unsigned int orders[] = {8, 4, 0};
34 static const int num_orders = ARRAY_SIZE(orders);
35 static int order_to_index(unsigned int order)
39 for (i = 0; i < num_orders; i++)
40 if (order == orders[i])
46 static unsigned int order_to_size(int order)
48 return PAGE_SIZE << order;
51 struct ion_system_heap {
53 struct ion_page_pool **pools;
59 struct list_head list;
62 static struct page *alloc_buffer_page(struct ion_system_heap *heap,
63 struct ion_buffer *buffer,
66 bool cached = ion_buffer_cached(buffer);
67 struct ion_page_pool *pool = heap->pools[order_to_index(order)];
71 page = ion_page_pool_alloc(pool);
73 gfp_t gfp_flags = low_order_gfp_flags;
76 gfp_flags = high_order_gfp_flags;
77 page = alloc_pages(gfp_flags, order);
80 ion_pages_sync_for_device(NULL, page, PAGE_SIZE << order,
89 static void free_buffer_page(struct ion_system_heap *heap,
90 struct ion_buffer *buffer, struct page *page,
93 bool cached = ion_buffer_cached(buffer);
96 struct ion_page_pool *pool = heap->pools[order_to_index(order)];
97 if (buffer->private_flags & ION_PRIV_FLAG_SHRINKER_FREE)
98 ion_page_pool_free_immediate(pool, page);
100 ion_page_pool_free(pool, page);
102 __free_pages(page, order);
107 static struct page_info *alloc_largest_available(struct ion_system_heap *heap,
108 struct ion_buffer *buffer,
110 unsigned int max_order)
113 struct page_info *info;
116 info = kmalloc(sizeof(struct page_info), GFP_KERNEL);
120 for (i = 0; i < num_orders; i++) {
121 if (size < order_to_size(orders[i]))
123 if (max_order < orders[i])
126 page = alloc_buffer_page(heap, buffer, orders[i]);
131 info->order = orders[i];
132 INIT_LIST_HEAD(&info->list);
140 static int ion_system_heap_allocate(struct ion_heap *heap,
141 struct ion_buffer *buffer,
142 unsigned long size, unsigned long align,
145 struct ion_system_heap *sys_heap = container_of(heap,
146 struct ion_system_heap,
148 struct sg_table *table;
149 struct scatterlist *sg;
151 struct list_head pages;
152 struct page_info *info, *tmp_info;
154 unsigned long size_remaining = PAGE_ALIGN(size);
155 unsigned int max_order = orders[0];
157 if (align > PAGE_SIZE)
160 if (size / PAGE_SIZE > totalram_pages / 2)
163 INIT_LIST_HEAD(&pages);
164 while (size_remaining > 0) {
165 info = alloc_largest_available(sys_heap, buffer, size_remaining,
169 list_add_tail(&info->list, &pages);
170 size_remaining -= (1 << info->order) * PAGE_SIZE;
171 max_order = info->order;
174 table = kzalloc(sizeof(struct sg_table), GFP_KERNEL);
178 ret = sg_alloc_table(table, i, GFP_KERNEL);
183 list_for_each_entry_safe(info, tmp_info, &pages, list) {
184 struct page *page = info->page;
185 sg_set_page(sg, page, (1 << info->order) * PAGE_SIZE, 0);
187 list_del(&info->list);
191 buffer->priv_virt = table;
196 list_for_each_entry_safe(info, tmp_info, &pages, list) {
197 free_buffer_page(sys_heap, buffer, info->page, info->order);
203 static void ion_system_heap_free(struct ion_buffer *buffer)
205 struct ion_heap *heap = buffer->heap;
206 struct ion_system_heap *sys_heap = container_of(heap,
207 struct ion_system_heap,
209 struct sg_table *table = buffer->sg_table;
210 bool cached = ion_buffer_cached(buffer);
211 struct scatterlist *sg;
215 /* uncached pages come from the page pools, zero them before returning
216 for security purposes (other allocations are zerod at alloc time */
217 if (!cached && !(buffer->private_flags & ION_PRIV_FLAG_SHRINKER_FREE))
218 ion_heap_buffer_zero(buffer);
220 for_each_sg(table->sgl, sg, table->nents, i)
221 free_buffer_page(sys_heap, buffer, sg_page(sg),
222 get_order(sg->length));
223 sg_free_table(table);
227 static struct sg_table *ion_system_heap_map_dma(struct ion_heap *heap,
228 struct ion_buffer *buffer)
230 return buffer->priv_virt;
233 static void ion_system_heap_unmap_dma(struct ion_heap *heap,
234 struct ion_buffer *buffer)
239 static int ion_system_heap_shrink(struct ion_heap *heap, gfp_t gfp_mask,
242 struct ion_system_heap *sys_heap;
246 sys_heap = container_of(heap, struct ion_system_heap, heap);
248 for (i = 0; i < num_orders; i++) {
249 struct ion_page_pool *pool = sys_heap->pools[i];
251 nr_total += ion_page_pool_shrink(pool, gfp_mask, nr_to_scan);
257 #ifdef CONFIG_ROCKCHIP_IOMMU
258 // get device's vaddr
259 static int ion_system_map_iommu(struct ion_buffer *buffer,
260 struct device *iommu_dev,
261 struct ion_iommu_map *data,
262 unsigned long iova_length,
266 struct sg_table *table = (struct sg_table*)buffer->priv_virt;
268 data->iova_addr = rockchip_iovmm_map(iommu_dev, table->sgl, 0, iova_length);
269 pr_debug("%s: map %lx -> %lx\n", __func__, (unsigned long)table->sgl->dma_address, data->iova_addr);
270 if (IS_ERR_VALUE(data->iova_addr)) {
271 pr_err("%s: rockchip_iovmm_map() failed: %lx\n", __func__, data->iova_addr);
272 ret = data->iova_addr;
276 data->mapped_size = iova_length;
282 void ion_system_unmap_iommu(struct device *iommu_dev, struct ion_iommu_map *data)
284 pr_debug("%s: unmap %x@%lx\n", __func__, data->mapped_size, data->iova_addr);
285 rockchip_iovmm_unmap(iommu_dev, data->iova_addr);
291 static struct ion_heap_ops system_heap_ops = {
292 .allocate = ion_system_heap_allocate,
293 .free = ion_system_heap_free,
294 .map_dma = ion_system_heap_map_dma,
295 .unmap_dma = ion_system_heap_unmap_dma,
296 .map_kernel = ion_heap_map_kernel,
297 .unmap_kernel = ion_heap_unmap_kernel,
298 .map_user = ion_heap_map_user,
299 .shrink = ion_system_heap_shrink,
300 #ifdef CONFIG_ROCKCHIP_IOMMU
301 .map_iommu = ion_system_map_iommu,
302 .unmap_iommu = ion_system_unmap_iommu,
306 static int ion_system_heap_debug_show(struct ion_heap *heap, struct seq_file *s,
310 struct ion_system_heap *sys_heap = container_of(heap,
311 struct ion_system_heap,
315 for (i = 0; i < num_orders; i++) {
316 struct ion_page_pool *pool = sys_heap->pools[i];
318 seq_printf(s, "%d order %u highmem pages in pool = %lu total\n",
319 pool->high_count, pool->order,
320 (1 << pool->order) * PAGE_SIZE * pool->high_count);
321 seq_printf(s, "%d order %u lowmem pages in pool = %lu total\n",
322 pool->low_count, pool->order,
323 (1 << pool->order) * PAGE_SIZE * pool->low_count);
328 struct ion_heap *ion_system_heap_create(struct ion_platform_heap *unused)
330 struct ion_system_heap *heap;
333 heap = kzalloc(sizeof(struct ion_system_heap), GFP_KERNEL);
335 return ERR_PTR(-ENOMEM);
336 heap->heap.ops = &system_heap_ops;
337 heap->heap.type = ION_HEAP_TYPE_SYSTEM;
338 heap->heap.flags = ION_HEAP_FLAG_DEFER_FREE;
339 heap->pools = kzalloc(sizeof(struct ion_page_pool *) * num_orders,
342 goto err_alloc_pools;
343 for (i = 0; i < num_orders; i++) {
344 struct ion_page_pool *pool;
345 gfp_t gfp_flags = low_order_gfp_flags;
348 gfp_flags = high_order_gfp_flags;
349 pool = ion_page_pool_create(gfp_flags, orders[i]);
351 goto err_create_pool;
352 heap->pools[i] = pool;
355 heap->heap.debug_show = ion_system_heap_debug_show;
358 for (i = 0; i < num_orders; i++)
360 ion_page_pool_destroy(heap->pools[i]);
364 return ERR_PTR(-ENOMEM);
367 void ion_system_heap_destroy(struct ion_heap *heap)
369 struct ion_system_heap *sys_heap = container_of(heap,
370 struct ion_system_heap,
374 for (i = 0; i < num_orders; i++)
375 ion_page_pool_destroy(sys_heap->pools[i]);
376 kfree(sys_heap->pools);
380 static int ion_system_contig_heap_allocate(struct ion_heap *heap,
381 struct ion_buffer *buffer,
386 int order = get_order(len);
388 struct sg_table *table;
392 if (align > (PAGE_SIZE << order))
395 page = alloc_pages(low_order_gfp_flags, order);
399 split_page(page, order);
401 len = PAGE_ALIGN(len);
402 for (i = len >> PAGE_SHIFT; i < (1 << order); i++)
403 __free_page(page + i);
405 table = kzalloc(sizeof(struct sg_table), GFP_KERNEL);
411 ret = sg_alloc_table(table, 1, GFP_KERNEL);
415 sg_set_page(table->sgl, page, len, 0);
417 buffer->priv_virt = table;
419 ion_pages_sync_for_device(NULL, page, len, DMA_BIDIRECTIONAL);
424 for (i = 0; i < len >> PAGE_SHIFT; i++)
425 __free_page(page + i);
430 static void ion_system_contig_heap_free(struct ion_buffer *buffer)
432 struct sg_table *table = buffer->priv_virt;
433 struct page *page = sg_page(table->sgl);
434 unsigned long pages = PAGE_ALIGN(buffer->size) >> PAGE_SHIFT;
437 for (i = 0; i < pages; i++)
438 __free_page(page + i);
439 sg_free_table(table);
443 static int ion_system_contig_heap_phys(struct ion_heap *heap,
444 struct ion_buffer *buffer,
445 ion_phys_addr_t *addr, size_t *len)
447 struct sg_table *table = buffer->priv_virt;
448 struct page *page = sg_page(table->sgl);
449 *addr = page_to_phys(page);
454 static struct sg_table *ion_system_contig_heap_map_dma(struct ion_heap *heap,
455 struct ion_buffer *buffer)
457 return buffer->priv_virt;
460 static void ion_system_contig_heap_unmap_dma(struct ion_heap *heap,
461 struct ion_buffer *buffer)
465 static struct ion_heap_ops kmalloc_ops = {
466 .allocate = ion_system_contig_heap_allocate,
467 .free = ion_system_contig_heap_free,
468 .phys = ion_system_contig_heap_phys,
469 .map_dma = ion_system_contig_heap_map_dma,
470 .unmap_dma = ion_system_contig_heap_unmap_dma,
471 .map_kernel = ion_heap_map_kernel,
472 .unmap_kernel = ion_heap_unmap_kernel,
473 .map_user = ion_heap_map_user,
476 struct ion_heap *ion_system_contig_heap_create(struct ion_platform_heap *unused)
478 struct ion_heap *heap;
480 heap = kzalloc(sizeof(struct ion_heap), GFP_KERNEL);
482 return ERR_PTR(-ENOMEM);
483 heap->ops = &kmalloc_ops;
484 heap->type = ION_HEAP_TYPE_SYSTEM_CONTIG;
488 void ion_system_contig_heap_destroy(struct ion_heap *heap)