Lines Matching full:master
3 * Silvaco dual-role I3C master driver
14 #include <linux/i3c/master.h>
24 /* Master Mode Registers */
162 * struct svc_i3c_master - Silvaco I3C Master structure
163 * @base: I3C master controller
185 * @lock: Transfer lock, protect between IBI work thread and callbacks from master
223 * @index: Index in the master tables corresponding to this device
224 * @ibi: IBI slot index in the master structure
233 static inline bool is_events_enabled(struct svc_i3c_master *master, u32 mask) in is_events_enabled() argument
235 return !!(master->enabled_events & mask); in is_events_enabled()
238 static bool svc_i3c_master_error(struct svc_i3c_master *master) in svc_i3c_master_error() argument
242 mstatus = readl(master->regs + SVC_I3C_MSTATUS); in svc_i3c_master_error()
244 merrwarn = readl(master->regs + SVC_I3C_MERRWARN); in svc_i3c_master_error()
245 writel(merrwarn, master->regs + SVC_I3C_MERRWARN); in svc_i3c_master_error()
249 dev_dbg(master->dev, "Warning condition: MSTATUS 0x%08x, MERRWARN 0x%08x\n", in svc_i3c_master_error()
254 dev_err(master->dev, in svc_i3c_master_error()
264 static void svc_i3c_master_enable_interrupts(struct svc_i3c_master *master, u32 mask) in svc_i3c_master_enable_interrupts() argument
266 writel(mask, master->regs + SVC_I3C_MINTSET); in svc_i3c_master_enable_interrupts()
269 static void svc_i3c_master_disable_interrupts(struct svc_i3c_master *master) in svc_i3c_master_disable_interrupts() argument
271 u32 mask = readl(master->regs + SVC_I3C_MINTSET); in svc_i3c_master_disable_interrupts()
273 writel(mask, master->regs + SVC_I3C_MINTCLR); in svc_i3c_master_disable_interrupts()
276 static void svc_i3c_master_clear_merrwarn(struct svc_i3c_master *master) in svc_i3c_master_clear_merrwarn() argument
279 writel(readl(master->regs + SVC_I3C_MERRWARN), in svc_i3c_master_clear_merrwarn()
280 master->regs + SVC_I3C_MERRWARN); in svc_i3c_master_clear_merrwarn()
283 static void svc_i3c_master_flush_fifo(struct svc_i3c_master *master) in svc_i3c_master_flush_fifo() argument
287 master->regs + SVC_I3C_MDATACTRL); in svc_i3c_master_flush_fifo()
290 static void svc_i3c_master_reset_fifo_trigger(struct svc_i3c_master *master) in svc_i3c_master_reset_fifo_trigger() argument
300 writel(reg, master->regs + SVC_I3C_MDATACTRL); in svc_i3c_master_reset_fifo_trigger()
303 static void svc_i3c_master_reset(struct svc_i3c_master *master) in svc_i3c_master_reset() argument
305 svc_i3c_master_clear_merrwarn(master); in svc_i3c_master_reset()
306 svc_i3c_master_reset_fifo_trigger(master); in svc_i3c_master_reset()
307 svc_i3c_master_disable_interrupts(master); in svc_i3c_master_reset()
311 to_svc_i3c_master(struct i3c_master_controller *master) in to_svc_i3c_master() argument
313 return container_of(master, struct svc_i3c_master, base); in to_svc_i3c_master()
318 struct svc_i3c_master *master; in svc_i3c_master_hj_work() local
320 master = container_of(work, struct svc_i3c_master, hj_work); in svc_i3c_master_hj_work()
321 i3c_master_do_daa(&master->base); in svc_i3c_master_hj_work()
325 svc_i3c_master_dev_from_addr(struct svc_i3c_master *master, in svc_i3c_master_dev_from_addr() argument
331 if (master->addrs[i] == ibiaddr) in svc_i3c_master_dev_from_addr()
337 return master->descs[i]; in svc_i3c_master_dev_from_addr()
340 static void svc_i3c_master_emit_stop(struct svc_i3c_master *master) in svc_i3c_master_emit_stop() argument
342 writel(SVC_I3C_MCTRL_REQUEST_STOP, master->regs + SVC_I3C_MCTRL); in svc_i3c_master_emit_stop()
353 static int svc_i3c_master_handle_ibi(struct svc_i3c_master *master, in svc_i3c_master_handle_ibi() argument
370 ret = readl_relaxed_poll_timeout(master->regs + SVC_I3C_MSTATUS, val, in svc_i3c_master_handle_ibi()
373 dev_err(master->dev, "Timeout when polling for COMPLETE\n"); in svc_i3c_master_handle_ibi()
377 while (SVC_I3C_MSTATUS_RXPEND(readl(master->regs + SVC_I3C_MSTATUS)) && in svc_i3c_master_handle_ibi()
379 mdatactrl = readl(master->regs + SVC_I3C_MDATACTRL); in svc_i3c_master_handle_ibi()
381 readsb(master->regs + SVC_I3C_MRDATAB, buf, count); in svc_i3c_master_handle_ibi()
386 master->ibi.tbq_slot = slot; in svc_i3c_master_handle_ibi()
391 static int svc_i3c_master_ack_ibi(struct svc_i3c_master *master, in svc_i3c_master_ack_ibi() argument
403 writel(ibi_ack_nack, master->regs + SVC_I3C_MCTRL); in svc_i3c_master_ack_ibi()
405 return readl_poll_timeout_atomic(master->regs + SVC_I3C_MSTATUS, reg, in svc_i3c_master_ack_ibi()
410 static int svc_i3c_master_nack_ibi(struct svc_i3c_master *master) in svc_i3c_master_nack_ibi() argument
417 master->regs + SVC_I3C_MCTRL); in svc_i3c_master_nack_ibi()
419 ret = readl_poll_timeout_atomic(master->regs + SVC_I3C_MSTATUS, reg, in svc_i3c_master_nack_ibi()
424 static int svc_i3c_master_handle_ibi_won(struct svc_i3c_master *master, u32 mstatus) in svc_i3c_master_handle_ibi_won() argument
431 writel(SVC_I3C_MINT_IBIWON, master->regs + SVC_I3C_MSTATUS); in svc_i3c_master_handle_ibi_won()
433 /* Hardware can't auto emit NACK for hot join and master request */ in svc_i3c_master_handle_ibi_won()
437 ret = svc_i3c_master_nack_ibi(master); in svc_i3c_master_handle_ibi_won()
445 struct svc_i3c_master *master = container_of(work, struct svc_i3c_master, ibi_work); in svc_i3c_master_ibi_work() local
460 guard(spinlock_irqsave)(&master->xferqueue.lock); in svc_i3c_master_ibi_work()
473 writel(SVC_I3C_MINT_IBIWON, master->regs + SVC_I3C_MSTATUS); in svc_i3c_master_ibi_work()
478 master->regs + SVC_I3C_MCTRL); in svc_i3c_master_ibi_work()
481 ret = readl_relaxed_poll_timeout_atomic(master->regs + SVC_I3C_MSTATUS, val, in svc_i3c_master_ibi_work()
484 dev_err(master->dev, "Timeout when polling for IBIWON\n"); in svc_i3c_master_ibi_work()
485 svc_i3c_master_emit_stop(master); in svc_i3c_master_ibi_work()
489 status = readl(master->regs + SVC_I3C_MSTATUS); in svc_i3c_master_ibi_work()
496 dev = svc_i3c_master_dev_from_addr(master, ibiaddr); in svc_i3c_master_ibi_work()
497 if (!dev || !is_events_enabled(master, SVC_I3C_EVENT_IBI)) in svc_i3c_master_ibi_work()
498 svc_i3c_master_nack_ibi(master); in svc_i3c_master_ibi_work()
500 svc_i3c_master_handle_ibi(master, dev); in svc_i3c_master_ibi_work()
503 if (is_events_enabled(master, SVC_I3C_EVENT_HOTJOIN)) in svc_i3c_master_ibi_work()
504 svc_i3c_master_ack_ibi(master, false); in svc_i3c_master_ibi_work()
506 svc_i3c_master_nack_ibi(master); in svc_i3c_master_ibi_work()
509 svc_i3c_master_nack_ibi(master); in svc_i3c_master_ibi_work()
520 if (svc_i3c_master_error(master)) { in svc_i3c_master_ibi_work()
521 if (master->ibi.tbq_slot) { in svc_i3c_master_ibi_work()
524 master->ibi.tbq_slot); in svc_i3c_master_ibi_work()
525 master->ibi.tbq_slot = NULL; in svc_i3c_master_ibi_work()
528 svc_i3c_master_emit_stop(master); in svc_i3c_master_ibi_work()
537 i3c_master_queue_ibi(dev, master->ibi.tbq_slot); in svc_i3c_master_ibi_work()
538 master->ibi.tbq_slot = NULL; in svc_i3c_master_ibi_work()
540 svc_i3c_master_emit_stop(master); in svc_i3c_master_ibi_work()
543 svc_i3c_master_emit_stop(master); in svc_i3c_master_ibi_work()
544 if (is_events_enabled(master, SVC_I3C_EVENT_HOTJOIN)) in svc_i3c_master_ibi_work()
545 queue_work(master->base.wq, &master->hj_work); in svc_i3c_master_ibi_work()
553 svc_i3c_master_enable_interrupts(master, SVC_I3C_MINT_SLVSTART); in svc_i3c_master_ibi_work()
558 struct svc_i3c_master *master = (struct svc_i3c_master *)dev_id; in svc_i3c_master_irq_handler() local
559 u32 active = readl(master->regs + SVC_I3C_MSTATUS); in svc_i3c_master_irq_handler()
565 writel(SVC_I3C_MINT_SLVSTART, master->regs + SVC_I3C_MSTATUS); in svc_i3c_master_irq_handler()
567 svc_i3c_master_disable_interrupts(master); in svc_i3c_master_irq_handler()
570 queue_work(master->base.wq, &master->ibi_work); in svc_i3c_master_irq_handler()
578 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_set_speed() local
579 struct i3c_bus *bus = i3c_master_get_bus(&master->base); in svc_i3c_master_set_speed()
584 ret = pm_runtime_resume_and_get(master->dev); in svc_i3c_master_set_speed()
586 dev_err(master->dev, "<%s> Cannot get runtime PM.\n", __func__); in svc_i3c_master_set_speed()
592 fclk_rate = clk_get_rate(master->fclk); in svc_i3c_master_set_speed()
603 mconfig = master->mctrl_config; in svc_i3c_master_set_speed()
609 writel(mconfig, master->regs + SVC_I3C_MCONFIG); in svc_i3c_master_set_speed()
612 writel(master->mctrl_config, master->regs + SVC_I3C_MCONFIG); in svc_i3c_master_set_speed()
617 pm_runtime_mark_last_busy(master->dev); in svc_i3c_master_set_speed()
618 pm_runtime_put_autosuspend(master->dev); in svc_i3c_master_set_speed()
625 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_bus_init() local
634 ret = pm_runtime_resume_and_get(master->dev); in svc_i3c_master_bus_init()
636 dev_err(master->dev, in svc_i3c_master_bus_init()
637 "<%s> cannot resume i3c bus master, err: %d\n", in svc_i3c_master_bus_init()
643 fclk_rate = clk_get_rate(master->fclk); in svc_i3c_master_bus_init()
714 writel(reg, master->regs + SVC_I3C_MCONFIG); in svc_i3c_master_bus_init()
716 master->mctrl_config = reg; in svc_i3c_master_bus_init()
717 /* Master core's registration */ in svc_i3c_master_bus_init()
725 master->regs + SVC_I3C_MDYNADDR); in svc_i3c_master_bus_init()
727 ret = i3c_master_set_info(&master->base, &info); in svc_i3c_master_bus_init()
732 pm_runtime_mark_last_busy(master->dev); in svc_i3c_master_bus_init()
733 pm_runtime_put_autosuspend(master->dev); in svc_i3c_master_bus_init()
740 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_bus_cleanup() local
743 ret = pm_runtime_resume_and_get(master->dev); in svc_i3c_master_bus_cleanup()
745 dev_err(master->dev, "<%s> Cannot get runtime PM.\n", __func__); in svc_i3c_master_bus_cleanup()
749 svc_i3c_master_disable_interrupts(master); in svc_i3c_master_bus_cleanup()
751 /* Disable master */ in svc_i3c_master_bus_cleanup()
752 writel(0, master->regs + SVC_I3C_MCONFIG); in svc_i3c_master_bus_cleanup()
754 pm_runtime_mark_last_busy(master->dev); in svc_i3c_master_bus_cleanup()
755 pm_runtime_put_autosuspend(master->dev); in svc_i3c_master_bus_cleanup()
758 static int svc_i3c_master_reserve_slot(struct svc_i3c_master *master) in svc_i3c_master_reserve_slot() argument
762 if (!(master->free_slots & GENMASK(SVC_I3C_MAX_DEVS - 1, 0))) in svc_i3c_master_reserve_slot()
765 slot = ffs(master->free_slots) - 1; in svc_i3c_master_reserve_slot()
767 master->free_slots &= ~BIT(slot); in svc_i3c_master_reserve_slot()
772 static void svc_i3c_master_release_slot(struct svc_i3c_master *master, in svc_i3c_master_release_slot() argument
775 master->free_slots |= BIT(slot); in svc_i3c_master_release_slot()
781 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_attach_i3c_dev() local
785 slot = svc_i3c_master_reserve_slot(master); in svc_i3c_master_attach_i3c_dev()
791 svc_i3c_master_release_slot(master, slot); in svc_i3c_master_attach_i3c_dev()
797 master->addrs[slot] = dev->info.dyn_addr ? dev->info.dyn_addr : in svc_i3c_master_attach_i3c_dev()
799 master->descs[slot] = dev; in svc_i3c_master_attach_i3c_dev()
810 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_reattach_i3c_dev() local
813 master->addrs[data->index] = dev->info.dyn_addr ? dev->info.dyn_addr : in svc_i3c_master_reattach_i3c_dev()
823 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_detach_i3c_dev() local
825 master->addrs[data->index] = 0; in svc_i3c_master_detach_i3c_dev()
826 svc_i3c_master_release_slot(master, data->index); in svc_i3c_master_detach_i3c_dev()
834 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_attach_i2c_dev() local
838 slot = svc_i3c_master_reserve_slot(master); in svc_i3c_master_attach_i2c_dev()
844 svc_i3c_master_release_slot(master, slot); in svc_i3c_master_attach_i2c_dev()
849 master->addrs[slot] = dev->addr; in svc_i3c_master_attach_i2c_dev()
860 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_detach_i2c_dev() local
862 svc_i3c_master_release_slot(master, data->index); in svc_i3c_master_detach_i2c_dev()
867 static int svc_i3c_master_readb(struct svc_i3c_master *master, u8 *dst, in svc_i3c_master_readb() argument
874 ret = readl_poll_timeout_atomic(master->regs + SVC_I3C_MSTATUS, in svc_i3c_master_readb()
881 dst[i] = readl(master->regs + SVC_I3C_MRDATAB); in svc_i3c_master_readb()
887 static int svc_i3c_master_do_daa_locked(struct svc_i3c_master *master, in svc_i3c_master_do_daa_locked() argument
897 writel(SVC_I3C_MINT_IBIWON, master->regs + SVC_I3C_MSTATUS); in svc_i3c_master_do_daa_locked()
917 master->regs + SVC_I3C_MCTRL); in svc_i3c_master_do_daa_locked()
923 ret = readl_poll_timeout_atomic(master->regs + SVC_I3C_MSTATUS, in svc_i3c_master_do_daa_locked()
939 ret = svc_i3c_master_readb(master, data, 6); in svc_i3c_master_do_daa_locked()
947 ret = svc_i3c_master_readb(master, data, 2); in svc_i3c_master_do_daa_locked()
951 ret = svc_i3c_master_handle_ibi_won(master, reg); in svc_i3c_master_do_daa_locked()
994 svc_i3c_master_emit_stop(master); in svc_i3c_master_do_daa_locked()
1003 ret = readl_poll_timeout_atomic(master->regs + SVC_I3C_MSTATUS, in svc_i3c_master_do_daa_locked()
1013 ret = i3c_master_get_free_addr(&master->base, last_addr + 1); in svc_i3c_master_do_daa_locked()
1018 dev_dbg(master->dev, "DAA: device %d assigned to 0x%02x\n", in svc_i3c_master_do_daa_locked()
1021 writel(addrs[dev_nb], master->regs + SVC_I3C_MWDATAB); in svc_i3c_master_do_daa_locked()
1026 svc_i3c_master_emit_stop(master); in svc_i3c_master_do_daa_locked()
1030 static int svc_i3c_update_ibirules(struct svc_i3c_master *master) in svc_i3c_update_ibirules() argument
1039 i3c_bus_for_each_i3cdev(&master->base.bus, dev) { in svc_i3c_update_ibirules()
1077 writel(reg_mbyte, master->regs + SVC_I3C_IBIRULES); in svc_i3c_update_ibirules()
1079 writel(reg_nobyte, master->regs + SVC_I3C_IBIRULES); in svc_i3c_update_ibirules()
1086 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_do_daa() local
1092 ret = pm_runtime_resume_and_get(master->dev); in svc_i3c_master_do_daa()
1094 dev_err(master->dev, "<%s> Cannot get runtime PM.\n", __func__); in svc_i3c_master_do_daa()
1098 spin_lock_irqsave(&master->xferqueue.lock, flags); in svc_i3c_master_do_daa()
1099 ret = svc_i3c_master_do_daa_locked(master, addrs, &dev_nb); in svc_i3c_master_do_daa()
1100 spin_unlock_irqrestore(&master->xferqueue.lock, flags); in svc_i3c_master_do_daa()
1102 svc_i3c_master_clear_merrwarn(master); in svc_i3c_master_do_daa()
1129 ret = svc_i3c_update_ibirules(master); in svc_i3c_master_do_daa()
1131 dev_err(master->dev, "Cannot handle such a list of devices"); in svc_i3c_master_do_daa()
1134 pm_runtime_mark_last_busy(master->dev); in svc_i3c_master_do_daa()
1135 pm_runtime_put_autosuspend(master->dev); in svc_i3c_master_do_daa()
1140 static int svc_i3c_master_read(struct svc_i3c_master *master, in svc_i3c_master_read() argument
1150 mstatus = readl(master->regs + SVC_I3C_MSTATUS); in svc_i3c_master_read()
1155 dev_dbg(master->dev, "I3C read timeout\n"); in svc_i3c_master_read()
1159 mdctrl = readl(master->regs + SVC_I3C_MDATACTRL); in svc_i3c_master_read()
1162 dev_err(master->dev, "I3C receive length too long!\n"); in svc_i3c_master_read()
1166 in[offset + i] = readl(master->regs + SVC_I3C_MRDATAB); in svc_i3c_master_read()
1174 static int svc_i3c_master_write(struct svc_i3c_master *master, in svc_i3c_master_write() argument
1181 ret = readl_poll_timeout(master->regs + SVC_I3C_MDATACTRL, in svc_i3c_master_write()
1193 writel(out[offset++], master->regs + SVC_I3C_MWDATAB); in svc_i3c_master_write()
1195 writel(out[offset++], master->regs + SVC_I3C_MWDATABE); in svc_i3c_master_write()
1201 static int svc_i3c_master_xfer(struct svc_i3c_master *master, in svc_i3c_master_xfer() argument
1211 writel(SVC_I3C_MINT_IBIWON, master->regs + SVC_I3C_MSTATUS); in svc_i3c_master_xfer()
1221 master->regs + SVC_I3C_MCTRL); in svc_i3c_master_xfer()
1223 ret = readl_poll_timeout(master->regs + SVC_I3C_MSTATUS, reg, in svc_i3c_master_xfer()
1242 ret = svc_i3c_master_handle_ibi_won(master, reg); in svc_i3c_master_xfer()
1248 if (readl(master->regs + SVC_I3C_MERRWARN) & SVC_I3C_MERRWARN_NACK) { in svc_i3c_master_xfer()
1270 writel(SVC_I3C_MERRWARN_NACK, master->regs + SVC_I3C_MERRWARN); in svc_i3c_master_xfer()
1282 ret = svc_i3c_master_read(master, in, xfer_len); in svc_i3c_master_xfer()
1284 ret = svc_i3c_master_write(master, out, xfer_len); in svc_i3c_master_xfer()
1291 ret = readl_poll_timeout(master->regs + SVC_I3C_MSTATUS, reg, in svc_i3c_master_xfer()
1296 writel(SVC_I3C_MINT_COMPLETE, master->regs + SVC_I3C_MSTATUS); in svc_i3c_master_xfer()
1299 svc_i3c_master_emit_stop(master); in svc_i3c_master_xfer()
1302 readl_poll_timeout(master->regs + SVC_I3C_MSTATUS, reg, in svc_i3c_master_xfer()
1309 svc_i3c_master_emit_stop(master); in svc_i3c_master_xfer()
1310 svc_i3c_master_clear_merrwarn(master); in svc_i3c_master_xfer()
1316 svc_i3c_master_alloc_xfer(struct svc_i3c_master *master, unsigned int ncmds) in svc_i3c_master_alloc_xfer() argument
1336 static void svc_i3c_master_dequeue_xfer_locked(struct svc_i3c_master *master, in svc_i3c_master_dequeue_xfer_locked() argument
1339 if (master->xferqueue.cur == xfer) in svc_i3c_master_dequeue_xfer_locked()
1340 master->xferqueue.cur = NULL; in svc_i3c_master_dequeue_xfer_locked()
1345 static void svc_i3c_master_dequeue_xfer(struct svc_i3c_master *master, in svc_i3c_master_dequeue_xfer() argument
1350 spin_lock_irqsave(&master->xferqueue.lock, flags); in svc_i3c_master_dequeue_xfer()
1351 svc_i3c_master_dequeue_xfer_locked(master, xfer); in svc_i3c_master_dequeue_xfer()
1352 spin_unlock_irqrestore(&master->xferqueue.lock, flags); in svc_i3c_master_dequeue_xfer()
1355 static void svc_i3c_master_start_xfer_locked(struct svc_i3c_master *master) in svc_i3c_master_start_xfer_locked() argument
1357 struct svc_i3c_xfer *xfer = master->xferqueue.cur; in svc_i3c_master_start_xfer_locked()
1363 svc_i3c_master_clear_merrwarn(master); in svc_i3c_master_start_xfer_locked()
1364 svc_i3c_master_flush_fifo(master); in svc_i3c_master_start_xfer_locked()
1369 ret = svc_i3c_master_xfer(master, cmd->rnw, xfer->type, in svc_i3c_master_start_xfer_locked()
1385 svc_i3c_master_dequeue_xfer_locked(master, xfer); in svc_i3c_master_start_xfer_locked()
1387 xfer = list_first_entry_or_null(&master->xferqueue.list, in svc_i3c_master_start_xfer_locked()
1393 master->xferqueue.cur = xfer; in svc_i3c_master_start_xfer_locked()
1394 svc_i3c_master_start_xfer_locked(master); in svc_i3c_master_start_xfer_locked()
1397 static void svc_i3c_master_enqueue_xfer(struct svc_i3c_master *master, in svc_i3c_master_enqueue_xfer() argument
1403 ret = pm_runtime_resume_and_get(master->dev); in svc_i3c_master_enqueue_xfer()
1405 dev_err(master->dev, "<%s> Cannot get runtime PM.\n", __func__); in svc_i3c_master_enqueue_xfer()
1410 spin_lock_irqsave(&master->xferqueue.lock, flags); in svc_i3c_master_enqueue_xfer()
1411 if (master->xferqueue.cur) { in svc_i3c_master_enqueue_xfer()
1412 list_add_tail(&xfer->node, &master->xferqueue.list); in svc_i3c_master_enqueue_xfer()
1414 master->xferqueue.cur = xfer; in svc_i3c_master_enqueue_xfer()
1415 svc_i3c_master_start_xfer_locked(master); in svc_i3c_master_enqueue_xfer()
1417 spin_unlock_irqrestore(&master->xferqueue.lock, flags); in svc_i3c_master_enqueue_xfer()
1419 pm_runtime_mark_last_busy(master->dev); in svc_i3c_master_enqueue_xfer()
1420 pm_runtime_put_autosuspend(master->dev); in svc_i3c_master_enqueue_xfer()
1424 svc_i3c_master_supports_ccc_cmd(struct i3c_master_controller *master, in svc_i3c_master_supports_ccc_cmd() argument
1431 static int svc_i3c_master_send_bdcast_ccc_cmd(struct svc_i3c_master *master, in svc_i3c_master_send_bdcast_ccc_cmd() argument
1440 xfer = svc_i3c_master_alloc_xfer(master, 1); in svc_i3c_master_send_bdcast_ccc_cmd()
1464 mutex_lock(&master->lock); in svc_i3c_master_send_bdcast_ccc_cmd()
1465 svc_i3c_master_enqueue_xfer(master, xfer); in svc_i3c_master_send_bdcast_ccc_cmd()
1467 svc_i3c_master_dequeue_xfer(master, xfer); in svc_i3c_master_send_bdcast_ccc_cmd()
1468 mutex_unlock(&master->lock); in svc_i3c_master_send_bdcast_ccc_cmd()
1477 static int svc_i3c_master_send_direct_ccc_cmd(struct svc_i3c_master *master, in svc_i3c_master_send_direct_ccc_cmd() argument
1486 xfer = svc_i3c_master_alloc_xfer(master, 2); in svc_i3c_master_send_direct_ccc_cmd()
1512 mutex_lock(&master->lock); in svc_i3c_master_send_direct_ccc_cmd()
1513 svc_i3c_master_enqueue_xfer(master, xfer); in svc_i3c_master_send_direct_ccc_cmd()
1515 svc_i3c_master_dequeue_xfer(master, xfer); in svc_i3c_master_send_direct_ccc_cmd()
1516 mutex_unlock(&master->lock); in svc_i3c_master_send_direct_ccc_cmd()
1530 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_send_ccc_cmd() local
1535 ret = svc_i3c_master_send_bdcast_ccc_cmd(master, cmd); in svc_i3c_master_send_ccc_cmd()
1537 ret = svc_i3c_master_send_direct_ccc_cmd(master, cmd); in svc_i3c_master_send_ccc_cmd()
1550 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_priv_xfers() local
1555 xfer = svc_i3c_master_alloc_xfer(master, nxfers); in svc_i3c_master_priv_xfers()
1565 cmd->addr = master->addrs[data->index]; in svc_i3c_master_priv_xfers()
1574 mutex_lock(&master->lock); in svc_i3c_master_priv_xfers()
1575 svc_i3c_master_enqueue_xfer(master, xfer); in svc_i3c_master_priv_xfers()
1577 svc_i3c_master_dequeue_xfer(master, xfer); in svc_i3c_master_priv_xfers()
1578 mutex_unlock(&master->lock); in svc_i3c_master_priv_xfers()
1591 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_i2c_xfers() local
1596 xfer = svc_i3c_master_alloc_xfer(master, nxfers); in svc_i3c_master_i2c_xfers()
1605 cmd->addr = master->addrs[data->index]; in svc_i3c_master_i2c_xfers()
1614 mutex_lock(&master->lock); in svc_i3c_master_i2c_xfers()
1615 svc_i3c_master_enqueue_xfer(master, xfer); in svc_i3c_master_i2c_xfers()
1617 svc_i3c_master_dequeue_xfer(master, xfer); in svc_i3c_master_i2c_xfers()
1618 mutex_unlock(&master->lock); in svc_i3c_master_i2c_xfers()
1630 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_request_ibi() local
1636 dev_err(master->dev, "IBI max payload %d should be < %d\n", in svc_i3c_master_request_ibi()
1645 spin_lock_irqsave(&master->ibi.lock, flags); in svc_i3c_master_request_ibi()
1646 for (i = 0; i < master->ibi.num_slots; i++) { in svc_i3c_master_request_ibi()
1647 if (!master->ibi.slots[i]) { in svc_i3c_master_request_ibi()
1649 master->ibi.slots[i] = dev; in svc_i3c_master_request_ibi()
1653 spin_unlock_irqrestore(&master->ibi.lock, flags); in svc_i3c_master_request_ibi()
1655 if (i < master->ibi.num_slots) in svc_i3c_master_request_ibi()
1667 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_free_ibi() local
1671 spin_lock_irqsave(&master->ibi.lock, flags); in svc_i3c_master_free_ibi()
1672 master->ibi.slots[data->ibi] = NULL; in svc_i3c_master_free_ibi()
1674 spin_unlock_irqrestore(&master->ibi.lock, flags); in svc_i3c_master_free_ibi()
1682 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_enable_ibi() local
1685 ret = pm_runtime_resume_and_get(master->dev); in svc_i3c_master_enable_ibi()
1687 dev_err(master->dev, "<%s> Cannot get runtime PM.\n", __func__); in svc_i3c_master_enable_ibi()
1691 master->enabled_events++; in svc_i3c_master_enable_ibi()
1692 svc_i3c_master_enable_interrupts(master, SVC_I3C_MINT_SLVSTART); in svc_i3c_master_enable_ibi()
1700 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_disable_ibi() local
1703 master->enabled_events--; in svc_i3c_master_disable_ibi()
1704 if (!master->enabled_events) in svc_i3c_master_disable_ibi()
1705 svc_i3c_master_disable_interrupts(master); in svc_i3c_master_disable_ibi()
1709 pm_runtime_mark_last_busy(master->dev); in svc_i3c_master_disable_ibi()
1710 pm_runtime_put_autosuspend(master->dev); in svc_i3c_master_disable_ibi()
1717 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_enable_hotjoin() local
1720 ret = pm_runtime_resume_and_get(master->dev); in svc_i3c_master_enable_hotjoin()
1722 dev_err(master->dev, "<%s> Cannot get runtime PM.\n", __func__); in svc_i3c_master_enable_hotjoin()
1726 master->enabled_events |= SVC_I3C_EVENT_HOTJOIN; in svc_i3c_master_enable_hotjoin()
1728 svc_i3c_master_enable_interrupts(master, SVC_I3C_MINT_SLVSTART); in svc_i3c_master_enable_hotjoin()
1735 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_disable_hotjoin() local
1737 master->enabled_events &= ~SVC_I3C_EVENT_HOTJOIN; in svc_i3c_master_disable_hotjoin()
1739 if (!master->enabled_events) in svc_i3c_master_disable_hotjoin()
1740 svc_i3c_master_disable_interrupts(master); in svc_i3c_master_disable_hotjoin()
1742 pm_runtime_mark_last_busy(master->dev); in svc_i3c_master_disable_hotjoin()
1743 pm_runtime_put_autosuspend(master->dev); in svc_i3c_master_disable_hotjoin()
1779 static int svc_i3c_master_prepare_clks(struct svc_i3c_master *master) in svc_i3c_master_prepare_clks() argument
1783 ret = clk_prepare_enable(master->pclk); in svc_i3c_master_prepare_clks()
1787 ret = clk_prepare_enable(master->fclk); in svc_i3c_master_prepare_clks()
1789 clk_disable_unprepare(master->pclk); in svc_i3c_master_prepare_clks()
1793 ret = clk_prepare_enable(master->sclk); in svc_i3c_master_prepare_clks()
1795 clk_disable_unprepare(master->pclk); in svc_i3c_master_prepare_clks()
1796 clk_disable_unprepare(master->fclk); in svc_i3c_master_prepare_clks()
1803 static void svc_i3c_master_unprepare_clks(struct svc_i3c_master *master) in svc_i3c_master_unprepare_clks() argument
1805 clk_disable_unprepare(master->pclk); in svc_i3c_master_unprepare_clks()
1806 clk_disable_unprepare(master->fclk); in svc_i3c_master_unprepare_clks()
1807 clk_disable_unprepare(master->sclk); in svc_i3c_master_unprepare_clks()
1813 struct svc_i3c_master *master; in svc_i3c_master_probe() local
1816 master = devm_kzalloc(dev, sizeof(*master), GFP_KERNEL); in svc_i3c_master_probe()
1817 if (!master) in svc_i3c_master_probe()
1820 master->regs = devm_platform_ioremap_resource(pdev, 0); in svc_i3c_master_probe()
1821 if (IS_ERR(master->regs)) in svc_i3c_master_probe()
1822 return PTR_ERR(master->regs); in svc_i3c_master_probe()
1824 master->pclk = devm_clk_get(dev, "pclk"); in svc_i3c_master_probe()
1825 if (IS_ERR(master->pclk)) in svc_i3c_master_probe()
1826 return PTR_ERR(master->pclk); in svc_i3c_master_probe()
1828 master->fclk = devm_clk_get(dev, "fast_clk"); in svc_i3c_master_probe()
1829 if (IS_ERR(master->fclk)) in svc_i3c_master_probe()
1830 return PTR_ERR(master->fclk); in svc_i3c_master_probe()
1832 master->sclk = devm_clk_get(dev, "slow_clk"); in svc_i3c_master_probe()
1833 if (IS_ERR(master->sclk)) in svc_i3c_master_probe()
1834 return PTR_ERR(master->sclk); in svc_i3c_master_probe()
1836 master->irq = platform_get_irq(pdev, 0); in svc_i3c_master_probe()
1837 if (master->irq < 0) in svc_i3c_master_probe()
1838 return master->irq; in svc_i3c_master_probe()
1840 master->dev = dev; in svc_i3c_master_probe()
1842 ret = svc_i3c_master_prepare_clks(master); in svc_i3c_master_probe()
1846 INIT_WORK(&master->hj_work, svc_i3c_master_hj_work); in svc_i3c_master_probe()
1847 INIT_WORK(&master->ibi_work, svc_i3c_master_ibi_work); in svc_i3c_master_probe()
1848 mutex_init(&master->lock); in svc_i3c_master_probe()
1850 ret = devm_request_irq(dev, master->irq, svc_i3c_master_irq_handler, in svc_i3c_master_probe()
1851 IRQF_NO_SUSPEND, "svc-i3c-irq", master); in svc_i3c_master_probe()
1855 master->free_slots = GENMASK(SVC_I3C_MAX_DEVS - 1, 0); in svc_i3c_master_probe()
1857 spin_lock_init(&master->xferqueue.lock); in svc_i3c_master_probe()
1858 INIT_LIST_HEAD(&master->xferqueue.list); in svc_i3c_master_probe()
1860 spin_lock_init(&master->ibi.lock); in svc_i3c_master_probe()
1861 master->ibi.num_slots = SVC_I3C_MAX_DEVS; in svc_i3c_master_probe()
1862 master->ibi.slots = devm_kcalloc(&pdev->dev, master->ibi.num_slots, in svc_i3c_master_probe()
1863 sizeof(*master->ibi.slots), in svc_i3c_master_probe()
1865 if (!master->ibi.slots) { in svc_i3c_master_probe()
1870 platform_set_drvdata(pdev, master); in svc_i3c_master_probe()
1878 svc_i3c_master_reset(master); in svc_i3c_master_probe()
1880 /* Register the master */ in svc_i3c_master_probe()
1881 ret = i3c_master_register(&master->base, &pdev->dev, in svc_i3c_master_probe()
1898 svc_i3c_master_unprepare_clks(master); in svc_i3c_master_probe()
1905 struct svc_i3c_master *master = platform_get_drvdata(pdev); in svc_i3c_master_remove() local
1907 cancel_work_sync(&master->hj_work); in svc_i3c_master_remove()
1908 i3c_master_unregister(&master->base); in svc_i3c_master_remove()
1914 static void svc_i3c_save_regs(struct svc_i3c_master *master) in svc_i3c_save_regs() argument
1916 master->saved_regs.mconfig = readl(master->regs + SVC_I3C_MCONFIG); in svc_i3c_save_regs()
1917 master->saved_regs.mdynaddr = readl(master->regs + SVC_I3C_MDYNADDR); in svc_i3c_save_regs()
1920 static void svc_i3c_restore_regs(struct svc_i3c_master *master) in svc_i3c_restore_regs() argument
1922 if (readl(master->regs + SVC_I3C_MDYNADDR) != in svc_i3c_restore_regs()
1923 master->saved_regs.mdynaddr) { in svc_i3c_restore_regs()
1924 writel(master->saved_regs.mconfig, in svc_i3c_restore_regs()
1925 master->regs + SVC_I3C_MCONFIG); in svc_i3c_restore_regs()
1926 writel(master->saved_regs.mdynaddr, in svc_i3c_restore_regs()
1927 master->regs + SVC_I3C_MDYNADDR); in svc_i3c_restore_regs()
1933 struct svc_i3c_master *master = dev_get_drvdata(dev); in svc_i3c_runtime_suspend() local
1935 svc_i3c_save_regs(master); in svc_i3c_runtime_suspend()
1936 svc_i3c_master_unprepare_clks(master); in svc_i3c_runtime_suspend()
1944 struct svc_i3c_master *master = dev_get_drvdata(dev); in svc_i3c_runtime_resume() local
1947 svc_i3c_master_prepare_clks(master); in svc_i3c_runtime_resume()
1949 svc_i3c_restore_regs(master); in svc_i3c_runtime_resume()
1962 { .compatible = "silvaco,i3c-master-v1"},
1971 .name = "silvaco-i3c-master",
1980 MODULE_DESCRIPTION("Silvaco dual-role I3C master driver");