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_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
)];
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
;
189 * uncached pages come from the page pools, zero them before returning
190 * for security purposes (other allocations are zerod at
193 if (!cached
&& !(buffer
->private_flags
& ION_PRIV_FLAG_SHRINKER_FREE
))
194 ion_heap_buffer_zero(buffer
);
196 for_each_sg(table
->sgl
, sg
, table
->nents
, i
)
197 free_buffer_page(sys_heap
, buffer
, sg_page(sg
));
198 sg_free_table(table
);
202 static struct sg_table
*ion_system_heap_map_dma(struct ion_heap
*heap
,
203 struct ion_buffer
*buffer
)
205 return buffer
->priv_virt
;
208 static void ion_system_heap_unmap_dma(struct ion_heap
*heap
,
209 struct ion_buffer
*buffer
)
213 static int ion_system_heap_shrink(struct ion_heap
*heap
, gfp_t gfp_mask
,
216 struct ion_system_heap
*sys_heap
;
221 sys_heap
= container_of(heap
, struct ion_system_heap
, heap
);
226 for (i
= 0; i
< num_orders
; i
++) {
227 struct ion_page_pool
*pool
= sys_heap
->pools
[i
];
229 nr_freed
= ion_page_pool_shrink(pool
, gfp_mask
, nr_to_scan
);
230 nr_total
+= nr_freed
;
233 nr_to_scan
-= nr_freed
;
234 /* shrink completed */
243 static struct ion_heap_ops system_heap_ops
= {
244 .allocate
= ion_system_heap_allocate
,
245 .free
= ion_system_heap_free
,
246 .map_dma
= ion_system_heap_map_dma
,
247 .unmap_dma
= ion_system_heap_unmap_dma
,
248 .map_kernel
= ion_heap_map_kernel
,
249 .unmap_kernel
= ion_heap_unmap_kernel
,
250 .map_user
= ion_heap_map_user
,
251 .shrink
= ion_system_heap_shrink
,
254 static int ion_system_heap_debug_show(struct ion_heap
*heap
, struct seq_file
*s
,
258 struct ion_system_heap
*sys_heap
= container_of(heap
,
259 struct ion_system_heap
,
263 for (i
= 0; i
< num_orders
; i
++) {
264 struct ion_page_pool
*pool
= sys_heap
->pools
[i
];
266 seq_printf(s
, "%d order %u highmem pages in pool = %lu total\n",
267 pool
->high_count
, pool
->order
,
268 (PAGE_SIZE
<< pool
->order
) * pool
->high_count
);
269 seq_printf(s
, "%d order %u lowmem pages in pool = %lu total\n",
270 pool
->low_count
, pool
->order
,
271 (PAGE_SIZE
<< pool
->order
) * pool
->low_count
);
276 struct ion_heap
*ion_system_heap_create(struct ion_platform_heap
*unused
)
278 struct ion_system_heap
*heap
;
281 heap
= kzalloc(sizeof(struct ion_system_heap
) +
282 sizeof(struct ion_page_pool
*) * num_orders
,
285 return ERR_PTR(-ENOMEM
);
286 heap
->heap
.ops
= &system_heap_ops
;
287 heap
->heap
.type
= ION_HEAP_TYPE_SYSTEM
;
288 heap
->heap
.flags
= ION_HEAP_FLAG_DEFER_FREE
;
290 for (i
= 0; i
< num_orders
; i
++) {
291 struct ion_page_pool
*pool
;
292 gfp_t gfp_flags
= low_order_gfp_flags
;
295 gfp_flags
= high_order_gfp_flags
;
296 pool
= ion_page_pool_create(gfp_flags
, orders
[i
]);
299 heap
->pools
[i
] = pool
;
302 heap
->heap
.debug_show
= ion_system_heap_debug_show
;
307 ion_page_pool_destroy(heap
->pools
[i
]);
309 return ERR_PTR(-ENOMEM
);
312 void ion_system_heap_destroy(struct ion_heap
*heap
)
314 struct ion_system_heap
*sys_heap
= container_of(heap
,
315 struct ion_system_heap
,
319 for (i
= 0; i
< num_orders
; i
++)
320 ion_page_pool_destroy(sys_heap
->pools
[i
]);
324 static int ion_system_contig_heap_allocate(struct ion_heap
*heap
,
325 struct ion_buffer
*buffer
,
330 int order
= get_order(len
);
332 struct sg_table
*table
;
336 if (align
> (PAGE_SIZE
<< order
))
339 page
= alloc_pages(low_order_gfp_flags
, order
);
343 split_page(page
, order
);
345 len
= PAGE_ALIGN(len
);
346 for (i
= len
>> PAGE_SHIFT
; i
< (1 << order
); i
++)
347 __free_page(page
+ i
);
349 table
= kmalloc(sizeof(struct sg_table
), GFP_KERNEL
);
355 ret
= sg_alloc_table(table
, 1, GFP_KERNEL
);
359 sg_set_page(table
->sgl
, page
, len
, 0);
361 buffer
->priv_virt
= table
;
363 ion_pages_sync_for_device(NULL
, page
, len
, DMA_BIDIRECTIONAL
);
370 for (i
= 0; i
< len
>> PAGE_SHIFT
; i
++)
371 __free_page(page
+ i
);
376 static void ion_system_contig_heap_free(struct ion_buffer
*buffer
)
378 struct sg_table
*table
= buffer
->priv_virt
;
379 struct page
*page
= sg_page(table
->sgl
);
380 unsigned long pages
= PAGE_ALIGN(buffer
->size
) >> PAGE_SHIFT
;
383 for (i
= 0; i
< pages
; i
++)
384 __free_page(page
+ i
);
385 sg_free_table(table
);
389 static int ion_system_contig_heap_phys(struct ion_heap
*heap
,
390 struct ion_buffer
*buffer
,
391 ion_phys_addr_t
*addr
, size_t *len
)
393 struct sg_table
*table
= buffer
->priv_virt
;
394 struct page
*page
= sg_page(table
->sgl
);
395 *addr
= page_to_phys(page
);
400 static struct sg_table
*ion_system_contig_heap_map_dma(struct ion_heap
*heap
,
401 struct ion_buffer
*buffer
)
403 return buffer
->priv_virt
;
406 static void ion_system_contig_heap_unmap_dma(struct ion_heap
*heap
,
407 struct ion_buffer
*buffer
)
411 static struct ion_heap_ops kmalloc_ops
= {
412 .allocate
= ion_system_contig_heap_allocate
,
413 .free
= ion_system_contig_heap_free
,
414 .phys
= ion_system_contig_heap_phys
,
415 .map_dma
= ion_system_contig_heap_map_dma
,
416 .unmap_dma
= ion_system_contig_heap_unmap_dma
,
417 .map_kernel
= ion_heap_map_kernel
,
418 .unmap_kernel
= ion_heap_unmap_kernel
,
419 .map_user
= ion_heap_map_user
,
422 struct ion_heap
*ion_system_contig_heap_create(struct ion_platform_heap
*unused
)
424 struct ion_heap
*heap
;
426 heap
= kzalloc(sizeof(struct ion_heap
), GFP_KERNEL
);
428 return ERR_PTR(-ENOMEM
);
429 heap
->ops
= &kmalloc_ops
;
430 heap
->type
= ION_HEAP_TYPE_SYSTEM_CONTIG
;
434 void ion_system_contig_heap_destroy(struct ion_heap
*heap
)