remoteproc: qcom: Add efuse evb selection control

Add efuse evb selection control and enable it for starting ADSP.

Signed-off-by: Srinivasa Rao Mandadapu <quic_srivasam@quicinc.com>
Reviewed-by: Stephen Boyd <swboyd@chromium.org>
Reviewed-by: Sibi Sankar <quic_sibis@quicinc.com>
Signed-off-by: Bjorn Andersson <andersson@kernel.org>
Link: https://lore.kernel.org/r/1664368073-13659-7-git-send-email-quic_srivasam@quicinc.com

diff --git a/drivers/remoteproc/qcom_q6v5_adsp.c b/drivers/remoteproc/qcom_q6v5_adsp.c
index 14c94af..4e70e76 100644 (file)
--- a/drivers/remoteproc/qcom_q6v5_adsp.c
+++ b/drivers/remoteproc/qcom_q6v5_adsp.c
@@ -56,6 +56,7 @@
 
 #define LPASS_BOOT_CORE_START  BIT(0)
 #define LPASS_BOOT_CMD_START   BIT(0)
+#define LPASS_EFUSE_Q6SS_EVB_SEL 0x0
 
 struct adsp_pil_data {
        int crash_reason_smem;
@@ -86,6 +87,7 @@ struct qcom_adsp {
        struct clk_bulk_data *clks;
 
        void __iomem *qdsp6ss_base;
+       void __iomem *lpass_efuse;
 
        struct reset_control *pdc_sync_reset;
        struct reset_control *restart;
@@ -367,6 +369,9 @@ static int adsp_start(struct rproc *rproc)
        /* Program boot address */
        writel(adsp->mem_phys >> 4, adsp->qdsp6ss_base + RST_EVB_REG);
 
+       if (adsp->lpass_efuse)
+               writel(LPASS_EFUSE_Q6SS_EVB_SEL, adsp->lpass_efuse);
+
        /* De-assert QDSP6 stop core. QDSP6 will execute after out of reset */
        writel(LPASS_BOOT_CORE_START, adsp->qdsp6ss_base + CORE_START_REG);
 
@@ -533,6 +538,7 @@ static int adsp_init_reset(struct qcom_adsp *adsp)
 static int adsp_init_mmio(struct qcom_adsp *adsp,
                                struct platform_device *pdev)
 {
+       struct resource *efuse_region;
        struct device_node *syscon;
        int ret;
 
@@ -542,6 +548,17 @@ static int adsp_init_mmio(struct qcom_adsp *adsp,
                return PTR_ERR(adsp->qdsp6ss_base);
        }
 
+       efuse_region = platform_get_resource(pdev, IORESOURCE_MEM, 1);
+       if (!efuse_region) {
+               adsp->lpass_efuse = NULL;
+               dev_dbg(adsp->dev, "failed to get efuse memory region\n");
+       } else {
+               adsp->lpass_efuse = devm_ioremap_resource(&pdev->dev, efuse_region);
+               if (IS_ERR(adsp->lpass_efuse)) {
+                       dev_err(adsp->dev, "failed to map efuse registers\n");
+                       return PTR_ERR(adsp->lpass_efuse);
+               }
+       }
        syscon = of_parse_phandle(pdev->dev.of_node, "qcom,halt-regs", 0);
        if (!syscon) {
                dev_err(&pdev->dev, "failed to parse qcom,halt-regs\n");