Lines Matching full:ctrl
103 struct slim_controller ctrl; member
120 static void qcom_slim_queue_tx(struct qcom_slim_ctrl *ctrl, void *buf, in qcom_slim_queue_tx() argument
125 __iowrite32_copy(ctrl->base + tx_reg, buf, count); in qcom_slim_queue_tx()
131 static void *slim_alloc_rxbuf(struct qcom_slim_ctrl *ctrl) in slim_alloc_rxbuf() argument
136 spin_lock_irqsave(&ctrl->rx.lock, flags); in slim_alloc_rxbuf()
137 if ((ctrl->rx.tail + 1) % ctrl->rx.n == ctrl->rx.head) { in slim_alloc_rxbuf()
138 spin_unlock_irqrestore(&ctrl->rx.lock, flags); in slim_alloc_rxbuf()
139 dev_err(ctrl->dev, "RX QUEUE full!"); in slim_alloc_rxbuf()
142 idx = ctrl->rx.tail; in slim_alloc_rxbuf()
143 ctrl->rx.tail = (ctrl->rx.tail + 1) % ctrl->rx.n; in slim_alloc_rxbuf()
144 spin_unlock_irqrestore(&ctrl->rx.lock, flags); in slim_alloc_rxbuf()
146 return ctrl->rx.base + (idx * ctrl->rx.sl_sz); in slim_alloc_rxbuf()
149 static void slim_ack_txn(struct qcom_slim_ctrl *ctrl, int err) in slim_ack_txn() argument
155 spin_lock_irqsave(&ctrl->tx.lock, flags); in slim_ack_txn()
156 idx = ctrl->tx.head; in slim_ack_txn()
157 ctrl->tx.head = (ctrl->tx.head + 1) % ctrl->tx.n; in slim_ack_txn()
158 spin_unlock_irqrestore(&ctrl->tx.lock, flags); in slim_ack_txn()
160 comp = ctrl->wr_comp[idx]; in slim_ack_txn()
161 ctrl->wr_comp[idx] = NULL; in slim_ack_txn()
166 static irqreturn_t qcom_slim_handle_tx_irq(struct qcom_slim_ctrl *ctrl, in qcom_slim_handle_tx_irq() argument
173 ctrl->base + MGR_INT_CLR); in qcom_slim_handle_tx_irq()
176 u32 mgr_stat = readl_relaxed(ctrl->base + MGR_STATUS); in qcom_slim_handle_tx_irq()
177 u32 mgr_ie_stat = readl_relaxed(ctrl->base + MGR_IE_STAT); in qcom_slim_handle_tx_irq()
178 u32 frm_stat = readl_relaxed(ctrl->base + FRM_STAT); in qcom_slim_handle_tx_irq()
179 u32 frm_cfg = readl_relaxed(ctrl->base + FRM_CFG); in qcom_slim_handle_tx_irq()
180 u32 frm_intr_stat = readl_relaxed(ctrl->base + FRM_INT_STAT); in qcom_slim_handle_tx_irq()
181 u32 frm_ie_stat = readl_relaxed(ctrl->base + FRM_IE_STAT); in qcom_slim_handle_tx_irq()
182 u32 intf_stat = readl_relaxed(ctrl->base + INTF_STAT); in qcom_slim_handle_tx_irq()
183 u32 intf_intr_stat = readl_relaxed(ctrl->base + INTF_INT_STAT); in qcom_slim_handle_tx_irq()
184 u32 intf_ie_stat = readl_relaxed(ctrl->base + INTF_IE_STAT); in qcom_slim_handle_tx_irq()
186 writel_relaxed(MGR_INT_TX_NACKED_2, ctrl->base + MGR_INT_CLR); in qcom_slim_handle_tx_irq()
188 dev_err(ctrl->dev, "TX Nack MGR:int:0x%x, stat:0x%x\n", in qcom_slim_handle_tx_irq()
190 dev_err(ctrl->dev, "TX Nack MGR:ie:0x%x\n", mgr_ie_stat); in qcom_slim_handle_tx_irq()
191 dev_err(ctrl->dev, "TX Nack FRM:int:0x%x, stat:0x%x\n", in qcom_slim_handle_tx_irq()
193 dev_err(ctrl->dev, "TX Nack FRM:cfg:0x%x, ie:0x%x\n", in qcom_slim_handle_tx_irq()
195 dev_err(ctrl->dev, "TX Nack INTF:intr:0x%x, stat:0x%x\n", in qcom_slim_handle_tx_irq()
197 dev_err(ctrl->dev, "TX Nack INTF:ie:0x%x\n", in qcom_slim_handle_tx_irq()
202 slim_ack_txn(ctrl, err); in qcom_slim_handle_tx_irq()
207 static irqreturn_t qcom_slim_handle_rx_irq(struct qcom_slim_ctrl *ctrl, in qcom_slim_handle_rx_irq() argument
214 pkt[0] = readl_relaxed(ctrl->base + MGR_RX_MSG); in qcom_slim_handle_rx_irq()
224 rx_buf = (u32 *)slim_alloc_rxbuf(ctrl); in qcom_slim_handle_rx_irq()
226 dev_err(ctrl->dev, "dropping RX:0x%x due to RX full\n", in qcom_slim_handle_rx_irq()
236 __ioread32_copy(rx_buf + 1, ctrl->base + MGR_RX_MSG + 4, in qcom_slim_handle_rx_irq()
246 slim_msg_response(&ctrl->ctrl, (u8 *)(rx_buf + 1), in qcom_slim_handle_rx_irq()
250 dev_err(ctrl->dev, "unsupported MC,%x MT:%x\n", in qcom_slim_handle_rx_irq()
255 writel(MGR_INT_RX_MSG_RCVD, ctrl->base + in qcom_slim_handle_rx_irq()
258 queue_work(ctrl->rxwq, &ctrl->wd); in qcom_slim_handle_rx_irq()
265 struct qcom_slim_ctrl *ctrl = d; in qcom_slim_interrupt() local
266 u32 stat = readl_relaxed(ctrl->base + MGR_INT_STAT); in qcom_slim_interrupt()
270 ret = qcom_slim_handle_tx_irq(ctrl, stat); in qcom_slim_interrupt()
273 ret = qcom_slim_handle_rx_irq(ctrl, stat); in qcom_slim_interrupt()
280 struct qcom_slim_ctrl *ctrl = dev_get_drvdata(sctrl->dev); in qcom_clk_pause_wakeup() local
282 clk_prepare_enable(ctrl->hclk); in qcom_clk_pause_wakeup()
283 clk_prepare_enable(ctrl->rclk); in qcom_clk_pause_wakeup()
284 enable_irq(ctrl->irq); in qcom_clk_pause_wakeup()
286 writel_relaxed(1, ctrl->base + FRM_WAKEUP); in qcom_clk_pause_wakeup()
302 static void *slim_alloc_txbuf(struct qcom_slim_ctrl *ctrl, in slim_alloc_txbuf() argument
309 spin_lock_irqsave(&ctrl->tx.lock, flags); in slim_alloc_txbuf()
310 if (((ctrl->tx.head + 1) % ctrl->tx.n) == ctrl->tx.tail) { in slim_alloc_txbuf()
311 spin_unlock_irqrestore(&ctrl->tx.lock, flags); in slim_alloc_txbuf()
312 dev_err(ctrl->dev, "controller TX buf unavailable"); in slim_alloc_txbuf()
315 idx = ctrl->tx.tail; in slim_alloc_txbuf()
316 ctrl->wr_comp[idx] = done; in slim_alloc_txbuf()
317 ctrl->tx.tail = (ctrl->tx.tail + 1) % ctrl->tx.n; in slim_alloc_txbuf()
319 spin_unlock_irqrestore(&ctrl->tx.lock, flags); in slim_alloc_txbuf()
321 return ctrl->tx.base + (idx * ctrl->tx.sl_sz); in slim_alloc_txbuf()
328 struct qcom_slim_ctrl *ctrl = dev_get_drvdata(sctrl->dev); in qcom_xfer_msg() local
330 void *pbuf = slim_alloc_txbuf(ctrl, txn, &done); in qcom_xfer_msg()
344 pbuf = slim_alloc_txbuf(ctrl, txn, &done); in qcom_xfer_msg()
377 qcom_slim_queue_tx(ctrl, head, txn->rl, MGR_TX_MSG); in qcom_xfer_msg()
381 dev_err(ctrl->dev, "TX timed out:MC:0x%x,mt:0x%x", txn->mc, in qcom_xfer_msg()
393 struct qcom_slim_ctrl *ctrl = dev_get_drvdata(sctrl->dev); in qcom_set_laddr() local
414 ret = slim_do_transfer(&ctrl->ctrl, &txn); in qcom_set_laddr()
417 dev_err(ctrl->dev, "set LA:0x%x failed:ret:%d\n", in qcom_set_laddr()
422 static int slim_get_current_rxbuf(struct qcom_slim_ctrl *ctrl, void *buf) in slim_get_current_rxbuf() argument
426 spin_lock_irqsave(&ctrl->rx.lock, flags); in slim_get_current_rxbuf()
427 if (ctrl->rx.tail == ctrl->rx.head) { in slim_get_current_rxbuf()
428 spin_unlock_irqrestore(&ctrl->rx.lock, flags); in slim_get_current_rxbuf()
431 memcpy(buf, ctrl->rx.base + (ctrl->rx.head * ctrl->rx.sl_sz), in slim_get_current_rxbuf()
432 ctrl->rx.sl_sz); in slim_get_current_rxbuf()
434 ctrl->rx.head = (ctrl->rx.head + 1) % ctrl->rx.n; in slim_get_current_rxbuf()
435 spin_unlock_irqrestore(&ctrl->rx.lock, flags); in slim_get_current_rxbuf()
445 struct qcom_slim_ctrl *ctrl = container_of(work, struct qcom_slim_ctrl, in qcom_slim_rxwq() local
448 while ((slim_get_current_rxbuf(ctrl, buf)) != -ENODATA) { in qcom_slim_rxwq()
461 ret = slim_device_report_present(&ctrl->ctrl, &ea, in qcom_slim_rxwq()
464 dev_err(ctrl->dev, "assign laddr failed:%d\n", in qcom_slim_rxwq()
467 dev_err(ctrl->dev, "unexpected message:mc:%x, mt:%x\n", in qcom_slim_rxwq()
474 struct qcom_slim_ctrl *ctrl) in qcom_slim_prg_slew() argument
476 if (!ctrl->slew_reg) { in qcom_slim_prg_slew()
478 ctrl->slew_reg = devm_platform_ioremap_resource_byname(pdev, "slew"); in qcom_slim_prg_slew()
479 if (IS_ERR(ctrl->slew_reg)) in qcom_slim_prg_slew()
483 writel_relaxed(1, ctrl->slew_reg); in qcom_slim_prg_slew()
490 struct qcom_slim_ctrl *ctrl; in qcom_slim_probe() local
494 ctrl = devm_kzalloc(&pdev->dev, sizeof(*ctrl), GFP_KERNEL); in qcom_slim_probe()
495 if (!ctrl) in qcom_slim_probe()
498 ctrl->hclk = devm_clk_get(&pdev->dev, "iface"); in qcom_slim_probe()
499 if (IS_ERR(ctrl->hclk)) in qcom_slim_probe()
500 return PTR_ERR(ctrl->hclk); in qcom_slim_probe()
502 ctrl->rclk = devm_clk_get(&pdev->dev, "core"); in qcom_slim_probe()
503 if (IS_ERR(ctrl->rclk)) in qcom_slim_probe()
504 return PTR_ERR(ctrl->rclk); in qcom_slim_probe()
506 ret = clk_set_rate(ctrl->rclk, SLIM_ROOT_FREQ); in qcom_slim_probe()
512 ctrl->irq = platform_get_irq(pdev, 0); in qcom_slim_probe()
513 if (ctrl->irq < 0) in qcom_slim_probe()
514 return ctrl->irq; in qcom_slim_probe()
516 sctrl = &ctrl->ctrl; in qcom_slim_probe()
518 ctrl->dev = &pdev->dev; in qcom_slim_probe()
519 platform_set_drvdata(pdev, ctrl); in qcom_slim_probe()
520 dev_set_drvdata(ctrl->dev, ctrl); in qcom_slim_probe()
522 ctrl->base = devm_platform_ioremap_resource_byname(pdev, "ctrl"); in qcom_slim_probe()
523 if (IS_ERR(ctrl->base)) in qcom_slim_probe()
524 return PTR_ERR(ctrl->base); in qcom_slim_probe()
529 ctrl->tx.n = QCOM_TX_MSGS; in qcom_slim_probe()
530 ctrl->tx.sl_sz = SLIM_MSGQ_BUF_LEN; in qcom_slim_probe()
531 ctrl->rx.n = QCOM_RX_MSGS; in qcom_slim_probe()
532 ctrl->rx.sl_sz = SLIM_MSGQ_BUF_LEN; in qcom_slim_probe()
533 ctrl->wr_comp = kcalloc(QCOM_TX_MSGS, sizeof(struct completion *), in qcom_slim_probe()
535 if (!ctrl->wr_comp) in qcom_slim_probe()
538 spin_lock_init(&ctrl->rx.lock); in qcom_slim_probe()
539 spin_lock_init(&ctrl->tx.lock); in qcom_slim_probe()
540 INIT_WORK(&ctrl->wd, qcom_slim_rxwq); in qcom_slim_probe()
541 ctrl->rxwq = create_singlethread_workqueue("qcom_slim_rx"); in qcom_slim_probe()
542 if (!ctrl->rxwq) { in qcom_slim_probe()
543 dev_err(ctrl->dev, "Failed to start Rx WQ\n"); in qcom_slim_probe()
547 ctrl->framer.rootfreq = SLIM_ROOT_FREQ / 8; in qcom_slim_probe()
548 ctrl->framer.superfreq = in qcom_slim_probe()
549 ctrl->framer.rootfreq / SLIM_CL_PER_SUPERFRAME_DIV8; in qcom_slim_probe()
550 sctrl->a_framer = &ctrl->framer; in qcom_slim_probe()
553 qcom_slim_prg_slew(pdev, ctrl); in qcom_slim_probe()
555 ret = devm_request_irq(&pdev->dev, ctrl->irq, qcom_slim_interrupt, in qcom_slim_probe()
556 IRQF_TRIGGER_HIGH, "qcom_slim_irq", ctrl); in qcom_slim_probe()
562 ret = clk_prepare_enable(ctrl->hclk); in qcom_slim_probe()
566 ret = clk_prepare_enable(ctrl->rclk); in qcom_slim_probe()
570 ctrl->tx.base = devm_kcalloc(&pdev->dev, ctrl->tx.n, ctrl->tx.sl_sz, in qcom_slim_probe()
572 if (!ctrl->tx.base) { in qcom_slim_probe()
577 ctrl->rx.base = devm_kcalloc(&pdev->dev,ctrl->rx.n, ctrl->rx.sl_sz, in qcom_slim_probe()
579 if (!ctrl->rx.base) { in qcom_slim_probe()
585 ret = slim_register_controller(&ctrl->ctrl); in qcom_slim_probe()
587 dev_err(ctrl->dev, "error adding controller\n"); in qcom_slim_probe()
591 ver = readl_relaxed(ctrl->base); in qcom_slim_probe()
595 writel(1, ctrl->base + CFG_PORT(COMP_CFG, ver)); in qcom_slim_probe()
597 ctrl->base + CFG_PORT(COMP_TRUST_CFG, ver)); in qcom_slim_probe()
601 MGR_INT_TX_MSG_SENT), ctrl->base + MGR_INT_EN); in qcom_slim_probe()
602 writel(1, ctrl->base + MGR_CFG); in qcom_slim_probe()
606 ctrl->base + FRM_CFG); in qcom_slim_probe()
607 writel(MGR_CFG_ENABLE, ctrl->base + MGR_CFG); in qcom_slim_probe()
608 writel(1, ctrl->base + INTF_CFG); in qcom_slim_probe()
609 writel(1, ctrl->base + CFG_PORT(COMP_CFG, ver)); in qcom_slim_probe()
617 dev_dbg(ctrl->dev, "QCOM SB controller is up:ver:0x%x!\n", ver); in qcom_slim_probe()
621 clk_disable_unprepare(ctrl->rclk); in qcom_slim_probe()
623 clk_disable_unprepare(ctrl->hclk); in qcom_slim_probe()
626 destroy_workqueue(ctrl->rxwq); in qcom_slim_probe()
632 struct qcom_slim_ctrl *ctrl = platform_get_drvdata(pdev); in qcom_slim_remove() local
635 slim_unregister_controller(&ctrl->ctrl); in qcom_slim_remove()
636 clk_disable_unprepare(ctrl->rclk); in qcom_slim_remove()
637 clk_disable_unprepare(ctrl->hclk); in qcom_slim_remove()
638 destroy_workqueue(ctrl->rxwq); in qcom_slim_remove()
648 struct qcom_slim_ctrl *ctrl = dev_get_drvdata(device); in qcom_slim_runtime_suspend() local
652 ret = slim_ctrl_clk_pause(&ctrl->ctrl, false, SLIM_CLK_UNSPECIFIED); in qcom_slim_runtime_suspend()
656 disable_irq(ctrl->irq); in qcom_slim_runtime_suspend()
657 clk_disable_unprepare(ctrl->hclk); in qcom_slim_runtime_suspend()
658 clk_disable_unprepare(ctrl->rclk); in qcom_slim_runtime_suspend()
665 struct qcom_slim_ctrl *ctrl = dev_get_drvdata(device); in qcom_slim_runtime_resume() local
669 ret = slim_ctrl_clk_pause(&ctrl->ctrl, true, 0); in qcom_slim_runtime_resume()