On 14/02/23 11:26, Mukunda,Vijendar wrote: > On 13/02/23 23:45, Pierre-Louis Bossart wrote: >> On 2/13/23 03:40, Vijendar Mukunda wrote: >>> Add support for handling soundwire manager interrupts. >> Try using the MIPI spelling: SoundWire > Will fix it. >>> Signed-off-by: Vijendar Mukunda <Vijendar.Mukunda@xxxxxxx> >>> Signed-off-by: Mastan Katragadda <Mastan.Katragadda@xxxxxxx> >>> --- >>> drivers/soundwire/amd_manager.c | 132 ++++++++++++++++++++++++++++++ >>> drivers/soundwire/amd_manager.h | 1 + >>> include/linux/soundwire/sdw_amd.h | 7 ++ >>> 3 files changed, 140 insertions(+) >>> >>> diff --git a/drivers/soundwire/amd_manager.c b/drivers/soundwire/amd_manager.c >>> index 14c88b80ab6d..87f9a987d93a 100644 >>> --- a/drivers/soundwire/amd_manager.c >>> +++ b/drivers/soundwire/amd_manager.c >>> @@ -417,6 +417,47 @@ static enum sdw_command_response amd_sdw_xfer_msg(struct sdw_bus *bus, struct sd >>> return SDW_CMD_OK; >>> } >>> >>> +static void amd_sdw_process_ping_status(u64 response, struct amd_sdw_manager *amd_manager) >>> +{ >>> + u64 slave_stat = 0; >> useless init > will fix it. >>> + u32 val = 0; >> useless init > will fix it. >>> + u16 dev_index; >>> + >>> + /* slave status response*/ >> response */ > will fix it. >>> + slave_stat = FIELD_GET(AMD_SDW_MCP_SLAVE_STAT_0_3, response); >>> + slave_stat |= FIELD_GET(AMD_SDW_MCP_SLAVE_STAT_4_11, response) << 8; >>> + >>> + dev_dbg(amd_manager->dev, "%s: slave_stat:0x%llx\n", __func__, slave_stat); >> newline? > will remove it. >>> + for (dev_index = 0; dev_index <= SDW_MAX_DEVICES; ++dev_index) { >>> + val = (slave_stat >> (dev_index * 2)) & AMD_SDW_MCP_SLAVE_STATUS_MASK; >>> + dev_dbg(amd_manager->dev, "%s val:0x%x\n", __func__, val); >> you don't need __func__ in dev_dbg() logs, they can be added e.g. with >> the option dyndbg=+pmf > it's overlooked. we will modify it. >>> + switch (val) { >>> + case SDW_SLAVE_ATTACHED: >>> + amd_manager->status[dev_index] = SDW_SLAVE_ATTACHED; >>> + break; >>> + case SDW_SLAVE_UNATTACHED: >>> + amd_manager->status[dev_index] = SDW_SLAVE_UNATTACHED; >>> + break; >>> + case SDW_SLAVE_ALERT: >>> + amd_manager->status[dev_index] = SDW_SLAVE_ALERT; >>> + break; >>> + default: >>> + amd_manager->status[dev_index] = SDW_SLAVE_RESERVED; >>> + break; >>> + } >>> + } >>> +} >>> + >>> +static void amd_sdw_read_and_process_ping_status(struct amd_sdw_manager *amd_manager) >>> +{ >>> + u64 response = 0; >> useless init > will fix it >>> + >>> + mutex_lock(&amd_manager->bus.msg_lock); >>> + response = amd_sdw_send_cmd_get_resp(amd_manager, 0, 0); >>> + mutex_unlock(&amd_manager->bus.msg_lock); >>> + amd_sdw_process_ping_status(response, amd_manager); >>> +} >>> + >>> static u32 amd_sdw_read_ping_status(struct sdw_bus *bus) >>> { >>> struct amd_sdw_manager *amd_manager = to_amd_sdw(bus); >>> @@ -817,6 +858,95 @@ static int amd_sdw_register_dais(struct amd_sdw_manager *amd_manager) >>> dais, num_dais); >>> } >>> >>> +static void amd_sdw_update_slave_status_work(struct work_struct *work) >>> +{ >>> + struct amd_sdw_manager *amd_manager = >>> + container_of(work, struct amd_sdw_manager, amd_sdw_work); >>> + int retry_count = 0; >>> + >>> + if (amd_manager->status[0] == SDW_SLAVE_ATTACHED) { >>> + acp_reg_writel(0, amd_manager->mmio + ACP_SW_STATE_CHANGE_STATUS_MASK_0TO7); >>> + acp_reg_writel(0, amd_manager->mmio + ACP_SW_STATE_CHANGE_STATUS_MASK_8TO11); >>> + } >>> + >>> +update_status: >>> + sdw_handle_slave_status(&amd_manager->bus, amd_manager->status); >>> + if (amd_manager->status[0] == SDW_SLAVE_ATTACHED) { >>> + if (retry_count++ < SDW_MAX_DEVICES) { >>> + acp_reg_writel(AMD_SDW_IRQ_MASK_0TO7, amd_manager->mmio + >>> + ACP_SW_STATE_CHANGE_STATUS_MASK_0TO7); >>> + acp_reg_writel(AMD_SDW_IRQ_MASK_8TO11, >>> + amd_manager->mmio + ACP_SW_STATE_CHANGE_STATUS_MASK_8TO11); >>> + amd_sdw_read_and_process_ping_status(amd_manager); >>> + goto update_status; >>> + } else { >>> + dev_err_ratelimited(amd_manager->dev, >>> + "Device0 detected after %d iterations\n", >>> + retry_count); >>> + } >>> + } >> this seems rather inspired by the Cadence code, but is there really a >> case where you need to re-check for devices? In the Cadence case, this >> was added because we have a logical OR and new devices would not be handled. > As mentioned in V1 set, we have corner cases during enumeration sequence. > We observed device alerts are missing during peripheral enumeration sequence > when multiple peripheral devices are connected over the same link. > This is not inspired by Intel code. > > As per V1 version review comment, we have included retry_count logic to address > faulty case. > > We forgot to include comment. we will fix it. Slight correction in the explanation. During the peripheral enumeration sequence, the soundwire peripheral interrupts are masked. If soundwire interrupts are not masked, it will cause side effects when multiple peripheral devices connected over the same link. As interrupts are masked, during device slot programming for each peripheral, soundwire manager driver won't receive any interrupts. Once the device number programming is done for all peripherals, the soundwire interrupts will be unmasked. Read the peripheral device status from ping command and process the response, which will invoke the peripheral device initialization sequence. This sequence will ensure all peripheral devices enumerated and initialized properly. >>> +} >>> + >>> +static void amd_sdw_update_slave_status(u32 status_change_0to7, u32 status_change_8to11, >>> + struct amd_sdw_manager *amd_manager) >>> +{ >>> + u64 slave_stat = 0; >> useless init > will fix it. >>> + u32 val = 0; >> useless init > will fix it. >>> + int dev_index; >>> + >>> + if (status_change_0to7 == AMD_SDW_SLAVE_0_ATTACHED) >>> + memset(amd_manager->status, 0, sizeof(amd_manager->status)); >>> + slave_stat = status_change_0to7; >>> + slave_stat |= FIELD_GET(AMD_SDW_MCP_SLAVE_STATUS_8TO_11, status_change_8to11) << 32; >>> + dev_dbg(amd_manager->dev, "%s: status_change_0to7:0x%x status_change_8to11:0x%x\n", >>> + __func__, status_change_0to7, status_change_8to11); >>> + if (slave_stat) { >>> + for (dev_index = 0; dev_index <= SDW_MAX_DEVICES; ++dev_index) { >>> + if (slave_stat & AMD_SDW_MCP_SLAVE_STATUS_VALID_MASK(dev_index)) { >>> + val = (slave_stat >> AMD_SDW_MCP_SLAVE_STAT_SHIFT_MASK(dev_index)) & >>> + AMD_SDW_MCP_SLAVE_STATUS_MASK; >>> + switch (val) { >>> + case SDW_SLAVE_ATTACHED: >>> + amd_manager->status[dev_index] = SDW_SLAVE_ATTACHED; >>> + break; >>> + case SDW_SLAVE_UNATTACHED: >>> + amd_manager->status[dev_index] = SDW_SLAVE_UNATTACHED; >>> + break; >>> + case SDW_SLAVE_ALERT: >>> + amd_manager->status[dev_index] = SDW_SLAVE_ALERT; >>> + break; >>> + default: >>> + amd_manager->status[dev_index] = SDW_SLAVE_RESERVED; >>> + break; >>> + } >> the code seems identical to that in amd_sdw_process_ping_status(), is >> there a need for a helper function? > will use helper function for status update. >>> + } >>> + } >>> + } >>> +} >>> + >>> +static void amd_sdw_irq_thread(struct work_struct *work) >>> +{ >>> + struct amd_sdw_manager *amd_manager = >>> + container_of(work, struct amd_sdw_manager, amd_sdw_irq_thread); >>> + u32 status_change_8to11; >>> + u32 status_change_0to7; >>> + >>> + status_change_8to11 = acp_reg_readl(amd_manager->mmio + ACP_SW_STATE_CHANGE_STATUS_8TO11); >>> + status_change_0to7 = acp_reg_readl(amd_manager->mmio + ACP_SW_STATE_CHANGE_STATUS_0TO7); >>> + dev_dbg(amd_manager->dev, "%s [SDW%d] SDW INT: 0to7=0x%x, 8to11=0x%x\n", >>> + __func__, amd_manager->instance, status_change_0to7, status_change_8to11); >> remove __func__ > will fix it. >>> + if (status_change_8to11 & AMD_SDW_PREQ_INTR_STAT) { >>> + amd_sdw_read_and_process_ping_status(amd_manager); >>> + } else { >>> + /* Check for the updated status on peripheral device */ >>> + amd_sdw_update_slave_status(status_change_0to7, status_change_8to11, amd_manager); >>> + } >>> + if (status_change_8to11 || status_change_0to7) >>> + schedule_work(&amd_manager->amd_sdw_work); >>> + acp_reg_writel(0x00, amd_manager->mmio + ACP_SW_STATE_CHANGE_STATUS_8TO11); >>> + acp_reg_writel(0x00, amd_manager->mmio + ACP_SW_STATE_CHANGE_STATUS_0TO7); >>> +}