Lines Matching full:master
3 * Silvaco dual-role I3C master driver
14 #include <linux/i3c/master.h>
24 /* Master Mode Registers */
155 * struct svc_i3c_master - Silvaco I3C Master structure
156 * @base: I3C master controller
210 * @index: Index in the master tables corresponding to this device
211 * @ibi: IBI slot index in the master structure
220 static bool svc_i3c_master_error(struct svc_i3c_master *master) in svc_i3c_master_error() argument
224 mstatus = readl(master->regs + SVC_I3C_MSTATUS); in svc_i3c_master_error()
226 merrwarn = readl(master->regs + SVC_I3C_MERRWARN); in svc_i3c_master_error()
227 writel(merrwarn, master->regs + SVC_I3C_MERRWARN); in svc_i3c_master_error()
228 dev_err(master->dev, in svc_i3c_master_error()
238 static void svc_i3c_master_enable_interrupts(struct svc_i3c_master *master, u32 mask) in svc_i3c_master_enable_interrupts() argument
240 writel(mask, master->regs + SVC_I3C_MINTSET); in svc_i3c_master_enable_interrupts()
243 static void svc_i3c_master_disable_interrupts(struct svc_i3c_master *master) in svc_i3c_master_disable_interrupts() argument
245 u32 mask = readl(master->regs + SVC_I3C_MINTSET); in svc_i3c_master_disable_interrupts()
247 writel(mask, master->regs + SVC_I3C_MINTCLR); in svc_i3c_master_disable_interrupts()
250 static void svc_i3c_master_clear_merrwarn(struct svc_i3c_master *master) in svc_i3c_master_clear_merrwarn() argument
253 writel(readl(master->regs + SVC_I3C_MERRWARN), in svc_i3c_master_clear_merrwarn()
254 master->regs + SVC_I3C_MERRWARN); in svc_i3c_master_clear_merrwarn()
257 static void svc_i3c_master_flush_fifo(struct svc_i3c_master *master) in svc_i3c_master_flush_fifo() argument
261 master->regs + SVC_I3C_MDATACTRL); in svc_i3c_master_flush_fifo()
264 static void svc_i3c_master_reset_fifo_trigger(struct svc_i3c_master *master) in svc_i3c_master_reset_fifo_trigger() argument
274 writel(reg, master->regs + SVC_I3C_MDATACTRL); in svc_i3c_master_reset_fifo_trigger()
277 static void svc_i3c_master_reset(struct svc_i3c_master *master) in svc_i3c_master_reset() argument
279 svc_i3c_master_clear_merrwarn(master); in svc_i3c_master_reset()
280 svc_i3c_master_reset_fifo_trigger(master); in svc_i3c_master_reset()
281 svc_i3c_master_disable_interrupts(master); in svc_i3c_master_reset()
285 to_svc_i3c_master(struct i3c_master_controller *master) in to_svc_i3c_master() argument
287 return container_of(master, struct svc_i3c_master, base); in to_svc_i3c_master()
292 struct svc_i3c_master *master; in svc_i3c_master_hj_work() local
294 master = container_of(work, struct svc_i3c_master, hj_work); in svc_i3c_master_hj_work()
295 i3c_master_do_daa(&master->base); in svc_i3c_master_hj_work()
299 svc_i3c_master_dev_from_addr(struct svc_i3c_master *master, in svc_i3c_master_dev_from_addr() argument
305 if (master->addrs[i] == ibiaddr) in svc_i3c_master_dev_from_addr()
311 return master->descs[i]; in svc_i3c_master_dev_from_addr()
314 static void svc_i3c_master_emit_stop(struct svc_i3c_master *master) in svc_i3c_master_emit_stop() argument
316 writel(SVC_I3C_MCTRL_REQUEST_STOP, master->regs + SVC_I3C_MCTRL); in svc_i3c_master_emit_stop()
327 static int svc_i3c_master_handle_ibi(struct svc_i3c_master *master, in svc_i3c_master_handle_ibi() argument
343 while (SVC_I3C_MSTATUS_RXPEND(readl(master->regs + SVC_I3C_MSTATUS)) && in svc_i3c_master_handle_ibi()
345 mdatactrl = readl(master->regs + SVC_I3C_MDATACTRL); in svc_i3c_master_handle_ibi()
347 readsl(master->regs + SVC_I3C_MRDATAB, buf, count); in svc_i3c_master_handle_ibi()
352 master->ibi.tbq_slot = slot; in svc_i3c_master_handle_ibi()
357 static void svc_i3c_master_ack_ibi(struct svc_i3c_master *master, in svc_i3c_master_ack_ibi() argument
368 writel(ibi_ack_nack, master->regs + SVC_I3C_MCTRL); in svc_i3c_master_ack_ibi()
371 static void svc_i3c_master_nack_ibi(struct svc_i3c_master *master) in svc_i3c_master_nack_ibi() argument
375 master->regs + SVC_I3C_MCTRL); in svc_i3c_master_nack_ibi()
380 struct svc_i3c_master *master = container_of(work, struct svc_i3c_master, ibi_work); in svc_i3c_master_ibi_work() local
390 master->regs + SVC_I3C_MCTRL); in svc_i3c_master_ibi_work()
393 ret = readl_relaxed_poll_timeout(master->regs + SVC_I3C_MSTATUS, val, in svc_i3c_master_ibi_work()
396 dev_err(master->dev, "Timeout when polling for IBIWON\n"); in svc_i3c_master_ibi_work()
401 writel(SVC_I3C_MINT_IBIWON, master->regs + SVC_I3C_MSTATUS); in svc_i3c_master_ibi_work()
403 status = readl(master->regs + SVC_I3C_MSTATUS); in svc_i3c_master_ibi_work()
410 dev = svc_i3c_master_dev_from_addr(master, ibiaddr); in svc_i3c_master_ibi_work()
412 svc_i3c_master_nack_ibi(master); in svc_i3c_master_ibi_work()
414 svc_i3c_master_handle_ibi(master, dev); in svc_i3c_master_ibi_work()
417 svc_i3c_master_ack_ibi(master, false); in svc_i3c_master_ibi_work()
420 svc_i3c_master_nack_ibi(master); in svc_i3c_master_ibi_work()
431 if (svc_i3c_master_error(master)) { in svc_i3c_master_ibi_work()
432 if (master->ibi.tbq_slot) { in svc_i3c_master_ibi_work()
435 master->ibi.tbq_slot); in svc_i3c_master_ibi_work()
436 master->ibi.tbq_slot = NULL; in svc_i3c_master_ibi_work()
439 svc_i3c_master_emit_stop(master); in svc_i3c_master_ibi_work()
448 i3c_master_queue_ibi(dev, master->ibi.tbq_slot); in svc_i3c_master_ibi_work()
449 master->ibi.tbq_slot = NULL; in svc_i3c_master_ibi_work()
451 svc_i3c_master_emit_stop(master); in svc_i3c_master_ibi_work()
454 queue_work(master->base.wq, &master->hj_work); in svc_i3c_master_ibi_work()
462 svc_i3c_master_enable_interrupts(master, SVC_I3C_MINT_SLVSTART); in svc_i3c_master_ibi_work()
467 struct svc_i3c_master *master = (struct svc_i3c_master *)dev_id; in svc_i3c_master_irq_handler() local
468 u32 active = readl(master->regs + SVC_I3C_MINTMASKED); in svc_i3c_master_irq_handler()
474 writel(SVC_I3C_MINT_SLVSTART, master->regs + SVC_I3C_MSTATUS); in svc_i3c_master_irq_handler()
476 svc_i3c_master_disable_interrupts(master); in svc_i3c_master_irq_handler()
479 queue_work(master->base.wq, &master->ibi_work); in svc_i3c_master_irq_handler()
486 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_bus_init() local
494 ret = pm_runtime_resume_and_get(master->dev); in svc_i3c_master_bus_init()
496 dev_err(master->dev, in svc_i3c_master_bus_init()
497 "<%s> cannot resume i3c bus master, err: %d\n", in svc_i3c_master_bus_init()
503 fclk_rate = clk_get_rate(master->fclk); in svc_i3c_master_bus_init()
564 writel(reg, master->regs + SVC_I3C_MCONFIG); in svc_i3c_master_bus_init()
566 /* Master core's registration */ in svc_i3c_master_bus_init()
574 master->regs + SVC_I3C_MDYNADDR); in svc_i3c_master_bus_init()
576 ret = i3c_master_set_info(&master->base, &info); in svc_i3c_master_bus_init()
581 pm_runtime_mark_last_busy(master->dev); in svc_i3c_master_bus_init()
582 pm_runtime_put_autosuspend(master->dev); in svc_i3c_master_bus_init()
589 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_bus_cleanup() local
592 ret = pm_runtime_resume_and_get(master->dev); in svc_i3c_master_bus_cleanup()
594 dev_err(master->dev, "<%s> Cannot get runtime PM.\n", __func__); in svc_i3c_master_bus_cleanup()
598 svc_i3c_master_disable_interrupts(master); in svc_i3c_master_bus_cleanup()
600 /* Disable master */ in svc_i3c_master_bus_cleanup()
601 writel(0, master->regs + SVC_I3C_MCONFIG); in svc_i3c_master_bus_cleanup()
603 pm_runtime_mark_last_busy(master->dev); in svc_i3c_master_bus_cleanup()
604 pm_runtime_put_autosuspend(master->dev); in svc_i3c_master_bus_cleanup()
607 static int svc_i3c_master_reserve_slot(struct svc_i3c_master *master) in svc_i3c_master_reserve_slot() argument
611 if (!(master->free_slots & GENMASK(SVC_I3C_MAX_DEVS - 1, 0))) in svc_i3c_master_reserve_slot()
614 slot = ffs(master->free_slots) - 1; in svc_i3c_master_reserve_slot()
616 master->free_slots &= ~BIT(slot); in svc_i3c_master_reserve_slot()
621 static void svc_i3c_master_release_slot(struct svc_i3c_master *master, in svc_i3c_master_release_slot() argument
624 master->free_slots |= BIT(slot); in svc_i3c_master_release_slot()
630 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_attach_i3c_dev() local
634 slot = svc_i3c_master_reserve_slot(master); in svc_i3c_master_attach_i3c_dev()
640 svc_i3c_master_release_slot(master, slot); in svc_i3c_master_attach_i3c_dev()
646 master->addrs[slot] = dev->info.dyn_addr ? dev->info.dyn_addr : in svc_i3c_master_attach_i3c_dev()
648 master->descs[slot] = dev; in svc_i3c_master_attach_i3c_dev()
659 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_reattach_i3c_dev() local
662 master->addrs[data->index] = dev->info.dyn_addr ? dev->info.dyn_addr : in svc_i3c_master_reattach_i3c_dev()
672 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_detach_i3c_dev() local
674 master->addrs[data->index] = 0; in svc_i3c_master_detach_i3c_dev()
675 svc_i3c_master_release_slot(master, data->index); in svc_i3c_master_detach_i3c_dev()
683 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_attach_i2c_dev() local
687 slot = svc_i3c_master_reserve_slot(master); in svc_i3c_master_attach_i2c_dev()
693 svc_i3c_master_release_slot(master, slot); in svc_i3c_master_attach_i2c_dev()
698 master->addrs[slot] = dev->addr; in svc_i3c_master_attach_i2c_dev()
709 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_detach_i2c_dev() local
711 svc_i3c_master_release_slot(master, data->index); in svc_i3c_master_detach_i2c_dev()
716 static int svc_i3c_master_readb(struct svc_i3c_master *master, u8 *dst, in svc_i3c_master_readb() argument
723 ret = readl_poll_timeout_atomic(master->regs + SVC_I3C_MSTATUS, in svc_i3c_master_readb()
730 dst[i] = readl(master->regs + SVC_I3C_MRDATAB); in svc_i3c_master_readb()
736 static int svc_i3c_master_do_daa_locked(struct svc_i3c_master *master, in svc_i3c_master_do_daa_locked() argument
750 master->regs + SVC_I3C_MCTRL); in svc_i3c_master_do_daa_locked()
756 ret = readl_poll_timeout_atomic(master->regs + SVC_I3C_MSTATUS, in svc_i3c_master_do_daa_locked()
772 ret = svc_i3c_master_readb(master, data, 6); in svc_i3c_master_do_daa_locked()
780 ret = svc_i3c_master_readb(master, data, 2); in svc_i3c_master_do_daa_locked()
809 svc_i3c_master_emit_stop(master); in svc_i3c_master_do_daa_locked()
818 ret = readl_poll_timeout_atomic(master->regs + SVC_I3C_MSTATUS, in svc_i3c_master_do_daa_locked()
828 ret = i3c_master_get_free_addr(&master->base, last_addr + 1); in svc_i3c_master_do_daa_locked()
833 dev_dbg(master->dev, "DAA: device %d assigned to 0x%02x\n", in svc_i3c_master_do_daa_locked()
836 writel(addrs[dev_nb], master->regs + SVC_I3C_MWDATAB); in svc_i3c_master_do_daa_locked()
845 static int svc_i3c_update_ibirules(struct svc_i3c_master *master) in svc_i3c_update_ibirules() argument
854 i3c_bus_for_each_i3cdev(&master->base.bus, dev) { in svc_i3c_update_ibirules()
892 writel(reg_mbyte, master->regs + SVC_I3C_IBIRULES); in svc_i3c_update_ibirules()
894 writel(reg_nobyte, master->regs + SVC_I3C_IBIRULES); in svc_i3c_update_ibirules()
901 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_do_daa() local
907 ret = pm_runtime_resume_and_get(master->dev); in svc_i3c_master_do_daa()
909 dev_err(master->dev, "<%s> Cannot get runtime PM.\n", __func__); in svc_i3c_master_do_daa()
913 spin_lock_irqsave(&master->xferqueue.lock, flags); in svc_i3c_master_do_daa()
914 ret = svc_i3c_master_do_daa_locked(master, addrs, &dev_nb); in svc_i3c_master_do_daa()
915 spin_unlock_irqrestore(&master->xferqueue.lock, flags); in svc_i3c_master_do_daa()
917 svc_i3c_master_emit_stop(master); in svc_i3c_master_do_daa()
918 svc_i3c_master_clear_merrwarn(master); in svc_i3c_master_do_daa()
930 ret = svc_i3c_update_ibirules(master); in svc_i3c_master_do_daa()
932 dev_err(master->dev, "Cannot handle such a list of devices"); in svc_i3c_master_do_daa()
935 pm_runtime_mark_last_busy(master->dev); in svc_i3c_master_do_daa()
936 pm_runtime_put_autosuspend(master->dev); in svc_i3c_master_do_daa()
941 static int svc_i3c_master_read(struct svc_i3c_master *master, in svc_i3c_master_read() argument
951 mstatus = readl(master->regs + SVC_I3C_MSTATUS); in svc_i3c_master_read()
956 dev_dbg(master->dev, "I3C read timeout\n"); in svc_i3c_master_read()
960 mdctrl = readl(master->regs + SVC_I3C_MDATACTRL); in svc_i3c_master_read()
963 dev_err(master->dev, "I3C receive length too long!\n"); in svc_i3c_master_read()
967 in[offset + i] = readl(master->regs + SVC_I3C_MRDATAB); in svc_i3c_master_read()
975 static int svc_i3c_master_write(struct svc_i3c_master *master, in svc_i3c_master_write() argument
982 ret = readl_poll_timeout(master->regs + SVC_I3C_MDATACTRL, in svc_i3c_master_write()
994 writel(out[offset++], master->regs + SVC_I3C_MWDATAB); in svc_i3c_master_write()
996 writel(out[offset++], master->regs + SVC_I3C_MWDATABE); in svc_i3c_master_write()
1002 static int svc_i3c_master_xfer(struct svc_i3c_master *master, in svc_i3c_master_xfer() argument
1016 master->regs + SVC_I3C_MCTRL); in svc_i3c_master_xfer()
1018 ret = readl_poll_timeout(master->regs + SVC_I3C_MSTATUS, reg, in svc_i3c_master_xfer()
1023 if (readl(master->regs + SVC_I3C_MERRWARN) & SVC_I3C_MERRWARN_NACK) { in svc_i3c_master_xfer()
1029 ret = svc_i3c_master_read(master, in, xfer_len); in svc_i3c_master_xfer()
1031 ret = svc_i3c_master_write(master, out, xfer_len); in svc_i3c_master_xfer()
1038 ret = readl_poll_timeout(master->regs + SVC_I3C_MSTATUS, reg, in svc_i3c_master_xfer()
1043 writel(SVC_I3C_MINT_COMPLETE, master->regs + SVC_I3C_MSTATUS); in svc_i3c_master_xfer()
1046 svc_i3c_master_emit_stop(master); in svc_i3c_master_xfer()
1049 readl_poll_timeout(master->regs + SVC_I3C_MSTATUS, reg, in svc_i3c_master_xfer()
1056 svc_i3c_master_emit_stop(master); in svc_i3c_master_xfer()
1057 svc_i3c_master_clear_merrwarn(master); in svc_i3c_master_xfer()
1063 svc_i3c_master_alloc_xfer(struct svc_i3c_master *master, unsigned int ncmds) in svc_i3c_master_alloc_xfer() argument
1083 static void svc_i3c_master_dequeue_xfer_locked(struct svc_i3c_master *master, in svc_i3c_master_dequeue_xfer_locked() argument
1086 if (master->xferqueue.cur == xfer) in svc_i3c_master_dequeue_xfer_locked()
1087 master->xferqueue.cur = NULL; in svc_i3c_master_dequeue_xfer_locked()
1092 static void svc_i3c_master_dequeue_xfer(struct svc_i3c_master *master, in svc_i3c_master_dequeue_xfer() argument
1097 spin_lock_irqsave(&master->xferqueue.lock, flags); in svc_i3c_master_dequeue_xfer()
1098 svc_i3c_master_dequeue_xfer_locked(master, xfer); in svc_i3c_master_dequeue_xfer()
1099 spin_unlock_irqrestore(&master->xferqueue.lock, flags); in svc_i3c_master_dequeue_xfer()
1102 static void svc_i3c_master_start_xfer_locked(struct svc_i3c_master *master) in svc_i3c_master_start_xfer_locked() argument
1104 struct svc_i3c_xfer *xfer = master->xferqueue.cur; in svc_i3c_master_start_xfer_locked()
1110 svc_i3c_master_clear_merrwarn(master); in svc_i3c_master_start_xfer_locked()
1111 svc_i3c_master_flush_fifo(master); in svc_i3c_master_start_xfer_locked()
1116 ret = svc_i3c_master_xfer(master, cmd->rnw, xfer->type, in svc_i3c_master_start_xfer_locked()
1128 svc_i3c_master_dequeue_xfer_locked(master, xfer); in svc_i3c_master_start_xfer_locked()
1130 xfer = list_first_entry_or_null(&master->xferqueue.list, in svc_i3c_master_start_xfer_locked()
1136 master->xferqueue.cur = xfer; in svc_i3c_master_start_xfer_locked()
1137 svc_i3c_master_start_xfer_locked(master); in svc_i3c_master_start_xfer_locked()
1140 static void svc_i3c_master_enqueue_xfer(struct svc_i3c_master *master, in svc_i3c_master_enqueue_xfer() argument
1146 ret = pm_runtime_resume_and_get(master->dev); in svc_i3c_master_enqueue_xfer()
1148 dev_err(master->dev, "<%s> Cannot get runtime PM.\n", __func__); in svc_i3c_master_enqueue_xfer()
1153 spin_lock_irqsave(&master->xferqueue.lock, flags); in svc_i3c_master_enqueue_xfer()
1154 if (master->xferqueue.cur) { in svc_i3c_master_enqueue_xfer()
1155 list_add_tail(&xfer->node, &master->xferqueue.list); in svc_i3c_master_enqueue_xfer()
1157 master->xferqueue.cur = xfer; in svc_i3c_master_enqueue_xfer()
1158 svc_i3c_master_start_xfer_locked(master); in svc_i3c_master_enqueue_xfer()
1160 spin_unlock_irqrestore(&master->xferqueue.lock, flags); in svc_i3c_master_enqueue_xfer()
1162 pm_runtime_mark_last_busy(master->dev); in svc_i3c_master_enqueue_xfer()
1163 pm_runtime_put_autosuspend(master->dev); in svc_i3c_master_enqueue_xfer()
1167 svc_i3c_master_supports_ccc_cmd(struct i3c_master_controller *master, in svc_i3c_master_supports_ccc_cmd() argument
1174 static int svc_i3c_master_send_bdcast_ccc_cmd(struct svc_i3c_master *master, in svc_i3c_master_send_bdcast_ccc_cmd() argument
1183 xfer = svc_i3c_master_alloc_xfer(master, 1); in svc_i3c_master_send_bdcast_ccc_cmd()
1207 svc_i3c_master_enqueue_xfer(master, xfer); in svc_i3c_master_send_bdcast_ccc_cmd()
1209 svc_i3c_master_dequeue_xfer(master, xfer); in svc_i3c_master_send_bdcast_ccc_cmd()
1218 static int svc_i3c_master_send_direct_ccc_cmd(struct svc_i3c_master *master, in svc_i3c_master_send_direct_ccc_cmd() argument
1227 xfer = svc_i3c_master_alloc_xfer(master, 2); in svc_i3c_master_send_direct_ccc_cmd()
1253 svc_i3c_master_enqueue_xfer(master, xfer); in svc_i3c_master_send_direct_ccc_cmd()
1255 svc_i3c_master_dequeue_xfer(master, xfer); in svc_i3c_master_send_direct_ccc_cmd()
1269 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_send_ccc_cmd() local
1274 ret = svc_i3c_master_send_bdcast_ccc_cmd(master, cmd); in svc_i3c_master_send_ccc_cmd()
1276 ret = svc_i3c_master_send_direct_ccc_cmd(master, cmd); in svc_i3c_master_send_ccc_cmd()
1289 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_priv_xfers() local
1294 xfer = svc_i3c_master_alloc_xfer(master, nxfers); in svc_i3c_master_priv_xfers()
1303 cmd->addr = master->addrs[data->index]; in svc_i3c_master_priv_xfers()
1312 svc_i3c_master_enqueue_xfer(master, xfer); in svc_i3c_master_priv_xfers()
1314 svc_i3c_master_dequeue_xfer(master, xfer); in svc_i3c_master_priv_xfers()
1327 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_i2c_xfers() local
1332 xfer = svc_i3c_master_alloc_xfer(master, nxfers); in svc_i3c_master_i2c_xfers()
1341 cmd->addr = master->addrs[data->index]; in svc_i3c_master_i2c_xfers()
1350 svc_i3c_master_enqueue_xfer(master, xfer); in svc_i3c_master_i2c_xfers()
1352 svc_i3c_master_dequeue_xfer(master, xfer); in svc_i3c_master_i2c_xfers()
1364 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_request_ibi() local
1370 dev_err(master->dev, "IBI max payload %d should be < %d\n", in svc_i3c_master_request_ibi()
1379 spin_lock_irqsave(&master->ibi.lock, flags); in svc_i3c_master_request_ibi()
1380 for (i = 0; i < master->ibi.num_slots; i++) { in svc_i3c_master_request_ibi()
1381 if (!master->ibi.slots[i]) { in svc_i3c_master_request_ibi()
1383 master->ibi.slots[i] = dev; in svc_i3c_master_request_ibi()
1387 spin_unlock_irqrestore(&master->ibi.lock, flags); in svc_i3c_master_request_ibi()
1389 if (i < master->ibi.num_slots) in svc_i3c_master_request_ibi()
1401 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_free_ibi() local
1405 spin_lock_irqsave(&master->ibi.lock, flags); in svc_i3c_master_free_ibi()
1406 master->ibi.slots[data->ibi] = NULL; in svc_i3c_master_free_ibi()
1408 spin_unlock_irqrestore(&master->ibi.lock, flags); in svc_i3c_master_free_ibi()
1416 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_enable_ibi() local
1419 ret = pm_runtime_resume_and_get(master->dev); in svc_i3c_master_enable_ibi()
1421 dev_err(master->dev, "<%s> Cannot get runtime PM.\n", __func__); in svc_i3c_master_enable_ibi()
1425 svc_i3c_master_enable_interrupts(master, SVC_I3C_MINT_SLVSTART); in svc_i3c_master_enable_ibi()
1433 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_disable_ibi() local
1436 svc_i3c_master_disable_interrupts(master); in svc_i3c_master_disable_ibi()
1440 pm_runtime_mark_last_busy(master->dev); in svc_i3c_master_disable_ibi()
1441 pm_runtime_put_autosuspend(master->dev); in svc_i3c_master_disable_ibi()
1474 static int svc_i3c_master_prepare_clks(struct svc_i3c_master *master) in svc_i3c_master_prepare_clks() argument
1478 ret = clk_prepare_enable(master->pclk); in svc_i3c_master_prepare_clks()
1482 ret = clk_prepare_enable(master->fclk); in svc_i3c_master_prepare_clks()
1484 clk_disable_unprepare(master->pclk); in svc_i3c_master_prepare_clks()
1488 ret = clk_prepare_enable(master->sclk); in svc_i3c_master_prepare_clks()
1490 clk_disable_unprepare(master->pclk); in svc_i3c_master_prepare_clks()
1491 clk_disable_unprepare(master->fclk); in svc_i3c_master_prepare_clks()
1498 static void svc_i3c_master_unprepare_clks(struct svc_i3c_master *master) in svc_i3c_master_unprepare_clks() argument
1500 clk_disable_unprepare(master->pclk); in svc_i3c_master_unprepare_clks()
1501 clk_disable_unprepare(master->fclk); in svc_i3c_master_unprepare_clks()
1502 clk_disable_unprepare(master->sclk); in svc_i3c_master_unprepare_clks()
1508 struct svc_i3c_master *master; in svc_i3c_master_probe() local
1511 master = devm_kzalloc(dev, sizeof(*master), GFP_KERNEL); in svc_i3c_master_probe()
1512 if (!master) in svc_i3c_master_probe()
1515 master->regs = devm_platform_ioremap_resource(pdev, 0); in svc_i3c_master_probe()
1516 if (IS_ERR(master->regs)) in svc_i3c_master_probe()
1517 return PTR_ERR(master->regs); in svc_i3c_master_probe()
1519 master->pclk = devm_clk_get(dev, "pclk"); in svc_i3c_master_probe()
1520 if (IS_ERR(master->pclk)) in svc_i3c_master_probe()
1521 return PTR_ERR(master->pclk); in svc_i3c_master_probe()
1523 master->fclk = devm_clk_get(dev, "fast_clk"); in svc_i3c_master_probe()
1524 if (IS_ERR(master->fclk)) in svc_i3c_master_probe()
1525 return PTR_ERR(master->fclk); in svc_i3c_master_probe()
1527 master->sclk = devm_clk_get(dev, "slow_clk"); in svc_i3c_master_probe()
1528 if (IS_ERR(master->sclk)) in svc_i3c_master_probe()
1529 return PTR_ERR(master->sclk); in svc_i3c_master_probe()
1531 master->irq = platform_get_irq(pdev, 0); in svc_i3c_master_probe()
1532 if (master->irq < 0) in svc_i3c_master_probe()
1533 return master->irq; in svc_i3c_master_probe()
1535 master->dev = dev; in svc_i3c_master_probe()
1537 ret = svc_i3c_master_prepare_clks(master); in svc_i3c_master_probe()
1541 INIT_WORK(&master->hj_work, svc_i3c_master_hj_work); in svc_i3c_master_probe()
1542 INIT_WORK(&master->ibi_work, svc_i3c_master_ibi_work); in svc_i3c_master_probe()
1543 ret = devm_request_irq(dev, master->irq, svc_i3c_master_irq_handler, in svc_i3c_master_probe()
1544 IRQF_NO_SUSPEND, "svc-i3c-irq", master); in svc_i3c_master_probe()
1548 master->free_slots = GENMASK(SVC_I3C_MAX_DEVS - 1, 0); in svc_i3c_master_probe()
1550 spin_lock_init(&master->xferqueue.lock); in svc_i3c_master_probe()
1551 INIT_LIST_HEAD(&master->xferqueue.list); in svc_i3c_master_probe()
1553 spin_lock_init(&master->ibi.lock); in svc_i3c_master_probe()
1554 master->ibi.num_slots = SVC_I3C_MAX_DEVS; in svc_i3c_master_probe()
1555 master->ibi.slots = devm_kcalloc(&pdev->dev, master->ibi.num_slots, in svc_i3c_master_probe()
1556 sizeof(*master->ibi.slots), in svc_i3c_master_probe()
1558 if (!master->ibi.slots) { in svc_i3c_master_probe()
1563 platform_set_drvdata(pdev, master); in svc_i3c_master_probe()
1571 svc_i3c_master_reset(master); in svc_i3c_master_probe()
1573 /* Register the master */ in svc_i3c_master_probe()
1574 ret = i3c_master_register(&master->base, &pdev->dev, in svc_i3c_master_probe()
1591 svc_i3c_master_unprepare_clks(master); in svc_i3c_master_probe()
1598 struct svc_i3c_master *master = platform_get_drvdata(pdev); in svc_i3c_master_remove() local
1600 i3c_master_unregister(&master->base); in svc_i3c_master_remove()
1606 static void svc_i3c_save_regs(struct svc_i3c_master *master) in svc_i3c_save_regs() argument
1608 master->saved_regs.mconfig = readl(master->regs + SVC_I3C_MCONFIG); in svc_i3c_save_regs()
1609 master->saved_regs.mdynaddr = readl(master->regs + SVC_I3C_MDYNADDR); in svc_i3c_save_regs()
1612 static void svc_i3c_restore_regs(struct svc_i3c_master *master) in svc_i3c_restore_regs() argument
1614 if (readl(master->regs + SVC_I3C_MDYNADDR) != in svc_i3c_restore_regs()
1615 master->saved_regs.mdynaddr) { in svc_i3c_restore_regs()
1616 writel(master->saved_regs.mconfig, in svc_i3c_restore_regs()
1617 master->regs + SVC_I3C_MCONFIG); in svc_i3c_restore_regs()
1618 writel(master->saved_regs.mdynaddr, in svc_i3c_restore_regs()
1619 master->regs + SVC_I3C_MDYNADDR); in svc_i3c_restore_regs()
1625 struct svc_i3c_master *master = dev_get_drvdata(dev); in svc_i3c_runtime_suspend() local
1627 svc_i3c_save_regs(master); in svc_i3c_runtime_suspend()
1628 svc_i3c_master_unprepare_clks(master); in svc_i3c_runtime_suspend()
1636 struct svc_i3c_master *master = dev_get_drvdata(dev); in svc_i3c_runtime_resume() local
1639 svc_i3c_master_prepare_clks(master); in svc_i3c_runtime_resume()
1641 svc_i3c_restore_regs(master); in svc_i3c_runtime_resume()
1654 { .compatible = "silvaco,i3c-master" },
1663 .name = "silvaco-i3c-master",
1672 MODULE_DESCRIPTION("Silvaco dual-role I3C master driver");