From: George Moussalem <[email protected]> The Bluetooth subsystem (BTSS) on the IPQ5018 SoC supports setting power modes which are required to be configured through a Secure Channel Manager (SCM) call to TrustZone. However, not all Trusted Execution Environment (QSEE) images support this call, so first check if the call is available.
Signed-off-by: George Moussalem <[email protected]> --- drivers/firmware/qcom/qcom_scm.c | 49 ++++++++++++++++++++++++++++++++++ drivers/firmware/qcom/qcom_scm.h | 1 + include/linux/firmware/qcom/qcom_scm.h | 1 + 3 files changed, 51 insertions(+) diff --git a/drivers/firmware/qcom/qcom_scm.c b/drivers/firmware/qcom/qcom_scm.c index 6b601a4b89db..e26f54e5033b 100644 --- a/drivers/firmware/qcom/qcom_scm.c +++ b/drivers/firmware/qcom/qcom_scm.c @@ -1094,6 +1094,55 @@ bool qcom_scm_pas_supported(u32 pas_id) } EXPORT_SYMBOL_GPL(qcom_scm_pas_supported); +static int __qcom_scm_pas_set_bluetooth_power_mode(u32 pas_id, u32 val) +{ + struct qcom_scm_desc desc = { + .svc = QCOM_SCM_SVC_PIL, + .cmd = QCOM_SCM_PIL_PAS_BT_PWR_MODE, + .arginfo = QCOM_SCM_ARGS(2), + .args[0] = pas_id, + .args[1] = val, + .owner = ARM_SMCCC_OWNER_SIP, + }; + struct qcom_scm_res res; + int ret; + + ret = qcom_scm_clk_enable(); + if (ret) + return ret; + + ret = qcom_scm_bw_enable(); + if (ret) + goto disable_clk; + + ret = qcom_scm_call(__scm->dev, &desc, &res); + qcom_scm_bw_disable(); + +disable_clk: + qcom_scm_clk_disable(); + + return ret ? : res.result[0]; +} + +/** + * qcom_scm_pas_set_bluetooth_power_mode() - Configure power optimization mode + * for the Bluetooth subsystem (BTSS) + * @pas_id: peripheral authentication service id + * @val: 0x0 for normal operation, 0x4 for ECO mode + * + * Return: 0 on success, negative errno on failure. + * Returns -EOPNOTSUPP if the firmware configuration call is unavailable. + */ +int qcom_scm_pas_set_bluetooth_power_mode(u32 pas_id, u32 val) +{ + if (!__qcom_scm_is_call_available(__scm->dev, QCOM_SCM_SVC_PIL, + QCOM_SCM_PIL_PAS_BT_PWR_MODE)) + return -EOPNOTSUPP; + + return __qcom_scm_pas_set_bluetooth_power_mode(pas_id, val); +} +EXPORT_SYMBOL_GPL(qcom_scm_pas_set_bluetooth_power_mode); + static int __qcom_scm_pas_mss_reset(struct device *dev, bool reset) { struct qcom_scm_desc desc = { diff --git a/drivers/firmware/qcom/qcom_scm.h b/drivers/firmware/qcom/qcom_scm.h index caab80a73e17..5579df5a2aca 100644 --- a/drivers/firmware/qcom/qcom_scm.h +++ b/drivers/firmware/qcom/qcom_scm.h @@ -105,6 +105,7 @@ int qcom_scm_shm_bridge_enable(struct device *scm_dev); #define QCOM_SCM_PIL_PAS_SHUTDOWN 0x06 #define QCOM_SCM_PIL_PAS_IS_SUPPORTED 0x07 #define QCOM_SCM_PIL_PAS_MSS_RESET 0x0a +#define QCOM_SCM_PIL_PAS_BT_PWR_MODE 0x21 #define QCOM_SCM_PIL_PAS_GET_RSCTABLE 0x21 #define QCOM_SCM_SVC_IO 0x05 diff --git a/include/linux/firmware/qcom/qcom_scm.h b/include/linux/firmware/qcom/qcom_scm.h index 5747bd191bf1..76de4b69580b 100644 --- a/include/linux/firmware/qcom/qcom_scm.h +++ b/include/linux/firmware/qcom/qcom_scm.h @@ -93,6 +93,7 @@ struct resource_table *qcom_scm_pas_get_rsc_table(struct qcom_scm_pas_context *c size_t *output_rt_size); int qcom_scm_pas_prepare_and_auth_reset(struct qcom_scm_pas_context *ctx); +int qcom_scm_pas_set_bluetooth_power_mode(u32 pas_id, u32 val); int qcom_scm_io_readl(phys_addr_t addr, unsigned int *val); int qcom_scm_io_writel(phys_addr_t addr, unsigned int val); -- 2.53.0
