|
@@ -535,18 +535,58 @@ void optee_free_pages_list(void *list, size_t num_entries)
|
|
|
free_pages_exact(list, get_pages_list_size(num_entries));
|
|
|
}
|
|
|
|
|
|
+static bool is_normal_memory(pgprot_t p)
|
|
|
+{
|
|
|
+#if defined(CONFIG_ARM)
|
|
|
+ return (pgprot_val(p) & L_PTE_MT_MASK) == L_PTE_MT_WRITEALLOC;
|
|
|
+#elif defined(CONFIG_ARM64)
|
|
|
+ return (pgprot_val(p) & PTE_ATTRINDX_MASK) == PTE_ATTRINDX(MT_NORMAL);
|
|
|
+#else
|
|
|
+#error "Unuspported architecture"
|
|
|
+#endif
|
|
|
+}
|
|
|
+
|
|
|
+static int __check_mem_type(struct vm_area_struct *vma, unsigned long end)
|
|
|
+{
|
|
|
+ while (vma && is_normal_memory(vma->vm_page_prot)) {
|
|
|
+ if (vma->vm_end >= end)
|
|
|
+ return 0;
|
|
|
+ vma = vma->vm_next;
|
|
|
+ }
|
|
|
+
|
|
|
+ return -EINVAL;
|
|
|
+}
|
|
|
+
|
|
|
+static int check_mem_type(unsigned long start, size_t num_pages)
|
|
|
+{
|
|
|
+ struct mm_struct *mm = current->mm;
|
|
|
+ int rc;
|
|
|
+
|
|
|
+ down_read(&mm->mmap_sem);
|
|
|
+ rc = __check_mem_type(find_vma(mm, start),
|
|
|
+ start + num_pages * PAGE_SIZE);
|
|
|
+ up_read(&mm->mmap_sem);
|
|
|
+
|
|
|
+ return rc;
|
|
|
+}
|
|
|
+
|
|
|
int optee_shm_register(struct tee_context *ctx, struct tee_shm *shm,
|
|
|
- struct page **pages, size_t num_pages)
|
|
|
+ struct page **pages, size_t num_pages,
|
|
|
+ unsigned long start)
|
|
|
{
|
|
|
struct tee_shm *shm_arg = NULL;
|
|
|
struct optee_msg_arg *msg_arg;
|
|
|
u64 *pages_list;
|
|
|
phys_addr_t msg_parg;
|
|
|
- int rc = 0;
|
|
|
+ int rc;
|
|
|
|
|
|
if (!num_pages)
|
|
|
return -EINVAL;
|
|
|
|
|
|
+ rc = check_mem_type(start, num_pages);
|
|
|
+ if (rc)
|
|
|
+ return rc;
|
|
|
+
|
|
|
pages_list = optee_allocate_pages_list(num_pages);
|
|
|
if (!pages_list)
|
|
|
return -ENOMEM;
|
|
@@ -606,13 +646,14 @@ int optee_shm_unregister(struct tee_context *ctx, struct tee_shm *shm)
|
|
|
}
|
|
|
|
|
|
int optee_shm_register_supp(struct tee_context *ctx, struct tee_shm *shm,
|
|
|
- struct page **pages, size_t num_pages)
|
|
|
+ struct page **pages, size_t num_pages,
|
|
|
+ unsigned long start)
|
|
|
{
|
|
|
/*
|
|
|
* We don't want to register supplicant memory in OP-TEE.
|
|
|
* Instead information about it will be passed in RPC code.
|
|
|
*/
|
|
|
- return 0;
|
|
|
+ return check_mem_type(start, num_pages);
|
|
|
}
|
|
|
|
|
|
int optee_shm_unregister_supp(struct tee_context *ctx, struct tee_shm *shm)
|