mirror of
https://github.com/openwrt/openwrt.git
synced 2024-12-23 07:22:33 +00:00
61 lines
1.8 KiB
Diff
61 lines
1.8 KiB
Diff
|
From b514bc3c0a5a57bc83843dc66c72788b9c9435ac Mon Sep 17 00:00:00 2001
|
||
|
From: Robert Marko <robimarko@gmail.com>
|
||
|
Date: Thu, 18 May 2023 16:02:23 +0200
|
||
|
Subject: [PATCH 1/3] firmware: qcom: scm: Add SDI disable support
|
||
|
|
||
|
Some SoC-s like IPQ5018 require SDI(Secure Debug Image) to be disabled
|
||
|
before trying to reboot, otherwise board will just hang after reboot has
|
||
|
been issued via PSCI.
|
||
|
|
||
|
So, provide a call to SCM that allows disabling it.
|
||
|
|
||
|
Signed-off-by: Robert Marko <robimarko@gmail.com>
|
||
|
Acked-by: Mukesh Ojha <quic_mojha@quicinc.com>
|
||
|
---
|
||
|
drivers/firmware/qcom_scm.c | 23 +++++++++++++++++++++++
|
||
|
drivers/firmware/qcom_scm.h | 1 +
|
||
|
2 files changed, 24 insertions(+)
|
||
|
|
||
|
--- a/drivers/firmware/qcom_scm.c
|
||
|
+++ b/drivers/firmware/qcom_scm.c
|
||
|
@@ -389,6 +389,29 @@ int qcom_scm_set_remote_state(u32 state,
|
||
|
}
|
||
|
EXPORT_SYMBOL(qcom_scm_set_remote_state);
|
||
|
|
||
|
+static int qcom_scm_disable_sdi(void)
|
||
|
+{
|
||
|
+ int ret;
|
||
|
+ struct qcom_scm_desc desc = {
|
||
|
+ .svc = QCOM_SCM_SVC_BOOT,
|
||
|
+ .cmd = QCOM_SCM_BOOT_SDI_CONFIG,
|
||
|
+ .args[0] = 1, /* Disable watchdog debug */
|
||
|
+ .args[1] = 0, /* Disable SDI */
|
||
|
+ .arginfo = QCOM_SCM_ARGS(2),
|
||
|
+ .owner = ARM_SMCCC_OWNER_SIP,
|
||
|
+ };
|
||
|
+ struct qcom_scm_res res;
|
||
|
+
|
||
|
+ ret = qcom_scm_clk_enable();
|
||
|
+ if (ret)
|
||
|
+ return ret;
|
||
|
+ ret = qcom_scm_call(__scm->dev, &desc, &res);
|
||
|
+
|
||
|
+ qcom_scm_clk_disable();
|
||
|
+
|
||
|
+ return ret ? : res.result[0];
|
||
|
+}
|
||
|
+
|
||
|
static int __qcom_scm_set_dload_mode(struct device *dev, bool enable)
|
||
|
{
|
||
|
struct qcom_scm_desc desc = {
|
||
|
--- a/drivers/firmware/qcom_scm.h
|
||
|
+++ b/drivers/firmware/qcom_scm.h
|
||
|
@@ -77,6 +77,7 @@ extern int scm_legacy_call(struct device
|
||
|
#define QCOM_SCM_SVC_BOOT 0x01
|
||
|
#define QCOM_SCM_BOOT_SET_ADDR 0x01
|
||
|
#define QCOM_SCM_BOOT_TERMINATE_PC 0x02
|
||
|
+#define QCOM_SCM_BOOT_SDI_CONFIG 0x09
|
||
|
#define QCOM_SCM_BOOT_SET_DLOAD_MODE 0x10
|
||
|
#define QCOM_SCM_BOOT_SET_REMOTE_STATE 0x0a
|
||
|
#define QCOM_SCM_FLUSH_FLAG_MASK 0x3
|