Lines Matching refs:cdns

199 static inline u32 cdns_readl(struct sdw_cdns *cdns, int offset)  in cdns_readl()  argument
201 return readl(cdns->registers + offset); in cdns_readl()
204 static inline void cdns_writel(struct sdw_cdns *cdns, int offset, u32 value) in cdns_writel() argument
206 writel(value, cdns->registers + offset); in cdns_writel()
209 static inline void cdns_updatel(struct sdw_cdns *cdns, in cdns_updatel() argument
214 tmp = cdns_readl(cdns, offset); in cdns_updatel()
216 cdns_writel(cdns, offset, tmp); in cdns_updatel()
219 static int cdns_set_wait(struct sdw_cdns *cdns, int offset, u32 mask, u32 value) in cdns_set_wait() argument
226 reg_read = readl(cdns->registers + offset); in cdns_set_wait()
237 static int cdns_clear_bit(struct sdw_cdns *cdns, int offset, u32 value) in cdns_clear_bit() argument
239 writel(value, cdns->registers + offset); in cdns_clear_bit()
242 return cdns_set_wait(cdns, offset, value, 0); in cdns_clear_bit()
249 static int cdns_config_update(struct sdw_cdns *cdns) in cdns_config_update() argument
253 if (sdw_cdns_is_clock_stop(cdns)) { in cdns_config_update()
254 dev_err(cdns->dev, "Cannot program MCP_CONFIG_UPDATE in ClockStopMode\n"); in cdns_config_update()
258 ret = cdns_clear_bit(cdns, CDNS_MCP_CONFIG_UPDATE, in cdns_config_update()
261 dev_err(cdns->dev, "Config update timedout\n"); in cdns_config_update()
273 static ssize_t cdns_sprintf(struct sdw_cdns *cdns, in cdns_sprintf() argument
277 "%4x\t%8x\n", reg, cdns_readl(cdns, reg)); in cdns_sprintf()
282 struct sdw_cdns *cdns = s->private; in cdns_reg_show() local
296 ret += cdns_sprintf(cdns, buf, ret, i); in cdns_reg_show()
302 ret += cdns_sprintf(cdns, buf, ret, i); in cdns_reg_show()
306 ret += cdns_sprintf(cdns, buf, ret, CDNS_MCP_SSP_CTRL0); in cdns_reg_show()
307 ret += cdns_sprintf(cdns, buf, ret, CDNS_MCP_SSP_CTRL1); in cdns_reg_show()
308 ret += cdns_sprintf(cdns, buf, ret, CDNS_MCP_CLK_CTRL0); in cdns_reg_show()
309 ret += cdns_sprintf(cdns, buf, ret, CDNS_MCP_CLK_CTRL1); in cdns_reg_show()
314 num_ports = cdns->num_ports; in cdns_reg_show()
321 ret += cdns_sprintf(cdns, buf, ret, j); in cdns_reg_show()
332 ret += cdns_sprintf(cdns, buf, ret, j); in cdns_reg_show()
338 ret += cdns_sprintf(cdns, buf, ret, in cdns_reg_show()
346 ret += cdns_sprintf(cdns, buf, ret, CDNS_PDI_CONFIG(i)); in cdns_reg_show()
357 struct sdw_cdns *cdns = data; in cdns_hw_reset() local
366 ret = sdw_cdns_exit_reset(cdns); in cdns_hw_reset()
368 dev_dbg(cdns->dev, "link hw_reset done: %d\n", ret); in cdns_hw_reset()
377 struct sdw_cdns *cdns = data; in cdns_parity_error_injection() local
384 bus = &cdns->bus; in cdns_parity_error_injection()
392 dev_err_ratelimited(cdns->dev, in cdns_parity_error_injection()
411 cdns_updatel(cdns, CDNS_MCP_CMDCTRL, in cdns_parity_error_injection()
416 cdns_updatel(cdns, CDNS_MCP_CONFIG_UPDATE, in cdns_parity_error_injection()
421 ret = sdw_bread_no_pm_unlocked(&cdns->bus, 0xf, SDW_SCP_DEVID_0); in cdns_parity_error_injection()
422 dev_info(cdns->dev, "parity error injection, read: %d\n", ret); in cdns_parity_error_injection()
425 cdns_updatel(cdns, CDNS_MCP_CMDCTRL, in cdns_parity_error_injection()
430 cdns_updatel(cdns, CDNS_MCP_CONFIG_UPDATE, in cdns_parity_error_injection()
455 struct sdw_cdns *cdns = data; in cdns_set_pdi_loopback_source() local
456 unsigned int pdi_out_num = cdns->pcm.num_bd + cdns->pcm.num_out; in cdns_set_pdi_loopback_source()
464 cdns->pdi_loopback_source = value; in cdns_set_pdi_loopback_source()
472 struct sdw_cdns *cdns = data; in cdns_set_pdi_loopback_target() local
473 unsigned int pdi_in_num = cdns->pcm.num_bd + cdns->pcm.num_in; in cdns_set_pdi_loopback_target()
481 cdns->pdi_loopback_target = value; in cdns_set_pdi_loopback_target()
492 void sdw_cdns_debugfs_init(struct sdw_cdns *cdns, struct dentry *root) in sdw_cdns_debugfs_init() argument
494 debugfs_create_file("cdns-registers", 0400, root, cdns, &cdns_reg_fops); in sdw_cdns_debugfs_init()
496 debugfs_create_file("cdns-hw-reset", 0200, root, cdns, in sdw_cdns_debugfs_init()
499 debugfs_create_file("cdns-parity-error-injection", 0200, root, cdns, in sdw_cdns_debugfs_init()
502 cdns->pdi_loopback_source = -1; in sdw_cdns_debugfs_init()
503 cdns->pdi_loopback_target = -1; in sdw_cdns_debugfs_init()
505 debugfs_create_file("cdns-pdi-loopback-source", 0200, root, cdns, in sdw_cdns_debugfs_init()
508 debugfs_create_file("cdns-pdi-loopback-target", 0200, root, cdns, in sdw_cdns_debugfs_init()
520 cdns_fill_msg_resp(struct sdw_cdns *cdns, in cdns_fill_msg_resp() argument
528 if (!(cdns->response_buf[i] & CDNS_MCP_RESP_ACK)) { in cdns_fill_msg_resp()
530 dev_vdbg(cdns->dev, "Msg Ack not received, cmd %d\n", i); in cdns_fill_msg_resp()
532 if (cdns->response_buf[i] & CDNS_MCP_RESP_NACK) { in cdns_fill_msg_resp()
534 dev_err_ratelimited(cdns->dev, "Msg NACK received, cmd %d\n", i); in cdns_fill_msg_resp()
539 dev_err_ratelimited(cdns->dev, "Msg NACKed for Slave %d\n", msg->dev_num); in cdns_fill_msg_resp()
544 dev_dbg_ratelimited(cdns->dev, "Msg ignored for Slave %d\n", msg->dev_num); in cdns_fill_msg_resp()
552 cdns->response_buf[i]); in cdns_fill_msg_resp()
558 static void cdns_read_response(struct sdw_cdns *cdns) in cdns_read_response() argument
564 BUILD_BUG_ON(ARRAY_SIZE(cdns->response_buf) < CDNS_MCP_CMD_LEN + 2); in cdns_read_response()
566 num_resp = cdns_readl(cdns, CDNS_MCP_FIFOSTAT); in cdns_read_response()
568 if (num_resp > ARRAY_SIZE(cdns->response_buf)) { in cdns_read_response()
569 dev_warn(cdns->dev, "RX AVAIL %d too long\n", num_resp); in cdns_read_response()
570 num_resp = ARRAY_SIZE(cdns->response_buf); in cdns_read_response()
576 cdns->response_buf[i] = cdns_readl(cdns, cmd_base); in cdns_read_response()
582 _cdns_xfer_msg(struct sdw_cdns *cdns, struct sdw_msg *msg, int cmd, in _cdns_xfer_msg() argument
590 if (cdns->msg_count != count) { in _cdns_xfer_msg()
591 cdns_writel(cdns, CDNS_MCP_FIFOLEVEL, count); in _cdns_xfer_msg()
592 cdns->msg_count = count; in _cdns_xfer_msg()
608 cdns_writel(cdns, base, data); in _cdns_xfer_msg()
616 time = wait_for_completion_timeout(&cdns->tx_complete, in _cdns_xfer_msg()
619 dev_err(cdns->dev, "IO transfer timed out, cmd %d device %d addr %x len %d\n", in _cdns_xfer_msg()
624 cdns_read_response(cdns); in _cdns_xfer_msg()
629 return cdns_fill_msg_resp(cdns, msg, count, offset); in _cdns_xfer_msg()
633 cdns_program_scp_addr(struct sdw_cdns *cdns, struct sdw_msg *msg) in cdns_program_scp_addr() argument
641 if (cdns->msg_count != CDNS_SCP_RX_FIFOLEVEL) { in cdns_program_scp_addr()
642 cdns_writel(cdns, CDNS_MCP_FIFOLEVEL, CDNS_SCP_RX_FIFOLEVEL); in cdns_program_scp_addr()
643 cdns->msg_count = CDNS_SCP_RX_FIFOLEVEL; in cdns_program_scp_addr()
657 cdns_writel(cdns, base, data[0]); in cdns_program_scp_addr()
659 cdns_writel(cdns, base, data[1]); in cdns_program_scp_addr()
661 time = wait_for_completion_timeout(&cdns->tx_complete, in cdns_program_scp_addr()
664 dev_err(cdns->dev, "SCP Msg trf timed out\n"); in cdns_program_scp_addr()
671 if (!(cdns->response_buf[i] & CDNS_MCP_RESP_ACK)) { in cdns_program_scp_addr()
673 dev_err(cdns->dev, "Program SCP Ack not received\n"); in cdns_program_scp_addr()
674 if (cdns->response_buf[i] & CDNS_MCP_RESP_NACK) { in cdns_program_scp_addr()
676 dev_err(cdns->dev, "Program SCP NACK received\n"); in cdns_program_scp_addr()
683 dev_err_ratelimited(cdns->dev, in cdns_program_scp_addr()
689 dev_dbg_ratelimited(cdns->dev, in cdns_program_scp_addr()
697 static int cdns_prep_msg(struct sdw_cdns *cdns, struct sdw_msg *msg, int *cmd) in cdns_prep_msg() argument
702 ret = cdns_program_scp_addr(cdns, msg); in cdns_prep_msg()
719 dev_err(cdns->dev, "Invalid msg cmd: %d\n", msg->flags); in cdns_prep_msg()
729 struct sdw_cdns *cdns = bus_to_cdns(bus); in cdns_xfer_msg() local
732 ret = cdns_prep_msg(cdns, msg, &cmd); in cdns_xfer_msg()
737 ret = _cdns_xfer_msg(cdns, msg, cmd, i * CDNS_MCP_CMD_LEN, in cdns_xfer_msg()
746 return _cdns_xfer_msg(cdns, msg, cmd, i * CDNS_MCP_CMD_LEN, in cdns_xfer_msg()
754 struct sdw_cdns *cdns = bus_to_cdns(bus); in cdns_xfer_msg_defer() local
763 ret = cdns_prep_msg(cdns, msg, &cmd); in cdns_xfer_msg_defer()
767 return _cdns_xfer_msg(cdns, msg, cmd, 0, msg->len, true); in cdns_xfer_msg_defer()
773 struct sdw_cdns *cdns = bus_to_cdns(bus); in cdns_read_ping_status() local
775 return cdns_readl(cdns, CDNS_MCP_SLAVE_STAT); in cdns_read_ping_status()
783 static int cdns_update_slave_status(struct sdw_cdns *cdns, in cdns_update_slave_status() argument
829 val = cdns_readl(cdns, CDNS_MCP_SLAVE_STAT); in cdns_update_slave_status()
851 return sdw_handle_slave_status(&cdns->bus, status); in cdns_update_slave_status()
863 struct sdw_cdns *cdns = dev_id; in sdw_cdns_irq() local
867 if (!cdns->link_up) in sdw_cdns_irq()
870 int_status = cdns_readl(cdns, CDNS_MCP_INTSTAT); in sdw_cdns_irq()
880 struct sdw_bus *bus = &cdns->bus; in sdw_cdns_irq()
883 cdns_read_response(cdns); in sdw_cdns_irq()
886 cdns_fill_msg_resp(cdns, defer->msg, in sdw_cdns_irq()
890 complete(&cdns->tx_complete); in sdw_cdns_irq()
896 dev_err_ratelimited(cdns->dev, "Parity error\n"); in sdw_cdns_irq()
901 dev_err_ratelimited(cdns->dev, "Bus clash for control word\n"); in sdw_cdns_irq()
909 dev_err_ratelimited(cdns->dev, "Bus clash for data word\n"); in sdw_cdns_irq()
912 if (cdns->bus.params.m_data_mode != SDW_PORT_DATA_MODE_NORMAL && in sdw_cdns_irq()
917 port_intstat = cdns_readl(cdns, CDNS_MCP_PORT_INTSTAT); in sdw_cdns_irq()
918 dev_err_ratelimited(cdns->dev, "DP interrupt: PortIntStat %8x\n", in sdw_cdns_irq()
922 cdns_writel(cdns, CDNS_MCP_PORT_INTSTAT, port_intstat); in sdw_cdns_irq()
927 cdns_updatel(cdns, CDNS_MCP_INTMASK, in sdw_cdns_irq()
939 if (cdns->interrupt_enabled) in sdw_cdns_irq()
940 schedule_work(&cdns->work); in sdw_cdns_irq()
943 cdns_writel(cdns, CDNS_MCP_INTSTAT, int_status); in sdw_cdns_irq()
956 struct sdw_cdns *cdns = in cdns_update_slave_status_work() local
967 cdns_writel(cdns, CDNS_MCP_INTSTAT, CDNS_MCP_INT_SLAVE_MASK); in cdns_update_slave_status_work()
969 slave0 = cdns_readl(cdns, CDNS_MCP_SLAVE_INTSTAT0); in cdns_update_slave_status_work()
970 slave1 = cdns_readl(cdns, CDNS_MCP_SLAVE_INTSTAT1); in cdns_update_slave_status_work()
976 cdns_writel(cdns, CDNS_MCP_SLAVE_INTSTAT0, slave0); in cdns_update_slave_status_work()
977 cdns_writel(cdns, CDNS_MCP_SLAVE_INTSTAT1, slave1); in cdns_update_slave_status_work()
982 dev_dbg_ratelimited(cdns->dev, "Slave status change: 0x%llx\n", slave_intstat); in cdns_update_slave_status_work()
985 cdns_update_slave_status(cdns, slave_intstat); in cdns_update_slave_status_work()
1009 device0_status = cdns_readl(cdns, CDNS_MCP_SLAVE_STAT); in cdns_update_slave_status_work()
1014 dev_dbg_ratelimited(cdns->dev, in cdns_update_slave_status_work()
1020 dev_err_ratelimited(cdns->dev, in cdns_update_slave_status_work()
1027 cdns_updatel(cdns, CDNS_MCP_INTMASK, in cdns_update_slave_status_work()
1033 void sdw_cdns_check_self_clearing_bits(struct sdw_cdns *cdns, const char *string, in sdw_cdns_check_self_clearing_bits() argument
1043 mcp_control = cdns_readl(cdns, CDNS_MCP_CONTROL); in sdw_cdns_check_self_clearing_bits()
1047 dev_err(cdns->dev, "%s failed: MCP_CONTROL_CMD_RST is not cleared\n", string); in sdw_cdns_check_self_clearing_bits()
1049 dev_err(cdns->dev, "%s failed: MCP_CONTROL_SOFT_RST is not cleared\n", string); in sdw_cdns_check_self_clearing_bits()
1051 dev_err(cdns->dev, "%s failed: MCP_CONTROL_SW_RST is not cleared\n", string); in sdw_cdns_check_self_clearing_bits()
1053 dev_err(cdns->dev, "%s failed: MCP_CONTROL_CLK_STOP_CLR is not cleared\n", string); in sdw_cdns_check_self_clearing_bits()
1054 mcp_config_update = cdns_readl(cdns, CDNS_MCP_CONFIG_UPDATE); in sdw_cdns_check_self_clearing_bits()
1056 dev_err(cdns->dev, "%s failed: MCP_CONFIG_UPDATE_BIT is not cleared\n", string); in sdw_cdns_check_self_clearing_bits()
1061 dev_err(cdns->dev, "%s failed: MCP_CONTROL_HW_RST is not cleared\n", string); in sdw_cdns_check_self_clearing_bits()
1065 dev_dbg(cdns->dev, "%s: MCP_CONTROL_HW_RST is not cleared at iteration %d\n", string, i); in sdw_cdns_check_self_clearing_bits()
1069 mcp_control = cdns_readl(cdns, CDNS_MCP_CONTROL); in sdw_cdns_check_self_clearing_bits()
1083 int sdw_cdns_exit_reset(struct sdw_cdns *cdns) in sdw_cdns_exit_reset() argument
1088 cdns_updatel(cdns, CDNS_MCP_CONTROL, in sdw_cdns_exit_reset()
1093 cdns_updatel(cdns, CDNS_MCP_CONFIG_UPDATE, in sdw_cdns_exit_reset()
1108 static void cdns_enable_slave_interrupts(struct sdw_cdns *cdns, bool state) in cdns_enable_slave_interrupts() argument
1112 mask = cdns_readl(cdns, CDNS_MCP_INTMASK); in cdns_enable_slave_interrupts()
1118 cdns_writel(cdns, CDNS_MCP_INTMASK, mask); in cdns_enable_slave_interrupts()
1126 int sdw_cdns_enable_interrupt(struct sdw_cdns *cdns, bool state) in sdw_cdns_enable_interrupt() argument
1146 if (cdns->bus.params.m_data_mode != SDW_PORT_DATA_MODE_NORMAL) in sdw_cdns_enable_interrupt()
1166 slave_state = cdns_readl(cdns, CDNS_MCP_SLAVE_INTSTAT0); in sdw_cdns_enable_interrupt()
1167 cdns_writel(cdns, CDNS_MCP_SLAVE_INTSTAT0, slave_state); in sdw_cdns_enable_interrupt()
1168 slave_state = cdns_readl(cdns, CDNS_MCP_SLAVE_INTSTAT1); in sdw_cdns_enable_interrupt()
1169 cdns_writel(cdns, CDNS_MCP_SLAVE_INTSTAT1, slave_state); in sdw_cdns_enable_interrupt()
1171 cdns->interrupt_enabled = state; in sdw_cdns_enable_interrupt()
1183 cancel_work_sync(&cdns->work); in sdw_cdns_enable_interrupt()
1185 cdns_writel(cdns, CDNS_MCP_SLAVE_INTMASK0, slave_intmask0); in sdw_cdns_enable_interrupt()
1186 cdns_writel(cdns, CDNS_MCP_SLAVE_INTMASK1, slave_intmask1); in sdw_cdns_enable_interrupt()
1187 cdns_writel(cdns, CDNS_MCP_INTMASK, mask); in sdw_cdns_enable_interrupt()
1193 static int cdns_allocate_pdi(struct sdw_cdns *cdns, in cdns_allocate_pdi() argument
1203 pdi = devm_kcalloc(cdns->dev, num, sizeof(*pdi), GFP_KERNEL); in cdns_allocate_pdi()
1221 int sdw_cdns_pdi_init(struct sdw_cdns *cdns, in sdw_cdns_pdi_init() argument
1228 cdns->pcm.num_bd = config.pcm_bd; in sdw_cdns_pdi_init()
1229 cdns->pcm.num_in = config.pcm_in; in sdw_cdns_pdi_init()
1230 cdns->pcm.num_out = config.pcm_out; in sdw_cdns_pdi_init()
1233 stream = &cdns->pcm; in sdw_cdns_pdi_init()
1238 ret = cdns_allocate_pdi(cdns, &stream->bd, in sdw_cdns_pdi_init()
1245 ret = cdns_allocate_pdi(cdns, &stream->in, in sdw_cdns_pdi_init()
1252 ret = cdns_allocate_pdi(cdns, &stream->out, in sdw_cdns_pdi_init()
1259 cdns->num_ports = stream->num_pdi; in sdw_cdns_pdi_init()
1280 static void cdns_init_clock_ctrl(struct sdw_cdns *cdns) in cdns_init_clock_ctrl() argument
1282 struct sdw_bus *bus = &cdns->bus; in cdns_init_clock_ctrl()
1291 cdns_updatel(cdns, CDNS_MCP_CLK_CTRL0, in cdns_init_clock_ctrl()
1293 cdns_updatel(cdns, CDNS_MCP_CLK_CTRL1, in cdns_init_clock_ctrl()
1302 cdns_writel(cdns, CDNS_MCP_FRAME_SHAPE_INIT, val); in cdns_init_clock_ctrl()
1306 cdns_writel(cdns, CDNS_MCP_SSP_CTRL0, ssp_interval); in cdns_init_clock_ctrl()
1307 cdns_writel(cdns, CDNS_MCP_SSP_CTRL1, ssp_interval); in cdns_init_clock_ctrl()
1314 int sdw_cdns_init(struct sdw_cdns *cdns) in sdw_cdns_init() argument
1318 cdns_init_clock_ctrl(cdns); in sdw_cdns_init()
1320 sdw_cdns_check_self_clearing_bits(cdns, __func__, false, 0); in sdw_cdns_init()
1323 cdns->msg_count = cdns_readl(cdns, CDNS_MCP_FIFOLEVEL); in sdw_cdns_init()
1326 cdns_updatel(cdns, CDNS_MCP_CONTROL, CDNS_MCP_CONTROL_CMD_RST, in sdw_cdns_init()
1330 cdns_updatel(cdns, CDNS_MCP_CONTROL, CDNS_MCP_CONTROL_CMD_ACCEPT, in sdw_cdns_init()
1334 val = cdns_readl(cdns, CDNS_MCP_CONFIG); in sdw_cdns_init()
1349 if (cdns->bus.multi_link) in sdw_cdns_init()
1357 cdns_writel(cdns, CDNS_MCP_CONFIG, val); in sdw_cdns_init()
1367 struct sdw_cdns *cdns = bus_to_cdns(bus); in cdns_bus_conf() local
1372 dev_err(cdns->dev, "NULL curr_dr_freq\n"); in cdns_bus_conf()
1385 cdns_updatel(cdns, mcp_clkctrl_off, CDNS_MCP_CLK_MCLKD_MASK, divider); in cdns_bus_conf()
1394 struct sdw_cdns *cdns = bus_to_cdns(bus); in cdns_port_params() local
1402 if (target_num == cdns->pdi_loopback_target && in cdns_port_params()
1403 cdns->pdi_loopback_source != -1) { in cdns_port_params()
1404 source_num = cdns->pdi_loopback_source; in cdns_port_params()
1416 dpn_config = cdns_readl(cdns, dpn_config_off_source); in cdns_port_params()
1425 cdns_writel(cdns, dpn_config_off_target, dpn_config); in cdns_port_params()
1434 struct sdw_cdns *cdns = bus_to_cdns(bus); in cdns_transport_params() local
1451 if (target_num == cdns->pdi_loopback_target && in cdns_transport_params()
1452 cdns->pdi_loopback_source != -1) { in cdns_transport_params()
1453 source_num = cdns->pdi_loopback_source; in cdns_transport_params()
1485 dpn_config = cdns_readl(cdns, dpn_config_off_source); in cdns_transport_params()
1490 cdns_writel(cdns, dpn_config_off_target, dpn_config); in cdns_transport_params()
1497 dpn_offsetctrl = cdns_readl(cdns, dpn_offsetctrl_off_source); in cdns_transport_params()
1499 cdns_writel(cdns, dpn_offsetctrl_off_target, dpn_offsetctrl); in cdns_transport_params()
1507 dpn_hctrl = cdns_readl(cdns, dpn_hctrl_off_source); in cdns_transport_params()
1509 cdns_writel(cdns, dpn_hctrl_off_target, dpn_hctrl); in cdns_transport_params()
1514 dpn_samplectrl = cdns_readl(cdns, dpn_samplectrl_off_source); in cdns_transport_params()
1515 cdns_writel(cdns, dpn_samplectrl_off_target, dpn_samplectrl); in cdns_transport_params()
1523 struct sdw_cdns *cdns = bus_to_cdns(bus); in cdns_port_enable() local
1532 cdns_writel(cdns, dpn_chnen_off, ch_mask); in cdns_port_enable()
1548 bool sdw_cdns_is_clock_stop(struct sdw_cdns *cdns) in sdw_cdns_is_clock_stop() argument
1550 return !!(cdns_readl(cdns, CDNS_MCP_STAT) & CDNS_MCP_STAT_CLK_STOP); in sdw_cdns_is_clock_stop()
1560 int sdw_cdns_clock_stop(struct sdw_cdns *cdns, bool block_wake) in sdw_cdns_clock_stop() argument
1566 sdw_cdns_check_self_clearing_bits(cdns, __func__, false, 0); in sdw_cdns_clock_stop()
1569 if (sdw_cdns_is_clock_stop(cdns)) { in sdw_cdns_clock_stop()
1570 dev_dbg(cdns->dev, "Clock is already stopped\n"); in sdw_cdns_clock_stop()
1579 cdns_enable_slave_interrupts(cdns, false); in sdw_cdns_clock_stop()
1587 cdns_updatel(cdns, CDNS_MCP_CONTROL, in sdw_cdns_clock_stop()
1591 list_for_each_entry(slave, &cdns->bus.slaves, node) { in sdw_cdns_clock_stop()
1600 ret = cdns_config_update(cdns); in sdw_cdns_clock_stop()
1602 dev_err(cdns->dev, "%s: config_update failed\n", __func__); in sdw_cdns_clock_stop()
1608 ret = sdw_bus_prep_clk_stop(&cdns->bus); in sdw_cdns_clock_stop()
1610 dev_err(cdns->dev, "prepare clock stop failed %d\n", ret); in sdw_cdns_clock_stop()
1619 ret = sdw_bus_clk_stop(&cdns->bus); in sdw_cdns_clock_stop()
1621 dev_err(cdns->dev, "bus clock stop failed %d\n", ret); in sdw_cdns_clock_stop()
1625 ret = cdns_set_wait(cdns, CDNS_MCP_STAT, in sdw_cdns_clock_stop()
1629 dev_err(cdns->dev, "Clock stop failed %d\n", ret); in sdw_cdns_clock_stop()
1642 int sdw_cdns_clock_restart(struct sdw_cdns *cdns, bool bus_reset) in sdw_cdns_clock_restart() argument
1647 cdns_enable_slave_interrupts(cdns, true); in sdw_cdns_clock_restart()
1649 ret = cdns_clear_bit(cdns, CDNS_MCP_CONTROL, in sdw_cdns_clock_restart()
1652 dev_err(cdns->dev, "Couldn't exit from clock stop\n"); in sdw_cdns_clock_restart()
1656 ret = cdns_set_wait(cdns, CDNS_MCP_STAT, CDNS_MCP_STAT_CLK_STOP, 0); in sdw_cdns_clock_restart()
1658 dev_err(cdns->dev, "clock stop exit failed %d\n", ret); in sdw_cdns_clock_restart()
1662 cdns_updatel(cdns, CDNS_MCP_CONTROL, in sdw_cdns_clock_restart()
1665 cdns_updatel(cdns, CDNS_MCP_CONTROL, CDNS_MCP_CONTROL_CMD_ACCEPT, in sdw_cdns_clock_restart()
1671 cdns_updatel(cdns, CDNS_MCP_CONFIG, in sdw_cdns_clock_restart()
1675 ret = cdns_config_update(cdns); in sdw_cdns_clock_restart()
1677 dev_err(cdns->dev, "%s: config_update failed\n", __func__); in sdw_cdns_clock_restart()
1681 ret = sdw_bus_exit_clk_stop(&cdns->bus); in sdw_cdns_clock_restart()
1683 dev_err(cdns->dev, "bus failed to exit clock stop %d\n", ret); in sdw_cdns_clock_restart()
1694 int sdw_cdns_probe(struct sdw_cdns *cdns) in sdw_cdns_probe() argument
1696 init_completion(&cdns->tx_complete); in sdw_cdns_probe()
1697 cdns->bus.port_ops = &cdns_port_ops; in sdw_cdns_probe()
1699 INIT_WORK(&cdns->work, cdns_update_slave_status_work); in sdw_cdns_probe()
1707 struct sdw_cdns *cdns = snd_soc_dai_get_drvdata(dai); in cdns_set_sdw_stream() local
1710 dai_runtime = cdns->dai_runtime_array[dai->id]; in cdns_set_sdw_stream()
1728 dai_runtime->bus = &cdns->bus; in cdns_set_sdw_stream()
1729 dai_runtime->link_id = cdns->instance; in cdns_set_sdw_stream()
1734 cdns->dai_runtime_array[dai->id] = dai_runtime; in cdns_set_sdw_stream()
1746 cdns->dai_runtime_array[dai->id] = NULL; in cdns_set_sdw_stream()
1764 static struct sdw_cdns_pdi *cdns_find_pdi(struct sdw_cdns *cdns, in cdns_find_pdi() argument
1787 void sdw_cdns_config_stream(struct sdw_cdns *cdns, in sdw_cdns_config_stream() argument
1795 if (cdns->bus.params.m_data_mode != SDW_PORT_DATA_MODE_NORMAL) in sdw_cdns_config_stream()
1799 cdns_updatel(cdns, offset, in sdw_cdns_config_stream()
1806 cdns_writel(cdns, CDNS_PDI_CONFIG(pdi->num), val); in sdw_cdns_config_stream()
1819 struct sdw_cdns_pdi *sdw_cdns_alloc_pdi(struct sdw_cdns *cdns, in sdw_cdns_alloc_pdi() argument
1826 pdi = cdns_find_pdi(cdns, 0, stream->num_in, stream->in, in sdw_cdns_alloc_pdi()
1829 pdi = cdns_find_pdi(cdns, 0, stream->num_out, stream->out, in sdw_cdns_alloc_pdi()
1834 pdi = cdns_find_pdi(cdns, 2, stream->num_bd, stream->bd, in sdw_cdns_alloc_pdi()