blob: bd9a5fbfb6c95fd84f3abb8b9de277c045d15ac4 [file] [log] [blame]
/*
* Copyright (C) 2016 The Android Open Source Project
*
* Permission is hereby granted, free of charge, to any person
* obtaining a copy of this software and associated documentation
* files (the "Software"), to deal in the Software without
* restriction, including without limitation the rights to use, copy,
* modify, merge, publish, distribute, sublicense, and/or sell copies
* of the Software, and to permit persons to whom the Software is
* furnished to do so, subject to the following conditions:
*
* The above copyright notice and this permission notice shall be
* included in all copies or substantial portions of the Software.
*
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
* NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
* BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
* ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
* CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
* SOFTWARE.
*/
#include <trusty/trusty_dev.h>
#include <trusty/util.h>
#include "sm_err.h"
#include "smcall.h"
struct trusty_dev;
#define LOCAL_LOG 0
#ifndef __asmeq
#define __asmeq(x, y) ".ifnc " x "," y " ; .err ; .endif\n\t"
#endif
#ifdef NS_ARCH_ARM64
#define SMC_ARG0 "x0"
#define SMC_ARG1 "x1"
#define SMC_ARG2 "x2"
#define SMC_ARG3 "x3"
#define SMC_ARCH_EXTENSION ""
#define SMC_REGISTERS_TRASHED "x4","x5","x6","x7","x8","x9","x10","x11", \
"x12","x13","x14","x15","x16","x17"
#else
#define SMC_ARG0 "r0"
#define SMC_ARG1 "r1"
#define SMC_ARG2 "r2"
#define SMC_ARG3 "r3"
#define SMC_ARCH_EXTENSION ".arch_extension sec\n"
#define SMC_REGISTERS_TRASHED "ip"
#endif
/*
* Execute SMC call into trusty
*/
static unsigned long smc(unsigned long r0,
unsigned long r1,
unsigned long r2,
unsigned long r3)
{
register unsigned long _r0 __asm__(SMC_ARG0) = r0;
register unsigned long _r1 __asm__(SMC_ARG1) = r1;
register unsigned long _r2 __asm__(SMC_ARG2) = r2;
register unsigned long _r3 __asm__(SMC_ARG3) = r3;
__asm__ volatile(
__asmeq("%0", SMC_ARG0)
__asmeq("%1", SMC_ARG1)
__asmeq("%2", SMC_ARG2)
__asmeq("%3", SMC_ARG3)
__asmeq("%4", SMC_ARG0)
__asmeq("%5", SMC_ARG1)
__asmeq("%6", SMC_ARG2)
__asmeq("%7", SMC_ARG3)
SMC_ARCH_EXTENSION
"smc #0" /* switch to secure world */
: "=r" (_r0), "=r" (_r1), "=r" (_r2), "=r" (_r3)
: "r" (_r0), "r" (_r1), "r" (_r2), "r" (_r3)
: SMC_REGISTERS_TRASHED);
return _r0;
}
static int32_t trusty_fast_call32(struct trusty_dev *dev, uint32_t smcnr,
uint32_t a0, uint32_t a1, uint32_t a2)
{
trusty_assert(dev);
trusty_assert(SMC_IS_FASTCALL(smcnr));
return smc(smcnr, a0, a1, a2);
}
static unsigned long trusty_std_call_inner(struct trusty_dev *dev,
unsigned long smcnr,
unsigned long a0,
unsigned long a1,
unsigned long a2)
{
unsigned long ret;
int retry = 5;
trusty_debug("%s(0x%lx 0x%lx 0x%lx 0x%lx)\n", __func__, smcnr, a0, a1, a2);
while (true) {
ret = smc(smcnr, a0, a1, a2);
while ((int32_t)ret == SM_ERR_FIQ_INTERRUPTED)
ret = smc(SMC_SC_RESTART_FIQ, 0, 0, 0);
if ((int)ret != SM_ERR_BUSY || !retry)
break;
trusty_debug("%s(0x%lx 0x%lx 0x%lx 0x%lx) returned busy, retry\n",
__func__, smcnr, a0, a1, a2);
retry--;
}
return ret;
}
static unsigned long trusty_std_call_helper(struct trusty_dev *dev,
unsigned long smcnr,
unsigned long a0,
unsigned long a1,
unsigned long a2)
{
unsigned long ret;
unsigned long irq_state;
while (true) {
trusty_local_irq_disable(&irq_state);
ret = trusty_std_call_inner(dev, smcnr, a0, a1, a2);
trusty_local_irq_restore(&irq_state);
if ((int)ret != SM_ERR_BUSY)
break;
trusty_idle(dev);
}
return ret;
}
static int32_t trusty_std_call32(struct trusty_dev *dev, uint32_t smcnr,
uint32_t a0, uint32_t a1, uint32_t a2)
{
int ret;
trusty_assert(dev);
trusty_assert(!SMC_IS_FASTCALL(smcnr));
if (smcnr != SMC_SC_NOP) {
trusty_lock(dev);
}
trusty_debug("%s(0x%x 0x%x 0x%x 0x%x) started\n", __func__,
smcnr, a0, a1, a2);
ret = trusty_std_call_helper(dev, smcnr, a0, a1, a2);
while (ret == SM_ERR_INTERRUPTED || ret == SM_ERR_CPU_IDLE) {
trusty_debug("%s(0x%x 0x%x 0x%x 0x%x) interrupted\n", __func__,
smcnr, a0, a1, a2);
if (ret == SM_ERR_CPU_IDLE) {
trusty_idle(dev);
}
ret = trusty_std_call_helper(dev, SMC_SC_RESTART_LAST, 0, 0, 0);
}
trusty_debug("%s(0x%x 0x%x 0x%x 0x%x) returned 0x%x\n",
__func__, smcnr, a0, a1, a2, ret);
if (smcnr != SMC_SC_NOP) {
trusty_unlock(dev);
}
return ret;
}
static int trusty_call32_mem_buf(struct trusty_dev *dev, uint32_t smcnr,
struct ns_mem_page_info *page, uint32_t size)
{
trusty_assert(dev);
trusty_assert(page);
if (SMC_IS_FASTCALL(smcnr)) {
return trusty_fast_call32(dev, smcnr,
(uint32_t)page->attr,
(uint32_t)(page->attr >> 32), size);
} else {
return trusty_std_call32(dev, smcnr,
(uint32_t)page->attr,
(uint32_t)(page->attr >> 32), size);
}
}
int trusty_dev_init_ipc(struct trusty_dev *dev,
struct ns_mem_page_info *buf, uint32_t buf_size)
{
return trusty_call32_mem_buf(dev, SMC_SC_TRUSTY_IPC_CREATE_QL_DEV,
buf, buf_size);
}
int trusty_dev_exec_ipc(struct trusty_dev *dev,
struct ns_mem_page_info *buf, uint32_t buf_size)
{
return trusty_call32_mem_buf(dev, SMC_SC_TRUSTY_IPC_HANDLE_QL_DEV_CMD,
buf, buf_size);
}
int trusty_dev_shutdown_ipc(struct trusty_dev *dev,
struct ns_mem_page_info *buf, uint32_t buf_size)
{
return trusty_call32_mem_buf(dev, SMC_SC_TRUSTY_IPC_SHUTDOWN_QL_DEV,
buf, buf_size);
}
static int trusty_init_api_version(struct trusty_dev *dev)
{
uint32_t api_version;
api_version = trusty_fast_call32(dev, SMC_FC_API_VERSION,
TRUSTY_API_VERSION_CURRENT, 0, 0);
if (api_version == SM_ERR_UNDEFINED_SMC)
api_version = 0;
if (api_version > TRUSTY_API_VERSION_CURRENT) {
trusty_error("unsupported trusty api version %u > %u\n",
api_version, TRUSTY_API_VERSION_CURRENT);
return -1;
}
trusty_info("selected trusty api version: %u (requested %u)\n",
api_version, TRUSTY_API_VERSION_CURRENT);
dev->api_version = api_version;
return 0;
}
int trusty_dev_init(struct trusty_dev *dev, void *priv_data)
{
trusty_assert(dev);
dev->priv_data = priv_data;
return trusty_init_api_version(dev);
}
int trusty_dev_shutdown(struct trusty_dev *dev)
{
trusty_assert(dev);
dev->priv_data = NULL;
return 0;
}