708 lines
19 KiB
C
Executable File
708 lines
19 KiB
C
Executable File
// SPDX-License-Identifier: GPL-2.0-only
|
|
/*
|
|
* Copyright (C) 2011 Google, Inc
|
|
* Copyright (c) 2011-2021, The Linux Foundation. All rights reserved.
|
|
* Copyright (c) 2023-2024 Qualcomm Innovation Center, Inc. All rights reserved.
|
|
*/
|
|
|
|
#include <linux/highmem.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/kref.h>
|
|
#include <linux/scatterlist.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/dma-mapping.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/module.h>
|
|
#include <linux/of.h>
|
|
#include <linux/firmware/qcom/qcom_scm.h>
|
|
#include <soc/qcom/secure_buffer.h>
|
|
|
|
#define CREATE_TRACE_POINTS
|
|
#include "trace_secure_buffer.h"
|
|
|
|
#include <linux/stackdepot.h>
|
|
|
|
|
|
#define BATCH_MAX_SIZE SZ_2M
|
|
#define BATCH_MAX_SECTIONS 32
|
|
|
|
#define HLOS_DEST_ARR_SIZE 1
|
|
|
|
static struct device *qcom_secure_buffer_dev;
|
|
static bool vmid_cp_camera_preview_ro;
|
|
|
|
struct hyp_assign_debug_track {
|
|
depot_stack_handle_t hdl;
|
|
int vmids[10];
|
|
int perms[10];
|
|
int nr_acl_entries;
|
|
u32 refcount;
|
|
};
|
|
|
|
#if IS_ENABLED(CONFIG_HYP_ASSIGN_DEBUG)
|
|
/*
|
|
* Contains a pointer to struct hyp_assign_debug_track for each pfn which
|
|
* is in an assigned state.
|
|
*/
|
|
static DEFINE_XARRAY(xa_pfns);
|
|
static DEFINE_MUTEX(xarray_lock);
|
|
static depot_stack_handle_t failure_handle;
|
|
#define HYP_ASSIGN_STACK_DEPTH (16)
|
|
|
|
static depot_stack_handle_t create_dummy_stack(void)
|
|
{
|
|
unsigned long entries[4];
|
|
unsigned int nr_entries;
|
|
|
|
nr_entries = stack_trace_save(entries, ARRAY_SIZE(entries), 0);
|
|
return stack_depot_save(entries, nr_entries, GFP_KERNEL);
|
|
}
|
|
|
|
static void hyp_assign_show_err(const char *msg, unsigned long pfn,
|
|
struct hyp_assign_debug_track *track)
|
|
{
|
|
int i;
|
|
unsigned long *stack_entries;
|
|
unsigned int nr_stack_entries;
|
|
|
|
pr_err("HYP_ASSIGN_DEBUG: %s pfn=0x%llx\n", msg, pfn);
|
|
if (!track)
|
|
goto out;
|
|
pr_err("currently assigned to:\n");
|
|
nr_stack_entries = stack_depot_fetch(track->hdl, &stack_entries);
|
|
stack_trace_print(stack_entries, nr_stack_entries, 0);
|
|
|
|
for (i = 0; i < track->nr_acl_entries; i++) {
|
|
pr_err("VMID: %d %s%s%s\n",
|
|
track->vmids[i],
|
|
track->perms[i] & PERM_READ ? "R" : " ",
|
|
track->perms[i] & PERM_WRITE ? "W" : " ",
|
|
track->perms[i] & PERM_EXEC ? "X" : " ");
|
|
}
|
|
|
|
out:
|
|
BUG();
|
|
}
|
|
|
|
static struct hyp_assign_debug_track *
|
|
alloc_debug_tracking(int *dst_vmids, int *dst_perms, int dest_nelems)
|
|
{
|
|
unsigned long stack_entries[HYP_ASSIGN_STACK_DEPTH];
|
|
u32 nr_stack_entries;
|
|
struct hyp_assign_debug_track *track;
|
|
u32 nr_acl_entries;
|
|
|
|
track = kzalloc(sizeof(*track), GFP_KERNEL);
|
|
if (!track)
|
|
return NULL;
|
|
|
|
nr_acl_entries = min_t(u32, dest_nelems, ARRAY_SIZE(track->vmids));
|
|
track->nr_acl_entries = nr_acl_entries;
|
|
memcpy(track->vmids, dst_vmids, nr_acl_entries * sizeof(*dst_vmids));
|
|
memcpy(track->perms, dst_perms, nr_acl_entries * sizeof(*dst_perms));
|
|
|
|
nr_stack_entries = stack_trace_save(stack_entries, ARRAY_SIZE(stack_entries), 2);
|
|
track->hdl = stack_depot_save(stack_entries, nr_stack_entries, GFP_KERNEL);
|
|
if (!track->hdl)
|
|
track->hdl = failure_handle;
|
|
|
|
track->refcount = 1;
|
|
return track;
|
|
}
|
|
|
|
/* caller holds xarray_lock */
|
|
static void get_track(struct hyp_assign_debug_track *track)
|
|
{
|
|
track->refcount++;
|
|
}
|
|
|
|
/* caller holds xarray_lock */
|
|
static void put_track(struct hyp_assign_debug_track *track)
|
|
{
|
|
if (!track)
|
|
return;
|
|
|
|
track->refcount--;
|
|
if (!track->refcount)
|
|
kfree(track);
|
|
}
|
|
|
|
static bool is_reclaim(struct qcom_scm_current_perm_info *newvms, size_t newvms_sz)
|
|
{
|
|
int vmid;
|
|
int perm;
|
|
|
|
vmid = le32_to_cpu(newvms->vmid);
|
|
perm = le32_to_cpu(newvms->perm);
|
|
return (newvms_sz == sizeof(*newvms)) &&
|
|
(vmid == VMID_HLOS) &&
|
|
(perm == (PERM_READ | PERM_WRITE | PERM_EXEC));
|
|
}
|
|
|
|
static void check_debug_tracking(struct qcom_scm_mem_map_info *mem_regions,
|
|
size_t mem_regions_sz,
|
|
struct qcom_scm_current_perm_info *newvms,
|
|
size_t newvms_sz)
|
|
{
|
|
struct qcom_scm_mem_map_info *p, *mem_regions_end;
|
|
unsigned long pfn;
|
|
bool reclaim = is_reclaim(newvms, newvms_sz);
|
|
struct hyp_assign_debug_track *track;
|
|
|
|
mem_regions_end = mem_regions + mem_regions_sz/sizeof(*mem_regions);
|
|
|
|
mutex_lock(&xarray_lock);
|
|
for (p = mem_regions; p < mem_regions_end; p++) {
|
|
unsigned long start_pfn;
|
|
unsigned long nr_pages;
|
|
|
|
start_pfn = PHYS_PFN(le64_to_cpu(p->mem_addr));
|
|
nr_pages = le64_to_cpu(p->mem_size) >> PAGE_SHIFT;
|
|
|
|
for (pfn = start_pfn; pfn < start_pfn + nr_pages; pfn++) {
|
|
track = xa_load(&xa_pfns, pfn);
|
|
if (reclaim && !track) {
|
|
hyp_assign_show_err("PFN not assigned",
|
|
pfn, NULL);
|
|
break;
|
|
} else if (!reclaim && track) {
|
|
hyp_assign_show_err("PFN already assigned",
|
|
pfn, track);
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
mutex_unlock(&xarray_lock);
|
|
}
|
|
|
|
static void update_debug_tracking(struct qcom_scm_mem_map_info *mem_regions,
|
|
size_t mem_regions_sz,
|
|
struct qcom_scm_current_perm_info *newvms,
|
|
size_t newvms_sz,
|
|
struct hyp_assign_debug_track *new)
|
|
{
|
|
struct qcom_scm_mem_map_info *p, *mem_regions_end;
|
|
unsigned long pfn;
|
|
bool reclaim = is_reclaim(newvms, newvms_sz);
|
|
struct hyp_assign_debug_track *track;
|
|
|
|
mem_regions_end = mem_regions + mem_regions_sz/sizeof(*mem_regions);
|
|
|
|
mutex_lock(&xarray_lock);
|
|
for (p = mem_regions; p < mem_regions_end; p++) {
|
|
unsigned long start_pfn;
|
|
unsigned long nr_pages;
|
|
|
|
start_pfn = PHYS_PFN(le64_to_cpu(p->mem_addr));
|
|
nr_pages = le64_to_cpu(p->mem_size) >> PAGE_SHIFT;
|
|
|
|
for (pfn = start_pfn; pfn < start_pfn + nr_pages; pfn++) {
|
|
if (reclaim) {
|
|
track = xa_erase(&xa_pfns, pfn);
|
|
put_track(track);
|
|
} else {
|
|
get_track(new);
|
|
xa_store(&xa_pfns, pfn, new, GFP_KERNEL);
|
|
}
|
|
}
|
|
}
|
|
mutex_unlock(&xarray_lock);
|
|
}
|
|
#else /* CONFIG_HYP_ASSIGN_DEBUG */
|
|
static struct hyp_assign_debug_track *
|
|
alloc_debug_tracking(int *dst_vmids, int *dst_perms, int dest_nelems)
|
|
{
|
|
return NULL;
|
|
}
|
|
static void put_track(struct hyp_assign_debug_track *track)
|
|
{
|
|
}
|
|
static void check_debug_tracking(struct qcom_scm_mem_map_info *mem_regions,
|
|
size_t mem_regions_sz,
|
|
struct qcom_scm_current_perm_info *newvms,
|
|
size_t newvms_sz)
|
|
{
|
|
}
|
|
static void update_debug_tracking(struct qcom_scm_mem_map_info *mem_regions,
|
|
size_t mem_regions_sz,
|
|
struct qcom_scm_current_perm_info *newvms,
|
|
size_t newvms_sz,
|
|
struct hyp_assign_debug_track *new)
|
|
{
|
|
}
|
|
#endif /* CONFIG_HYP_ASSIGN_DEBUG */
|
|
|
|
static struct qcom_scm_current_perm_info *
|
|
populate_dest_info(int *dest_vmids, int nelements, int *dest_perms,
|
|
size_t *size_in_bytes)
|
|
{
|
|
struct qcom_scm_current_perm_info *dest_info;
|
|
int i;
|
|
size_t size;
|
|
|
|
/* Ensure allocated size is less than PAGE_ALLOC_COSTLY_ORDER */
|
|
size = nelements * sizeof(*dest_info);
|
|
if (size > PAGE_SIZE)
|
|
return NULL;
|
|
|
|
dest_info = kzalloc(size, GFP_KERNEL);
|
|
if (!dest_info)
|
|
return NULL;
|
|
|
|
for (i = 0; i < nelements; i++)
|
|
qcom_scm_populate_vmperm_info(&dest_info[i], dest_vmids[i],
|
|
dest_perms[i]);
|
|
|
|
*size_in_bytes = size;
|
|
return dest_info;
|
|
}
|
|
|
|
static unsigned int get_batches_from_sgl(struct qcom_scm_mem_map_info *sgt_copy,
|
|
struct scatterlist *sgl,
|
|
struct scatterlist **next_sgl)
|
|
{
|
|
u64 batch_size = 0;
|
|
unsigned int i = 0;
|
|
struct scatterlist *curr_sgl = sgl;
|
|
|
|
/* Ensure no zero size batches */
|
|
do {
|
|
qcom_scm_populate_mem_map_info(&sgt_copy[i],
|
|
page_to_phys(sg_page(curr_sgl)),
|
|
curr_sgl->length);
|
|
batch_size += curr_sgl->length;
|
|
curr_sgl = sg_next(curr_sgl);
|
|
i++;
|
|
} while (curr_sgl && i < BATCH_MAX_SECTIONS &&
|
|
curr_sgl->length + batch_size < BATCH_MAX_SIZE);
|
|
|
|
*next_sgl = curr_sgl;
|
|
return i;
|
|
}
|
|
|
|
static inline int _hyp_assign_table(struct sg_table *table, unsigned int sg_nents_to_assign,
|
|
u32 *source_vm_list, int source_nelems,
|
|
int *dest_vmids, int *dest_perms,
|
|
int dest_nelems,
|
|
bool rollback_on_assign_failure);
|
|
|
|
static inline int rollback_batched_assign(struct sg_table *table, unsigned int nents_assigned,
|
|
struct qcom_scm_current_perm_info *destvms,
|
|
size_t destvms_size_bytes)
|
|
{
|
|
u32 *new_source_vm_list;
|
|
int new_source_nelems;
|
|
|
|
/* Hard-coded to work with HLOS as the source */
|
|
int hlos_dest[HLOS_DEST_ARR_SIZE] = {VMID_HLOS};
|
|
int hlos_perms[HLOS_DEST_ARR_SIZE] = {PERM_READ | PERM_WRITE | PERM_EXEC};
|
|
|
|
int ret;
|
|
|
|
new_source_nelems = sizeof(*destvms) / destvms_size_bytes;
|
|
new_source_vm_list = kmalloc_array(new_source_nelems,
|
|
sizeof(*new_source_vm_list),
|
|
GFP_KERNEL);
|
|
if (!new_source_vm_list)
|
|
return -ENOMEM;
|
|
|
|
for (int i = 0; i < new_source_nelems; i++)
|
|
new_source_vm_list[i] = le32_to_cpu(destvms[i].vmid);
|
|
|
|
ret = _hyp_assign_table(table, nents_assigned,
|
|
new_source_vm_list, new_source_nelems,
|
|
hlos_dest, hlos_perms, HLOS_DEST_ARR_SIZE,
|
|
false);
|
|
|
|
kfree(new_source_vm_list);
|
|
|
|
return ret;
|
|
}
|
|
|
|
/*
|
|
* batched_hyp_assign() - assigns memory to destvms in batches
|
|
* @table: sg_table of memory to assign
|
|
* @nents: the number of entries in @table in the range [0, nents - 1)
|
|
* that we want to assign
|
|
* @source_vmids: array of source VMIDs
|
|
* @source_size_bytes: size of @source_vmids in _bytes_, pass directly into
|
|
* qcom_scm_assign_mem()
|
|
* @destvms: array of VMIDs + permissions for each VMID that we're assigning to
|
|
* @destvms_size_bytes: size of @destvms in bytes
|
|
* @track: debug structure used for tracking which pages are and aren't
|
|
* assigned
|
|
* @rollback_on_assign_failureue: indicates if we should try rolling back an
|
|
* assign attempt
|
|
*/
|
|
static int batched_hyp_assign(struct sg_table *table, unsigned int nents,
|
|
u32 *source_vmids, size_t source_size_bytes,
|
|
struct qcom_scm_current_perm_info *destvms,
|
|
size_t destvms_size_bytes,
|
|
struct hyp_assign_debug_track *track,
|
|
bool rollback_on_assign_failure)
|
|
{
|
|
unsigned int batch_start = 0;
|
|
unsigned int batches_processed;
|
|
unsigned int i = 0;
|
|
u64 total_delta;
|
|
struct scatterlist *curr_sgl = table->sgl;
|
|
struct scatterlist *next_sgl;
|
|
int ret = 0;
|
|
ktime_t batch_assign_start_ts;
|
|
ktime_t first_assign_ts;
|
|
struct qcom_scm_mem_map_info *mem_regions_buf =
|
|
kcalloc(BATCH_MAX_SECTIONS, sizeof(*mem_regions_buf),
|
|
GFP_KERNEL);
|
|
dma_addr_t entries_dma_addr;
|
|
size_t mem_regions_buf_size;
|
|
|
|
if (!mem_regions_buf)
|
|
return -ENOMEM;
|
|
|
|
first_assign_ts = ktime_get();
|
|
while (batch_start < nents) {
|
|
batches_processed = get_batches_from_sgl(mem_regions_buf,
|
|
curr_sgl, &next_sgl);
|
|
curr_sgl = next_sgl;
|
|
mem_regions_buf_size = batches_processed *
|
|
sizeof(*mem_regions_buf);
|
|
entries_dma_addr = dma_map_single(qcom_secure_buffer_dev,
|
|
mem_regions_buf,
|
|
mem_regions_buf_size,
|
|
DMA_TO_DEVICE);
|
|
if (dma_mapping_error(qcom_secure_buffer_dev,
|
|
entries_dma_addr)) {
|
|
ret = -EADDRNOTAVAIL;
|
|
break;
|
|
}
|
|
|
|
check_debug_tracking(mem_regions_buf, mem_regions_buf_size,
|
|
destvms, destvms_size_bytes);
|
|
|
|
trace_hyp_assign_batch_start(mem_regions_buf,
|
|
batches_processed);
|
|
batch_assign_start_ts = ktime_get();
|
|
ret = qcom_scm_assign_mem_regions(mem_regions_buf,
|
|
mem_regions_buf_size,
|
|
source_vmids, source_size_bytes,
|
|
destvms, destvms_size_bytes);
|
|
|
|
trace_hyp_assign_batch_end(ret, ktime_us_delta(ktime_get(),
|
|
batch_assign_start_ts));
|
|
dma_unmap_single(qcom_secure_buffer_dev, entries_dma_addr,
|
|
mem_regions_buf_size, DMA_TO_DEVICE);
|
|
|
|
if (ret) {
|
|
int reclaim_ret;
|
|
|
|
pr_err("%s: Failed to assign memory protection, ret = %d, batch = %d\n",
|
|
__func__, ret, i);
|
|
|
|
if (!rollback_on_assign_failure)
|
|
/*
|
|
* Only called from outer invocation of batched_hyp_assign(),
|
|
* user will get -EADDRNOTAVAIL
|
|
*/
|
|
break;
|
|
|
|
/*
|
|
* If we haven't assigned anything yet, there's nothing to roll back,
|
|
* don't return -EADDRNOTAVAIL
|
|
*/
|
|
if (batch_start == 0)
|
|
break;
|
|
|
|
/* We shouldn't roll back if the source VM is not HLOS */
|
|
if (source_size_bytes > sizeof(*source_vmids) ||
|
|
source_vmids[0] != VMID_HLOS) {
|
|
pr_err("%s: Can only reclaim memory coming from HLOS\n",
|
|
__func__);
|
|
ret = -EADDRNOTAVAIL;
|
|
break;
|
|
}
|
|
|
|
/* Attempt to reclaim the i - 1 entries we already assigned */
|
|
reclaim_ret = rollback_batched_assign(table, batch_start - 1, destvms,
|
|
destvms_size_bytes);
|
|
|
|
if (reclaim_ret) {
|
|
pr_err("%s: Failed to reclaim memory, ret = %d\n", __func__,
|
|
reclaim_ret);
|
|
/*
|
|
* Make it clear to clients that the memory may no
|
|
* longer be in a usable state.
|
|
*/
|
|
ret = -EADDRNOTAVAIL;
|
|
} else {
|
|
pr_err("%s: Reclaimed memory\n", __func__);
|
|
}
|
|
|
|
break;
|
|
}
|
|
|
|
i++;
|
|
|
|
update_debug_tracking(mem_regions_buf, mem_regions_buf_size,
|
|
destvms, destvms_size_bytes, track);
|
|
batch_start += batches_processed;
|
|
}
|
|
total_delta = ktime_us_delta(ktime_get(), first_assign_ts);
|
|
trace_hyp_assign_end(total_delta, div64_u64(total_delta, i));
|
|
kfree(mem_regions_buf);
|
|
return ret;
|
|
}
|
|
|
|
static inline void set_each_page_of_sg(struct sg_table *table, u64 flag)
|
|
{
|
|
struct scatterlist *sg;
|
|
int npages;
|
|
int i = 0;
|
|
|
|
for_each_sg(table->sgl, sg, table->nents, i) {
|
|
npages = sg->length / PAGE_SIZE;
|
|
if (sg->length % PAGE_SIZE)
|
|
npages++;
|
|
while (npages--)
|
|
set_page_private(nth_page(sg_page(sg), npages), flag);
|
|
}
|
|
}
|
|
|
|
#define SECURE_PAGE_MAGIC 0xEEEEEEEE
|
|
int page_accessible(unsigned long pfn)
|
|
{
|
|
struct page *page = pfn_to_page(pfn);
|
|
|
|
if (page->private == SECURE_PAGE_MAGIC)
|
|
return 0;
|
|
else
|
|
return 1;
|
|
}
|
|
|
|
/*
|
|
* When -EADDRNOTAVAIL is returned the memory may no longer be in
|
|
* a usable state and should no longer be accessed by the HLOS.
|
|
*/
|
|
static inline int _hyp_assign_table(struct sg_table *table, unsigned int sg_nents_to_assign,
|
|
u32 *source_vm_list, int source_nelems,
|
|
int *dest_vmids, int *dest_perms,
|
|
int dest_nelems,
|
|
bool rollback_on_assign_failure)
|
|
{
|
|
int ret = 0;
|
|
u32 *source_vm_copy;
|
|
size_t source_vm_copy_size;
|
|
struct qcom_scm_current_perm_info *dest_vm_copy;
|
|
size_t dest_vm_copy_size;
|
|
dma_addr_t source_dma_addr, dest_dma_addr;
|
|
struct hyp_assign_debug_track *track;
|
|
|
|
if (!qcom_secure_buffer_dev)
|
|
return -EPROBE_DEFER;
|
|
|
|
if (!table || !table->sgl || !source_vm_list || !source_nelems ||
|
|
!dest_vmids || !dest_perms || !dest_nelems || !table->nents)
|
|
return -EINVAL;
|
|
|
|
/*
|
|
* We can only pass cache-aligned sizes to hypervisor, so we need
|
|
* to kmalloc and memcpy the source_vm_list here.
|
|
*/
|
|
source_vm_copy_size = sizeof(*source_vm_copy) * source_nelems;
|
|
source_vm_copy = kmemdup(source_vm_list, source_vm_copy_size,
|
|
GFP_KERNEL);
|
|
if (!source_vm_copy)
|
|
return -ENOMEM;
|
|
|
|
source_dma_addr = dma_map_single(qcom_secure_buffer_dev, source_vm_copy,
|
|
source_vm_copy_size, DMA_TO_DEVICE);
|
|
if (dma_mapping_error(qcom_secure_buffer_dev, source_dma_addr)) {
|
|
ret = -ENOMEM;
|
|
goto out_free_source;
|
|
}
|
|
|
|
dest_vm_copy = populate_dest_info(dest_vmids, dest_nelems, dest_perms,
|
|
&dest_vm_copy_size);
|
|
if (!dest_vm_copy) {
|
|
ret = -ENOMEM;
|
|
goto out_unmap_source;
|
|
}
|
|
|
|
dest_dma_addr = dma_map_single(qcom_secure_buffer_dev, dest_vm_copy,
|
|
dest_vm_copy_size, DMA_TO_DEVICE);
|
|
if (dma_mapping_error(qcom_secure_buffer_dev, dest_dma_addr)) {
|
|
ret = -ENOMEM;
|
|
goto out_free_dest;
|
|
}
|
|
|
|
/* Save stacktrace & hyp_assign parameters */
|
|
track = alloc_debug_tracking(dest_vmids, dest_perms, dest_nelems);
|
|
#if IS_ENABLED(CONFIG_HYP_ASSIGN_DEBUG)
|
|
if (!track) {
|
|
ret = -ENOMEM;
|
|
dma_unmap_single(qcom_secure_buffer_dev, dest_dma_addr,
|
|
dest_vm_copy_size, DMA_TO_DEVICE);
|
|
goto out_free_dest;
|
|
}
|
|
#endif /* CONFIG_HYP_ASSIGN_DEBUG */
|
|
|
|
trace_hyp_assign_info(source_vm_list, source_nelems, dest_vmids,
|
|
dest_perms, dest_nelems);
|
|
|
|
|
|
ret = batched_hyp_assign(table, sg_nents_to_assign, source_vm_copy,
|
|
source_vm_copy_size, dest_vm_copy,
|
|
dest_vm_copy_size, track,
|
|
rollback_on_assign_failure);
|
|
|
|
if (!ret) {
|
|
while (dest_nelems--) {
|
|
if (dest_vmids[dest_nelems] == VMID_HLOS)
|
|
break;
|
|
}
|
|
|
|
if (dest_nelems == -1)
|
|
set_each_page_of_sg(table, SECURE_PAGE_MAGIC);
|
|
else
|
|
set_each_page_of_sg(table, 0);
|
|
}
|
|
|
|
|
|
dma_unmap_single(qcom_secure_buffer_dev, dest_dma_addr,
|
|
dest_vm_copy_size, DMA_TO_DEVICE);
|
|
|
|
/* Drop initial refcount from alloc_debug_tracking */
|
|
put_track(track);
|
|
out_free_dest:
|
|
kfree(dest_vm_copy);
|
|
out_unmap_source:
|
|
dma_unmap_single(qcom_secure_buffer_dev, source_dma_addr,
|
|
source_vm_copy_size, DMA_TO_DEVICE);
|
|
out_free_source:
|
|
kfree(source_vm_copy);
|
|
return ret;
|
|
}
|
|
|
|
int hyp_assign_table(struct sg_table *table,
|
|
u32 *source_vm_list, int source_nelems,
|
|
int *dest_vmids, int *dest_perms,
|
|
int dest_nelems)
|
|
{
|
|
return _hyp_assign_table(table, table->nents, source_vm_list, source_nelems,
|
|
dest_vmids, dest_perms, dest_nelems, true);
|
|
}
|
|
EXPORT_SYMBOL(hyp_assign_table);
|
|
|
|
const char *msm_secure_vmid_to_string(int secure_vmid)
|
|
{
|
|
switch (secure_vmid) {
|
|
case VMID_TZ:
|
|
return "VMID_TZ";
|
|
case VMID_HLOS:
|
|
return "VMID_HLOS";
|
|
case VMID_CP_TOUCH:
|
|
return "VMID_CP_TOUCH";
|
|
case VMID_CP_BITSTREAM:
|
|
return "VMID_CP_BITSTREAM";
|
|
case VMID_CP_PIXEL:
|
|
return "VMID_CP_PIXEL";
|
|
case VMID_CP_NON_PIXEL:
|
|
return "VMID_CP_NON_PIXEL";
|
|
case VMID_CP_CAMERA:
|
|
return "VMID_CP_CAMERA";
|
|
case VMID_HLOS_FREE:
|
|
return "VMID_HLOS_FREE";
|
|
case VMID_MSS_MSA:
|
|
return "VMID_MSS_MSA";
|
|
case VMID_MSS_NONMSA:
|
|
return "VMID_MSS_NONMSA";
|
|
case VMID_CP_SEC_DISPLAY:
|
|
return "VMID_CP_SEC_DISPLAY";
|
|
case VMID_CP_APP:
|
|
return "VMID_CP_APP";
|
|
case VMID_LPASS:
|
|
return "VMID_LPASS";
|
|
case VMID_WLAN:
|
|
return "VMID_WLAN";
|
|
case VMID_WLAN_CE:
|
|
return "VMID_WLAN_CE";
|
|
case VMID_CP_CAMERA_PREVIEW:
|
|
return "VMID_CP_CAMERA_PREVIEW";
|
|
case VMID_CP_SPSS_SP:
|
|
return "VMID_CP_SPSS_SP";
|
|
case VMID_CP_SPSS_SP_SHARED:
|
|
return "VMID_CP_SPSS_SP_SHARED";
|
|
case VMID_CP_SPSS_HLOS_SHARED:
|
|
return "VMID_CP_SPSS_HLOS_SHARED";
|
|
case VMID_ADSP_HEAP:
|
|
return "VMID_ADSP_HEAP";
|
|
case VMID_INVAL:
|
|
return "VMID_INVAL";
|
|
case VMID_NAV:
|
|
return "VMID_NAV";
|
|
default:
|
|
return "Unknown VMID";
|
|
}
|
|
}
|
|
EXPORT_SYMBOL(msm_secure_vmid_to_string);
|
|
|
|
u32 msm_secure_get_vmid_perms(u32 vmid)
|
|
{
|
|
if (vmid == VMID_CP_SEC_DISPLAY || (vmid == VMID_CP_CAMERA_PREVIEW &&
|
|
vmid_cp_camera_preview_ro))
|
|
return PERM_READ;
|
|
else if (vmid == VMID_CP_CDSP)
|
|
return PERM_READ | PERM_WRITE | PERM_EXEC;
|
|
else
|
|
return PERM_READ | PERM_WRITE;
|
|
}
|
|
EXPORT_SYMBOL(msm_secure_get_vmid_perms);
|
|
|
|
static int qcom_secure_buffer_probe(struct platform_device *pdev)
|
|
{
|
|
struct device *dev = &pdev->dev;
|
|
int ret;
|
|
|
|
if (IS_ENABLED(CONFIG_ARM64)) {
|
|
ret = dma_set_mask(dev, DMA_BIT_MASK(64));
|
|
if (ret)
|
|
return ret;
|
|
}
|
|
|
|
qcom_secure_buffer_dev = dev;
|
|
vmid_cp_camera_preview_ro = of_property_read_bool(dev->of_node,
|
|
"qcom,vmid-cp-camera-preview-ro");
|
|
return 0;
|
|
}
|
|
|
|
static const struct of_device_id qcom_secure_buffer_of_match[] = {
|
|
{.compatible = "qcom,secure-buffer"},
|
|
{}
|
|
};
|
|
MODULE_DEVICE_TABLE(of, qcom_secure_buffer_of_match);
|
|
|
|
static struct platform_driver qcom_secure_buffer_driver = {
|
|
.probe = qcom_secure_buffer_probe,
|
|
.driver = {
|
|
.name = "qcom_secure_buffer",
|
|
.of_match_table = qcom_secure_buffer_of_match,
|
|
},
|
|
};
|
|
|
|
static int __init qcom_secure_buffer_init(void)
|
|
{
|
|
#if IS_ENABLED(CONFIG_HYP_ASSIGN_DEBUG)
|
|
failure_handle = create_dummy_stack();
|
|
#endif
|
|
|
|
return platform_driver_register(&qcom_secure_buffer_driver);
|
|
}
|
|
subsys_initcall(qcom_secure_buffer_init);
|
|
|
|
static void __exit qcom_secure_buffer_exit(void)
|
|
{
|
|
return platform_driver_unregister(&qcom_secure_buffer_driver);
|
|
}
|
|
module_exit(qcom_secure_buffer_exit);
|
|
|
|
MODULE_LICENSE("GPL");
|