tjh.dev
Linux kernel mirror (for testing)
git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
kernel
os
linux
1// SPDX-License-Identifier: GPL-2.0-only
2/*
3 * Copyright (c) 2015, Linaro Limited
4 * Copyright (c) 2017, EPAM Systems
5 */
6#include <linux/device.h>
7#include <linux/dma-buf.h>
8#include <linux/genalloc.h>
9#include <linux/slab.h>
10#include <linux/tee_drv.h>
11#include "optee_private.h"
12#include "optee_smc.h"
13#include "shm_pool.h"
14
15static int pool_op_alloc(struct tee_shm_pool_mgr *poolm,
16 struct tee_shm *shm, size_t size)
17{
18 unsigned int order = get_order(size);
19 struct page *page;
20 int rc = 0;
21
22 page = alloc_pages(GFP_KERNEL | __GFP_ZERO, order);
23 if (!page)
24 return -ENOMEM;
25
26 shm->kaddr = page_address(page);
27 shm->paddr = page_to_phys(page);
28 shm->size = PAGE_SIZE << order;
29
30 if (shm->flags & TEE_SHM_DMA_BUF) {
31 shm->flags |= TEE_SHM_REGISTER;
32 rc = optee_shm_register(shm->ctx, shm, &page, 1 << order,
33 (unsigned long)shm->kaddr);
34 }
35
36 return rc;
37}
38
39static void pool_op_free(struct tee_shm_pool_mgr *poolm,
40 struct tee_shm *shm)
41{
42 if (shm->flags & TEE_SHM_DMA_BUF)
43 optee_shm_unregister(shm->ctx, shm);
44
45 free_pages((unsigned long)shm->kaddr, get_order(shm->size));
46 shm->kaddr = NULL;
47}
48
49static void pool_op_destroy_poolmgr(struct tee_shm_pool_mgr *poolm)
50{
51 kfree(poolm);
52}
53
54static const struct tee_shm_pool_mgr_ops pool_ops = {
55 .alloc = pool_op_alloc,
56 .free = pool_op_free,
57 .destroy_poolmgr = pool_op_destroy_poolmgr,
58};
59
60/**
61 * optee_shm_pool_alloc_pages() - create page-based allocator pool
62 *
63 * This pool is used when OP-TEE supports dymanic SHM. In this case
64 * command buffers and such are allocated from kernel's own memory.
65 */
66struct tee_shm_pool_mgr *optee_shm_pool_alloc_pages(void)
67{
68 struct tee_shm_pool_mgr *mgr = kzalloc(sizeof(*mgr), GFP_KERNEL);
69
70 if (!mgr)
71 return ERR_PTR(-ENOMEM);
72
73 mgr->ops = &pool_ops;
74
75 return mgr;
76}