According to usage (bitfields.h) of REG_FIELDS,
Modify is:
  reg &= ~REG_FIELD_C;
  reg |= FIELD_PREP(REG_FIELD_C, c);

Patch ("soundwire: qcom : use FIELD_{GET|PREP}") seems to have
accidentally removed clearing bit field while modifying the register.

Fix this by using u32_replace_bits() to clear and set the values.

Signed-off-by: Srinivas Kandagatla <[email protected]>
---
 drivers/soundwire/qcom.c | 6 +++---
 1 file changed, 3 insertions(+), 3 deletions(-)

diff --git a/drivers/soundwire/qcom.c b/drivers/soundwire/qcom.c
index d7aabdaffee3..0036d3248fb4 100644
--- a/drivers/soundwire/qcom.c
+++ b/drivers/soundwire/qcom.c
@@ -311,7 +311,7 @@ static int qcom_swrm_init(struct qcom_swrm_ctrl *ctrl)
 
        /* Configure No pings */
        ctrl->reg_read(ctrl, SWRM_MCP_CFG_ADDR, &val);
-       val |= FIELD_PREP(SWRM_MCP_CFG_MAX_NUM_OF_CMD_NO_PINGS_BMSK, 
SWRM_DEF_CMD_NO_PINGS);
+       val = u32_replace_bits(val, SWRM_DEF_CMD_NO_PINGS, 
SWRM_MCP_CFG_MAX_NUM_OF_CMD_NO_PINGS_BMSK);
        ctrl->reg_write(ctrl, SWRM_MCP_CFG_ADDR, val);
 
        /* Configure number of retries of a read/write cmd */
@@ -372,8 +372,8 @@ static int qcom_swrm_pre_bank_switch(struct sdw_bus *bus)
 
        ctrl->reg_read(ctrl, reg, &val);
 
-       val |= FIELD_PREP(SWRM_MCP_FRAME_CTRL_BANK_COL_CTRL_BMSK, 
SWRM_MAX_COL_VAL);
-       val |= FIELD_PREP(SWRM_MCP_FRAME_CTRL_BANK_ROW_CTRL_BMSK, 
SWRM_MAX_ROW_VAL);
+       val = u32_replace_bits(val, SWRM_MAX_COL_VAL, 
SWRM_MCP_FRAME_CTRL_BANK_COL_CTRL_BMSK);
+       val = u32_replace_bits(val, SWRM_MAX_ROW_VAL, 
SWRM_MCP_FRAME_CTRL_BANK_ROW_CTRL_BMSK);
 
        return ctrl->reg_write(ctrl, reg, val);
 }
-- 
2.21.0

Reply via email to