Lines Matching full:ctrl
109 int (*reg_read)(struct qcom_swrm_ctrl *ctrl, int reg, u32 *val);
110 int (*reg_write)(struct qcom_swrm_ctrl *ctrl, int reg, int val);
130 static int qcom_swrm_ahb_reg_read(struct qcom_swrm_ctrl *ctrl, int reg, in qcom_swrm_ahb_reg_read() argument
133 struct regmap *wcd_regmap = ctrl->regmap; in qcom_swrm_ahb_reg_read()
150 static int qcom_swrm_ahb_reg_write(struct qcom_swrm_ctrl *ctrl, in qcom_swrm_ahb_reg_write() argument
153 struct regmap *wcd_regmap = ctrl->regmap; in qcom_swrm_ahb_reg_write()
170 static int qcom_swrm_cpu_reg_read(struct qcom_swrm_ctrl *ctrl, int reg, in qcom_swrm_cpu_reg_read() argument
173 *val = readl(ctrl->mmio + reg); in qcom_swrm_cpu_reg_read()
177 static int qcom_swrm_cpu_reg_write(struct qcom_swrm_ctrl *ctrl, int reg, in qcom_swrm_cpu_reg_write() argument
180 writel(val, ctrl->mmio + reg); in qcom_swrm_cpu_reg_write()
184 static int qcom_swrm_cmd_fifo_wr_cmd(struct qcom_swrm_ctrl *ctrl, u8 cmd_data, in qcom_swrm_cmd_fifo_wr_cmd() argument
192 spin_lock_irqsave(&ctrl->comp_lock, flags); in qcom_swrm_cmd_fifo_wr_cmd()
193 ctrl->comp = ∁ in qcom_swrm_cmd_fifo_wr_cmd()
194 spin_unlock_irqrestore(&ctrl->comp_lock, flags); in qcom_swrm_cmd_fifo_wr_cmd()
197 ret = ctrl->reg_write(ctrl, SWRM_CMD_FIFO_WR_CMD, val); in qcom_swrm_cmd_fifo_wr_cmd()
201 ret = wait_for_completion_timeout(ctrl->comp, in qcom_swrm_cmd_fifo_wr_cmd()
209 spin_lock_irqsave(&ctrl->comp_lock, flags); in qcom_swrm_cmd_fifo_wr_cmd()
210 ctrl->comp = NULL; in qcom_swrm_cmd_fifo_wr_cmd()
211 spin_unlock_irqrestore(&ctrl->comp_lock, flags); in qcom_swrm_cmd_fifo_wr_cmd()
216 static int qcom_swrm_cmd_fifo_rd_cmd(struct qcom_swrm_ctrl *ctrl, in qcom_swrm_cmd_fifo_rd_cmd() argument
225 spin_lock_irqsave(&ctrl->comp_lock, flags); in qcom_swrm_cmd_fifo_rd_cmd()
226 ctrl->comp = ∁ in qcom_swrm_cmd_fifo_rd_cmd()
227 spin_unlock_irqrestore(&ctrl->comp_lock, flags); in qcom_swrm_cmd_fifo_rd_cmd()
230 ret = ctrl->reg_write(ctrl, SWRM_CMD_FIFO_RD_CMD, val); in qcom_swrm_cmd_fifo_rd_cmd()
234 ret = wait_for_completion_timeout(ctrl->comp, in qcom_swrm_cmd_fifo_rd_cmd()
245 ctrl->reg_read(ctrl, SWRM_CMD_FIFO_RD_FIFO_ADDR, &val); in qcom_swrm_cmd_fifo_rd_cmd()
250 spin_lock_irqsave(&ctrl->comp_lock, flags); in qcom_swrm_cmd_fifo_rd_cmd()
251 ctrl->comp = NULL; in qcom_swrm_cmd_fifo_rd_cmd()
252 spin_unlock_irqrestore(&ctrl->comp_lock, flags); in qcom_swrm_cmd_fifo_rd_cmd()
257 static void qcom_swrm_get_device_status(struct qcom_swrm_ctrl *ctrl) in qcom_swrm_get_device_status() argument
262 ctrl->reg_read(ctrl, SWRM_MCP_SLV_STATUS, &val); in qcom_swrm_get_device_status()
269 ctrl->status[i] = s; in qcom_swrm_get_device_status()
275 struct qcom_swrm_ctrl *ctrl = dev_id; in qcom_swrm_irq_handler() local
279 ctrl->reg_read(ctrl, SWRM_INTERRUPT_STATUS, &sts); in qcom_swrm_irq_handler()
282 ctrl->reg_read(ctrl, SWRM_CMD_FIFO_STATUS, &value); in qcom_swrm_irq_handler()
283 dev_err_ratelimited(ctrl->dev, in qcom_swrm_irq_handler()
286 ctrl->reg_write(ctrl, SWRM_CMD_FIFO_CMD, 0x1); in qcom_swrm_irq_handler()
291 schedule_work(&ctrl->slave_work); in qcom_swrm_irq_handler()
298 ctrl->reg_write(ctrl, SWRM_INTERRUPT_CLEAR, sts); in qcom_swrm_irq_handler()
301 spin_lock_irqsave(&ctrl->comp_lock, flags); in qcom_swrm_irq_handler()
302 if (ctrl->comp) in qcom_swrm_irq_handler()
303 complete(ctrl->comp); in qcom_swrm_irq_handler()
304 spin_unlock_irqrestore(&ctrl->comp_lock, flags); in qcom_swrm_irq_handler()
309 static int qcom_swrm_init(struct qcom_swrm_ctrl *ctrl) in qcom_swrm_init() argument
314 val = FIELD_PREP(SWRM_MCP_FRAME_CTRL_BANK_ROW_CTRL_BMSK, ctrl->rows_index); in qcom_swrm_init()
315 val |= FIELD_PREP(SWRM_MCP_FRAME_CTRL_BANK_COL_CTRL_BMSK, ctrl->cols_index); in qcom_swrm_init()
317 ctrl->reg_write(ctrl, SWRM_MCP_FRAME_CTRL_BANK_ADDR(0), val); in qcom_swrm_init()
320 ctrl->reg_write(ctrl, SWRM_ENUMERATOR_CFG_ADDR, 0); in qcom_swrm_init()
323 ctrl->reg_write(ctrl, SWRM_INTERRUPT_MASK_ADDR, in qcom_swrm_init()
327 ctrl->reg_read(ctrl, SWRM_MCP_CFG_ADDR, &val); in qcom_swrm_init()
329 ctrl->reg_write(ctrl, SWRM_MCP_CFG_ADDR, val); in qcom_swrm_init()
332 ctrl->reg_write(ctrl, SWRM_CMD_FIFO_CFG_ADDR, SWRM_RD_WR_CMD_RETRIES); in qcom_swrm_init()
335 ctrl->reg_write(ctrl, SWRM_COMP_CFG_ADDR, in qcom_swrm_init()
340 if (ctrl->mmio) { in qcom_swrm_init()
341 ctrl->reg_write(ctrl, SWRM_INTERRUPT_CPU_EN, in qcom_swrm_init()
350 struct qcom_swrm_ctrl *ctrl = to_qcom_sdw(bus); in qcom_swrm_xfer_msg() local
360 ret = qcom_swrm_cmd_fifo_rd_cmd(ctrl, msg->dev_num, in qcom_swrm_xfer_msg()
370 ret = qcom_swrm_cmd_fifo_wr_cmd(ctrl, msg->buf[i], in qcom_swrm_xfer_msg()
384 struct qcom_swrm_ctrl *ctrl = to_qcom_sdw(bus); in qcom_swrm_pre_bank_switch() local
387 ctrl->reg_read(ctrl, reg, &val); in qcom_swrm_pre_bank_switch()
389 u32p_replace_bits(&val, ctrl->cols_index, SWRM_MCP_FRAME_CTRL_BANK_COL_CTRL_BMSK); in qcom_swrm_pre_bank_switch()
390 u32p_replace_bits(&val, ctrl->rows_index, SWRM_MCP_FRAME_CTRL_BANK_ROW_CTRL_BMSK); in qcom_swrm_pre_bank_switch()
392 return ctrl->reg_write(ctrl, reg, val); in qcom_swrm_pre_bank_switch()
407 struct qcom_swrm_ctrl *ctrl = to_qcom_sdw(bus); in qcom_swrm_transport_params() local
416 ret = ctrl->reg_write(ctrl, reg, value); in qcom_swrm_transport_params()
421 ret = ctrl->reg_write(ctrl, reg, 1); in qcom_swrm_transport_params()
432 struct qcom_swrm_ctrl *ctrl = to_qcom_sdw(bus); in qcom_swrm_port_enable() local
435 ctrl->reg_read(ctrl, reg, &val); in qcom_swrm_port_enable()
442 return ctrl->reg_write(ctrl, reg, val); in qcom_swrm_port_enable()
458 struct qcom_swrm_ctrl *ctrl = to_qcom_sdw(bus); in qcom_swrm_compute_params() local
467 pcfg = &ctrl->pconfig[p_rt->num - 1]; in qcom_swrm_compute_params()
477 pcfg = &ctrl->pconfig[i]; in qcom_swrm_compute_params()
498 struct qcom_swrm_ctrl *ctrl = in qcom_swrm_slave_wq() local
501 qcom_swrm_get_device_status(ctrl); in qcom_swrm_slave_wq()
502 sdw_handle_slave_status(&ctrl->bus, ctrl->status); in qcom_swrm_slave_wq()
506 static void qcom_swrm_stream_free_ports(struct qcom_swrm_ctrl *ctrl, in qcom_swrm_stream_free_ports() argument
513 mutex_lock(&ctrl->port_lock); in qcom_swrm_stream_free_ports()
517 port_mask = &ctrl->dout_port_mask; in qcom_swrm_stream_free_ports()
519 port_mask = &ctrl->din_port_mask; in qcom_swrm_stream_free_ports()
525 mutex_unlock(&ctrl->port_lock); in qcom_swrm_stream_free_ports()
528 static int qcom_swrm_stream_alloc_ports(struct qcom_swrm_ctrl *ctrl, in qcom_swrm_stream_alloc_ports() argument
541 mutex_lock(&ctrl->port_lock); in qcom_swrm_stream_alloc_ports()
544 maxport = ctrl->num_dout_ports; in qcom_swrm_stream_alloc_ports()
545 port_mask = &ctrl->dout_port_mask; in qcom_swrm_stream_alloc_ports()
547 maxport = ctrl->num_din_ports; in qcom_swrm_stream_alloc_ports()
548 port_mask = &ctrl->din_port_mask; in qcom_swrm_stream_alloc_ports()
556 dev_err(ctrl->dev, "All ports busy\n"); in qcom_swrm_stream_alloc_ports()
578 sdw_stream_add_master(&ctrl->bus, &sconfig, pconfig, in qcom_swrm_stream_alloc_ports()
586 mutex_unlock(&ctrl->port_lock); in qcom_swrm_stream_alloc_ports()
595 struct qcom_swrm_ctrl *ctrl = dev_get_drvdata(dai->dev); in qcom_swrm_hw_params() local
596 struct sdw_stream_runtime *sruntime = ctrl->sruntime[dai->id]; in qcom_swrm_hw_params()
599 ret = qcom_swrm_stream_alloc_ports(ctrl, sruntime, params, in qcom_swrm_hw_params()
602 qcom_swrm_stream_free_ports(ctrl, sruntime); in qcom_swrm_hw_params()
610 struct qcom_swrm_ctrl *ctrl = dev_get_drvdata(dai->dev); in qcom_swrm_hw_free() local
611 struct sdw_stream_runtime *sruntime = ctrl->sruntime[dai->id]; in qcom_swrm_hw_free()
613 qcom_swrm_stream_free_ports(ctrl, sruntime); in qcom_swrm_hw_free()
614 sdw_stream_remove_master(&ctrl->bus, sruntime); in qcom_swrm_hw_free()
622 struct qcom_swrm_ctrl *ctrl = dev_get_drvdata(dai->dev); in qcom_swrm_set_sdw_stream() local
624 ctrl->sruntime[dai->id] = stream; in qcom_swrm_set_sdw_stream()
631 struct qcom_swrm_ctrl *ctrl = dev_get_drvdata(dai->dev); in qcom_swrm_get_sdw_stream() local
633 return ctrl->sruntime[dai->id]; in qcom_swrm_get_sdw_stream()
639 struct qcom_swrm_ctrl *ctrl = dev_get_drvdata(dai->dev); in qcom_swrm_startup() local
649 ctrl->sruntime[dai->id] = sruntime; in qcom_swrm_startup()
668 struct qcom_swrm_ctrl *ctrl = dev_get_drvdata(dai->dev); in qcom_swrm_shutdown() local
670 sdw_release_stream(ctrl->sruntime[dai->id]); in qcom_swrm_shutdown()
671 ctrl->sruntime[dai->id] = NULL; in qcom_swrm_shutdown()
687 static int qcom_swrm_register_dais(struct qcom_swrm_ctrl *ctrl) in qcom_swrm_register_dais() argument
689 int num_dais = ctrl->num_dout_ports + ctrl->num_din_ports; in qcom_swrm_register_dais()
692 struct device *dev = ctrl->dev; in qcom_swrm_register_dais()
705 if (i < ctrl->num_dout_ports) in qcom_swrm_register_dais()
719 return devm_snd_soc_register_component(ctrl->dev, in qcom_swrm_register_dais()
724 static int qcom_swrm_get_port_config(struct qcom_swrm_ctrl *ctrl) in qcom_swrm_get_port_config() argument
726 struct device_node *np = ctrl->dev->of_node; in qcom_swrm_get_port_config()
733 ctrl->reg_read(ctrl, SWRM_COMP_PARAMS, &val); in qcom_swrm_get_port_config()
735 ctrl->num_dout_ports = FIELD_GET(SWRM_COMP_PARAMS_DOUT_PORTS_MASK, val); in qcom_swrm_get_port_config()
736 ctrl->num_din_ports = FIELD_GET(SWRM_COMP_PARAMS_DIN_PORTS_MASK, val); in qcom_swrm_get_port_config()
742 if (val > ctrl->num_din_ports) in qcom_swrm_get_port_config()
745 ctrl->num_din_ports = val; in qcom_swrm_get_port_config()
751 if (val > ctrl->num_dout_ports) in qcom_swrm_get_port_config()
754 ctrl->num_dout_ports = val; in qcom_swrm_get_port_config()
756 nports = ctrl->num_dout_ports + ctrl->num_din_ports; in qcom_swrm_get_port_config()
776 ctrl->pconfig[i].si = si[i]; in qcom_swrm_get_port_config()
777 ctrl->pconfig[i].off1 = off1[i]; in qcom_swrm_get_port_config()
778 ctrl->pconfig[i].off2 = off2[i]; in qcom_swrm_get_port_config()
779 ctrl->pconfig[i].bp_mode = bp_mode[i]; in qcom_swrm_get_port_config()
790 struct qcom_swrm_ctrl *ctrl; local
795 ctrl = devm_kzalloc(dev, sizeof(*ctrl), GFP_KERNEL);
796 if (!ctrl)
800 ctrl->rows_index = sdw_find_row_index(data->default_rows);
801 ctrl->cols_index = sdw_find_col_index(data->default_cols);
807 ctrl->reg_read = qcom_swrm_ahb_reg_read;
808 ctrl->reg_write = qcom_swrm_ahb_reg_write;
809 ctrl->regmap = dev_get_regmap(dev->parent, NULL);
810 if (!ctrl->regmap)
813 ctrl->reg_read = qcom_swrm_cpu_reg_read;
814 ctrl->reg_write = qcom_swrm_cpu_reg_write;
815 ctrl->mmio = devm_platform_ioremap_resource(pdev, 0);
816 if (IS_ERR(ctrl->mmio))
817 return PTR_ERR(ctrl->mmio);
820 ctrl->irq = of_irq_get(dev->of_node, 0);
821 if (ctrl->irq < 0) {
822 ret = ctrl->irq;
826 ctrl->hclk = devm_clk_get(dev, "iface");
827 if (IS_ERR(ctrl->hclk)) {
828 ret = PTR_ERR(ctrl->hclk);
832 clk_prepare_enable(ctrl->hclk);
834 ctrl->dev = dev;
835 dev_set_drvdata(&pdev->dev, ctrl);
836 spin_lock_init(&ctrl->comp_lock);
837 mutex_init(&ctrl->port_lock);
838 INIT_WORK(&ctrl->slave_work, qcom_swrm_slave_wq);
840 ctrl->bus.ops = &qcom_swrm_ops;
841 ctrl->bus.port_ops = &qcom_swrm_port_ops;
842 ctrl->bus.compute_params = &qcom_swrm_compute_params;
844 ret = qcom_swrm_get_port_config(ctrl);
848 params = &ctrl->bus.params;
853 ctrl->reg_read(ctrl, SWRM_MCP_STATUS, &val);
857 prop = &ctrl->bus.prop;
865 ctrl->reg_read(ctrl, SWRM_COMP_HW_VERSION, &ctrl->version);
867 ret = devm_request_threaded_irq(dev, ctrl->irq, NULL,
871 "soundwire", ctrl);
877 ret = sdw_bus_master_add(&ctrl->bus, dev, dev->fwnode);
884 qcom_swrm_init(ctrl);
885 ret = qcom_swrm_register_dais(ctrl);
890 (ctrl->version >> 24) & 0xff, (ctrl->version >> 16) & 0xff,
891 ctrl->version & 0xffff);
896 sdw_bus_master_delete(&ctrl->bus);
898 clk_disable_unprepare(ctrl->hclk);
905 struct qcom_swrm_ctrl *ctrl = dev_get_drvdata(&pdev->dev); local
907 sdw_bus_master_delete(&ctrl->bus);
908 clk_disable_unprepare(ctrl->hclk);