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
)
37 for (i
= 0; i
< num_orders
; i
++)
38 if (order
== orders
[i
])
44 static unsigned int order_to_size(int order
)
46 return PAGE_SIZE
<< order
;
49 struct ion_system_heap
{
51 struct ion_page_pool
**pools
;
57 struct list_head list
;
60 static struct page
*alloc_buffer_page(struct ion_system_heap
*heap
,
61 struct ion_buffer
*buffer
,
64 bool cached
= ion_buffer_cached(buffer
);
65 struct ion_page_pool
*pool
= heap
->pools
[order_to_index(order
)];
69 page
= ion_page_pool_alloc(pool
);
71 gfp_t gfp_flags
= low_order_gfp_flags
;
74 gfp_flags
= high_order_gfp_flags
;
75 page
= alloc_pages(gfp_flags
, order
);
78 ion_pages_sync_for_device(NULL
, page
, PAGE_SIZE
<< order
,
87 static void free_buffer_page(struct ion_system_heap
*heap
,
88 struct ion_buffer
*buffer
, struct page
*page
,
91 bool cached
= ion_buffer_cached(buffer
);
94 struct ion_page_pool
*pool
= heap
->pools
[order_to_index(order
)];
95 ion_page_pool_free(pool
, page
);
97 __free_pages(page
, order
);
102 static struct page_info
*alloc_largest_available(struct ion_system_heap
*heap
,
103 struct ion_buffer
*buffer
,
105 unsigned int max_order
)
108 struct page_info
*info
;
111 info
= kmalloc(sizeof(struct page_info
), GFP_KERNEL
);
115 for (i
= 0; i
< num_orders
; i
++) {
116 if (size
< order_to_size(orders
[i
]))
118 if (max_order
< orders
[i
])
121 page
= alloc_buffer_page(heap
, buffer
, orders
[i
]);
126 info
->order
= orders
[i
];
127 INIT_LIST_HEAD(&info
->list
);
135 static int ion_system_heap_allocate(struct ion_heap
*heap
,
136 struct ion_buffer
*buffer
,
137 unsigned long size
, unsigned long align
,
140 struct ion_system_heap
*sys_heap
= container_of(heap
,
141 struct ion_system_heap
,
143 struct sg_table
*table
;
144 struct scatterlist
*sg
;
146 struct list_head pages
;
147 struct page_info
*info
, *tmp_info
;
149 unsigned long size_remaining
= PAGE_ALIGN(size
);
150 unsigned int max_order
= orders
[0];
152 if (align
> PAGE_SIZE
)
155 if (size
/ PAGE_SIZE
> totalram_pages
/ 2)
158 INIT_LIST_HEAD(&pages
);
159 while (size_remaining
> 0) {
160 info
= alloc_largest_available(sys_heap
, buffer
, size_remaining
,
164 list_add_tail(&info
->list
, &pages
);
165 size_remaining
-= (1 << info
->order
) * PAGE_SIZE
;
166 max_order
= info
->order
;
169 table
= kzalloc(sizeof(struct sg_table
), GFP_KERNEL
);
173 ret
= sg_alloc_table(table
, i
, GFP_KERNEL
);
178 list_for_each_entry_safe(info
, tmp_info
, &pages
, list
) {
179 struct page
*page
= info
->page
;
180 sg_set_page(sg
, page
, (1 << info
->order
) * PAGE_SIZE
, 0);
182 list_del(&info
->list
);
186 buffer
->priv_virt
= table
;
191 list_for_each_entry_safe(info
, tmp_info
, &pages
, list
) {
192 free_buffer_page(sys_heap
, buffer
, info
->page
, info
->order
);
198 static void ion_system_heap_free(struct ion_buffer
*buffer
)
200 struct ion_heap
*heap
= buffer
->heap
;
201 struct ion_system_heap
*sys_heap
= container_of(heap
,
202 struct ion_system_heap
,
204 struct sg_table
*table
= buffer
->sg_table
;
205 bool cached
= ion_buffer_cached(buffer
);
206 struct scatterlist
*sg
;
210 /* uncached pages come from the page pools, zero them before returning
211 for security purposes (other allocations are zerod at alloc time */
213 ion_heap_buffer_zero(buffer
);
215 for_each_sg(table
->sgl
, sg
, table
->nents
, i
)
216 free_buffer_page(sys_heap
, buffer
, sg_page(sg
),
217 get_order(sg
->length
));
218 sg_free_table(table
);
222 static struct sg_table
*ion_system_heap_map_dma(struct ion_heap
*heap
,
223 struct ion_buffer
*buffer
)
225 return buffer
->priv_virt
;
228 static void ion_system_heap_unmap_dma(struct ion_heap
*heap
,
229 struct ion_buffer
*buffer
)
234 static struct ion_heap_ops system_heap_ops
= {
235 .allocate
= ion_system_heap_allocate
,
236 .free
= ion_system_heap_free
,
237 .map_dma
= ion_system_heap_map_dma
,
238 .unmap_dma
= ion_system_heap_unmap_dma
,
239 .map_kernel
= ion_heap_map_kernel
,
240 .unmap_kernel
= ion_heap_unmap_kernel
,
241 .map_user
= ion_heap_map_user
,
244 static unsigned long ion_system_heap_shrink_count(struct shrinker
*shrinker
,
245 struct shrink_control
*sc
)
247 struct ion_heap
*heap
= container_of(shrinker
, struct ion_heap
,
249 struct ion_system_heap
*sys_heap
= container_of(heap
,
250 struct ion_system_heap
,
255 /* total number of items is whatever the page pools are holding
256 plus whatever's in the freelist */
257 for (i
= 0; i
< num_orders
; i
++) {
258 struct ion_page_pool
*pool
= sys_heap
->pools
[i
];
259 nr_total
+= ion_page_pool_shrink(pool
, sc
->gfp_mask
, 0);
261 nr_total
+= ion_heap_freelist_size(heap
) / PAGE_SIZE
;
266 static unsigned long ion_system_heap_shrink_scan(struct shrinker
*shrinker
,
267 struct shrink_control
*sc
)
270 struct ion_heap
*heap
= container_of(shrinker
, struct ion_heap
,
272 struct ion_system_heap
*sys_heap
= container_of(heap
,
273 struct ion_system_heap
,
278 if (sc
->nr_to_scan
== 0)
281 /* shrink the free list first, no point in zeroing the memory if
282 we're just going to reclaim it */
283 nr_freed
+= ion_heap_freelist_drain(heap
, sc
->nr_to_scan
* PAGE_SIZE
) /
286 if (nr_freed
>= sc
->nr_to_scan
)
289 for (i
= 0; i
< num_orders
; i
++) {
290 struct ion_page_pool
*pool
= sys_heap
->pools
[i
];
292 nr_freed
+= ion_page_pool_shrink(pool
, sc
->gfp_mask
,
294 if (nr_freed
>= sc
->nr_to_scan
)
303 static int ion_system_heap_debug_show(struct ion_heap
*heap
, struct seq_file
*s
,
307 struct ion_system_heap
*sys_heap
= container_of(heap
,
308 struct ion_system_heap
,
311 for (i
= 0; i
< num_orders
; i
++) {
312 struct ion_page_pool
*pool
= sys_heap
->pools
[i
];
313 seq_printf(s
, "%d order %u highmem pages in pool = %lu total\n",
314 pool
->high_count
, pool
->order
,
315 (1 << pool
->order
) * PAGE_SIZE
* pool
->high_count
);
316 seq_printf(s
, "%d order %u lowmem pages in pool = %lu total\n",
317 pool
->low_count
, pool
->order
,
318 (1 << pool
->order
) * PAGE_SIZE
* pool
->low_count
);
323 struct ion_heap
*ion_system_heap_create(struct ion_platform_heap
*unused
)
325 struct ion_system_heap
*heap
;
328 heap
= kzalloc(sizeof(struct ion_system_heap
), GFP_KERNEL
);
330 return ERR_PTR(-ENOMEM
);
331 heap
->heap
.ops
= &system_heap_ops
;
332 heap
->heap
.type
= ION_HEAP_TYPE_SYSTEM
;
333 heap
->heap
.flags
= ION_HEAP_FLAG_DEFER_FREE
;
334 heap
->pools
= kzalloc(sizeof(struct ion_page_pool
*) * num_orders
,
337 goto err_alloc_pools
;
338 for (i
= 0; i
< num_orders
; i
++) {
339 struct ion_page_pool
*pool
;
340 gfp_t gfp_flags
= low_order_gfp_flags
;
343 gfp_flags
= high_order_gfp_flags
;
344 pool
= ion_page_pool_create(gfp_flags
, orders
[i
]);
346 goto err_create_pool
;
347 heap
->pools
[i
] = pool
;
350 heap
->heap
.shrinker
.scan_objects
= ion_system_heap_shrink_scan
;
351 heap
->heap
.shrinker
.count_objects
= ion_system_heap_shrink_count
;
352 heap
->heap
.shrinker
.seeks
= DEFAULT_SEEKS
;
353 heap
->heap
.shrinker
.batch
= 0;
354 register_shrinker(&heap
->heap
.shrinker
);
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
)