samsung-sm8650/android_kernel_samsung_sm8650-modules
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

soc: add support for swr version 1p7

Browse Source 
-add support for swr version 1p7.
-Return 0 instead of EBUSY during swrm_suspend to
allow system to enter suspend without rx swrm
preventing it.
- Update proper reg value during pcm port config.

Change-Id: Id42d3625a0609507fffc92b650cfae92b0e1dc4f
Signed-off-by: Sarath Varma Ganapathiraju <quic_ganavarm@quicinc.com>
This commit is contained in:
Sarath Varma Ganapathiraju
2024-03-05 23:55:20 +05:30
parent ddbe2ef0da
commit b58f10f76f
5 changed files with 123 additions and 18 deletions
Download Patch File Download Diff File Expand all files Collapse all files

75
soc/swr-mstr-ctrl.c
View File

@@ -786,15 +786,44 @@ static int swrm_pcm_port_config(struct swr_mstr_ctrl *swrm, u8 port_num,
return -EINVAL;
}
if (stream_type == SWR_PDM)
switch (stream_type) {
case SWR_PCM:
case SWR_PDM_32:
if (swrm->version != SWRM_VERSION_1_7) {
if (dir)
reg_addr = SWRM_DIN_DP_PCM_PORT_CTRL(port_num);
else
reg_addr = SWRM_DOUT_DP_PCM_PORT_CTRL(port_num);
reg_val = enable ? 0x3 : 0x0;
swr_master_write(swrm, reg_addr, reg_val);
} else if (stream_type == SWR_PCM) {
if (dir)
reg_addr = SWRM_DIN_DP_PCM_PORT_CTRL(port_num);
else
reg_addr = SWRM_DOUT_DP_PCM_PORT_CTRL(port_num);
swr_master_write(swrm, reg_addr, enable);
}
break;
case SWR_PDM:
default:
return 0;
}
if (swrm->version == SWRM_VERSION_1_7) {
reg_val = SWRM_COMP_FEATURE_CFG_DEFAULT_VAL_V1P7;
reg_addr = ((dir) ? SWRM_DIN_DP_PCM_PORT_CTRL(port_num) : \
SWRM_DOUT_DP_PCM_PORT_CTRL(port_num));
reg_val = enable ? 0x3 : 0x0;
swr_master_write(swrm, reg_addr, reg_val);
dev_dbg(swrm->dev, "%s : pcm port %s, reg_val = %d, for addr %x\n",
__func__, enable ? "Enabled" : "disabled", reg_val, reg_addr);
if (enable) {
if (swrm->pcm_enable_count == 0) {
reg_val |= SWRM_COMP_FEATURE_CFG_PCM_EN_MASK;
swr_master_write(swrm, SWRM_COMP_FEATURE_CFG, reg_val);
}
swrm->pcm_enable_count++;
} else {
if (swrm->pcm_enable_count > 0)
swrm->pcm_enable_count--;
if (swrm->pcm_enable_count == 0)
swr_master_write(swrm, SWRM_COMP_FEATURE_CFG, reg_val);
}
}
return 0;
}
@@ -1692,6 +1721,8 @@ static int swrm_slvdev_datapath_control(struct swr_master *master, bool enable)
}
clear_bit(DISABLE_PENDING, &swrm->port_req_pending);
swrm_cleanup_disabled_port_reqs(master);
/* reset enable_count to 0 in SSR if master is already down */
swrm->pcm_enable_count = 0;
if (!swrm_is_port_en(master)) {
dev_dbg(&master->dev, "%s: pm_runtime auto suspend triggered\n",
__func__);
@@ -2273,6 +2304,7 @@ handle_irq:
swrm->clk_stop_wakeup = false;
}
break;
#ifdef CONFIG_SWRM_VER_2P0
case SWRM_INTERRUPT_STATUS_CMD_IGNORED_AND_EXEC_CONTINUED:
value = swr_master_read(swrm, SWRM_CMD_FIFO_STATUS(swrm->ee_val));
dev_err_ratelimited(swrm->dev,
@@ -2281,6 +2313,7 @@ handle_irq:
/* Wait 3.5ms to clear */
usleep_range(3500, 3505);
break;
#endif
case SWRM_INTERRUPT_STATUS_DOUT_RATE_MISMATCH:
dev_err(swrm->dev,
"%s: SWR Port Channel rate mismatch\n", __func__);
@@ -2616,6 +2649,14 @@ static int swrm_master_init(struct swr_mstr_ctrl *swrm)
value[len++] = 0x01;
#endif
#ifdef CONFIG_SWRM_VER_1P7
reg[len] = SWRM_MCP_BUS_CTRL;
if (swrm->version < SWRM_VERSION_1_7)
value[len++] = 0x2;
else
value[len++] = 0x2 << swrm->ee_val;
#endif
/* Set IRQ to PULSE */
reg[len] = SWRM_COMP_CFG;
value[len++] = 0x02;
@@ -2830,7 +2871,7 @@ static int swrm_probe(struct platform_device *pdev)
dev_err(swrm->dev, "missing port mapping\n");
goto err_pdata_fail;
}
swrm->pcm_enable_count = 0;
map_length = map_size / (3 * sizeof(u32));
if (num_ports > SWR_MSTR_PORT_LEN) {
dev_err(&pdev->dev, "%s:invalid number of swr ports\n",
@@ -3034,10 +3075,12 @@ static int swrm_probe(struct platform_device *pdev)
& SWRM_COMP_PARAMS_WR_FIFO_DEPTH) >> 10);
swrm_hw_ver = swr_master_read(swrm, SWRM_COMP_HW_VERSION);
if (swrm->version != swrm_hw_ver)
if (swrm->version != swrm_hw_ver) {
dev_info(&pdev->dev,
"%s: version specified in dtsi: 0x%x not match with HW read version 0x%x\n",
__func__, swrm->version, swrm_hw_ver);
swrm->version = swrm_hw_ver;
}
swrm->num_auto_enum = ((swr_master_read(swrm, SWRM_COMP_PARAMS)
& SWRM_COMP_PARAMS_AUTO_ENUM_SLAVES) >> 20);
@@ -3197,7 +3240,7 @@ static int swrm_runtime_resume(struct device *dev)
{
struct platform_device *pdev = to_platform_device(dev);
struct swr_mstr_ctrl *swrm = platform_get_drvdata(pdev);
int ret = 0;
int ret = 0, val = 0;
bool swrm_clk_req_err = false;
bool hw_core_err = false, aud_core_err = false;
struct swr_master *mstr = &swrm->master;
@@ -3301,10 +3344,16 @@ static int swrm_runtime_resume(struct device *dev)
}
/*wake up from clock stop*/
#ifdef CONFIG_SWRM_VER_2P0
val = 0x01;
swr_master_write(swrm,
SWRM_CLK_CTRL(swrm->ee_val), 0x01);
SWRM_CLK_CTRL(swrm->ee_val), val);
#else
swr_master_write(swrm, SWRM_MCP_BUS_CTRL, 0x2);
if (swrm->version < SWRM_VERSION_1_7)
val = 0x2;
else
val = 0x2 << swrm->ee_val;
swr_master_write(swrm, SWRM_MCP_BUS_CTRL, val);
#endif
/* clear and enable bus clash interrupt */
swr_master_write(swrm,
@@ -3983,7 +4032,7 @@ static int swrm_suspend(struct device *dev)
dev_dbg(swrm->dev, "%s: suspend failed state %d, wlock %d\n",
__func__, swrm->pm_state,
swrm->wlock_holders);
return -EBUSY;
return 0;
} else {
dev_dbg(swrm->dev,
"%s: done, state %d, wlock %d\n",