diff --git a/soc/swr-mstr-ctrl.c b/soc/swr-mstr-ctrl.c index f9dbc24af097..8d82ff1ec775 100644 --- a/soc/swr-mstr-ctrl.c +++ b/soc/swr-mstr-ctrl.c @@ -448,11 +448,16 @@ static int swrm_cmd_fifo_rd_cmd(struct swr_mstr_ctrl *swrm, int *cmd_data, mutex_lock(&swrm->iolock); val = swrm_get_packed_reg_val(&swrm->rcmd_id, len, dev_addr, reg_addr); - /* wait for FIFO RD to complete to avoid overflow */ - usleep_range(100, 105); - swr_master_write(swrm, SWRM_CMD_FIFO_RD_CMD, val); - /* wait for FIFO RD CMD complete to avoid overflow */ - usleep_range(250, 255); + if (swrm->read) { + /* skip delay if read is handled in platform driver */ + swr_master_write(swrm, SWRM_CMD_FIFO_RD_CMD, val); + } else { + /* wait for FIFO RD to complete to avoid overflow */ + usleep_range(100, 105); + swr_master_write(swrm, SWRM_CMD_FIFO_RD_CMD, val); + /* wait for FIFO RD CMD complete to avoid overflow */ + usleep_range(250, 255); + } retry_read: *cmd_data = swr_master_read(swrm, SWRM_CMD_FIFO_RD_FIFO_ADDR); dev_dbg(swrm->dev, "%s: reg: 0x%x, cmd_id: 0x%x, rcmd_id: 0x%x, \ @@ -496,8 +501,12 @@ static int swrm_cmd_fifo_wr_cmd(struct swr_mstr_ctrl *swrm, u8 cmd_data, dev_num: 0x%x, cmd_data: 0x%x\n", __func__, reg_addr, cmd_id, swrm->wcmd_id,dev_addr, cmd_data); swr_master_write(swrm, SWRM_CMD_FIFO_WR_CMD, val); - /* wait for FIFO WR command to complete to avoid overflow */ - usleep_range(250, 255); + /* + * wait for FIFO WR command to complete to avoid overflow + * skip delay if write is handled in platform driver. + */ + if(!swrm->write) + usleep_range(250, 255); if (cmd_id == 0xF) { /* * sleep for 10ms for MSM soundwire variant to allow broadcast