static void main_tee_entry(struct thread_smc_args *args) { /* * This function first catches all ST specific SMC functions * if none matches, the generic tee_entry is called. */ if (args->a0 == TEESMC32_ST_FASTCALL_GET_SHM_CONFIG) { args->a0 = TEESMC_RETURN_OK; args->a1 = default_nsec_shm_paddr; args->a2 = default_nsec_shm_size; /* Should this be TEESMC cache attributes instead? */ args->a3 = core_mmu_is_shm_cached(); return; } if (args->a0 == TEESMC32_ST_FASTCALL_L2CC_MUTEX) { switch (args->a1) { case TEESMC_ST_L2CC_MUTEX_GET_ADDR: case TEESMC_ST_L2CC_MUTEX_SET_ADDR: case TEESMC_ST_L2CC_MUTEX_ENABLE: case TEESMC_ST_L2CC_MUTEX_DISABLE: /* TODO call the appropriate internal functions */ args->a0 = TEESMC_RETURN_UNKNOWN_FUNCTION; return; default: args->a0 = TEESMC_RETURN_EBADCMD; return; } } tee_entry(args); }
TEE_Result tee_mmu_kmap_helper(tee_paddr_t pa, size_t len, void **va) { tee_mm_entry_t *mm; uint32_t attr; struct core_mmu_table_info tbl_info; uint32_t pa_s; uint32_t pa_e; size_t n; size_t offs; if (!core_mmu_find_table(TEE_MMU_KMAP_START_VA, UINT_MAX, &tbl_info)) panic(); pa_s = ROUNDDOWN(pa, 1 << tbl_info.shift); pa_e = ROUNDUP(pa + len, 1 << tbl_info.shift); mm = tee_mm_alloc(&tee_mmu_virt_kmap, pa_e - pa_s); if (!mm) return TEE_ERROR_OUT_OF_MEMORY; attr = TEE_MATTR_VALID_BLOCK | TEE_MATTR_PRW | TEE_MATTR_GLOBAL; if (tee_pbuf_is_sec(pa, len)) { attr |= TEE_MATTR_SECURE; attr |= TEE_MATTR_I_WRITE_BACK | TEE_MATTR_O_WRITE_BACK; } else if (tee_pbuf_is_non_sec(pa, len)) { if (core_mmu_is_shm_cached()) attr |= TEE_MATTR_I_WRITE_BACK | TEE_MATTR_O_WRITE_BACK; } else return TEE_ERROR_GENERIC; offs = (tee_mm_get_smem(mm) - tbl_info.va_base) >> tbl_info.shift; for (n = 0; n < tee_mm_get_size(mm); n++) core_mmu_set_entry(&tbl_info, n + offs, pa_s + (n << tbl_info.shift), attr); core_tlb_maintenance(TLBINV_UNIFIEDTLB, 0); *va = (void *)(tee_mm_get_smem(mm) + core_mmu_get_block_offset(&tbl_info, pa)); return TEE_SUCCESS; }