Lines Matching refs:amd_manager
30 static int amd_init_sdw_manager(struct amd_sdw_manager *amd_manager) in amd_init_sdw_manager() argument
35 writel(AMD_SDW_ENABLE, amd_manager->mmio + ACP_SW_EN); in amd_init_sdw_manager()
36 ret = readl_poll_timeout(amd_manager->mmio + ACP_SW_EN_STATUS, val, val, ACP_DELAY_US, in amd_init_sdw_manager()
42 writel(AMD_SDW_BUS_RESET_REQ, amd_manager->mmio + ACP_SW_BUS_RESET_CTRL); in amd_init_sdw_manager()
43 ret = readl_poll_timeout(amd_manager->mmio + ACP_SW_BUS_RESET_CTRL, val, in amd_init_sdw_manager()
48 writel(AMD_SDW_BUS_RESET_CLEAR_REQ, amd_manager->mmio + ACP_SW_BUS_RESET_CTRL); in amd_init_sdw_manager()
49 ret = readl_poll_timeout(amd_manager->mmio + ACP_SW_BUS_RESET_CTRL, val, !val, in amd_init_sdw_manager()
52 dev_err(amd_manager->dev, "Failed to reset SoundWire manager instance%d\n", in amd_init_sdw_manager()
53 amd_manager->instance); in amd_init_sdw_manager()
57 writel(AMD_SDW_DISABLE, amd_manager->mmio + ACP_SW_EN); in amd_init_sdw_manager()
58 return readl_poll_timeout(amd_manager->mmio + ACP_SW_EN_STATUS, val, !val, ACP_DELAY_US, in amd_init_sdw_manager()
62 static int amd_enable_sdw_manager(struct amd_sdw_manager *amd_manager) in amd_enable_sdw_manager() argument
66 writel(AMD_SDW_ENABLE, amd_manager->mmio + ACP_SW_EN); in amd_enable_sdw_manager()
67 return readl_poll_timeout(amd_manager->mmio + ACP_SW_EN_STATUS, val, val, ACP_DELAY_US, in amd_enable_sdw_manager()
71 static int amd_disable_sdw_manager(struct amd_sdw_manager *amd_manager) in amd_disable_sdw_manager() argument
75 writel(AMD_SDW_DISABLE, amd_manager->mmio + ACP_SW_EN); in amd_disable_sdw_manager()
81 val = readl(amd_manager->mmio + ACP_SW_CLK_RESUME_CTRL); in amd_disable_sdw_manager()
84 return readl_poll_timeout(amd_manager->mmio + ACP_SW_EN_STATUS, val, !val, ACP_DELAY_US, in amd_disable_sdw_manager()
88 static void amd_enable_sdw_interrupts(struct amd_sdw_manager *amd_manager) in amd_enable_sdw_interrupts() argument
92 mutex_lock(amd_manager->acp_sdw_lock); in amd_enable_sdw_interrupts()
93 val = sdw_manager_reg_mask_array[amd_manager->instance]; in amd_enable_sdw_interrupts()
94 amd_updatel(amd_manager->acp_mmio, ACP_EXTERNAL_INTR_CNTL(amd_manager->instance), val, val); in amd_enable_sdw_interrupts()
95 mutex_unlock(amd_manager->acp_sdw_lock); in amd_enable_sdw_interrupts()
97 writel(AMD_SDW_IRQ_MASK_0TO7, amd_manager->mmio + in amd_enable_sdw_interrupts()
99 writel(AMD_SDW_IRQ_MASK_8TO11, amd_manager->mmio + in amd_enable_sdw_interrupts()
101 writel(AMD_SDW_IRQ_ERROR_MASK, amd_manager->mmio + ACP_SW_ERROR_INTR_MASK); in amd_enable_sdw_interrupts()
104 static void amd_disable_sdw_interrupts(struct amd_sdw_manager *amd_manager) in amd_disable_sdw_interrupts() argument
108 mutex_lock(amd_manager->acp_sdw_lock); in amd_disable_sdw_interrupts()
109 irq_mask = sdw_manager_reg_mask_array[amd_manager->instance]; in amd_disable_sdw_interrupts()
110 amd_updatel(amd_manager->acp_mmio, ACP_EXTERNAL_INTR_CNTL(amd_manager->instance), in amd_disable_sdw_interrupts()
112 mutex_unlock(amd_manager->acp_sdw_lock); in amd_disable_sdw_interrupts()
114 writel(0x00, amd_manager->mmio + ACP_SW_STATE_CHANGE_STATUS_MASK_0TO7); in amd_disable_sdw_interrupts()
115 writel(0x00, amd_manager->mmio + ACP_SW_STATE_CHANGE_STATUS_MASK_8TO11); in amd_disable_sdw_interrupts()
116 writel(0x00, amd_manager->mmio + ACP_SW_ERROR_INTR_MASK); in amd_disable_sdw_interrupts()
119 static int amd_deinit_sdw_manager(struct amd_sdw_manager *amd_manager) in amd_deinit_sdw_manager() argument
121 amd_disable_sdw_interrupts(amd_manager); in amd_deinit_sdw_manager()
122 return amd_disable_sdw_manager(amd_manager); in amd_deinit_sdw_manager()
125 static void amd_sdw_set_frameshape(struct amd_sdw_manager *amd_manager) in amd_sdw_set_frameshape() argument
129 frame_size = (amd_manager->rows_index << 3) | amd_manager->cols_index; in amd_sdw_set_frameshape()
130 writel(frame_size, amd_manager->mmio + ACP_SW_FRAMESIZE); in amd_sdw_set_frameshape()
133 static void amd_sdw_wake_enable(struct amd_sdw_manager *amd_manager, bool enable) in amd_sdw_wake_enable() argument
137 wake_ctrl = readl(amd_manager->mmio + ACP_SW_STATE_CHANGE_STATUS_MASK_8TO11); in amd_sdw_wake_enable()
143 writel(wake_ctrl, amd_manager->mmio + ACP_SW_STATE_CHANGE_STATUS_MASK_8TO11); in amd_sdw_wake_enable()
146 static int amd_sdw_set_device_state(struct amd_sdw_manager *amd_manager, u32 target_device_state) in amd_sdw_set_device_state() argument
150 sdw_dev_state = readl(amd_manager->acp_mmio + AMD_SDW_DEVICE_STATE); in amd_sdw_set_device_state()
151 switch (amd_manager->instance) { in amd_sdw_set_device_state()
163 writel(sdw_dev_state, amd_manager->acp_mmio + AMD_SDW_DEVICE_STATE); in amd_sdw_set_device_state()
164 sdw_dev_state = readl(amd_manager->acp_mmio + AMD_SDW_DEVICE_STATE); in amd_sdw_set_device_state()
165 dev_dbg(amd_manager->dev, "AMD_SDW_DEVICE_STATE:0x%x\n", sdw_dev_state); in amd_sdw_set_device_state()
169 static int amd_sdw_host_wake_enable(struct amd_sdw_manager *amd_manager, bool enable) in amd_sdw_host_wake_enable() argument
174 if (!amd_manager->wake_en_mask) in amd_sdw_host_wake_enable()
177 switch (amd_manager->instance) { in amd_sdw_host_wake_enable()
188 intr_cntl1 = readl(amd_manager->acp_mmio + ACP_EXTERNAL_INTR_CNTL(ACP_SDW1)); in amd_sdw_host_wake_enable()
193 writel(intr_cntl1, amd_manager->acp_mmio + ACP_EXTERNAL_INTR_CNTL(ACP_SDW1)); in amd_sdw_host_wake_enable()
223 static u64 amd_sdw_send_cmd_get_resp(struct amd_sdw_manager *amd_manager, u32 lower_data, in amd_sdw_send_cmd_get_resp() argument
231 ret = readl_poll_timeout(amd_manager->mmio + ACP_SW_IMM_CMD_STS, sts, in amd_sdw_send_cmd_get_resp()
234 dev_err(amd_manager->dev, "SDW%x previous cmd status clear failed\n", in amd_sdw_send_cmd_get_resp()
235 amd_manager->instance); in amd_sdw_send_cmd_get_resp()
240 dev_err(amd_manager->dev, "SDW%x manager is in bad state\n", amd_manager->instance); in amd_sdw_send_cmd_get_resp()
241 writel(AMD_SDW_IMM_RES_VALID, amd_manager->mmio + ACP_SW_IMM_CMD_STS); in amd_sdw_send_cmd_get_resp()
243 writel(upper_data, amd_manager->mmio + ACP_SW_IMM_CMD_UPPER_WORD); in amd_sdw_send_cmd_get_resp()
244 writel(lower_data, amd_manager->mmio + ACP_SW_IMM_CMD_LOWER_QWORD); in amd_sdw_send_cmd_get_resp()
246 ret = readl_poll_timeout(amd_manager->mmio + ACP_SW_IMM_CMD_STS, sts, in amd_sdw_send_cmd_get_resp()
249 dev_err(amd_manager->dev, "SDW%x cmd response timeout occurred\n", in amd_sdw_send_cmd_get_resp()
250 amd_manager->instance); in amd_sdw_send_cmd_get_resp()
253 upper_resp = readl(amd_manager->mmio + ACP_SW_IMM_RESP_UPPER_WORD); in amd_sdw_send_cmd_get_resp()
254 lower_resp = readl(amd_manager->mmio + ACP_SW_IMM_RESP_LOWER_QWORD); in amd_sdw_send_cmd_get_resp()
256 writel(AMD_SDW_IMM_RES_VALID, amd_manager->mmio + ACP_SW_IMM_CMD_STS); in amd_sdw_send_cmd_get_resp()
257 ret = readl_poll_timeout(amd_manager->mmio + ACP_SW_IMM_CMD_STS, sts, in amd_sdw_send_cmd_get_resp()
260 dev_err(amd_manager->dev, "SDW%x cmd status retry failed\n", in amd_sdw_send_cmd_get_resp()
261 amd_manager->instance); in amd_sdw_send_cmd_get_resp()
270 amd_program_scp_addr(struct amd_sdw_manager *amd_manager, struct sdw_msg *msg) in amd_program_scp_addr() argument
282 response_buf[0] = amd_sdw_send_cmd_get_resp(amd_manager, lower_data, upper_data); in amd_program_scp_addr()
286 response_buf[1] = amd_sdw_send_cmd_get_resp(amd_manager, lower_data, upper_data); in amd_program_scp_addr()
290 dev_err_ratelimited(amd_manager->dev, in amd_program_scp_addr()
296 dev_err_ratelimited(amd_manager->dev, in amd_program_scp_addr()
301 dev_dbg_ratelimited(amd_manager->dev, "SCP_addrpage ignored for Slave %d\n", in amd_program_scp_addr()
309 static int amd_prep_msg(struct amd_sdw_manager *amd_manager, struct sdw_msg *msg) in amd_prep_msg() argument
314 ret = amd_program_scp_addr(amd_manager, msg); in amd_prep_msg()
325 dev_err(amd_manager->dev, "Invalid msg cmd: %d\n", msg->flags); in amd_prep_msg()
331 static enum sdw_command_response amd_sdw_fill_msg_resp(struct amd_sdw_manager *amd_manager, in amd_sdw_fill_msg_resp() argument
340 dev_err_ratelimited(amd_manager->dev, "command timeout for Slave %d\n", in amd_sdw_fill_msg_resp()
344 dev_err_ratelimited(amd_manager->dev, in amd_sdw_fill_msg_resp()
349 dev_dbg_ratelimited(amd_manager->dev, "command is ignored for Slave %d\n", in amd_sdw_fill_msg_resp()
356 static unsigned int _amd_sdw_xfer_msg(struct amd_sdw_manager *amd_manager, struct sdw_msg *msg, in _amd_sdw_xfer_msg() argument
363 response = amd_sdw_send_cmd_get_resp(amd_manager, lower_data, upper_data); in _amd_sdw_xfer_msg()
364 return amd_sdw_fill_msg_resp(amd_manager, msg, response, cmd_offset); in _amd_sdw_xfer_msg()
369 struct amd_sdw_manager *amd_manager = to_amd_sdw(bus); in amd_sdw_xfer_msg() local
372 ret = amd_prep_msg(amd_manager, msg); in amd_sdw_xfer_msg()
376 ret = _amd_sdw_xfer_msg(amd_manager, msg, i); in amd_sdw_xfer_msg()
383 static void amd_sdw_fill_slave_status(struct amd_sdw_manager *amd_manager, u16 index, u32 status) in amd_sdw_fill_slave_status() argument
389 amd_manager->status[index] = status; in amd_sdw_fill_slave_status()
392 amd_manager->status[index] = SDW_SLAVE_RESERVED; in amd_sdw_fill_slave_status()
397 static void amd_sdw_process_ping_status(u64 response, struct amd_sdw_manager *amd_manager) in amd_sdw_process_ping_status() argument
406 dev_dbg(amd_manager->dev, "slave_stat:0x%llx\n", slave_stat); in amd_sdw_process_ping_status()
409 dev_dbg(amd_manager->dev, "val:0x%x\n", val); in amd_sdw_process_ping_status()
410 amd_sdw_fill_slave_status(amd_manager, dev_index, val); in amd_sdw_process_ping_status()
414 static void amd_sdw_read_and_process_ping_status(struct amd_sdw_manager *amd_manager) in amd_sdw_read_and_process_ping_status() argument
418 mutex_lock(&amd_manager->bus.msg_lock); in amd_sdw_read_and_process_ping_status()
419 response = amd_sdw_send_cmd_get_resp(amd_manager, 0, 0); in amd_sdw_read_and_process_ping_status()
420 mutex_unlock(&amd_manager->bus.msg_lock); in amd_sdw_read_and_process_ping_status()
421 amd_sdw_process_ping_status(response, amd_manager); in amd_sdw_read_and_process_ping_status()
426 struct amd_sdw_manager *amd_manager = to_amd_sdw(bus); in amd_sdw_read_ping_status() local
430 response = amd_sdw_send_cmd_get_resp(amd_manager, 0, 0); in amd_sdw_read_ping_status()
434 dev_dbg(amd_manager->dev, "slave_stat:0x%x\n", slave_stat); in amd_sdw_read_ping_status()
483 struct amd_sdw_manager *amd_manager = to_amd_sdw(bus); in amd_sdw_port_params() local
486 dev_dbg(amd_manager->dev, "p_params->num:0x%x\n", p_params->num); in amd_sdw_port_params()
487 switch (amd_manager->acp_rev) { in amd_sdw_port_params()
489 switch (amd_manager->instance) { in amd_sdw_port_params()
509 dpn_frame_fmt = readl(amd_manager->mmio + frame_fmt_reg); in amd_sdw_port_params()
513 writel(dpn_frame_fmt, amd_manager->mmio + frame_fmt_reg); in amd_sdw_port_params()
521 struct amd_sdw_manager *amd_manager = to_amd_sdw(bus); in amd_sdw_transport_params() local
530 switch (amd_manager->acp_rev) { in amd_sdw_transport_params()
532 switch (amd_manager->instance) { in amd_sdw_transport_params()
565 writel(AMD_SDW_SSP_COUNTER_VAL, amd_manager->mmio + ACP_SW_SSP_COUNTER); in amd_sdw_transport_params()
567 dpn_frame_fmt = readl(amd_manager->mmio + frame_fmt_reg); in amd_sdw_transport_params()
571 writel(dpn_frame_fmt, amd_manager->mmio + frame_fmt_reg); in amd_sdw_transport_params()
574 writel(dpn_sampleinterval, amd_manager->mmio + sample_int_reg); in amd_sdw_transport_params()
578 writel(dpn_hctrl, amd_manager->mmio + hctrl_dp0_reg); in amd_sdw_transport_params()
582 writel(dpn_offsetctrl, amd_manager->mmio + offset_reg); in amd_sdw_transport_params()
588 dpn_lanectrl = readl(amd_manager->mmio + lane_ctrl_ch_en_reg); in amd_sdw_transport_params()
590 writel(dpn_lanectrl, amd_manager->mmio + lane_ctrl_ch_en_reg); in amd_sdw_transport_params()
598 struct amd_sdw_manager *amd_manager = to_amd_sdw(bus); in amd_sdw_port_enable() local
602 switch (amd_manager->acp_rev) { in amd_sdw_port_enable()
604 switch (amd_manager->instance) { in amd_sdw_port_enable()
630 dpn_ch_enable = readl(amd_manager->mmio + lane_ctrl_ch_en_reg); in amd_sdw_port_enable()
633 writel(dpn_ch_enable, amd_manager->mmio + lane_ctrl_ch_en_reg); in amd_sdw_port_enable()
635 writel(0, amd_manager->mmio + lane_ctrl_ch_en_reg); in amd_sdw_port_enable()
641 struct amd_sdw_manager *amd_manager = to_amd_sdw(bus); in sdw_master_read_amd_prop() local
664 amd_manager->wake_en_mask = wake_en_mask; in sdw_master_read_amd_prop()
666 amd_manager->power_mode_mask = power_mode_mask; in sdw_master_read_amd_prop()
696 struct amd_sdw_manager *amd_manager = snd_soc_dai_get_drvdata(dai); in amd_sdw_hw_params() local
702 dai_runtime = amd_manager->dai_runtime_array[dai->id]; in amd_sdw_hw_params()
711 dev_dbg(amd_manager->dev, "dir:%d dai->id:0x%x\n", dir, dai->id); in amd_sdw_hw_params()
728 ret = sdw_stream_add_master(&amd_manager->bus, &sconfig, in amd_sdw_hw_params()
731 dev_err(amd_manager->dev, "add manager to stream failed:%d\n", ret); in amd_sdw_hw_params()
738 struct amd_sdw_manager *amd_manager = snd_soc_dai_get_drvdata(dai); in amd_sdw_hw_free() local
742 dai_runtime = amd_manager->dai_runtime_array[dai->id]; in amd_sdw_hw_free()
746 ret = sdw_stream_remove_master(&amd_manager->bus, dai_runtime->stream); in amd_sdw_hw_free()
755 struct amd_sdw_manager *amd_manager = snd_soc_dai_get_drvdata(dai); in amd_set_sdw_stream() local
758 dai_runtime = amd_manager->dai_runtime_array[dai->id]; in amd_set_sdw_stream()
772 dai_runtime->bus = &amd_manager->bus; in amd_set_sdw_stream()
774 amd_manager->dai_runtime_array[dai->id] = dai_runtime; in amd_set_sdw_stream()
784 amd_manager->dai_runtime_array[dai->id] = NULL; in amd_set_sdw_stream()
796 struct amd_sdw_manager *amd_manager = snd_soc_dai_get_drvdata(dai); in amd_get_sdw_stream() local
799 dai_runtime = amd_manager->dai_runtime_array[dai->id]; in amd_get_sdw_stream()
817 static int amd_sdw_register_dais(struct amd_sdw_manager *amd_manager) in amd_sdw_register_dais() argument
825 dev = amd_manager->dev; in amd_sdw_register_dais()
826 num_dais = amd_manager->num_dout_ports + amd_manager->num_din_ports; in amd_sdw_register_dais()
836 amd_manager->dai_runtime_array = dai_runtime_array; in amd_sdw_register_dais()
838 dais[i].name = devm_kasprintf(dev, GFP_KERNEL, "SDW%d Pin%d", amd_manager->instance, in amd_sdw_register_dais()
842 if (i < amd_manager->num_dout_ports) in amd_sdw_register_dais()
862 struct amd_sdw_manager *amd_manager = in amd_sdw_update_slave_status_work() local
866 if (amd_manager->status[0] == SDW_SLAVE_ATTACHED) { in amd_sdw_update_slave_status_work()
867 writel(0, amd_manager->mmio + ACP_SW_STATE_CHANGE_STATUS_MASK_0TO7); in amd_sdw_update_slave_status_work()
868 writel(0, amd_manager->mmio + ACP_SW_STATE_CHANGE_STATUS_MASK_8TO11); in amd_sdw_update_slave_status_work()
872 sdw_handle_slave_status(&amd_manager->bus, amd_manager->status); in amd_sdw_update_slave_status_work()
880 if (amd_manager->status[0] == SDW_SLAVE_ATTACHED) { in amd_sdw_update_slave_status_work()
882 writel(AMD_SDW_IRQ_MASK_0TO7, amd_manager->mmio + in amd_sdw_update_slave_status_work()
884 writel(AMD_SDW_IRQ_MASK_8TO11, amd_manager->mmio + in amd_sdw_update_slave_status_work()
886 amd_sdw_read_and_process_ping_status(amd_manager); in amd_sdw_update_slave_status_work()
889 dev_err_ratelimited(amd_manager->dev, in amd_sdw_update_slave_status_work()
897 struct amd_sdw_manager *amd_manager) in amd_sdw_update_slave_status() argument
904 memset(amd_manager->status, 0, sizeof(amd_manager->status)); in amd_sdw_update_slave_status()
907 dev_dbg(amd_manager->dev, "status_change_0to7:0x%x status_change_8to11:0x%x\n", in amd_sdw_update_slave_status()
914 amd_sdw_fill_slave_status(amd_manager, dev_index, val); in amd_sdw_update_slave_status()
920 static void amd_sdw_process_wake_event(struct amd_sdw_manager *amd_manager) in amd_sdw_process_wake_event() argument
922 dev_dbg(amd_manager->dev, "SoundWire Wake event reported\n"); in amd_sdw_process_wake_event()
923 pm_request_resume(amd_manager->dev); in amd_sdw_process_wake_event()
924 writel(0x00, amd_manager->acp_mmio + ACP_SW_WAKE_EN(amd_manager->instance)); in amd_sdw_process_wake_event()
925 writel(0x00, amd_manager->mmio + ACP_SW_STATE_CHANGE_STATUS_8TO11); in amd_sdw_process_wake_event()
930 struct amd_sdw_manager *amd_manager = in amd_sdw_irq_thread() local
935 status_change_8to11 = readl(amd_manager->mmio + ACP_SW_STATE_CHANGE_STATUS_8TO11); in amd_sdw_irq_thread()
936 status_change_0to7 = readl(amd_manager->mmio + ACP_SW_STATE_CHANGE_STATUS_0TO7); in amd_sdw_irq_thread()
940 dev_dbg(amd_manager->dev, "[SDW%d] SDW INT: 0to7=0x%x, 8to11=0x%x\n", in amd_sdw_irq_thread()
941 amd_manager->instance, status_change_0to7, status_change_8to11); in amd_sdw_irq_thread()
943 return amd_sdw_process_wake_event(amd_manager); in amd_sdw_irq_thread()
946 amd_sdw_read_and_process_ping_status(amd_manager); in amd_sdw_irq_thread()
949 amd_sdw_update_slave_status(status_change_0to7, status_change_8to11, amd_manager); in amd_sdw_irq_thread()
952 schedule_work(&amd_manager->amd_sdw_work); in amd_sdw_irq_thread()
953 writel(0x00, amd_manager->mmio + ACP_SW_STATE_CHANGE_STATUS_8TO11); in amd_sdw_irq_thread()
954 writel(0x00, amd_manager->mmio + ACP_SW_STATE_CHANGE_STATUS_0TO7); in amd_sdw_irq_thread()
957 int amd_sdw_manager_start(struct amd_sdw_manager *amd_manager) in amd_sdw_manager_start() argument
962 prop = &amd_manager->bus.prop; in amd_sdw_manager_start()
964 ret = amd_init_sdw_manager(amd_manager); in amd_sdw_manager_start()
967 amd_enable_sdw_interrupts(amd_manager); in amd_sdw_manager_start()
968 ret = amd_enable_sdw_manager(amd_manager); in amd_sdw_manager_start()
971 amd_sdw_set_frameshape(amd_manager); in amd_sdw_manager_start()
974 pm_runtime_set_autosuspend_delay(amd_manager->dev, AMD_SDW_MASTER_SUSPEND_DELAY_MS); in amd_sdw_manager_start()
975 pm_runtime_use_autosuspend(amd_manager->dev); in amd_sdw_manager_start()
976 pm_runtime_mark_last_busy(amd_manager->dev); in amd_sdw_manager_start()
977 pm_runtime_set_active(amd_manager->dev); in amd_sdw_manager_start()
978 pm_runtime_enable(amd_manager->dev); in amd_sdw_manager_start()
989 struct amd_sdw_manager *amd_manager; in amd_sdw_manager_probe() local
992 amd_manager = devm_kzalloc(dev, sizeof(struct amd_sdw_manager), GFP_KERNEL); in amd_sdw_manager_probe()
993 if (!amd_manager) in amd_sdw_manager_probe()
1000 amd_manager->acp_mmio = devm_ioremap(dev, res->start, resource_size(res)); in amd_sdw_manager_probe()
1001 if (!amd_manager->acp_mmio) { in amd_sdw_manager_probe()
1005 amd_manager->instance = pdata->instance; in amd_sdw_manager_probe()
1006 amd_manager->mmio = amd_manager->acp_mmio + in amd_sdw_manager_probe()
1007 (amd_manager->instance * SDW_MANAGER_REG_OFFSET); in amd_sdw_manager_probe()
1008 amd_manager->acp_sdw_lock = pdata->acp_sdw_lock; in amd_sdw_manager_probe()
1009 amd_manager->acp_rev = pdata->acp_rev; in amd_sdw_manager_probe()
1010 amd_manager->cols_index = sdw_find_col_index(AMD_SDW_DEFAULT_COLUMNS); in amd_sdw_manager_probe()
1011 amd_manager->rows_index = sdw_find_row_index(AMD_SDW_DEFAULT_ROWS); in amd_sdw_manager_probe()
1012 amd_manager->dev = dev; in amd_sdw_manager_probe()
1013 amd_manager->bus.ops = &amd_sdw_ops; in amd_sdw_manager_probe()
1014 amd_manager->bus.port_ops = &amd_sdw_port_ops; in amd_sdw_manager_probe()
1015 amd_manager->bus.compute_params = &amd_sdw_compute_params; in amd_sdw_manager_probe()
1016 amd_manager->bus.clk_stop_timeout = 200; in amd_sdw_manager_probe()
1017 amd_manager->bus.link_id = amd_manager->instance; in amd_sdw_manager_probe()
1025 amd_manager->bus.controller_id = 0; in amd_sdw_manager_probe()
1026 dev_dbg(dev, "acp_rev:0x%x\n", amd_manager->acp_rev); in amd_sdw_manager_probe()
1027 switch (amd_manager->acp_rev) { in amd_sdw_manager_probe()
1029 switch (amd_manager->instance) { in amd_sdw_manager_probe()
1031 amd_manager->num_dout_ports = AMD_ACP63_SDW0_MAX_TX_PORTS; in amd_sdw_manager_probe()
1032 amd_manager->num_din_ports = AMD_ACP63_SDW0_MAX_RX_PORTS; in amd_sdw_manager_probe()
1035 amd_manager->num_dout_ports = AMD_ACP63_SDW1_MAX_TX_PORTS; in amd_sdw_manager_probe()
1036 amd_manager->num_din_ports = AMD_ACP63_SDW1_MAX_RX_PORTS; in amd_sdw_manager_probe()
1045 amd_manager->num_dout_ports = AMD_ACP70_SDW_MAX_TX_PORTS; in amd_sdw_manager_probe()
1046 amd_manager->num_din_ports = AMD_ACP70_SDW_MAX_RX_PORTS; in amd_sdw_manager_probe()
1052 params = &amd_manager->bus.params; in amd_sdw_manager_probe()
1056 prop = &amd_manager->bus.prop; in amd_sdw_manager_probe()
1061 ret = sdw_bus_master_add(&amd_manager->bus, dev, dev->fwnode); in amd_sdw_manager_probe()
1066 ret = amd_sdw_register_dais(amd_manager); in amd_sdw_manager_probe()
1069 sdw_bus_master_delete(&amd_manager->bus); in amd_sdw_manager_probe()
1072 dev_set_drvdata(dev, amd_manager); in amd_sdw_manager_probe()
1073 INIT_WORK(&amd_manager->amd_sdw_irq_thread, amd_sdw_irq_thread); in amd_sdw_manager_probe()
1074 INIT_WORK(&amd_manager->amd_sdw_work, amd_sdw_update_slave_status_work); in amd_sdw_manager_probe()
1080 struct amd_sdw_manager *amd_manager = dev_get_drvdata(&pdev->dev); in amd_sdw_manager_remove() local
1084 cancel_work_sync(&amd_manager->amd_sdw_work); in amd_sdw_manager_remove()
1085 amd_disable_sdw_interrupts(amd_manager); in amd_sdw_manager_remove()
1086 sdw_bus_master_delete(&amd_manager->bus); in amd_sdw_manager_remove()
1087 ret = amd_disable_sdw_manager(amd_manager); in amd_sdw_manager_remove()
1092 static int amd_sdw_clock_stop(struct amd_sdw_manager *amd_manager) in amd_sdw_clock_stop() argument
1097 ret = sdw_bus_prep_clk_stop(&amd_manager->bus); in amd_sdw_clock_stop()
1099 dev_err(amd_manager->dev, "prepare clock stop failed %d", ret); in amd_sdw_clock_stop()
1102 ret = sdw_bus_clk_stop(&amd_manager->bus); in amd_sdw_clock_stop()
1104 dev_err(amd_manager->dev, "bus clock stop failed %d", ret); in amd_sdw_clock_stop()
1108 ret = readl_poll_timeout(amd_manager->mmio + ACP_SW_CLK_RESUME_CTRL, val, in amd_sdw_clock_stop()
1111 dev_err(amd_manager->dev, "SDW%x clock stop failed\n", amd_manager->instance); in amd_sdw_clock_stop()
1115 amd_manager->clk_stopped = true; in amd_sdw_clock_stop()
1116 if (amd_manager->wake_en_mask) in amd_sdw_clock_stop()
1117 writel(0x01, amd_manager->acp_mmio + ACP_SW_WAKE_EN(amd_manager->instance)); in amd_sdw_clock_stop()
1119 dev_dbg(amd_manager->dev, "SDW%x clock stop successful\n", amd_manager->instance); in amd_sdw_clock_stop()
1123 static int amd_sdw_clock_stop_exit(struct amd_sdw_manager *amd_manager) in amd_sdw_clock_stop_exit() argument
1128 if (amd_manager->clk_stopped) { in amd_sdw_clock_stop_exit()
1129 val = readl(amd_manager->mmio + ACP_SW_CLK_RESUME_CTRL); in amd_sdw_clock_stop_exit()
1131 writel(val, amd_manager->mmio + ACP_SW_CLK_RESUME_CTRL); in amd_sdw_clock_stop_exit()
1132 ret = readl_poll_timeout(amd_manager->mmio + ACP_SW_CLK_RESUME_CTRL, val, in amd_sdw_clock_stop_exit()
1136 writel(0, amd_manager->mmio + ACP_SW_CLK_RESUME_CTRL); in amd_sdw_clock_stop_exit()
1137 ret = sdw_bus_exit_clk_stop(&amd_manager->bus); in amd_sdw_clock_stop_exit()
1139 dev_err(amd_manager->dev, "bus failed to exit clock stop %d\n", in amd_sdw_clock_stop_exit()
1141 amd_manager->clk_stopped = false; in amd_sdw_clock_stop_exit()
1144 if (amd_manager->clk_stopped) { in amd_sdw_clock_stop_exit()
1145 dev_err(amd_manager->dev, "SDW%x clock stop exit failed\n", amd_manager->instance); in amd_sdw_clock_stop_exit()
1148 dev_dbg(amd_manager->dev, "SDW%x clock stop exit successful\n", amd_manager->instance); in amd_sdw_clock_stop_exit()
1175 struct amd_sdw_manager *amd_manager = dev_get_drvdata(dev); in amd_pm_prepare() local
1176 struct sdw_bus *bus = &amd_manager->bus; in amd_pm_prepare()
1189 if (amd_manager->power_mode_mask) { in amd_pm_prepare()
1209 struct amd_sdw_manager *amd_manager = dev_get_drvdata(dev); in amd_suspend() local
1210 struct sdw_bus *bus = &amd_manager->bus; in amd_suspend()
1219 if (amd_manager->power_mode_mask & AMD_SDW_CLK_STOP_MODE) { in amd_suspend()
1220 cancel_work_sync(&amd_manager->amd_sdw_work); in amd_suspend()
1221 amd_sdw_wake_enable(amd_manager, false); in amd_suspend()
1222 if (amd_manager->acp_rev >= ACP70_PCI_REV_ID) { in amd_suspend()
1223 ret = amd_sdw_host_wake_enable(amd_manager, false); in amd_suspend()
1227 ret = amd_sdw_clock_stop(amd_manager); in amd_suspend()
1230 } else if (amd_manager->power_mode_mask & AMD_SDW_POWER_OFF_MODE) { in amd_suspend()
1231 cancel_work_sync(&amd_manager->amd_sdw_work); in amd_suspend()
1232 amd_sdw_wake_enable(amd_manager, false); in amd_suspend()
1233 if (amd_manager->acp_rev >= ACP70_PCI_REV_ID) { in amd_suspend()
1234 ret = amd_sdw_host_wake_enable(amd_manager, false); in amd_suspend()
1242 ret = amd_sdw_clock_stop(amd_manager); in amd_suspend()
1245 ret = amd_deinit_sdw_manager(amd_manager); in amd_suspend()
1249 if (amd_manager->acp_rev >= ACP70_PCI_REV_ID) { in amd_suspend()
1250 ret = amd_sdw_set_device_state(amd_manager, AMD_SDW_DEVICE_STATE_D3); in amd_suspend()
1259 struct amd_sdw_manager *amd_manager = dev_get_drvdata(dev); in amd_suspend_runtime() local
1260 struct sdw_bus *bus = &amd_manager->bus; in amd_suspend_runtime()
1269 if (amd_manager->power_mode_mask & AMD_SDW_CLK_STOP_MODE) { in amd_suspend_runtime()
1270 amd_sdw_wake_enable(amd_manager, true); in amd_suspend_runtime()
1271 if (amd_manager->acp_rev >= ACP70_PCI_REV_ID) { in amd_suspend_runtime()
1272 ret = amd_sdw_host_wake_enable(amd_manager, true); in amd_suspend_runtime()
1276 ret = amd_sdw_clock_stop(amd_manager); in amd_suspend_runtime()
1279 } else if (amd_manager->power_mode_mask & AMD_SDW_POWER_OFF_MODE) { in amd_suspend_runtime()
1280 amd_sdw_wake_enable(amd_manager, true); in amd_suspend_runtime()
1281 if (amd_manager->acp_rev >= ACP70_PCI_REV_ID) { in amd_suspend_runtime()
1282 ret = amd_sdw_host_wake_enable(amd_manager, true); in amd_suspend_runtime()
1286 ret = amd_sdw_clock_stop(amd_manager); in amd_suspend_runtime()
1289 ret = amd_deinit_sdw_manager(amd_manager); in amd_suspend_runtime()
1293 if (amd_manager->acp_rev >= ACP70_PCI_REV_ID) { in amd_suspend_runtime()
1294 ret = amd_sdw_set_device_state(amd_manager, AMD_SDW_DEVICE_STATE_D3); in amd_suspend_runtime()
1297 if (amd_manager->wake_en_mask) { in amd_suspend_runtime()
1298 val = readl(amd_manager->acp_mmio + ACP_PME_EN); in amd_suspend_runtime()
1300 writel(1, amd_manager->acp_mmio + ACP_PME_EN); in amd_suspend_runtime()
1301 val = readl(amd_manager->acp_mmio + ACP_PME_EN); in amd_suspend_runtime()
1302 dev_dbg(amd_manager->dev, "ACP_PME_EN:0x%x\n", val); in amd_suspend_runtime()
1311 struct amd_sdw_manager *amd_manager = dev_get_drvdata(dev); in amd_resume_runtime() local
1312 struct sdw_bus *bus = &amd_manager->bus; in amd_resume_runtime()
1322 if (amd_manager->power_mode_mask & AMD_SDW_CLK_STOP_MODE) { in amd_resume_runtime()
1323 ret = amd_sdw_clock_stop_exit(amd_manager); in amd_resume_runtime()
1326 if (amd_manager->acp_rev >= ACP70_PCI_REV_ID) { in amd_resume_runtime()
1327 ret = amd_sdw_host_wake_enable(amd_manager, false); in amd_resume_runtime()
1331 } else if (amd_manager->power_mode_mask & AMD_SDW_POWER_OFF_MODE) { in amd_resume_runtime()
1332 writel(0x00, amd_manager->acp_mmio + ACP_SW_WAKE_EN(amd_manager->instance)); in amd_resume_runtime()
1333 if (amd_manager->acp_rev >= ACP70_PCI_REV_ID) { in amd_resume_runtime()
1334 ret = amd_sdw_host_wake_enable(amd_manager, false); in amd_resume_runtime()
1338 val = readl(amd_manager->mmio + ACP_SW_CLK_RESUME_CTRL); in amd_resume_runtime()
1341 writel(val, amd_manager->mmio + ACP_SW_CLK_RESUME_CTRL); in amd_resume_runtime()
1342 ret = readl_poll_timeout(amd_manager->mmio + ACP_SW_CLK_RESUME_CTRL, val, in amd_resume_runtime()
1346 writel(0, amd_manager->mmio + ACP_SW_CLK_RESUME_CTRL); in amd_resume_runtime()
1347 amd_manager->clk_stopped = false; in amd_resume_runtime()
1351 amd_init_sdw_manager(amd_manager); in amd_resume_runtime()
1352 amd_enable_sdw_interrupts(amd_manager); in amd_resume_runtime()
1353 ret = amd_enable_sdw_manager(amd_manager); in amd_resume_runtime()
1356 amd_sdw_set_frameshape(amd_manager); in amd_resume_runtime()
1358 if (amd_manager->acp_rev >= ACP70_PCI_REV_ID) { in amd_resume_runtime()
1359 ret = amd_sdw_set_device_state(amd_manager, AMD_SDW_DEVICE_STATE_D0); in amd_resume_runtime()