Commit b30a2a72 authored by Elliot Berman's avatar Elliot Berman Committed by Bjorn Andersson

firmware: qcom_scm-64: Move svc/cmd/owner into qcom_scm_desc

Service, command, and owner IDs are all part of qcom_scm_desc struct and
have no special reason to be a function argument (or hard-coded in the
case of owner [1]). Moving them to be part of qcom_scm_desc struct improves
readability.

[1]: Example of SCM function using owner vale other than hard-coded SIP value:
https://source.codeaurora.org/quic/la/kernel/msm-4.9/tree/drivers/soc/qcom/smcinvoke.c?h=kernel.lnx.4.9.r28-rel#n35

Tested-by: Brian Masney <masneyb@onstation.org> # arm32
Tested-by: default avatarStephan Gerhold <stephan@gerhold.net>
Signed-off-by: default avatarElliot Berman <eberman@codeaurora.org>
Link: https://lore.kernel.org/r/1578431066-19600-6-git-send-email-eberman@codeaurora.orgSigned-off-by: default avatarBjorn Andersson <bjorn.andersson@linaro.org>
parent 4a9f1e13
...@@ -48,8 +48,11 @@ enum qcom_scm_arg_types { ...@@ -48,8 +48,11 @@ enum qcom_scm_arg_types {
* @res: The values returned by the secure syscall * @res: The values returned by the secure syscall
*/ */
struct qcom_scm_desc { struct qcom_scm_desc {
u32 svc;
u32 cmd;
u32 arginfo; u32 arginfo;
u64 args[MAX_QCOM_SCM_ARGS]; u64 args[MAX_QCOM_SCM_ARGS];
u32 owner;
}; };
static u64 qcom_smccc_convention = -1; static u64 qcom_smccc_convention = -1;
...@@ -63,14 +66,16 @@ static DEFINE_MUTEX(qcom_scm_lock); ...@@ -63,14 +66,16 @@ static DEFINE_MUTEX(qcom_scm_lock);
#define SCM_SMC_N_EXT_ARGS (MAX_QCOM_SCM_ARGS - SCM_SMC_N_REG_ARGS + 1) #define SCM_SMC_N_EXT_ARGS (MAX_QCOM_SCM_ARGS - SCM_SMC_N_REG_ARGS + 1)
static void __scm_smc_do_quirk(const struct qcom_scm_desc *desc, static void __scm_smc_do_quirk(const struct qcom_scm_desc *desc,
struct arm_smccc_res *res, u32 fn_id, struct arm_smccc_res *res, u64 x5, u32 type)
u64 x5, u32 type)
{ {
u64 cmd; u64 cmd;
struct arm_smccc_quirk quirk = { .id = ARM_SMCCC_QUIRK_QCOM_A6 }; struct arm_smccc_quirk quirk = { .id = ARM_SMCCC_QUIRK_QCOM_A6 };
cmd = ARM_SMCCC_CALL_VAL(type, qcom_smccc_convention, cmd = ARM_SMCCC_CALL_VAL(
ARM_SMCCC_OWNER_SIP, fn_id); type,
qcom_smccc_convention,
desc->owner,
SCM_SMC_FNID(desc->svc, desc->cmd));
quirk.state.a6 = 0; quirk.state.a6 = 0;
...@@ -86,22 +91,19 @@ static void __scm_smc_do_quirk(const struct qcom_scm_desc *desc, ...@@ -86,22 +91,19 @@ static void __scm_smc_do_quirk(const struct qcom_scm_desc *desc,
} }
static void __scm_smc_do(const struct qcom_scm_desc *desc, static void __scm_smc_do(const struct qcom_scm_desc *desc,
struct arm_smccc_res *res, u32 fn_id, struct arm_smccc_res *res, u64 x5, bool atomic)
u64 x5, bool atomic)
{ {
int retry_count = 0; int retry_count = 0;
if (atomic) { if (atomic) {
__scm_smc_do_quirk(desc, res, fn_id, x5, __scm_smc_do_quirk(desc, res, x5, ARM_SMCCC_FAST_CALL);
ARM_SMCCC_FAST_CALL);
return; return;
} }
do { do {
mutex_lock(&qcom_scm_lock); mutex_lock(&qcom_scm_lock);
__scm_smc_do_quirk(desc, res, fn_id, x5, __scm_smc_do_quirk(desc, res, x5, ARM_SMCCC_STD_CALL);
ARM_SMCCC_STD_CALL);
mutex_unlock(&qcom_scm_lock); mutex_unlock(&qcom_scm_lock);
...@@ -113,13 +115,11 @@ static void __scm_smc_do(const struct qcom_scm_desc *desc, ...@@ -113,13 +115,11 @@ static void __scm_smc_do(const struct qcom_scm_desc *desc,
} while (res->a0 == QCOM_SCM_V2_EBUSY); } while (res->a0 == QCOM_SCM_V2_EBUSY);
} }
static int __scm_smc_call(struct device *dev, u32 svc_id, u32 cmd_id, static int __scm_smc_call(struct device *dev, const struct qcom_scm_desc *desc,
const struct qcom_scm_desc *desc, struct arm_smccc_res *res, bool atomic)
struct arm_smccc_res *res, bool atomic)
{ {
int arglen = desc->arginfo & 0xf; int arglen = desc->arginfo & 0xf;
int i; int i;
u32 fn_id = SCM_SMC_FNID(svc_id, cmd_id);
u64 x5 = desc->args[SCM_SMC_FIRST_EXT_IDX]; u64 x5 = desc->args[SCM_SMC_FIRST_EXT_IDX];
dma_addr_t args_phys = 0; dma_addr_t args_phys = 0;
void *args_virt = NULL; void *args_virt = NULL;
...@@ -158,7 +158,7 @@ static int __scm_smc_call(struct device *dev, u32 svc_id, u32 cmd_id, ...@@ -158,7 +158,7 @@ static int __scm_smc_call(struct device *dev, u32 svc_id, u32 cmd_id,
x5 = args_phys; x5 = args_phys;
} }
__scm_smc_do(desc, res, fn_id, x5, atomic); __scm_smc_do(desc, res, x5, atomic);
if (args_virt) { if (args_virt) {
dma_unmap_single(dev, args_phys, alloc_len, DMA_TO_DEVICE); dma_unmap_single(dev, args_phys, alloc_len, DMA_TO_DEVICE);
...@@ -181,12 +181,11 @@ static int __scm_smc_call(struct device *dev, u32 svc_id, u32 cmd_id, ...@@ -181,12 +181,11 @@ static int __scm_smc_call(struct device *dev, u32 svc_id, u32 cmd_id,
* Sends a command to the SCM and waits for the command to finish processing. * Sends a command to the SCM and waits for the command to finish processing.
* This should *only* be called in pre-emptible context. * This should *only* be called in pre-emptible context.
*/ */
static int qcom_scm_call(struct device *dev, u32 svc_id, u32 cmd_id, static int qcom_scm_call(struct device *dev, const struct qcom_scm_desc *desc,
const struct qcom_scm_desc *desc,
struct arm_smccc_res *res) struct arm_smccc_res *res)
{ {
might_sleep(); might_sleep();
return __scm_smc_call(dev, svc_id, cmd_id, desc, res, false); return __scm_smc_call(dev, desc, res, false);
} }
/** /**
...@@ -200,11 +199,11 @@ static int qcom_scm_call(struct device *dev, u32 svc_id, u32 cmd_id, ...@@ -200,11 +199,11 @@ static int qcom_scm_call(struct device *dev, u32 svc_id, u32 cmd_id,
* Sends a command to the SCM and waits for the command to finish processing. * Sends a command to the SCM and waits for the command to finish processing.
* This can be called in atomic context. * This can be called in atomic context.
*/ */
static int qcom_scm_call_atomic(struct device *dev, u32 svc_id, u32 cmd_id, static int qcom_scm_call_atomic(struct device *dev,
const struct qcom_scm_desc *desc, const struct qcom_scm_desc *desc,
struct arm_smccc_res *res) struct arm_smccc_res *res)
{ {
return __scm_smc_call(dev, svc_id, cmd_id, desc, res, true); return __scm_smc_call(dev, desc, res, true);
} }
/** /**
...@@ -250,15 +249,18 @@ void __qcom_scm_cpu_power_down(u32 flags) ...@@ -250,15 +249,18 @@ void __qcom_scm_cpu_power_down(u32 flags)
int __qcom_scm_is_call_available(struct device *dev, u32 svc_id, u32 cmd_id) int __qcom_scm_is_call_available(struct device *dev, u32 svc_id, u32 cmd_id)
{ {
int ret; int ret;
struct qcom_scm_desc desc = {0}; struct qcom_scm_desc desc = {
.svc = QCOM_SCM_SVC_INFO,
.cmd = QCOM_SCM_INFO_IS_CALL_AVAIL,
.owner = ARM_SMCCC_OWNER_SIP,
};
struct arm_smccc_res res; struct arm_smccc_res res;
desc.arginfo = QCOM_SCM_ARGS(1); desc.arginfo = QCOM_SCM_ARGS(1);
desc.args[0] = SCM_SMC_FNID(svc_id, cmd_id) | desc.args[0] = SCM_SMC_FNID(svc_id, cmd_id) |
(ARM_SMCCC_OWNER_SIP << ARM_SMCCC_OWNER_SHIFT); (ARM_SMCCC_OWNER_SIP << ARM_SMCCC_OWNER_SHIFT);
ret = qcom_scm_call(dev, QCOM_SCM_SVC_INFO, QCOM_SCM_INFO_IS_CALL_AVAIL, ret = qcom_scm_call(dev, &desc, &res);
&desc, &res);
return ret ? : res.a1; return ret ? : res.a1;
} }
...@@ -267,7 +269,11 @@ int __qcom_scm_hdcp_req(struct device *dev, struct qcom_scm_hdcp_req *req, ...@@ -267,7 +269,11 @@ int __qcom_scm_hdcp_req(struct device *dev, struct qcom_scm_hdcp_req *req,
u32 req_cnt, u32 *resp) u32 req_cnt, u32 *resp)
{ {
int ret; int ret;
struct qcom_scm_desc desc = {0}; struct qcom_scm_desc desc = {
.svc = QCOM_SCM_SVC_HDCP,
.cmd = QCOM_SCM_HDCP_INVOKE,
.owner = ARM_SMCCC_OWNER_SIP,
};
struct arm_smccc_res res; struct arm_smccc_res res;
if (req_cnt > QCOM_SCM_HDCP_MAX_REQ_CNT) if (req_cnt > QCOM_SCM_HDCP_MAX_REQ_CNT)
...@@ -285,8 +291,7 @@ int __qcom_scm_hdcp_req(struct device *dev, struct qcom_scm_hdcp_req *req, ...@@ -285,8 +291,7 @@ int __qcom_scm_hdcp_req(struct device *dev, struct qcom_scm_hdcp_req *req,
desc.args[9] = req[4].val; desc.args[9] = req[4].val;
desc.arginfo = QCOM_SCM_ARGS(10); desc.arginfo = QCOM_SCM_ARGS(10);
ret = qcom_scm_call(dev, QCOM_SCM_SVC_HDCP, QCOM_SCM_HDCP_INVOKE, &desc, ret = qcom_scm_call(dev, &desc, &res);
&res);
*resp = res.a1; *resp = res.a1;
return ret; return ret;
...@@ -326,15 +331,17 @@ void __qcom_scm_init(void) ...@@ -326,15 +331,17 @@ void __qcom_scm_init(void)
bool __qcom_scm_pas_supported(struct device *dev, u32 peripheral) bool __qcom_scm_pas_supported(struct device *dev, u32 peripheral)
{ {
int ret; int ret;
struct qcom_scm_desc desc = {0}; struct qcom_scm_desc desc = {
.svc = QCOM_SCM_SVC_PIL,
.cmd = QCOM_SCM_PIL_PAS_IS_SUPPORTED,
.owner = ARM_SMCCC_OWNER_SIP,
};
struct arm_smccc_res res; struct arm_smccc_res res;
desc.args[0] = peripheral; desc.args[0] = peripheral;
desc.arginfo = QCOM_SCM_ARGS(1); desc.arginfo = QCOM_SCM_ARGS(1);
ret = qcom_scm_call(dev, QCOM_SCM_SVC_PIL, ret = qcom_scm_call(dev, &desc, &res);
QCOM_SCM_PIL_PAS_IS_SUPPORTED,
&desc, &res);
return ret ? false : !!res.a1; return ret ? false : !!res.a1;
} }
...@@ -343,15 +350,18 @@ int __qcom_scm_pas_init_image(struct device *dev, u32 peripheral, ...@@ -343,15 +350,18 @@ int __qcom_scm_pas_init_image(struct device *dev, u32 peripheral,
dma_addr_t metadata_phys) dma_addr_t metadata_phys)
{ {
int ret; int ret;
struct qcom_scm_desc desc = {0}; struct qcom_scm_desc desc = {
.svc = QCOM_SCM_SVC_PIL,
.cmd = QCOM_SCM_PIL_PAS_INIT_IMAGE,
.owner = ARM_SMCCC_OWNER_SIP,
};
struct arm_smccc_res res; struct arm_smccc_res res;
desc.args[0] = peripheral; desc.args[0] = peripheral;
desc.args[1] = metadata_phys; desc.args[1] = metadata_phys;
desc.arginfo = QCOM_SCM_ARGS(2, QCOM_SCM_VAL, QCOM_SCM_RW); desc.arginfo = QCOM_SCM_ARGS(2, QCOM_SCM_VAL, QCOM_SCM_RW);
ret = qcom_scm_call(dev, QCOM_SCM_SVC_PIL, QCOM_SCM_PIL_PAS_INIT_IMAGE, ret = qcom_scm_call(dev, &desc, &res);
&desc, &res);
return ret ? : res.a1; return ret ? : res.a1;
} }
...@@ -360,7 +370,11 @@ int __qcom_scm_pas_mem_setup(struct device *dev, u32 peripheral, ...@@ -360,7 +370,11 @@ int __qcom_scm_pas_mem_setup(struct device *dev, u32 peripheral,
phys_addr_t addr, phys_addr_t size) phys_addr_t addr, phys_addr_t size)
{ {
int ret; int ret;
struct qcom_scm_desc desc = {0}; struct qcom_scm_desc desc = {
.svc = QCOM_SCM_SVC_PIL,
.cmd = QCOM_SCM_PIL_PAS_MEM_SETUP,
.owner = ARM_SMCCC_OWNER_SIP,
};
struct arm_smccc_res res; struct arm_smccc_res res;
desc.args[0] = peripheral; desc.args[0] = peripheral;
...@@ -368,8 +382,7 @@ int __qcom_scm_pas_mem_setup(struct device *dev, u32 peripheral, ...@@ -368,8 +382,7 @@ int __qcom_scm_pas_mem_setup(struct device *dev, u32 peripheral,
desc.args[2] = size; desc.args[2] = size;
desc.arginfo = QCOM_SCM_ARGS(3); desc.arginfo = QCOM_SCM_ARGS(3);
ret = qcom_scm_call(dev, QCOM_SCM_SVC_PIL, QCOM_SCM_PIL_PAS_MEM_SETUP, ret = qcom_scm_call(dev, &desc, &res);
&desc, &res);
return ret ? : res.a1; return ret ? : res.a1;
} }
...@@ -377,15 +390,17 @@ int __qcom_scm_pas_mem_setup(struct device *dev, u32 peripheral, ...@@ -377,15 +390,17 @@ int __qcom_scm_pas_mem_setup(struct device *dev, u32 peripheral,
int __qcom_scm_pas_auth_and_reset(struct device *dev, u32 peripheral) int __qcom_scm_pas_auth_and_reset(struct device *dev, u32 peripheral)
{ {
int ret; int ret;
struct qcom_scm_desc desc = {0}; struct qcom_scm_desc desc = {
.svc = QCOM_SCM_SVC_PIL,
.cmd = QCOM_SCM_PIL_PAS_AUTH_AND_RESET,
.owner = ARM_SMCCC_OWNER_SIP,
};
struct arm_smccc_res res; struct arm_smccc_res res;
desc.args[0] = peripheral; desc.args[0] = peripheral;
desc.arginfo = QCOM_SCM_ARGS(1); desc.arginfo = QCOM_SCM_ARGS(1);
ret = qcom_scm_call(dev, QCOM_SCM_SVC_PIL, ret = qcom_scm_call(dev, &desc, &res);
QCOM_SCM_PIL_PAS_AUTH_AND_RESET,
&desc, &res);
return ret ? : res.a1; return ret ? : res.a1;
} }
...@@ -393,21 +408,28 @@ int __qcom_scm_pas_auth_and_reset(struct device *dev, u32 peripheral) ...@@ -393,21 +408,28 @@ int __qcom_scm_pas_auth_and_reset(struct device *dev, u32 peripheral)
int __qcom_scm_pas_shutdown(struct device *dev, u32 peripheral) int __qcom_scm_pas_shutdown(struct device *dev, u32 peripheral)
{ {
int ret; int ret;
struct qcom_scm_desc desc = {0}; struct qcom_scm_desc desc = {
.svc = QCOM_SCM_SVC_PIL,
.cmd = QCOM_SCM_PIL_PAS_SHUTDOWN,
.owner = ARM_SMCCC_OWNER_SIP,
};
struct arm_smccc_res res; struct arm_smccc_res res;
desc.args[0] = peripheral; desc.args[0] = peripheral;
desc.arginfo = QCOM_SCM_ARGS(1); desc.arginfo = QCOM_SCM_ARGS(1);
ret = qcom_scm_call(dev, QCOM_SCM_SVC_PIL, QCOM_SCM_PIL_PAS_SHUTDOWN, ret = qcom_scm_call(dev, &desc, &res);
&desc, &res);
return ret ? : res.a1; return ret ? : res.a1;
} }
int __qcom_scm_pas_mss_reset(struct device *dev, bool reset) int __qcom_scm_pas_mss_reset(struct device *dev, bool reset)
{ {
struct qcom_scm_desc desc = {0}; struct qcom_scm_desc desc = {
.svc = QCOM_SCM_SVC_PIL,
.cmd = QCOM_SCM_PIL_PAS_MSS_RESET,
.owner = ARM_SMCCC_OWNER_SIP,
};
struct arm_smccc_res res; struct arm_smccc_res res;
int ret; int ret;
...@@ -415,15 +437,18 @@ int __qcom_scm_pas_mss_reset(struct device *dev, bool reset) ...@@ -415,15 +437,18 @@ int __qcom_scm_pas_mss_reset(struct device *dev, bool reset)
desc.args[1] = 0; desc.args[1] = 0;
desc.arginfo = QCOM_SCM_ARGS(2); desc.arginfo = QCOM_SCM_ARGS(2);
ret = qcom_scm_call(dev, QCOM_SCM_SVC_PIL, QCOM_SCM_PIL_PAS_MSS_RESET, &desc, ret = qcom_scm_call(dev, &desc, &res);
&res);
return ret ? : res.a1; return ret ? : res.a1;
} }
int __qcom_scm_set_remote_state(struct device *dev, u32 state, u32 id) int __qcom_scm_set_remote_state(struct device *dev, u32 state, u32 id)
{ {
struct qcom_scm_desc desc = {0}; struct qcom_scm_desc desc = {
.svc = QCOM_SCM_SVC_BOOT,
.cmd = QCOM_SCM_BOOT_SET_REMOTE_STATE,
.owner = ARM_SMCCC_OWNER_SIP,
};
struct arm_smccc_res res; struct arm_smccc_res res;
int ret; int ret;
...@@ -431,8 +456,7 @@ int __qcom_scm_set_remote_state(struct device *dev, u32 state, u32 id) ...@@ -431,8 +456,7 @@ int __qcom_scm_set_remote_state(struct device *dev, u32 state, u32 id)
desc.args[1] = id; desc.args[1] = id;
desc.arginfo = QCOM_SCM_ARGS(2); desc.arginfo = QCOM_SCM_ARGS(2);
ret = qcom_scm_call(dev, QCOM_SCM_SVC_BOOT, QCOM_SCM_BOOT_SET_REMOTE_STATE, ret = qcom_scm_call(dev, &desc, &res);
&desc, &res);
return ret ? : res.a1; return ret ? : res.a1;
} }
...@@ -442,7 +466,11 @@ int __qcom_scm_assign_mem(struct device *dev, phys_addr_t mem_region, ...@@ -442,7 +466,11 @@ int __qcom_scm_assign_mem(struct device *dev, phys_addr_t mem_region,
phys_addr_t dest, size_t dest_sz) phys_addr_t dest, size_t dest_sz)
{ {
int ret; int ret;
struct qcom_scm_desc desc = {0}; struct qcom_scm_desc desc = {
.svc = QCOM_SCM_SVC_MP,
.cmd = QCOM_SCM_MP_ASSIGN,
.owner = ARM_SMCCC_OWNER_SIP,
};
struct arm_smccc_res res; struct arm_smccc_res res;
desc.args[0] = mem_region; desc.args[0] = mem_region;
...@@ -457,16 +485,18 @@ int __qcom_scm_assign_mem(struct device *dev, phys_addr_t mem_region, ...@@ -457,16 +485,18 @@ int __qcom_scm_assign_mem(struct device *dev, phys_addr_t mem_region,
QCOM_SCM_RO, QCOM_SCM_VAL, QCOM_SCM_RO, QCOM_SCM_RO, QCOM_SCM_VAL, QCOM_SCM_RO,
QCOM_SCM_VAL, QCOM_SCM_VAL); QCOM_SCM_VAL, QCOM_SCM_VAL);
ret = qcom_scm_call(dev, QCOM_SCM_SVC_MP, ret = qcom_scm_call(dev, &desc, &res);
QCOM_SCM_MP_ASSIGN,
&desc, &res);
return ret ? : res.a1; return ret ? : res.a1;
} }
int __qcom_scm_restore_sec_cfg(struct device *dev, u32 device_id, u32 spare) int __qcom_scm_restore_sec_cfg(struct device *dev, u32 device_id, u32 spare)
{ {
struct qcom_scm_desc desc = {0}; struct qcom_scm_desc desc = {
.svc = QCOM_SCM_SVC_MP,
.cmd = QCOM_SCM_MP_RESTORE_SEC_CFG,
.owner = ARM_SMCCC_OWNER_SIP,
};
struct arm_smccc_res res; struct arm_smccc_res res;
int ret; int ret;
...@@ -474,8 +504,7 @@ int __qcom_scm_restore_sec_cfg(struct device *dev, u32 device_id, u32 spare) ...@@ -474,8 +504,7 @@ int __qcom_scm_restore_sec_cfg(struct device *dev, u32 device_id, u32 spare)
desc.args[1] = spare; desc.args[1] = spare;
desc.arginfo = QCOM_SCM_ARGS(2); desc.arginfo = QCOM_SCM_ARGS(2);
ret = qcom_scm_call(dev, QCOM_SCM_SVC_MP, QCOM_SCM_MP_RESTORE_SEC_CFG, ret = qcom_scm_call(dev, &desc, &res);
&desc, &res);
return ret ? : res.a1; return ret ? : res.a1;
} }
...@@ -483,15 +512,18 @@ int __qcom_scm_restore_sec_cfg(struct device *dev, u32 device_id, u32 spare) ...@@ -483,15 +512,18 @@ int __qcom_scm_restore_sec_cfg(struct device *dev, u32 device_id, u32 spare)
int __qcom_scm_iommu_secure_ptbl_size(struct device *dev, u32 spare, int __qcom_scm_iommu_secure_ptbl_size(struct device *dev, u32 spare,
size_t *size) size_t *size)
{ {
struct qcom_scm_desc desc = {0}; struct qcom_scm_desc desc = {
.svc = QCOM_SCM_SVC_MP,
.cmd = QCOM_SCM_MP_IOMMU_SECURE_PTBL_SIZE,
.owner = ARM_SMCCC_OWNER_SIP,
};
struct arm_smccc_res res; struct arm_smccc_res res;
int ret; int ret;
desc.args[0] = spare; desc.args[0] = spare;
desc.arginfo = QCOM_SCM_ARGS(1); desc.arginfo = QCOM_SCM_ARGS(1);
ret = qcom_scm_call(dev, QCOM_SCM_SVC_MP, ret = qcom_scm_call(dev, &desc, &res);
QCOM_SCM_MP_IOMMU_SECURE_PTBL_SIZE, &desc, &res);
if (size) if (size)
*size = res.a1; *size = res.a1;
...@@ -502,7 +534,11 @@ int __qcom_scm_iommu_secure_ptbl_size(struct device *dev, u32 spare, ...@@ -502,7 +534,11 @@ int __qcom_scm_iommu_secure_ptbl_size(struct device *dev, u32 spare,
int __qcom_scm_iommu_secure_ptbl_init(struct device *dev, u64 addr, u32 size, int __qcom_scm_iommu_secure_ptbl_init(struct device *dev, u64 addr, u32 size,
u32 spare) u32 spare)
{ {
struct qcom_scm_desc desc = {0}; struct qcom_scm_desc desc = {
.svc = QCOM_SCM_SVC_MP,
.cmd = QCOM_SCM_MP_IOMMU_SECURE_PTBL_INIT,
.owner = ARM_SMCCC_OWNER_SIP,
};
struct arm_smccc_res res; struct arm_smccc_res res;
int ret; int ret;
...@@ -512,8 +548,7 @@ int __qcom_scm_iommu_secure_ptbl_init(struct device *dev, u64 addr, u32 size, ...@@ -512,8 +548,7 @@ int __qcom_scm_iommu_secure_ptbl_init(struct device *dev, u64 addr, u32 size,
desc.arginfo = QCOM_SCM_ARGS(3, QCOM_SCM_RW, QCOM_SCM_VAL, desc.arginfo = QCOM_SCM_ARGS(3, QCOM_SCM_RW, QCOM_SCM_VAL,
QCOM_SCM_VAL); QCOM_SCM_VAL);
ret = qcom_scm_call(dev, QCOM_SCM_SVC_MP, ret = qcom_scm_call(dev, &desc, &res);
QCOM_SCM_MP_IOMMU_SECURE_PTBL_INIT, &desc, &res);
/* the pg table has been initialized already, ignore the error */ /* the pg table has been initialized already, ignore the error */
if (ret == -EPERM) if (ret == -EPERM)
...@@ -524,29 +559,35 @@ int __qcom_scm_iommu_secure_ptbl_init(struct device *dev, u64 addr, u32 size, ...@@ -524,29 +559,35 @@ int __qcom_scm_iommu_secure_ptbl_init(struct device *dev, u64 addr, u32 size,
int __qcom_scm_set_dload_mode(struct device *dev, bool enable) int __qcom_scm_set_dload_mode(struct device *dev, bool enable)
{ {
struct qcom_scm_desc desc = {0}; struct qcom_scm_desc desc = {
.svc = QCOM_SCM_SVC_BOOT,
.cmd = QCOM_SCM_BOOT_SET_DLOAD_MODE,
.owner = ARM_SMCCC_OWNER_SIP,
};
struct arm_smccc_res res; struct arm_smccc_res res;
desc.args[0] = QCOM_SCM_BOOT_SET_DLOAD_MODE; desc.args[0] = QCOM_SCM_BOOT_SET_DLOAD_MODE;
desc.args[1] = enable ? QCOM_SCM_BOOT_SET_DLOAD_MODE : 0; desc.args[1] = enable ? QCOM_SCM_BOOT_SET_DLOAD_MODE : 0;
desc.arginfo = QCOM_SCM_ARGS(2); desc.arginfo = QCOM_SCM_ARGS(2);
return qcom_scm_call(dev, QCOM_SCM_SVC_BOOT, QCOM_SCM_BOOT_SET_DLOAD_MODE, return qcom_scm_call(dev, &desc, &res);
&desc, &res);
} }
int __qcom_scm_io_readl(struct device *dev, phys_addr_t addr, int __qcom_scm_io_readl(struct device *dev, phys_addr_t addr,
unsigned int *val) unsigned int *val)
{ {
struct qcom_scm_desc desc = {0}; struct qcom_scm_desc desc = {
.svc = QCOM_SCM_SVC_IO,
.cmd = QCOM_SCM_IO_READ,
.owner = ARM_SMCCC_OWNER_SIP,
};
struct arm_smccc_res res; struct arm_smccc_res res;
int ret; int ret;
desc.args[0] = addr; desc.args[0] = addr;
desc.arginfo = QCOM_SCM_ARGS(1); desc.arginfo = QCOM_SCM_ARGS(1);
ret = qcom_scm_call(dev, QCOM_SCM_SVC_IO, QCOM_SCM_IO_READ, ret = qcom_scm_call(dev, &desc, &res);
&desc, &res);
if (ret >= 0) if (ret >= 0)
*val = res.a1; *val = res.a1;
...@@ -555,26 +596,32 @@ int __qcom_scm_io_readl(struct device *dev, phys_addr_t addr, ...@@ -555,26 +596,32 @@ int __qcom_scm_io_readl(struct device *dev, phys_addr_t addr,
int __qcom_scm_io_writel(struct device *dev, phys_addr_t addr, unsigned int val) int __qcom_scm_io_writel(struct device *dev, phys_addr_t addr, unsigned int val)
{ {
struct qcom_scm_desc desc = {0}; struct qcom_scm_desc desc = {
.svc = QCOM_SCM_SVC_IO,
.cmd = QCOM_SCM_IO_WRITE,
.owner = ARM_SMCCC_OWNER_SIP,
};
struct arm_smccc_res res; struct arm_smccc_res res;
desc.args[0] = addr; desc.args[0] = addr;
desc.args[1] = val; desc.args[1] = val;
desc.arginfo = QCOM_SCM_ARGS(2); desc.arginfo = QCOM_SCM_ARGS(2);
return qcom_scm_call(dev, QCOM_SCM_SVC_IO, QCOM_SCM_IO_WRITE, return qcom_scm_call(dev, &desc, &res);
&desc, &res);
} }
int __qcom_scm_qsmmu500_wait_safe_toggle(struct device *dev, bool en) int __qcom_scm_qsmmu500_wait_safe_toggle(struct device *dev, bool en)
{ {
struct qcom_scm_desc desc = {0}; struct qcom_scm_desc desc = {
.svc = QCOM_SCM_SVC_SMMU_PROGRAM,
.cmd = QCOM_SCM_SMMU_CONFIG_ERRATA1,
.owner = ARM_SMCCC_OWNER_SIP,
};
struct arm_smccc_res res; struct arm_smccc_res res;
desc.args[0] = QCOM_SCM_SMMU_CONFIG_ERRATA1_CLIENT_ALL; desc.args[0] = QCOM_SCM_SMMU_CONFIG_ERRATA1_CLIENT_ALL;
desc.args[1] = en; desc.args[1] = en;
desc.arginfo = QCOM_SCM_ARGS(2); desc.arginfo = QCOM_SCM_ARGS(2);
return qcom_scm_call_atomic(dev, QCOM_SCM_SVC_SMMU_PROGRAM, return qcom_scm_call_atomic(dev, &desc, &res);
QCOM_SCM_SMMU_CONFIG_ERRATA1, &desc, &res);
} }
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment