Lines Matching +full:reset +full:- +full:bps
1 // SPDX-License-Identifier: (GPL-2.0 OR BSD-3-Clause)
5 * Copyright 2023-24 Advanced Micro Devices, Inc.
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()
41 /* SoundWire manager bus reset */ 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()
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()
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()
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()
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()
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()
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()
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()
161 return -EINVAL; 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()
174 if (!amd_manager->wake_en_mask) in amd_sdw_host_wake_enable()
177 switch (amd_manager->instance) { in amd_sdw_host_wake_enable()
185 return -EINVAL; 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()
206 addr = msg->addr + cmd_offset; in amd_sdw_ctl_word_prep()
210 if (msg->flags == SDW_MSG_FLAG_WRITE) in amd_sdw_ctl_word_prep()
211 data = msg->buf[cmd_offset]; in amd_sdw_ctl_word_prep()
213 upper_data = FIELD_PREP(AMD_SDW_MCP_CMD_DEV_ADDR, msg->dev_num); in amd_sdw_ctl_word_prep()
214 upper_data |= FIELD_PREP(AMD_SDW_MCP_CMD_COMMAND, msg->flags + 2); in amd_sdw_ctl_word_prep()
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(0x00, 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()
277 scp_msg.dev_num = msg->dev_num; in amd_program_scp_addr()
279 scp_msg.buf = &msg->addr_page1; in amd_program_scp_addr()
284 scp_msg.buf = &msg->addr_page2; in amd_program_scp_addr()
289 if (response_buf[index] == -ETIMEDOUT) { in amd_program_scp_addr()
290 dev_err_ratelimited(amd_manager->dev, in amd_program_scp_addr()
292 msg->dev_num); in amd_program_scp_addr()
296 dev_err_ratelimited(amd_manager->dev, in amd_program_scp_addr()
298 msg->dev_num); in amd_program_scp_addr()
301 dev_dbg_ratelimited(amd_manager->dev, "SCP_addrpage ignored for Slave %d\n", in amd_program_scp_addr()
302 msg->dev_num); in amd_program_scp_addr()
313 if (msg->page) { in amd_prep_msg()
316 msg->len = 0; in amd_prep_msg()
320 switch (msg->flags) { in amd_prep_msg()
325 dev_err(amd_manager->dev, "Invalid msg cmd: %d\n", msg->flags); in amd_prep_msg()
326 return -EINVAL; in amd_prep_msg()
336 if (msg->flags == SDW_MSG_FLAG_READ) in amd_sdw_fill_msg_resp()
337 msg->buf[offset] = FIELD_GET(AMD_SDW_MCP_RESP_RDATA, response); in amd_sdw_fill_msg_resp()
339 if (response == -ETIMEDOUT) { in amd_sdw_fill_msg_resp()
340 dev_err_ratelimited(amd_manager->dev, "command timeout for Slave %d\n", in amd_sdw_fill_msg_resp()
341 msg->dev_num); in amd_sdw_fill_msg_resp()
344 dev_err_ratelimited(amd_manager->dev, in amd_sdw_fill_msg_resp()
346 msg->dev_num); 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()
350 msg->dev_num); in amd_sdw_fill_msg_resp()
375 for (i = 0; i < msg->len; i++) { in amd_sdw_xfer_msg()
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()
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()
418 mutex_lock(&amd_manager->bus.msg_lock); in amd_sdw_read_and_process_ping_status()
420 mutex_unlock(&amd_manager->bus.msg_lock); in amd_sdw_read_and_process_ping_status()
434 dev_dbg(amd_manager->dev, "slave_stat:0x%x\n", slave_stat); in amd_sdw_read_ping_status()
443 struct sdw_bus_params *b_params = &bus->params; in amd_sdw_compute_params()
445 unsigned int rate, bps; in amd_sdw_compute_params() local
449 hstop = bus->params.col - 1; in amd_sdw_compute_params()
453 list_for_each_entry(m_rt, &bus->m_rt_list, bus_node) { in amd_sdw_compute_params()
454 rate = m_rt->stream->params.rate; in amd_sdw_compute_params()
455 bps = m_rt->stream->params.bps; in amd_sdw_compute_params()
456 sample_int = (bus->params.curr_dr_freq / rate); in amd_sdw_compute_params()
457 list_for_each_entry(p_rt, &m_rt->port_list, port_node) { in amd_sdw_compute_params()
458 port_bo = (p_rt->num * 64) + 1; in amd_sdw_compute_params()
459 dev_dbg(bus->dev, "p_rt->num=%d hstart=%d hstop=%d port_bo=%d\n", in amd_sdw_compute_params()
460 p_rt->num, hstart, hstop, port_bo); in amd_sdw_compute_params()
461 sdw_fill_xport_params(&p_rt->transport_params, p_rt->num, in amd_sdw_compute_params()
464 SDW_BLK_PKG_PER_PORT, p_rt->lane); in amd_sdw_compute_params()
466 sdw_fill_port_params(&p_rt->port_params, in amd_sdw_compute_params()
467 p_rt->num, bps, in amd_sdw_compute_params()
469 b_params->m_data_mode); in amd_sdw_compute_params()
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()
491 frame_fmt_reg = acp63_sdw0_dp_reg[p_params->num].frame_fmt_reg; in amd_sdw_port_params()
494 frame_fmt_reg = acp63_sdw1_dp_reg[p_params->num].frame_fmt_reg; in amd_sdw_port_params()
497 return -EINVAL; in amd_sdw_port_params()
502 frame_fmt_reg = acp70_sdw_dp_reg[p_params->num].frame_fmt_reg; in amd_sdw_port_params()
505 return -EINVAL; in amd_sdw_port_params()
508 dpn_frame_fmt = readl(amd_manager->mmio + frame_fmt_reg); in amd_sdw_port_params()
509 u32p_replace_bits(&dpn_frame_fmt, p_params->flow_mode, AMD_DPN_FRAME_FMT_PFM); in amd_sdw_port_params()
510 u32p_replace_bits(&dpn_frame_fmt, p_params->data_mode, AMD_DPN_FRAME_FMT_PDM); in amd_sdw_port_params()
511 u32p_replace_bits(&dpn_frame_fmt, p_params->bps - 1, AMD_DPN_FRAME_FMT_WORD_LEN); in amd_sdw_port_params()
512 writel(dpn_frame_fmt, amd_manager->mmio + frame_fmt_reg); in amd_sdw_port_params()
529 switch (amd_manager->acp_rev) { in amd_sdw_transport_params()
531 switch (amd_manager->instance) { in amd_sdw_transport_params()
533 frame_fmt_reg = acp63_sdw0_dp_reg[params->port_num].frame_fmt_reg; in amd_sdw_transport_params()
534 sample_int_reg = acp63_sdw0_dp_reg[params->port_num].sample_int_reg; in amd_sdw_transport_params()
535 hctrl_dp0_reg = acp63_sdw0_dp_reg[params->port_num].hctrl_dp0_reg; in amd_sdw_transport_params()
536 offset_reg = acp63_sdw0_dp_reg[params->port_num].offset_reg; in amd_sdw_transport_params()
538 acp63_sdw0_dp_reg[params->port_num].lane_ctrl_ch_en_reg; in amd_sdw_transport_params()
541 frame_fmt_reg = acp63_sdw1_dp_reg[params->port_num].frame_fmt_reg; in amd_sdw_transport_params()
542 sample_int_reg = acp63_sdw1_dp_reg[params->port_num].sample_int_reg; in amd_sdw_transport_params()
543 hctrl_dp0_reg = acp63_sdw1_dp_reg[params->port_num].hctrl_dp0_reg; in amd_sdw_transport_params()
544 offset_reg = acp63_sdw1_dp_reg[params->port_num].offset_reg; in amd_sdw_transport_params()
546 acp63_sdw1_dp_reg[params->port_num].lane_ctrl_ch_en_reg; in amd_sdw_transport_params()
549 return -EINVAL; in amd_sdw_transport_params()
554 frame_fmt_reg = acp70_sdw_dp_reg[params->port_num].frame_fmt_reg; in amd_sdw_transport_params()
555 sample_int_reg = acp70_sdw_dp_reg[params->port_num].sample_int_reg; in amd_sdw_transport_params()
556 hctrl_dp0_reg = acp70_sdw_dp_reg[params->port_num].hctrl_dp0_reg; in amd_sdw_transport_params()
557 offset_reg = acp70_sdw_dp_reg[params->port_num].offset_reg; in amd_sdw_transport_params()
558 lane_ctrl_ch_en_reg = acp70_sdw_dp_reg[params->port_num].lane_ctrl_ch_en_reg; in amd_sdw_transport_params()
561 return -EINVAL; in amd_sdw_transport_params()
563 writel(AMD_SDW_SSP_COUNTER_VAL, amd_manager->mmio + ACP_SW_SSP_COUNTER); in amd_sdw_transport_params()
565 dpn_frame_fmt = readl(amd_manager->mmio + frame_fmt_reg); in amd_sdw_transport_params()
566 u32p_replace_bits(&dpn_frame_fmt, params->blk_pkg_mode, AMD_DPN_FRAME_FMT_BLK_PKG_MODE); in amd_sdw_transport_params()
567 u32p_replace_bits(&dpn_frame_fmt, params->blk_grp_ctrl, AMD_DPN_FRAME_FMT_BLK_GRP_CTRL); in amd_sdw_transport_params()
569 writel(dpn_frame_fmt, amd_manager->mmio + frame_fmt_reg); in amd_sdw_transport_params()
571 dpn_sampleinterval = params->sample_interval - 1; in amd_sdw_transport_params()
572 writel(dpn_sampleinterval, amd_manager->mmio + sample_int_reg); in amd_sdw_transport_params()
574 dpn_hctrl = FIELD_PREP(AMD_DPN_HCTRL_HSTOP, params->hstop); in amd_sdw_transport_params()
575 dpn_hctrl |= FIELD_PREP(AMD_DPN_HCTRL_HSTART, params->hstart); in amd_sdw_transport_params()
576 writel(dpn_hctrl, amd_manager->mmio + hctrl_dp0_reg); in amd_sdw_transport_params()
578 dpn_offsetctrl = FIELD_PREP(AMD_DPN_OFFSET_CTRL_1, params->offset1); in amd_sdw_transport_params()
579 dpn_offsetctrl |= FIELD_PREP(AMD_DPN_OFFSET_CTRL_2, params->offset2); in amd_sdw_transport_params()
580 writel(dpn_offsetctrl, amd_manager->mmio + offset_reg); in amd_sdw_transport_params()
586 dpn_lanectrl = readl(amd_manager->mmio + lane_ctrl_ch_en_reg); in amd_sdw_transport_params()
587 u32p_replace_bits(&dpn_lanectrl, params->lane_ctrl, AMD_DPN_CH_EN_LCTRL); in amd_sdw_transport_params()
588 writel(dpn_lanectrl, amd_manager->mmio + lane_ctrl_ch_en_reg); in amd_sdw_transport_params()
600 switch (amd_manager->acp_rev) { in amd_sdw_port_enable()
602 switch (amd_manager->instance) { in amd_sdw_port_enable()
605 acp63_sdw0_dp_reg[enable_ch->port_num].lane_ctrl_ch_en_reg; in amd_sdw_port_enable()
609 acp63_sdw1_dp_reg[enable_ch->port_num].lane_ctrl_ch_en_reg; in amd_sdw_port_enable()
612 return -EINVAL; in amd_sdw_port_enable()
617 lane_ctrl_ch_en_reg = acp70_sdw_dp_reg[enable_ch->port_num].lane_ctrl_ch_en_reg; in amd_sdw_port_enable()
620 return -EINVAL; in amd_sdw_port_enable()
627 dpn_ch_enable = readl(amd_manager->mmio + lane_ctrl_ch_en_reg); in amd_sdw_port_enable()
628 u32p_replace_bits(&dpn_ch_enable, enable_ch->ch_mask, AMD_DPN_CH_EN_CHMASK); in amd_sdw_port_enable()
629 if (enable_ch->enable) in amd_sdw_port_enable()
630 writel(dpn_ch_enable, amd_manager->mmio + lane_ctrl_ch_en_reg); in amd_sdw_port_enable()
632 writel(0, amd_manager->mmio + lane_ctrl_ch_en_reg); in amd_sdw_port_enable()
646 prop = &bus->prop; in sdw_master_read_amd_prop()
648 snprintf(name, sizeof(name), "mipi-sdw-link-%d-subproperties", bus->link_id); in sdw_master_read_amd_prop()
649 link = device_get_named_child_node(bus->dev, name); in sdw_master_read_amd_prop()
651 dev_err(bus->dev, "Manager node %s not found\n", name); in sdw_master_read_amd_prop()
652 return -EIO; in sdw_master_read_amd_prop()
654 fwnode_property_read_u32(link, "amd-sdw-enable", &quirk_mask); in sdw_master_read_amd_prop()
656 prop->hw_disabled = true; in sdw_master_read_amd_prop()
657 prop->quirks = SDW_MASTER_QUIRKS_CLEAR_INITIAL_CLASH | in sdw_master_read_amd_prop()
660 fwnode_property_read_u32(link, "amd-sdw-wakeup-enable", &wake_en_mask); in sdw_master_read_amd_prop()
661 amd_manager->wake_en_mask = wake_en_mask; in sdw_master_read_amd_prop()
662 fwnode_property_read_u32(link, "amd-sdw-power-mode", &power_mode_mask); in sdw_master_read_amd_prop()
663 amd_manager->power_mode_mask = power_mode_mask; in sdw_master_read_amd_prop()
699 dai_runtime = amd_manager->dai_runtime_array[dai->id]; in amd_sdw_hw_params()
701 return -EIO; in amd_sdw_hw_params()
704 if (substream->stream == SNDRV_PCM_STREAM_CAPTURE) in amd_sdw_hw_params()
708 dev_dbg(amd_manager->dev, "dir:%d dai->id:0x%x\n", dir, dai->id); in amd_sdw_hw_params()
713 sconfig.type = dai_runtime->stream_type; in amd_sdw_hw_params()
715 sconfig.bps = snd_pcm_format_width(params_format(params)); in amd_sdw_hw_params()
721 return -ENOMEM; in amd_sdw_hw_params()
723 pconfig->num = dai->id; in amd_sdw_hw_params()
724 pconfig->ch_mask = (1 << ch) - 1; in amd_sdw_hw_params()
725 ret = sdw_stream_add_master(&amd_manager->bus, &sconfig, in amd_sdw_hw_params()
726 pconfig, 1, dai_runtime->stream); in amd_sdw_hw_params()
728 dev_err(amd_manager->dev, "add manager to stream failed:%d\n", ret); in amd_sdw_hw_params()
739 dai_runtime = amd_manager->dai_runtime_array[dai->id]; in amd_sdw_hw_free()
741 return -EIO; in amd_sdw_hw_free()
743 ret = sdw_stream_remove_master(&amd_manager->bus, dai_runtime->stream); in amd_sdw_hw_free()
745 dev_err(dai->dev, "remove manager from stream %s failed: %d\n", in amd_sdw_hw_free()
746 dai_runtime->stream->name, ret); in amd_sdw_hw_free()
755 dai_runtime = amd_manager->dai_runtime_array[dai->id]; in amd_set_sdw_stream()
759 dev_err(dai->dev, "dai_runtime already allocated for dai %s\n", dai->name); in amd_set_sdw_stream()
760 return -EINVAL; in amd_set_sdw_stream()
766 return -ENOMEM; in amd_set_sdw_stream()
768 dai_runtime->stream_type = SDW_STREAM_PCM; in amd_set_sdw_stream()
769 dai_runtime->bus = &amd_manager->bus; in amd_set_sdw_stream()
770 dai_runtime->stream = stream; in amd_set_sdw_stream()
771 amd_manager->dai_runtime_array[dai->id] = dai_runtime; in amd_set_sdw_stream()
775 dev_err(dai->dev, "dai_runtime not allocated for dai %s\n", dai->name); in amd_set_sdw_stream()
776 return -EINVAL; in amd_set_sdw_stream()
781 amd_manager->dai_runtime_array[dai->id] = NULL; in amd_set_sdw_stream()
796 dai_runtime = amd_manager->dai_runtime_array[dai->id]; in amd_get_sdw_stream()
798 return ERR_PTR(-EINVAL); in amd_get_sdw_stream()
800 return dai_runtime->stream; in amd_get_sdw_stream()
822 dev = amd_manager->dev; in amd_sdw_register_dais()
823 num_dais = amd_manager->num_dout_ports + amd_manager->num_din_ports; in amd_sdw_register_dais()
826 return -ENOMEM; in amd_sdw_register_dais()
832 return -ENOMEM; in amd_sdw_register_dais()
833 amd_manager->dai_runtime_array = dai_runtime_array; in amd_sdw_register_dais()
835 dais[i].name = devm_kasprintf(dev, GFP_KERNEL, "SDW%d Pin%d", amd_manager->instance, in amd_sdw_register_dais()
838 return -ENOMEM; in amd_sdw_register_dais()
839 if (i < amd_manager->num_dout_ports) in amd_sdw_register_dais()
844 stream->channels_min = 2; in amd_sdw_register_dais()
845 stream->channels_max = 2; in amd_sdw_register_dais()
846 stream->rates = SNDRV_PCM_RATE_48000; in amd_sdw_register_dais()
847 stream->formats = SNDRV_PCM_FMTBIT_S16_LE; in amd_sdw_register_dais()
863 if (amd_manager->status[0] == SDW_SLAVE_ATTACHED) { in amd_sdw_update_slave_status_work()
864 writel(0, amd_manager->mmio + ACP_SW_STATE_CHANGE_STATUS_MASK_0TO7); in amd_sdw_update_slave_status_work()
865 writel(0, amd_manager->mmio + ACP_SW_STATE_CHANGE_STATUS_MASK_8TO11); in amd_sdw_update_slave_status_work()
869 sdw_handle_slave_status(&amd_manager->bus, amd_manager->status); in amd_sdw_update_slave_status_work()
877 if (amd_manager->status[0] == SDW_SLAVE_ATTACHED) { in amd_sdw_update_slave_status_work()
879 writel(AMD_SDW_IRQ_MASK_0TO7, amd_manager->mmio + in amd_sdw_update_slave_status_work()
881 writel(AMD_SDW_IRQ_MASK_8TO11, amd_manager->mmio + in amd_sdw_update_slave_status_work()
886 dev_err_ratelimited(amd_manager->dev, in amd_sdw_update_slave_status_work()
901 memset(amd_manager->status, 0, sizeof(amd_manager->status)); in amd_sdw_update_slave_status()
904 dev_dbg(amd_manager->dev, "status_change_0to7:0x%x status_change_8to11:0x%x\n", in amd_sdw_update_slave_status()
919 dev_dbg(amd_manager->dev, "SoundWire Wake event reported\n"); in amd_sdw_process_wake_event()
920 pm_request_resume(amd_manager->dev); in amd_sdw_process_wake_event()
921 writel(0x00, amd_manager->acp_mmio + ACP_SW_WAKE_EN(amd_manager->instance)); in amd_sdw_process_wake_event()
922 writel(0x00, amd_manager->mmio + ACP_SW_STATE_CHANGE_STATUS_8TO11); in amd_sdw_process_wake_event()
932 status_change_8to11 = readl(amd_manager->mmio + ACP_SW_STATE_CHANGE_STATUS_8TO11); in amd_sdw_irq_thread()
933 status_change_0to7 = readl(amd_manager->mmio + ACP_SW_STATE_CHANGE_STATUS_0TO7); in amd_sdw_irq_thread()
934 dev_dbg(amd_manager->dev, "[SDW%d] SDW INT: 0to7=0x%x, 8to11=0x%x\n", in amd_sdw_irq_thread()
935 amd_manager->instance, status_change_0to7, status_change_8to11); in amd_sdw_irq_thread()
946 schedule_work(&amd_manager->amd_sdw_work); in amd_sdw_irq_thread()
947 writel(0x00, amd_manager->mmio + ACP_SW_STATE_CHANGE_STATUS_8TO11); in amd_sdw_irq_thread()
948 writel(0x00, amd_manager->mmio + ACP_SW_STATE_CHANGE_STATUS_0TO7); in amd_sdw_irq_thread()
956 prop = &amd_manager->bus.prop; in amd_sdw_manager_start()
957 if (!prop->hw_disabled) { in amd_sdw_manager_start()
968 pm_runtime_set_autosuspend_delay(amd_manager->dev, AMD_SDW_MASTER_SUSPEND_DELAY_MS); in amd_sdw_manager_start()
969 pm_runtime_use_autosuspend(amd_manager->dev); in amd_sdw_manager_start()
970 pm_runtime_mark_last_busy(amd_manager->dev); in amd_sdw_manager_start()
971 pm_runtime_set_active(amd_manager->dev); in amd_sdw_manager_start()
972 pm_runtime_enable(amd_manager->dev); in amd_sdw_manager_start()
978 const struct acp_sdw_pdata *pdata = pdev->dev.platform_data; in amd_sdw_manager_probe()
980 struct device *dev = &pdev->dev; in amd_sdw_manager_probe()
988 return -ENOMEM; in amd_sdw_manager_probe()
992 return -ENOMEM; in amd_sdw_manager_probe()
994 amd_manager->acp_mmio = devm_ioremap(dev, res->start, resource_size(res)); in amd_sdw_manager_probe()
995 if (!amd_manager->acp_mmio) { in amd_sdw_manager_probe()
997 return -ENOMEM; in amd_sdw_manager_probe()
999 amd_manager->instance = pdata->instance; in amd_sdw_manager_probe()
1000 amd_manager->mmio = amd_manager->acp_mmio + in amd_sdw_manager_probe()
1001 (amd_manager->instance * SDW_MANAGER_REG_OFFSET); in amd_sdw_manager_probe()
1002 amd_manager->acp_sdw_lock = pdata->acp_sdw_lock; in amd_sdw_manager_probe()
1003 amd_manager->acp_rev = pdata->acp_rev; in amd_sdw_manager_probe()
1004 amd_manager->cols_index = sdw_find_col_index(AMD_SDW_DEFAULT_COLUMNS); in amd_sdw_manager_probe()
1005 amd_manager->rows_index = sdw_find_row_index(AMD_SDW_DEFAULT_ROWS); in amd_sdw_manager_probe()
1006 amd_manager->dev = dev; in amd_sdw_manager_probe()
1007 amd_manager->bus.ops = &amd_sdw_ops; in amd_sdw_manager_probe()
1008 amd_manager->bus.port_ops = &amd_sdw_port_ops; in amd_sdw_manager_probe()
1009 amd_manager->bus.compute_params = &amd_sdw_compute_params; in amd_sdw_manager_probe()
1010 amd_manager->bus.clk_stop_timeout = 200; in amd_sdw_manager_probe()
1011 amd_manager->bus.link_id = amd_manager->instance; in amd_sdw_manager_probe()
1019 amd_manager->bus.controller_id = 0; in amd_sdw_manager_probe()
1020 dev_dbg(dev, "acp_rev:0x%x\n", amd_manager->acp_rev); in amd_sdw_manager_probe()
1021 switch (amd_manager->acp_rev) { in amd_sdw_manager_probe()
1023 switch (amd_manager->instance) { in amd_sdw_manager_probe()
1025 amd_manager->num_dout_ports = AMD_ACP63_SDW0_MAX_TX_PORTS; in amd_sdw_manager_probe()
1026 amd_manager->num_din_ports = AMD_ACP63_SDW0_MAX_RX_PORTS; in amd_sdw_manager_probe()
1029 amd_manager->num_dout_ports = AMD_ACP63_SDW1_MAX_TX_PORTS; in amd_sdw_manager_probe()
1030 amd_manager->num_din_ports = AMD_ACP63_SDW1_MAX_RX_PORTS; in amd_sdw_manager_probe()
1033 return -EINVAL; in amd_sdw_manager_probe()
1038 amd_manager->num_dout_ports = AMD_ACP70_SDW_MAX_TX_PORTS; in amd_sdw_manager_probe()
1039 amd_manager->num_din_ports = AMD_ACP70_SDW_MAX_RX_PORTS; in amd_sdw_manager_probe()
1042 return -EINVAL; in amd_sdw_manager_probe()
1045 params = &amd_manager->bus.params; in amd_sdw_manager_probe()
1047 params->col = AMD_SDW_DEFAULT_COLUMNS; in amd_sdw_manager_probe()
1048 params->row = AMD_SDW_DEFAULT_ROWS; in amd_sdw_manager_probe()
1049 prop = &amd_manager->bus.prop; in amd_sdw_manager_probe()
1050 prop->clk_freq = &amd_sdw_freq_tbl[0]; in amd_sdw_manager_probe()
1051 prop->mclk_freq = AMD_SDW_BUS_BASE_FREQ; in amd_sdw_manager_probe()
1052 prop->max_clk_freq = AMD_SDW_DEFAULT_CLK_FREQ; in amd_sdw_manager_probe()
1054 ret = sdw_bus_master_add(&amd_manager->bus, dev, dev->fwnode); in amd_sdw_manager_probe()
1062 sdw_bus_master_delete(&amd_manager->bus); in amd_sdw_manager_probe()
1066 INIT_WORK(&amd_manager->amd_sdw_irq_thread, amd_sdw_irq_thread); in amd_sdw_manager_probe()
1067 INIT_WORK(&amd_manager->amd_sdw_work, amd_sdw_update_slave_status_work); in amd_sdw_manager_probe()
1073 struct amd_sdw_manager *amd_manager = dev_get_drvdata(&pdev->dev); in amd_sdw_manager_remove()
1076 pm_runtime_disable(&pdev->dev); in amd_sdw_manager_remove()
1078 sdw_bus_master_delete(&amd_manager->bus); in amd_sdw_manager_remove()
1081 dev_err(&pdev->dev, "Failed to disable device (%pe)\n", ERR_PTR(ret)); in amd_sdw_manager_remove()
1089 ret = sdw_bus_prep_clk_stop(&amd_manager->bus); in amd_sdw_clock_stop()
1090 if (ret < 0 && ret != -ENODATA) { in amd_sdw_clock_stop()
1091 dev_err(amd_manager->dev, "prepare clock stop failed %d", ret); in amd_sdw_clock_stop()
1094 ret = sdw_bus_clk_stop(&amd_manager->bus); in amd_sdw_clock_stop()
1095 if (ret < 0 && ret != -ENODATA) { in amd_sdw_clock_stop()
1096 dev_err(amd_manager->dev, "bus clock stop failed %d", ret); in amd_sdw_clock_stop()
1100 ret = readl_poll_timeout(amd_manager->mmio + ACP_SW_CLK_RESUME_CTRL, val, in amd_sdw_clock_stop()
1103 dev_err(amd_manager->dev, "SDW%x clock stop failed\n", amd_manager->instance); in amd_sdw_clock_stop()
1107 amd_manager->clk_stopped = true; in amd_sdw_clock_stop()
1108 if (amd_manager->wake_en_mask) in amd_sdw_clock_stop()
1109 writel(0x01, amd_manager->acp_mmio + ACP_SW_WAKE_EN(amd_manager->instance)); in amd_sdw_clock_stop()
1111 dev_dbg(amd_manager->dev, "SDW%x clock stop successful\n", amd_manager->instance); in amd_sdw_clock_stop()
1120 if (amd_manager->clk_stopped) { in amd_sdw_clock_stop_exit()
1121 val = readl(amd_manager->mmio + ACP_SW_CLK_RESUME_CTRL); in amd_sdw_clock_stop_exit()
1123 writel(val, amd_manager->mmio + ACP_SW_CLK_RESUME_CTRL); in amd_sdw_clock_stop_exit()
1124 ret = readl_poll_timeout(amd_manager->mmio + ACP_SW_CLK_RESUME_CTRL, val, in amd_sdw_clock_stop_exit()
1128 writel(0, amd_manager->mmio + ACP_SW_CLK_RESUME_CTRL); in amd_sdw_clock_stop_exit()
1129 ret = sdw_bus_exit_clk_stop(&amd_manager->bus); in amd_sdw_clock_stop_exit()
1131 dev_err(amd_manager->dev, "bus failed to exit clock stop %d\n", in amd_sdw_clock_stop_exit()
1133 amd_manager->clk_stopped = false; in amd_sdw_clock_stop_exit()
1136 if (amd_manager->clk_stopped) { in amd_sdw_clock_stop_exit()
1137 dev_err(amd_manager->dev, "SDW%x clock stop exit failed\n", amd_manager->instance); in amd_sdw_clock_stop_exit()
1140 dev_dbg(amd_manager->dev, "SDW%x clock stop exit successful\n", amd_manager->instance); in amd_sdw_clock_stop_exit()
1149 if (!slave->probed) { in amd_resume_child_device()
1153 if (!slave->dev_num_sticky) { in amd_resume_child_device()
1168 struct sdw_bus *bus = &amd_manager->bus; in amd_pm_prepare()
1171 if (bus->prop.hw_disabled) { in amd_pm_prepare()
1172 dev_dbg(bus->dev, "SoundWire manager %d is disabled, ignoring\n", in amd_pm_prepare()
1173 bus->link_id); in amd_pm_prepare()
1181 if (amd_manager->power_mode_mask & AMD_SDW_CLK_STOP_MODE) { in amd_pm_prepare()
1184 dev_err(bus->dev, "pm_request_resume failed: %d\n", ret); in amd_pm_prepare()
1193 ret = device_for_each_child(bus->dev, NULL, amd_resume_child_device); in amd_pm_prepare()
1202 struct sdw_bus *bus = &amd_manager->bus; in amd_suspend()
1205 if (bus->prop.hw_disabled) { in amd_suspend()
1206 dev_dbg(bus->dev, "SoundWire manager %d is disabled, ignoring\n", in amd_suspend()
1207 bus->link_id); in amd_suspend()
1211 if (amd_manager->power_mode_mask & AMD_SDW_CLK_STOP_MODE) { in amd_suspend()
1213 if (amd_manager->acp_rev >= ACP70_PCI_REV_ID) { in amd_suspend()
1221 } else if (amd_manager->power_mode_mask & AMD_SDW_POWER_OFF_MODE) { in amd_suspend()
1223 if (amd_manager->acp_rev >= ACP70_PCI_REV_ID) { in amd_suspend()
1230 * clock stop should be invoked first before powering-off in amd_suspend()
1239 if (amd_manager->acp_rev >= ACP70_PCI_REV_ID) { in amd_suspend()
1250 struct sdw_bus *bus = &amd_manager->bus; in amd_suspend_runtime()
1254 if (bus->prop.hw_disabled) { in amd_suspend_runtime()
1255 dev_dbg(bus->dev, "SoundWire manager %d is disabled,\n", in amd_suspend_runtime()
1256 bus->link_id); in amd_suspend_runtime()
1259 if (amd_manager->power_mode_mask & AMD_SDW_CLK_STOP_MODE) { in amd_suspend_runtime()
1261 if (amd_manager->acp_rev >= ACP70_PCI_REV_ID) { in amd_suspend_runtime()
1269 } else if (amd_manager->power_mode_mask & AMD_SDW_POWER_OFF_MODE) { in amd_suspend_runtime()
1271 if (amd_manager->acp_rev >= ACP70_PCI_REV_ID) { in amd_suspend_runtime()
1283 if (amd_manager->acp_rev >= ACP70_PCI_REV_ID) { in amd_suspend_runtime()
1287 if (amd_manager->wake_en_mask) { in amd_suspend_runtime()
1288 val = readl(amd_manager->acp_mmio + ACP_PME_EN); in amd_suspend_runtime()
1290 writel(1, amd_manager->acp_mmio + ACP_PME_EN); in amd_suspend_runtime()
1291 val = readl(amd_manager->acp_mmio + ACP_PME_EN); in amd_suspend_runtime()
1292 dev_dbg(amd_manager->dev, "ACP_PME_EN:0x%x\n", val); in amd_suspend_runtime()
1302 struct sdw_bus *bus = &amd_manager->bus; in amd_resume_runtime()
1306 if (bus->prop.hw_disabled) { in amd_resume_runtime()
1307 dev_dbg(bus->dev, "SoundWire manager %d is disabled, ignoring\n", in amd_resume_runtime()
1308 bus->link_id); in amd_resume_runtime()
1312 if (amd_manager->power_mode_mask & AMD_SDW_CLK_STOP_MODE) { in amd_resume_runtime()
1316 if (amd_manager->acp_rev >= ACP70_PCI_REV_ID) { in amd_resume_runtime()
1321 } else if (amd_manager->power_mode_mask & AMD_SDW_POWER_OFF_MODE) { in amd_resume_runtime()
1322 writel(0x00, amd_manager->acp_mmio + ACP_SW_WAKE_EN(amd_manager->instance)); in amd_resume_runtime()
1323 if (amd_manager->acp_rev >= ACP70_PCI_REV_ID) { in amd_resume_runtime()
1328 val = readl(amd_manager->mmio + ACP_SW_CLK_RESUME_CTRL); in amd_resume_runtime()
1331 writel(val, amd_manager->mmio + ACP_SW_CLK_RESUME_CTRL); in amd_resume_runtime()
1332 ret = readl_poll_timeout(amd_manager->mmio + ACP_SW_CLK_RESUME_CTRL, val, in amd_resume_runtime()
1336 writel(0, amd_manager->mmio + ACP_SW_CLK_RESUME_CTRL); in amd_resume_runtime()
1337 amd_manager->clk_stopped = false; in amd_resume_runtime()
1348 if (amd_manager->acp_rev >= ACP70_PCI_REV_ID) { in amd_resume_runtime()