#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
#include <linux/firmware/qcom/qcom_scm.h>
#include <linux/mm.h>
#include "qcomtee.h"
struct qcomtee_mem_object {
struct qcomtee_object object;
struct tee_shm *shm;
phys_addr_t paddr;
size_t size;
};
#define to_qcomtee_mem_object(o) \
container_of((o), struct qcomtee_mem_object, object)
static struct qcomtee_object_operations qcomtee_mem_object_ops;
int is_qcomtee_memobj_object(struct qcomtee_object *object)
{
return object != NULL_QCOMTEE_OBJECT &&
typeof_qcomtee_object(object) == QCOMTEE_OBJECT_TYPE_CB &&
object->ops == &qcomtee_mem_object_ops;
}
static int qcomtee_mem_object_dispatch(struct qcomtee_object_invoke_ctx *oic,
struct qcomtee_object *object, u32 op,
struct qcomtee_arg *args)
{
return -EINVAL;
}
static void qcomtee_mem_object_release(struct qcomtee_object *object)
{
struct qcomtee_mem_object *mem_object = to_qcomtee_mem_object(object);
tee_shm_put(mem_object->shm);
kfree(mem_object);
}
static struct qcomtee_object_operations qcomtee_mem_object_ops = {
.release = qcomtee_mem_object_release,
.dispatch = qcomtee_mem_object_dispatch,
};
int qcomtee_memobj_param_to_object(struct qcomtee_object **object,
struct tee_param *param,
struct tee_context *ctx)
{
struct tee_shm *shm;
int err;
struct qcomtee_mem_object *mem_object __free(kfree) = kzalloc_obj(*mem_object);
if (!mem_object)
return -ENOMEM;
shm = tee_shm_get_from_id(ctx, param->u.objref.id);
if (IS_ERR(shm))
return PTR_ERR(shm);
err = qcomtee_object_user_init(&mem_object->object,
QCOMTEE_OBJECT_TYPE_CB,
&qcomtee_mem_object_ops, "tee-shm-%d",
shm->id);
if (err) {
tee_shm_put(shm);
return err;
}
mem_object->paddr = shm->paddr;
mem_object->size = shm->size;
mem_object->shm = shm;
*object = &no_free_ptr(mem_object)->object;
return 0;
}
int qcomtee_memobj_param_from_object(struct tee_param *param,
struct qcomtee_object *object,
struct tee_context *ctx)
{
struct qcomtee_mem_object *mem_object;
mem_object = to_qcomtee_mem_object(object);
if (mem_object->shm->ctx != ctx)
return -EINVAL;
param->u.objref.id = mem_object->shm->id;
param->u.objref.flags = QCOMTEE_OBJREF_FLAG_MEM;
qcomtee_object_put(object);
return 0;
}
int qcomtee_mem_object_map(struct qcomtee_object *object,
struct qcomtee_object **map_object, u64 *mem_paddr,
u64 *mem_size, u32 *perms)
{
struct qcomtee_mem_object *mem_object = to_qcomtee_mem_object(object);
qcomtee_object_get(&mem_object->object);
*map_object = &mem_object->object;
*mem_paddr = mem_object->paddr;
*mem_size = mem_object->size;
*perms = QCOM_SCM_PERM_RW;
return 0;
}