298977887/lede
1
0
Fork 0
mirror of https://github.com/coolsnowwolf/lede.git synced 2025-04-16 14:23:38 +00:00
Code Issues Packages Projects Releases Wiki Activity
718ac376b9
lede/target/linux/qualcommax/patches-6.1/0132-ipq6018-rproc-Add-non-secure-Q6-bringup-sequence.patch
coolsnowwolf 718ac376b9 kernel: bump 6.1 to 6.1.111
2024-09-19 22:14:36 +08:00

480 lines
14 KiB
Diff
Raw Blame History

From 5b6c148bfb6c25449c59a0a87896a90f883307fd Mon Sep 17 00:00:00 2001
From: Manikanta Mylavarapu <quic_mmanikan@quicinc.com>
Date: Fri, 31 Dec 2021 17:13:59 +0530
Subject: [PATCH] ipq6018: rproc: Add non secure Q6 bringup sequence
This patch adds Q6 bring up sequence support.
Change-Id: I28eee991168034cc240d863e736ed9c766ec4f33
Signed-off-by: Manikanta Mylavarapu <quic_mmanikan@quicinc.com>
---
arch/arm64/boot/dts/qcom/ipq6018.dtsi | 20 ++-
drivers/remoteproc/qcom_q6v5_wcss.c | 235 +++++++++++++++++++++++---
2 files changed, 232 insertions(+), 23 deletions(-)
--- a/drivers/remoteproc/qcom_q6v5_wcss.c
+++ b/drivers/remoteproc/qcom_q6v5_wcss.c
@@ -12,6 +12,7 @@
#include <linux/mfd/syscon.h>
#include <linux/module.h>
#include <linux/of_address.h>
+#include <linux/of_device.h>
#include <linux/of_reserved_mem.h>
#include <linux/platform_device.h>
#include <linux/regmap.h>
@@ -27,6 +28,7 @@
/* Q6SS Register Offsets */
#define Q6SS_RESET_REG 0x014
+#define Q6SS_DBG_CFG 0x018
#define Q6SS_GFMUX_CTL_REG 0x020
#define Q6SS_PWR_CTL_REG 0x030
#define Q6SS_MEM_PWR_CTL 0x0B0
@@ -68,6 +70,7 @@
#define HALT_CHECK_MAX_LOOPS 200
#define Q6SS_XO_CBCR GENMASK(5, 3)
#define Q6SS_SLEEP_CBCR GENMASK(5, 2)
+#define Q6SS_TIMEOUT_US 1000
/* Q6SS config/status registers */
#define TCSR_GLOBAL_CFG0 0x0
@@ -78,6 +81,7 @@
#define Q6SS_RST_EVB 0x10
#define BHS_EN_REST_ACK BIT(0)
+#define WCSS_HM_RET BIT(1)
#define SSCAON_ENABLE BIT(13)
#define SSCAON_BUS_EN BIT(15)
#define SSCAON_BUS_MUX_MASK GENMASK(18, 16)
@@ -90,6 +94,8 @@
#define WCNSS_PAS_ID 6
+static const struct wcss_data wcss_ipq6018_res_init;
+
enum {
WCSS_IPQ,
WCSS_QCS404,
@@ -120,6 +126,12 @@ struct q6v5_wcss {
struct clk *qdsp6ss_core_gfmux;
struct clk *lcc_bcr_sleep;
struct clk *prng_clk;
+
+ struct clk *gcc_sys_noc_wcss_ahb_clk;
+ struct clk *gcc_q6ss_atbm_clk;
+ struct clk *gcc_q6ss_pclkdbg_clk;
+ struct clk *gcc_q6_tsctr_1to2_clk;
+
struct regulator *cx_supply;
struct qcom_sysmon *sysmon;
@@ -164,12 +176,79 @@ struct wcss_data {
bool need_auto_boot;
};
-static int q6v5_wcss_reset(struct q6v5_wcss *wcss)
+static int ipq6018_clks_prepare_enable(struct q6v5_wcss *wcss)
+{
+ int ret;
+
+ ret = clk_prepare_enable(wcss->gcc_sys_noc_wcss_ahb_clk);
+ if (ret)
+ return ret;
+
+ ret = clk_prepare_enable(wcss->gcc_q6ss_atbm_clk);
+ if (ret)
+ return ret;
+
+ ret = clk_prepare_enable(wcss->gcc_q6ss_pclkdbg_clk);
+ if (ret)
+ return ret;
+
+ ret = clk_prepare_enable(wcss->gcc_q6_tsctr_1to2_clk);
+ if (ret)
+ return ret;
+
+ return 0;
+}
+
+static void ipq6018_clks_prepare_disable(struct q6v5_wcss *wcss)
+{
+ clk_disable_unprepare(wcss->gcc_sys_noc_wcss_ahb_clk);
+ clk_disable_unprepare(wcss->gcc_q6ss_atbm_clk);
+ clk_disable_unprepare(wcss->gcc_q6ss_pclkdbg_clk);
+ clk_disable_unprepare(wcss->gcc_q6_tsctr_1to2_clk);
+}
+
+static int q6v5_wcss_reset(struct rproc *rproc)
{
int ret;
u32 val;
int i;
+ struct q6v5_wcss *wcss = rproc->priv;
+ const struct wcss_data *desc;
+
+ desc = of_device_get_match_data(wcss->dev);
+ if (desc == &wcss_ipq6018_res_init) {
+ if (desc->aon_reset_required) {
+ /* Deassert wcss aon reset */
+ ret = reset_control_deassert(wcss->wcss_aon_reset);
+ if (ret) {
+ dev_err(wcss->dev, "wcss_aon_reset failed\n");
+ return ret;
+ }
+ mdelay(1);
+ }
+
+ ret = ipq6018_clks_prepare_enable(wcss);
+ if (ret) {
+ dev_err(wcss->dev, "failed to enable clock\n");
+ return ret;
+ }
+ }
+
+ val = readl(wcss->rmb_base + SSCAON_CONFIG);
+ val |= BIT(0);
+ writel(val, wcss->rmb_base + SSCAON_CONFIG);
+ mdelay(1);
+
+ /*set CFG[18:15]=1* and clear CFG[1]=0*/
+ val = readl(wcss->rmb_base + SSCAON_CONFIG);
+ val &= ~(SSCAON_BUS_MUX_MASK | WCSS_HM_RET);
+ val |= SSCAON_BUS_EN;
+ writel(val, wcss->rmb_base + SSCAON_CONFIG);
+ mdelay(1);
+
+ writel(rproc->bootaddr >> 4, wcss->reg_base + Q6SS_RST_EVB);
+
/* Assert resets, stop core */
val = readl(wcss->reg_base + Q6SS_RESET_REG);
val |= Q6SS_CORE_ARES | Q6SS_BUS_ARES_ENABLE | Q6SS_STOP_CORE;
@@ -183,7 +262,7 @@ static int q6v5_wcss_reset(struct q6v5_w
/* Read CLKOFF bit to go low indicating CLK is enabled */
ret = readl_poll_timeout(wcss->reg_base + Q6SS_XO_CBCR,
val, !(val & BIT(31)), 1,
- HALT_CHECK_MAX_LOOPS);
+ Q6SS_TIMEOUT_US);
if (ret) {
dev_err(wcss->dev,
"xo cbcr enabling timed out (rc:%d)\n", ret);
@@ -195,7 +274,19 @@ static int q6v5_wcss_reset(struct q6v5_w
writel(val, wcss->reg_base + Q6SS_PWR_CTL_REG);
udelay(1);
+ if (desc == &wcss_ipq6018_res_init) {
+ /* 10 - Wait till BHS Reset is done */
+ ret = readl_poll_timeout(wcss->reg_base + Q6SS_BHS_STATUS,
+ val, (val & BHS_EN_REST_ACK), 1000,
+ Q6SS_TIMEOUT_US * 50);
+ if (ret) {
+ dev_err(wcss->dev, "BHS_STATUS not ON (rc:%d) val:0x%X\n", ret, val);
+ return ret;
+ }
+ }
+
/* Put LDO in bypass mode */
+ val = readl(wcss->reg_base + Q6SS_PWR_CTL_REG);
val |= Q6SS_LDO_BYP;
writel(val, wcss->reg_base + Q6SS_PWR_CTL_REG);
@@ -205,6 +296,7 @@ static int q6v5_wcss_reset(struct q6v5_w
writel(val, wcss->reg_base + Q6SS_PWR_CTL_REG);
/* Deassert memory peripheral sleep and L2 memory standby */
+ val = readl(wcss->reg_base + Q6SS_PWR_CTL_REG);
val |= Q6SS_L2DATA_STBY_N | Q6SS_SLP_RET_N;
writel(val, wcss->reg_base + Q6SS_PWR_CTL_REG);
@@ -219,7 +311,10 @@ static int q6v5_wcss_reset(struct q6v5_w
* array to turn on.
*/
val |= readl(wcss->reg_base + Q6SS_MEM_PWR_CTL);
- udelay(1);
+ if (desc == &wcss_ipq6018_res_init)
+ mdelay(10);
+ else
+ udelay(1);
}
/* Remove word line clamp */
val = readl(wcss->reg_base + Q6SS_PWR_CTL_REG);
@@ -245,6 +340,16 @@ static int q6v5_wcss_reset(struct q6v5_w
val &= ~Q6SS_STOP_CORE;
writel(val, wcss->reg_base + Q6SS_RESET_REG);
+ /* Wait for SSCAON_STATUS */
+ val = readl(wcss->rmb_base + SSCAON_STATUS);
+ ret = readl_poll_timeout(wcss->rmb_base + SSCAON_STATUS,
+ val, (val & 0xffff) == 0x10, 1000,
+ Q6SS_TIMEOUT_US * 1000);
+ if (ret) {
+ dev_err(wcss->dev, " Boot Error, SSCAON=0x%08X\n", val);
+ return ret;
+ }
+
return 0;
}
@@ -300,7 +405,7 @@ static int q6v5_wcss_start(struct rproc
/* Write bootaddr to EVB so that Q6WCSS will jump there after reset */
writel(rproc->bootaddr >> 4, wcss->reg_base + Q6SS_RST_EVB);
- ret = q6v5_wcss_reset(wcss);
+ ret = q6v5_wcss_reset(rproc);
if (ret)
goto wcss_q6_reset;
@@ -526,16 +631,21 @@ static void q6v5_wcss_halt_axi_port(stru
struct regmap *halt_map,
u32 offset)
{
+ const struct wcss_data *desc = of_device_get_match_data(wcss->dev);
unsigned long timeout;
unsigned int val;
int ret;
- /* Check if we're already idle */
- ret = regmap_read(halt_map, offset + AXI_IDLE_REG, &val);
- if (!ret && val)
- return;
+ if (desc != &wcss_ipq6018_res_init) {
+ /* Check if we're already idle */
+ ret = regmap_read(halt_map, offset + AXI_IDLE_REG, &val);
+ if (!ret && val)
+ return;
+ }
/* Assert halt request */
+ regmap_read(halt_map, offset + AXI_HALTREQ_REG, &val);
+ val |= BIT(0);
regmap_write(halt_map, offset + AXI_HALTREQ_REG, 1);
/* Wait for halt */
@@ -548,12 +658,14 @@ static void q6v5_wcss_halt_axi_port(stru
msleep(1);
}
- ret = regmap_read(halt_map, offset + AXI_IDLE_REG, &val);
- if (ret || !val)
- dev_err(wcss->dev, "port failed halt\n");
+ if (desc != &wcss_ipq6018_res_init) {
+ ret = regmap_read(halt_map, offset + AXI_IDLE_REG, &val);
+ if (ret || !val)
+ dev_err(wcss->dev, "port failed halt\n");
- /* Clear halt request (port will remain halted until reset) */
- regmap_write(halt_map, offset + AXI_HALTREQ_REG, 0);
+ /* Clear halt request (port will remain halted until reset) */
+ regmap_write(halt_map, offset + AXI_HALTREQ_REG, 0);
+ }
}
static int q6v5_qcs404_wcss_shutdown(struct q6v5_wcss *wcss)
@@ -622,6 +734,7 @@ static int q6v5_qcs404_wcss_shutdown(str
static int q6v5_wcss_powerdown(struct q6v5_wcss *wcss)
{
+ const struct wcss_data *desc = of_device_get_match_data(wcss->dev);
int ret;
u32 val;
@@ -639,13 +752,14 @@ static int q6v5_wcss_powerdown(struct q6
writel(val, wcss->rmb_base + SSCAON_CONFIG);
/* 4 - SSCAON_CONFIG 1 */
+ val = readl(wcss->rmb_base + SSCAON_CONFIG);
val |= BIT(1);
writel(val, wcss->rmb_base + SSCAON_CONFIG);
/* 5 - wait for SSCAON_STATUS */
ret = readl_poll_timeout(wcss->rmb_base + SSCAON_STATUS,
val, (val & 0xffff) == 0x400, 1000,
- HALT_CHECK_MAX_LOOPS);
+ Q6SS_TIMEOUT_US * 10);
if (ret) {
dev_err(wcss->dev,
"can't get SSCAON_STATUS rc:%d)\n", ret);
@@ -654,6 +768,8 @@ static int q6v5_wcss_powerdown(struct q6
/* 6 - De-assert WCSS_AON reset */
reset_control_assert(wcss->wcss_aon_reset);
+ if (desc == &wcss_ipq6018_res_init)
+ mdelay(1);
/* 7 - Disable WCSSAON_CONFIG 13 */
val = readl(wcss->rmb_base + SSCAON_CONFIG);
@@ -663,15 +779,28 @@ static int q6v5_wcss_powerdown(struct q6
/* 8 - De-assert WCSS/Q6 HALTREQ */
reset_control_assert(wcss->wcss_reset);
+ if (desc == &wcss_ipq6018_res_init) {
+ /* Clear halt request (port will remain halted until reset) */
+ regmap_read(wcss->halt_map, wcss->halt_wcss + AXI_HALTREQ_REG, &val);
+ val &= ~0x1;
+ regmap_write(wcss->halt_map, wcss->halt_wcss + AXI_HALTREQ_REG, val);
+ }
+
return 0;
}
static int q6v5_q6_powerdown(struct q6v5_wcss *wcss)
{
+ const struct wcss_data *desc = of_device_get_match_data(wcss->dev);
int ret;
u32 val;
int i;
+ if (desc == &wcss_ipq6018_res_init) {
+ /* To retain power domain after q6 powerdown */
+ writel(0x1, wcss->reg_base + Q6SS_DBG_CFG);
+ }
+
/* 1 - Halt Q6 bus interface */
q6v5_wcss_halt_axi_port(wcss, wcss->halt_map, wcss->halt_q6);
@@ -686,14 +815,17 @@ static int q6v5_q6_powerdown(struct q6v5
writel(val, wcss->reg_base + Q6SS_PWR_CTL_REG);
/* 4 - Clamp WL */
+ val = readl(wcss->reg_base + Q6SS_PWR_CTL_REG);
val |= QDSS_BHS_ON;
writel(val, wcss->reg_base + Q6SS_PWR_CTL_REG);
/* 5 - Clear Erase standby */
+ val = readl(wcss->reg_base + Q6SS_PWR_CTL_REG);
val &= ~Q6SS_L2DATA_STBY_N;
writel(val, wcss->reg_base + Q6SS_PWR_CTL_REG);
/* 6 - Clear Sleep RTN */
+ val = readl(wcss->reg_base + Q6SS_PWR_CTL_REG);
val &= ~Q6SS_SLP_RET_N;
writel(val, wcss->reg_base + Q6SS_PWR_CTL_REG);
@@ -711,6 +843,7 @@ static int q6v5_q6_powerdown(struct q6v5
writel(val, wcss->reg_base + Q6SS_PWR_CTL_REG);
/* 9 - Turn off BHS */
+ val = readl(wcss->reg_base + Q6SS_PWR_CTL_REG);
val &= ~Q6SS_BHS_ON;
writel(val, wcss->reg_base + Q6SS_PWR_CTL_REG);
udelay(1);
@@ -718,7 +851,7 @@ static int q6v5_q6_powerdown(struct q6v5
/* 10 - Wait till BHS Reset is done */
ret = readl_poll_timeout(wcss->reg_base + Q6SS_BHS_STATUS,
val, !(val & BHS_EN_REST_ACK), 1000,
- HALT_CHECK_MAX_LOOPS);
+ Q6SS_TIMEOUT_US * 10);
if (ret) {
dev_err(wcss->dev, "BHS_STATUS not OFF (rc:%d)\n", ret);
return ret;
@@ -726,9 +859,23 @@ static int q6v5_q6_powerdown(struct q6v5
/* 11 - Assert WCSS reset */
reset_control_assert(wcss->wcss_reset);
+ if (desc == &wcss_ipq6018_res_init)
+ mdelay(1);
/* 12 - Assert Q6 reset */
reset_control_assert(wcss->wcss_q6_reset);
+ if (desc == &wcss_ipq6018_res_init) {
+ mdelay(2);
+
+ /* Clear halt request (port will remain halted until reset) */
+ regmap_read(wcss->halt_map, wcss->halt_q6 + AXI_HALTREQ_REG, &val);
+ val &= ~0x1;
+ regmap_write(wcss->halt_map, wcss->halt_q6 + AXI_HALTREQ_REG, val);
+ mdelay(1);
+
+ /* Disable clocks*/
+ ipq6018_clks_prepare_disable(wcss);
+ }
return 0;
}
@@ -984,6 +1131,57 @@ static int ipq8074_init_clock(struct q6v
return 0;
}
+static int ipq6018_init_clock(struct q6v5_wcss *wcss)
+{
+ int ret;
+
+ wcss->prng_clk = devm_clk_get(wcss->dev, "prng");
+ if (IS_ERR(wcss->prng_clk)) {
+ ret = PTR_ERR(wcss->prng_clk);
+ if (ret != -EPROBE_DEFER)
+ dev_err(wcss->dev, "Failed to get prng clock\n");
+ return ret;
+ }
+
+ wcss->gcc_sys_noc_wcss_ahb_clk =
+ devm_clk_get(wcss->dev, "gcc_sys_noc_wcss_ahb_clk");
+ if (IS_ERR(wcss->gcc_sys_noc_wcss_ahb_clk)) {
+ ret = PTR_ERR(wcss->gcc_sys_noc_wcss_ahb_clk);
+ if (ret != -EPROBE_DEFER)
+ dev_err(wcss->dev, "Failed to get sys_noc_wcss_ahb clock\n");
+ return ret;
+ }
+
+ wcss->gcc_q6ss_atbm_clk =
+ devm_clk_get(wcss->dev, "gcc_q6ss_atbm_clk");
+ if (IS_ERR(wcss->gcc_q6ss_atbm_clk)) {
+ ret = PTR_ERR(wcss->gcc_q6ss_atbm_clk);
+ if (ret != -EPROBE_DEFER)
+ dev_err(wcss->dev, "Failed to get q6ss_atbm clock\n");
+ return ret;
+ }
+
+ wcss->gcc_q6ss_pclkdbg_clk =
+ devm_clk_get(wcss->dev, "gcc_q6ss_pclkdbg_clk");
+ if (IS_ERR(wcss->gcc_q6ss_pclkdbg_clk)) {
+ ret = PTR_ERR(wcss->gcc_q6ss_pclkdbg_clk);
+ if (ret != -EPROBE_DEFER)
+ dev_err(wcss->dev, "Failed to get q6ss_pclkdbg clock\n");
+ return ret;
+ }
+
+ wcss->gcc_q6_tsctr_1to2_clk =
+ devm_clk_get(wcss->dev, "gcc_q6_tsctr_1to2_clk");
+ if (IS_ERR(wcss->gcc_q6_tsctr_1to2_clk)) {
+ ret = PTR_ERR(wcss->gcc_q6_tsctr_1to2_clk);
+ if (ret != -EPROBE_DEFER)
+ dev_err(wcss->dev, "Failed to get q6_tsctr_1to2 clock\n");
+ return ret;
+ }
+
+ return 0;
+}
+
static int qcs404_init_clock(struct q6v5_wcss *wcss)
{
int ret;
@@ -1115,6 +1313,9 @@ static int q6v5_wcss_probe(struct platfo
wcss->need_mem_protection = desc->need_mem_protection;
wcss->m3_firmware_name = desc->m3_firmware_name;
+ if (of_property_read_bool(pdev->dev.of_node, "qcom,nosecure"))
+ wcss->need_mem_protection = false;
+
ret = q6v5_wcss_init_mmio(wcss, pdev);
if (ret)
goto free_rproc;
@@ -1194,7 +1395,7 @@ static const struct wcss_data wcss_ipq80
};
static const struct wcss_data wcss_ipq6018_res_init = {
- .init_clock = ipq8074_init_clock,
+ .init_clock = ipq6018_init_clock,
.q6_firmware_name = "IPQ6018/q6_fw.mdt",
.m3_firmware_name = "IPQ6018/m3_fw.mdt",
.crash_reason_smem = WCSS_CRASH_REASON,
@@ -1203,7 +1404,7 @@ static const struct wcss_data wcss_ipq60
.bcr_reset_required = false,
.ssr_name = "q6wcss",
.ops = &q6v5_wcss_ipq8074_ops,
- .requires_force_stop = true,
+ .requires_force_stop = false,
.need_mem_protection = true,
.need_auto_boot = false,
};
Reference in New Issue View Git Blame Copy Permalink