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;
}
