Lines Matching +full:i3c +full:- +full:master
1 // SPDX-License-Identifier: GPL-2.0
3 * Silvaco dual-role I3C master driver
14 #include <linux/i3c/master.h>
24 /* Master Mode Registers */
160 * struct svc_i3c_master - Silvaco I3C Master structure
161 * @base: I3C master controller
168 * @hj_work: Hot-join work
183 * @lock: Transfer lock, protect between IBI work thread and callbacks from master
220 * struct svc_i3c_i2c_dev_data - Device specific data
221 * @index: Index in the master tables corresponding to this device
222 * @ibi: IBI slot index in the master structure
231 static inline bool is_events_enabled(struct svc_i3c_master *master, u32 mask) in is_events_enabled() argument
233 return !!(master->enabled_events & mask); in is_events_enabled()
236 static bool svc_i3c_master_error(struct svc_i3c_master *master) in svc_i3c_master_error() argument
240 mstatus = readl(master->regs + SVC_I3C_MSTATUS); in svc_i3c_master_error()
242 merrwarn = readl(master->regs + SVC_I3C_MERRWARN); in svc_i3c_master_error()
243 writel(merrwarn, master->regs + SVC_I3C_MERRWARN); in svc_i3c_master_error()
247 dev_dbg(master->dev, "Warning condition: MSTATUS 0x%08x, MERRWARN 0x%08x\n", in svc_i3c_master_error()
252 dev_err(master->dev, in svc_i3c_master_error()
262 static void svc_i3c_master_enable_interrupts(struct svc_i3c_master *master, u32 mask) in svc_i3c_master_enable_interrupts() argument
264 writel(mask, master->regs + SVC_I3C_MINTSET); in svc_i3c_master_enable_interrupts()
267 static void svc_i3c_master_disable_interrupts(struct svc_i3c_master *master) in svc_i3c_master_disable_interrupts() argument
269 u32 mask = readl(master->regs + SVC_I3C_MINTSET); in svc_i3c_master_disable_interrupts()
271 writel(mask, master->regs + SVC_I3C_MINTCLR); in svc_i3c_master_disable_interrupts()
274 static void svc_i3c_master_clear_merrwarn(struct svc_i3c_master *master) in svc_i3c_master_clear_merrwarn() argument
277 writel(readl(master->regs + SVC_I3C_MERRWARN), in svc_i3c_master_clear_merrwarn()
278 master->regs + SVC_I3C_MERRWARN); in svc_i3c_master_clear_merrwarn()
281 static void svc_i3c_master_flush_fifo(struct svc_i3c_master *master) in svc_i3c_master_flush_fifo() argument
285 master->regs + SVC_I3C_MDATACTRL); in svc_i3c_master_flush_fifo()
288 static void svc_i3c_master_reset_fifo_trigger(struct svc_i3c_master *master) in svc_i3c_master_reset_fifo_trigger() argument
298 writel(reg, master->regs + SVC_I3C_MDATACTRL); in svc_i3c_master_reset_fifo_trigger()
301 static void svc_i3c_master_reset(struct svc_i3c_master *master) in svc_i3c_master_reset() argument
303 svc_i3c_master_clear_merrwarn(master); in svc_i3c_master_reset()
304 svc_i3c_master_reset_fifo_trigger(master); in svc_i3c_master_reset()
305 svc_i3c_master_disable_interrupts(master); in svc_i3c_master_reset()
309 to_svc_i3c_master(struct i3c_master_controller *master) in to_svc_i3c_master() argument
311 return container_of(master, struct svc_i3c_master, base); in to_svc_i3c_master()
316 struct svc_i3c_master *master; in svc_i3c_master_hj_work() local
318 master = container_of(work, struct svc_i3c_master, hj_work); in svc_i3c_master_hj_work()
319 i3c_master_do_daa(&master->base); in svc_i3c_master_hj_work()
323 svc_i3c_master_dev_from_addr(struct svc_i3c_master *master, in svc_i3c_master_dev_from_addr() argument
329 if (master->addrs[i] == ibiaddr) in svc_i3c_master_dev_from_addr()
335 return master->descs[i]; in svc_i3c_master_dev_from_addr()
338 static void svc_i3c_master_emit_stop(struct svc_i3c_master *master) in svc_i3c_master_emit_stop() argument
340 writel(SVC_I3C_MCTRL_REQUEST_STOP, master->regs + SVC_I3C_MCTRL); in svc_i3c_master_emit_stop()
351 static int svc_i3c_master_handle_ibi(struct svc_i3c_master *master, in svc_i3c_master_handle_ibi() argument
361 slot = i3c_generic_ibi_get_free_slot(data->ibi_pool); in svc_i3c_master_handle_ibi()
363 return -ENOSPC; in svc_i3c_master_handle_ibi()
365 slot->len = 0; in svc_i3c_master_handle_ibi()
366 buf = slot->data; in svc_i3c_master_handle_ibi()
368 ret = readl_relaxed_poll_timeout(master->regs + SVC_I3C_MSTATUS, val, in svc_i3c_master_handle_ibi()
371 dev_err(master->dev, "Timeout when polling for COMPLETE\n"); in svc_i3c_master_handle_ibi()
375 while (SVC_I3C_MSTATUS_RXPEND(readl(master->regs + SVC_I3C_MSTATUS)) && in svc_i3c_master_handle_ibi()
376 slot->len < SVC_I3C_FIFO_SIZE) { in svc_i3c_master_handle_ibi()
377 mdatactrl = readl(master->regs + SVC_I3C_MDATACTRL); in svc_i3c_master_handle_ibi()
379 readsb(master->regs + SVC_I3C_MRDATAB, buf, count); in svc_i3c_master_handle_ibi()
380 slot->len += count; in svc_i3c_master_handle_ibi()
384 master->ibi.tbq_slot = slot; in svc_i3c_master_handle_ibi()
389 static void svc_i3c_master_ack_ibi(struct svc_i3c_master *master, in svc_i3c_master_ack_ibi() argument
400 writel(ibi_ack_nack, master->regs + SVC_I3C_MCTRL); in svc_i3c_master_ack_ibi()
403 static void svc_i3c_master_nack_ibi(struct svc_i3c_master *master) in svc_i3c_master_nack_ibi() argument
407 master->regs + SVC_I3C_MCTRL); in svc_i3c_master_nack_ibi()
412 struct svc_i3c_master *master = container_of(work, struct svc_i3c_master, ibi_work); in svc_i3c_master_ibi_work() local
419 mutex_lock(&master->lock); in svc_i3c_master_ibi_work()
431 writel(SVC_I3C_MINT_IBIWON, master->regs + SVC_I3C_MSTATUS); in svc_i3c_master_ibi_work()
436 master->regs + SVC_I3C_MCTRL); in svc_i3c_master_ibi_work()
439 ret = readl_relaxed_poll_timeout(master->regs + SVC_I3C_MSTATUS, val, in svc_i3c_master_ibi_work()
442 dev_err(master->dev, "Timeout when polling for IBIWON\n"); in svc_i3c_master_ibi_work()
443 svc_i3c_master_emit_stop(master); in svc_i3c_master_ibi_work()
447 status = readl(master->regs + SVC_I3C_MSTATUS); in svc_i3c_master_ibi_work()
454 dev = svc_i3c_master_dev_from_addr(master, ibiaddr); in svc_i3c_master_ibi_work()
455 if (!dev || !is_events_enabled(master, SVC_I3C_EVENT_IBI)) in svc_i3c_master_ibi_work()
456 svc_i3c_master_nack_ibi(master); in svc_i3c_master_ibi_work()
458 svc_i3c_master_handle_ibi(master, dev); in svc_i3c_master_ibi_work()
461 if (is_events_enabled(master, SVC_I3C_EVENT_HOTJOIN)) in svc_i3c_master_ibi_work()
462 svc_i3c_master_ack_ibi(master, false); in svc_i3c_master_ibi_work()
464 svc_i3c_master_nack_ibi(master); in svc_i3c_master_ibi_work()
467 svc_i3c_master_nack_ibi(master); in svc_i3c_master_ibi_work()
478 if (svc_i3c_master_error(master)) { in svc_i3c_master_ibi_work()
479 if (master->ibi.tbq_slot) { in svc_i3c_master_ibi_work()
481 i3c_generic_ibi_recycle_slot(data->ibi_pool, in svc_i3c_master_ibi_work()
482 master->ibi.tbq_slot); in svc_i3c_master_ibi_work()
483 master->ibi.tbq_slot = NULL; in svc_i3c_master_ibi_work()
486 svc_i3c_master_emit_stop(master); in svc_i3c_master_ibi_work()
495 i3c_master_queue_ibi(dev, master->ibi.tbq_slot); in svc_i3c_master_ibi_work()
496 master->ibi.tbq_slot = NULL; in svc_i3c_master_ibi_work()
498 svc_i3c_master_emit_stop(master); in svc_i3c_master_ibi_work()
501 svc_i3c_master_emit_stop(master); in svc_i3c_master_ibi_work()
502 if (is_events_enabled(master, SVC_I3C_EVENT_HOTJOIN)) in svc_i3c_master_ibi_work()
503 queue_work(master->base.wq, &master->hj_work); in svc_i3c_master_ibi_work()
506 svc_i3c_master_emit_stop(master); in svc_i3c_master_ibi_work()
513 svc_i3c_master_enable_interrupts(master, SVC_I3C_MINT_SLVSTART); in svc_i3c_master_ibi_work()
514 mutex_unlock(&master->lock); in svc_i3c_master_ibi_work()
519 struct svc_i3c_master *master = (struct svc_i3c_master *)dev_id; in svc_i3c_master_irq_handler() local
520 u32 active = readl(master->regs + SVC_I3C_MSTATUS); in svc_i3c_master_irq_handler()
526 writel(SVC_I3C_MINT_SLVSTART, master->regs + SVC_I3C_MSTATUS); in svc_i3c_master_irq_handler()
528 svc_i3c_master_disable_interrupts(master); in svc_i3c_master_irq_handler()
531 queue_work(master->base.wq, &master->ibi_work); in svc_i3c_master_irq_handler()
539 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_set_speed() local
540 struct i3c_bus *bus = i3c_master_get_bus(&master->base); in svc_i3c_master_set_speed()
545 ret = pm_runtime_resume_and_get(master->dev); in svc_i3c_master_set_speed()
547 dev_err(master->dev, "<%s> Cannot get runtime PM.\n", __func__); in svc_i3c_master_set_speed()
553 fclk_rate = clk_get_rate(master->fclk); in svc_i3c_master_set_speed()
555 ret = -EINVAL; in svc_i3c_master_set_speed()
559 * Set 50% duty-cycle I2C speed to I3C OPEN-DRAIN mode, so the first in svc_i3c_master_set_speed()
560 * broadcast address is visible to all I2C/I3C devices on the I3C bus. in svc_i3c_master_set_speed()
561 * I3C device working as a I2C device will turn off its 50ns Spike in svc_i3c_master_set_speed()
562 * Filter to change to I3C mode. in svc_i3c_master_set_speed()
564 mconfig = master->mctrl_config; in svc_i3c_master_set_speed()
567 odbaud = DIV_ROUND_UP(fclk_rate, bus->scl_rate.i2c * (2 + 2 * ppbaud)) - 1; in svc_i3c_master_set_speed()
570 writel(mconfig, master->regs + SVC_I3C_MCONFIG); in svc_i3c_master_set_speed()
573 writel(master->mctrl_config, master->regs + SVC_I3C_MCONFIG); in svc_i3c_master_set_speed()
578 pm_runtime_mark_last_busy(master->dev); in svc_i3c_master_set_speed()
579 pm_runtime_put_autosuspend(master->dev); in svc_i3c_master_set_speed()
586 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_bus_init() local
594 ret = pm_runtime_resume_and_get(master->dev); in svc_i3c_master_bus_init()
596 dev_err(master->dev, in svc_i3c_master_bus_init()
597 "<%s> cannot resume i3c bus master, err: %d\n", in svc_i3c_master_bus_init()
603 fclk_rate = clk_get_rate(master->fclk); in svc_i3c_master_bus_init()
605 ret = -EINVAL; in svc_i3c_master_bus_init()
612 * Using I3C Push-Pull mode, target is 12.5MHz/80ns period. in svc_i3c_master_bus_init()
613 * Simplest configuration is using a 50% duty-cycle of 40ns. in svc_i3c_master_bus_init()
615 ppbaud = DIV_ROUND_UP(40, fclk_period_ns) - 1; in svc_i3c_master_bus_init()
619 * Using I3C Open-Drain mode, target is 4.17MHz/240ns with a in svc_i3c_master_bus_init()
620 * duty-cycle tuned so that high levels are filetered out by in svc_i3c_master_bus_init()
625 odbaud = DIV_ROUND_UP(240 - high_period_ns, high_period_ns) - 1; in svc_i3c_master_bus_init()
628 switch (bus->mode) { in svc_i3c_master_bus_init()
639 i2cbaud = DIV_ROUND_UP(1000, od_low_period_ns) - 2; in svc_i3c_master_bus_init()
647 i2cbaud = DIV_ROUND_UP(2500, od_low_period_ns) - 2; in svc_i3c_master_bus_init()
664 writel(reg, master->regs + SVC_I3C_MCONFIG); in svc_i3c_master_bus_init()
666 master->mctrl_config = reg; in svc_i3c_master_bus_init()
667 /* Master core's registration */ in svc_i3c_master_bus_init()
675 master->regs + SVC_I3C_MDYNADDR); in svc_i3c_master_bus_init()
677 ret = i3c_master_set_info(&master->base, &info); in svc_i3c_master_bus_init()
682 pm_runtime_mark_last_busy(master->dev); in svc_i3c_master_bus_init()
683 pm_runtime_put_autosuspend(master->dev); in svc_i3c_master_bus_init()
690 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_bus_cleanup() local
693 ret = pm_runtime_resume_and_get(master->dev); in svc_i3c_master_bus_cleanup()
695 dev_err(master->dev, "<%s> Cannot get runtime PM.\n", __func__); in svc_i3c_master_bus_cleanup()
699 svc_i3c_master_disable_interrupts(master); in svc_i3c_master_bus_cleanup()
701 /* Disable master */ in svc_i3c_master_bus_cleanup()
702 writel(0, master->regs + SVC_I3C_MCONFIG); in svc_i3c_master_bus_cleanup()
704 pm_runtime_mark_last_busy(master->dev); in svc_i3c_master_bus_cleanup()
705 pm_runtime_put_autosuspend(master->dev); in svc_i3c_master_bus_cleanup()
708 static int svc_i3c_master_reserve_slot(struct svc_i3c_master *master) in svc_i3c_master_reserve_slot() argument
712 if (!(master->free_slots & GENMASK(SVC_I3C_MAX_DEVS - 1, 0))) in svc_i3c_master_reserve_slot()
713 return -ENOSPC; in svc_i3c_master_reserve_slot()
715 slot = ffs(master->free_slots) - 1; in svc_i3c_master_reserve_slot()
717 master->free_slots &= ~BIT(slot); in svc_i3c_master_reserve_slot()
722 static void svc_i3c_master_release_slot(struct svc_i3c_master *master, in svc_i3c_master_release_slot() argument
725 master->free_slots |= BIT(slot); in svc_i3c_master_release_slot()
731 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_attach_i3c_dev() local
735 slot = svc_i3c_master_reserve_slot(master); in svc_i3c_master_attach_i3c_dev()
741 svc_i3c_master_release_slot(master, slot); in svc_i3c_master_attach_i3c_dev()
742 return -ENOMEM; in svc_i3c_master_attach_i3c_dev()
745 data->ibi = -1; in svc_i3c_master_attach_i3c_dev()
746 data->index = slot; in svc_i3c_master_attach_i3c_dev()
747 master->addrs[slot] = dev->info.dyn_addr ? dev->info.dyn_addr : in svc_i3c_master_attach_i3c_dev()
748 dev->info.static_addr; in svc_i3c_master_attach_i3c_dev()
749 master->descs[slot] = dev; in svc_i3c_master_attach_i3c_dev()
760 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_reattach_i3c_dev() local
763 master->addrs[data->index] = dev->info.dyn_addr ? dev->info.dyn_addr : in svc_i3c_master_reattach_i3c_dev()
764 dev->info.static_addr; in svc_i3c_master_reattach_i3c_dev()
773 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_detach_i3c_dev() local
775 master->addrs[data->index] = 0; in svc_i3c_master_detach_i3c_dev()
776 svc_i3c_master_release_slot(master, data->index); in svc_i3c_master_detach_i3c_dev()
784 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_attach_i2c_dev() local
788 slot = svc_i3c_master_reserve_slot(master); in svc_i3c_master_attach_i2c_dev()
794 svc_i3c_master_release_slot(master, slot); in svc_i3c_master_attach_i2c_dev()
795 return -ENOMEM; in svc_i3c_master_attach_i2c_dev()
798 data->index = slot; in svc_i3c_master_attach_i2c_dev()
799 master->addrs[slot] = dev->addr; in svc_i3c_master_attach_i2c_dev()
810 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_detach_i2c_dev() local
812 svc_i3c_master_release_slot(master, data->index); in svc_i3c_master_detach_i2c_dev()
817 static int svc_i3c_master_readb(struct svc_i3c_master *master, u8 *dst, in svc_i3c_master_readb() argument
824 ret = readl_poll_timeout_atomic(master->regs + SVC_I3C_MSTATUS, in svc_i3c_master_readb()
831 dst[i] = readl(master->regs + SVC_I3C_MRDATAB); in svc_i3c_master_readb()
837 static int svc_i3c_master_do_daa_locked(struct svc_i3c_master *master, in svc_i3c_master_do_daa_locked() argument
845 svc_i3c_master_flush_fifo(master); in svc_i3c_master_do_daa_locked()
853 master->regs + SVC_I3C_MCTRL); in svc_i3c_master_do_daa_locked()
859 ret = readl_poll_timeout_atomic(master->regs + SVC_I3C_MSTATUS, in svc_i3c_master_do_daa_locked()
871 * We only care about the 48-bit provisional ID yet to in svc_i3c_master_do_daa_locked()
875 ret = svc_i3c_master_readb(master, data, 6); in svc_i3c_master_do_daa_locked()
880 prov_id[dev_nb] |= (u64)(data[i]) << (8 * (5 - i)); in svc_i3c_master_do_daa_locked()
883 ret = svc_i3c_master_readb(master, data, 2); in svc_i3c_master_do_daa_locked()
896 /* No I3C devices attached */ in svc_i3c_master_do_daa_locked()
908 return -EIO; in svc_i3c_master_do_daa_locked()
910 dev_nb--; in svc_i3c_master_do_daa_locked()
912 svc_i3c_master_emit_stop(master); in svc_i3c_master_do_daa_locked()
916 return -EIO; in svc_i3c_master_do_daa_locked()
921 ret = readl_poll_timeout_atomic(master->regs + SVC_I3C_MSTATUS, in svc_i3c_master_do_daa_locked()
931 ret = i3c_master_get_free_addr(&master->base, last_addr + 1); in svc_i3c_master_do_daa_locked()
936 dev_dbg(master->dev, "DAA: device %d assigned to 0x%02x\n", in svc_i3c_master_do_daa_locked()
939 writel(addrs[dev_nb], master->regs + SVC_I3C_MWDATAB); in svc_i3c_master_do_daa_locked()
948 static int svc_i3c_update_ibirules(struct svc_i3c_master *master) in svc_i3c_update_ibirules() argument
957 i3c_bus_for_each_i3cdev(&master->base.bus, dev) { in svc_i3c_update_ibirules()
958 if (!(dev->info.bcr & I3C_BCR_IBI_REQ_CAP)) in svc_i3c_update_ibirules()
961 if (dev->info.bcr & I3C_BCR_IBI_PAYLOAD) { in svc_i3c_update_ibirules()
963 dev->info.dyn_addr); in svc_i3c_update_ibirules()
966 if (dev->info.dyn_addr & BIT(7)) in svc_i3c_update_ibirules()
972 dev->info.dyn_addr); in svc_i3c_update_ibirules()
975 if (dev->info.dyn_addr & BIT(7)) in svc_i3c_update_ibirules()
991 return -ERANGE; in svc_i3c_update_ibirules()
995 writel(reg_mbyte, master->regs + SVC_I3C_IBIRULES); in svc_i3c_update_ibirules()
997 writel(reg_nobyte, master->regs + SVC_I3C_IBIRULES); in svc_i3c_update_ibirules()
1004 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_do_daa() local
1010 ret = pm_runtime_resume_and_get(master->dev); in svc_i3c_master_do_daa()
1012 dev_err(master->dev, "<%s> Cannot get runtime PM.\n", __func__); in svc_i3c_master_do_daa()
1016 spin_lock_irqsave(&master->xferqueue.lock, flags); in svc_i3c_master_do_daa()
1017 ret = svc_i3c_master_do_daa_locked(master, addrs, &dev_nb); in svc_i3c_master_do_daa()
1018 spin_unlock_irqrestore(&master->xferqueue.lock, flags); in svc_i3c_master_do_daa()
1020 svc_i3c_master_emit_stop(master); in svc_i3c_master_do_daa()
1021 svc_i3c_master_clear_merrwarn(master); in svc_i3c_master_do_daa()
1031 * registered on the bus. The I3C stack might still consider 0xb a free in svc_i3c_master_do_daa()
1033 * causing both devices A and B to use the same address 0xb, violating the I3C in svc_i3c_master_do_daa()
1037 * because subsequent steps will scan the entire I3C bus, independent of in svc_i3c_master_do_daa()
1047 /* Configure IBI auto-rules */ in svc_i3c_master_do_daa()
1048 ret = svc_i3c_update_ibirules(master); in svc_i3c_master_do_daa()
1050 dev_err(master->dev, "Cannot handle such a list of devices"); in svc_i3c_master_do_daa()
1053 pm_runtime_mark_last_busy(master->dev); in svc_i3c_master_do_daa()
1054 pm_runtime_put_autosuspend(master->dev); in svc_i3c_master_do_daa()
1059 static int svc_i3c_master_read(struct svc_i3c_master *master, in svc_i3c_master_read() argument
1069 mstatus = readl(master->regs + SVC_I3C_MSTATUS); in svc_i3c_master_read()
1074 dev_dbg(master->dev, "I3C read timeout\n"); in svc_i3c_master_read()
1075 return -ETIMEDOUT; in svc_i3c_master_read()
1078 mdctrl = readl(master->regs + SVC_I3C_MDATACTRL); in svc_i3c_master_read()
1081 dev_err(master->dev, "I3C receive length too long!\n"); in svc_i3c_master_read()
1082 return -EINVAL; in svc_i3c_master_read()
1085 in[offset + i] = readl(master->regs + SVC_I3C_MRDATAB); in svc_i3c_master_read()
1093 static int svc_i3c_master_write(struct svc_i3c_master *master, in svc_i3c_master_write() argument
1100 ret = readl_poll_timeout(master->regs + SVC_I3C_MDATACTRL, in svc_i3c_master_write()
1111 if (likely(offset < (len - 1))) in svc_i3c_master_write()
1112 writel(out[offset++], master->regs + SVC_I3C_MWDATAB); in svc_i3c_master_write()
1114 writel(out[offset++], master->regs + SVC_I3C_MWDATABE); in svc_i3c_master_write()
1120 static int svc_i3c_master_xfer(struct svc_i3c_master *master, in svc_i3c_master_xfer() argument
1130 writel(SVC_I3C_MINT_IBIWON, master->regs + SVC_I3C_MSTATUS); in svc_i3c_master_xfer()
1133 while (retry--) { in svc_i3c_master_xfer()
1140 master->regs + SVC_I3C_MCTRL); in svc_i3c_master_xfer()
1142 ret = readl_poll_timeout(master->regs + SVC_I3C_MSTATUS, reg, in svc_i3c_master_xfer()
1147 if (readl(master->regs + SVC_I3C_MERRWARN) & SVC_I3C_MERRWARN_NACK) { in svc_i3c_master_xfer()
1149 * According to I3C Spec 1.1.1, 11-Jun-2021, section: 5.1.2.2.3. in svc_i3c_master_xfer()
1150 * If the Controller chooses to start an I3C Message with an I3C Dynamic in svc_i3c_master_xfer()
1151 * Address, then special provisions shall be made because that same I3C in svc_i3c_master_xfer()
1169 writel(SVC_I3C_MERRWARN_NACK, master->regs + SVC_I3C_MERRWARN); in svc_i3c_master_xfer()
1171 ret = -ENXIO; in svc_i3c_master_xfer()
1181 * According to I3C spec ver 1.1.1, 5.1.2.2.3 Consequence of Controller Starting a Frame in svc_i3c_master_xfer()
1182 * with I3C Target Address. in svc_i3c_master_xfer()
1184 * The I3C Controller normally should start a Frame, the Address may be arbitrated, and so in svc_i3c_master_xfer()
1185 * the Controller shall monitor to see whether an In-Band Interrupt request, a Controller in svc_i3c_master_xfer()
1187 * a Hot-Join Request has been made. in svc_i3c_master_xfer()
1193 ret = -EAGAIN; in svc_i3c_master_xfer()
1199 ret = svc_i3c_master_read(master, in, xfer_len); in svc_i3c_master_xfer()
1201 ret = svc_i3c_master_write(master, out, xfer_len); in svc_i3c_master_xfer()
1208 ret = readl_poll_timeout(master->regs + SVC_I3C_MSTATUS, reg, in svc_i3c_master_xfer()
1213 writel(SVC_I3C_MINT_COMPLETE, master->regs + SVC_I3C_MSTATUS); in svc_i3c_master_xfer()
1216 svc_i3c_master_emit_stop(master); in svc_i3c_master_xfer()
1219 readl_poll_timeout(master->regs + SVC_I3C_MSTATUS, reg, in svc_i3c_master_xfer()
1226 svc_i3c_master_emit_stop(master); in svc_i3c_master_xfer()
1227 svc_i3c_master_clear_merrwarn(master); in svc_i3c_master_xfer()
1233 svc_i3c_master_alloc_xfer(struct svc_i3c_master *master, unsigned int ncmds) in svc_i3c_master_alloc_xfer() argument
1241 INIT_LIST_HEAD(&xfer->node); in svc_i3c_master_alloc_xfer()
1242 xfer->ncmds = ncmds; in svc_i3c_master_alloc_xfer()
1243 xfer->ret = -ETIMEDOUT; in svc_i3c_master_alloc_xfer()
1253 static void svc_i3c_master_dequeue_xfer_locked(struct svc_i3c_master *master, in svc_i3c_master_dequeue_xfer_locked() argument
1256 if (master->xferqueue.cur == xfer) in svc_i3c_master_dequeue_xfer_locked()
1257 master->xferqueue.cur = NULL; in svc_i3c_master_dequeue_xfer_locked()
1259 list_del_init(&xfer->node); in svc_i3c_master_dequeue_xfer_locked()
1262 static void svc_i3c_master_dequeue_xfer(struct svc_i3c_master *master, in svc_i3c_master_dequeue_xfer() argument
1267 spin_lock_irqsave(&master->xferqueue.lock, flags); in svc_i3c_master_dequeue_xfer()
1268 svc_i3c_master_dequeue_xfer_locked(master, xfer); in svc_i3c_master_dequeue_xfer()
1269 spin_unlock_irqrestore(&master->xferqueue.lock, flags); in svc_i3c_master_dequeue_xfer()
1272 static void svc_i3c_master_start_xfer_locked(struct svc_i3c_master *master) in svc_i3c_master_start_xfer_locked() argument
1274 struct svc_i3c_xfer *xfer = master->xferqueue.cur; in svc_i3c_master_start_xfer_locked()
1280 svc_i3c_master_clear_merrwarn(master); in svc_i3c_master_start_xfer_locked()
1281 svc_i3c_master_flush_fifo(master); in svc_i3c_master_start_xfer_locked()
1283 for (i = 0; i < xfer->ncmds; i++) { in svc_i3c_master_start_xfer_locked()
1284 struct svc_i3c_cmd *cmd = &xfer->cmds[i]; in svc_i3c_master_start_xfer_locked()
1286 ret = svc_i3c_master_xfer(master, cmd->rnw, xfer->type, in svc_i3c_master_start_xfer_locked()
1287 cmd->addr, cmd->in, cmd->out, in svc_i3c_master_start_xfer_locked()
1288 cmd->len, &cmd->actual_len, in svc_i3c_master_start_xfer_locked()
1289 cmd->continued); in svc_i3c_master_start_xfer_locked()
1290 /* cmd->xfer is NULL if I2C or CCC transfer */ in svc_i3c_master_start_xfer_locked()
1291 if (cmd->xfer) in svc_i3c_master_start_xfer_locked()
1292 cmd->xfer->actual_len = cmd->actual_len; in svc_i3c_master_start_xfer_locked()
1298 xfer->ret = ret; in svc_i3c_master_start_xfer_locked()
1299 complete(&xfer->comp); in svc_i3c_master_start_xfer_locked()
1302 svc_i3c_master_dequeue_xfer_locked(master, xfer); in svc_i3c_master_start_xfer_locked()
1304 xfer = list_first_entry_or_null(&master->xferqueue.list, in svc_i3c_master_start_xfer_locked()
1308 list_del_init(&xfer->node); in svc_i3c_master_start_xfer_locked()
1310 master->xferqueue.cur = xfer; in svc_i3c_master_start_xfer_locked()
1311 svc_i3c_master_start_xfer_locked(master); in svc_i3c_master_start_xfer_locked()
1314 static void svc_i3c_master_enqueue_xfer(struct svc_i3c_master *master, in svc_i3c_master_enqueue_xfer() argument
1320 ret = pm_runtime_resume_and_get(master->dev); in svc_i3c_master_enqueue_xfer()
1322 dev_err(master->dev, "<%s> Cannot get runtime PM.\n", __func__); in svc_i3c_master_enqueue_xfer()
1326 init_completion(&xfer->comp); in svc_i3c_master_enqueue_xfer()
1327 spin_lock_irqsave(&master->xferqueue.lock, flags); in svc_i3c_master_enqueue_xfer()
1328 if (master->xferqueue.cur) { in svc_i3c_master_enqueue_xfer()
1329 list_add_tail(&xfer->node, &master->xferqueue.list); in svc_i3c_master_enqueue_xfer()
1331 master->xferqueue.cur = xfer; in svc_i3c_master_enqueue_xfer()
1332 svc_i3c_master_start_xfer_locked(master); in svc_i3c_master_enqueue_xfer()
1334 spin_unlock_irqrestore(&master->xferqueue.lock, flags); in svc_i3c_master_enqueue_xfer()
1336 pm_runtime_mark_last_busy(master->dev); in svc_i3c_master_enqueue_xfer()
1337 pm_runtime_put_autosuspend(master->dev); in svc_i3c_master_enqueue_xfer()
1341 svc_i3c_master_supports_ccc_cmd(struct i3c_master_controller *master, in svc_i3c_master_supports_ccc_cmd() argument
1345 return (cmd->ndests == 1); in svc_i3c_master_supports_ccc_cmd()
1348 static int svc_i3c_master_send_bdcast_ccc_cmd(struct svc_i3c_master *master, in svc_i3c_master_send_bdcast_ccc_cmd() argument
1351 unsigned int xfer_len = ccc->dests[0].payload.len + 1; in svc_i3c_master_send_bdcast_ccc_cmd()
1357 xfer = svc_i3c_master_alloc_xfer(master, 1); in svc_i3c_master_send_bdcast_ccc_cmd()
1359 return -ENOMEM; in svc_i3c_master_send_bdcast_ccc_cmd()
1364 return -ENOMEM; in svc_i3c_master_send_bdcast_ccc_cmd()
1367 buf[0] = ccc->id; in svc_i3c_master_send_bdcast_ccc_cmd()
1368 memcpy(&buf[1], ccc->dests[0].payload.data, ccc->dests[0].payload.len); in svc_i3c_master_send_bdcast_ccc_cmd()
1370 xfer->type = SVC_I3C_MCTRL_TYPE_I3C; in svc_i3c_master_send_bdcast_ccc_cmd()
1372 cmd = &xfer->cmds[0]; in svc_i3c_master_send_bdcast_ccc_cmd()
1373 cmd->addr = ccc->dests[0].addr; in svc_i3c_master_send_bdcast_ccc_cmd()
1374 cmd->rnw = ccc->rnw; in svc_i3c_master_send_bdcast_ccc_cmd()
1375 cmd->in = NULL; in svc_i3c_master_send_bdcast_ccc_cmd()
1376 cmd->out = buf; in svc_i3c_master_send_bdcast_ccc_cmd()
1377 cmd->len = xfer_len; in svc_i3c_master_send_bdcast_ccc_cmd()
1378 cmd->actual_len = 0; in svc_i3c_master_send_bdcast_ccc_cmd()
1379 cmd->continued = false; in svc_i3c_master_send_bdcast_ccc_cmd()
1381 mutex_lock(&master->lock); in svc_i3c_master_send_bdcast_ccc_cmd()
1382 svc_i3c_master_enqueue_xfer(master, xfer); in svc_i3c_master_send_bdcast_ccc_cmd()
1383 if (!wait_for_completion_timeout(&xfer->comp, msecs_to_jiffies(1000))) in svc_i3c_master_send_bdcast_ccc_cmd()
1384 svc_i3c_master_dequeue_xfer(master, xfer); in svc_i3c_master_send_bdcast_ccc_cmd()
1385 mutex_unlock(&master->lock); in svc_i3c_master_send_bdcast_ccc_cmd()
1387 ret = xfer->ret; in svc_i3c_master_send_bdcast_ccc_cmd()
1394 static int svc_i3c_master_send_direct_ccc_cmd(struct svc_i3c_master *master, in svc_i3c_master_send_direct_ccc_cmd() argument
1397 unsigned int xfer_len = ccc->dests[0].payload.len; in svc_i3c_master_send_direct_ccc_cmd()
1398 unsigned int actual_len = ccc->rnw ? xfer_len : 0; in svc_i3c_master_send_direct_ccc_cmd()
1403 xfer = svc_i3c_master_alloc_xfer(master, 2); in svc_i3c_master_send_direct_ccc_cmd()
1405 return -ENOMEM; in svc_i3c_master_send_direct_ccc_cmd()
1407 xfer->type = SVC_I3C_MCTRL_TYPE_I3C; in svc_i3c_master_send_direct_ccc_cmd()
1410 cmd = &xfer->cmds[0]; in svc_i3c_master_send_direct_ccc_cmd()
1411 cmd->addr = I3C_BROADCAST_ADDR; in svc_i3c_master_send_direct_ccc_cmd()
1412 cmd->rnw = 0; in svc_i3c_master_send_direct_ccc_cmd()
1413 cmd->in = NULL; in svc_i3c_master_send_direct_ccc_cmd()
1414 cmd->out = &ccc->id; in svc_i3c_master_send_direct_ccc_cmd()
1415 cmd->len = 1; in svc_i3c_master_send_direct_ccc_cmd()
1416 cmd->actual_len = 0; in svc_i3c_master_send_direct_ccc_cmd()
1417 cmd->continued = true; in svc_i3c_master_send_direct_ccc_cmd()
1420 cmd = &xfer->cmds[1]; in svc_i3c_master_send_direct_ccc_cmd()
1421 cmd->addr = ccc->dests[0].addr; in svc_i3c_master_send_direct_ccc_cmd()
1422 cmd->rnw = ccc->rnw; in svc_i3c_master_send_direct_ccc_cmd()
1423 cmd->in = ccc->rnw ? ccc->dests[0].payload.data : NULL; in svc_i3c_master_send_direct_ccc_cmd()
1424 cmd->out = ccc->rnw ? NULL : ccc->dests[0].payload.data, in svc_i3c_master_send_direct_ccc_cmd()
1425 cmd->len = xfer_len; in svc_i3c_master_send_direct_ccc_cmd()
1426 cmd->actual_len = actual_len; in svc_i3c_master_send_direct_ccc_cmd()
1427 cmd->continued = false; in svc_i3c_master_send_direct_ccc_cmd()
1429 mutex_lock(&master->lock); in svc_i3c_master_send_direct_ccc_cmd()
1430 svc_i3c_master_enqueue_xfer(master, xfer); in svc_i3c_master_send_direct_ccc_cmd()
1431 if (!wait_for_completion_timeout(&xfer->comp, msecs_to_jiffies(1000))) in svc_i3c_master_send_direct_ccc_cmd()
1432 svc_i3c_master_dequeue_xfer(master, xfer); in svc_i3c_master_send_direct_ccc_cmd()
1433 mutex_unlock(&master->lock); in svc_i3c_master_send_direct_ccc_cmd()
1435 if (cmd->actual_len != xfer_len) in svc_i3c_master_send_direct_ccc_cmd()
1436 ccc->dests[0].payload.len = cmd->actual_len; in svc_i3c_master_send_direct_ccc_cmd()
1438 ret = xfer->ret; in svc_i3c_master_send_direct_ccc_cmd()
1447 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_send_ccc_cmd() local
1448 bool broadcast = cmd->id < 0x80; in svc_i3c_master_send_ccc_cmd()
1452 ret = svc_i3c_master_send_bdcast_ccc_cmd(master, cmd); in svc_i3c_master_send_ccc_cmd()
1454 ret = svc_i3c_master_send_direct_ccc_cmd(master, cmd); in svc_i3c_master_send_ccc_cmd()
1457 cmd->err = I3C_ERROR_M2; in svc_i3c_master_send_ccc_cmd()
1467 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_priv_xfers() local
1472 xfer = svc_i3c_master_alloc_xfer(master, nxfers); in svc_i3c_master_priv_xfers()
1474 return -ENOMEM; in svc_i3c_master_priv_xfers()
1476 xfer->type = SVC_I3C_MCTRL_TYPE_I3C; in svc_i3c_master_priv_xfers()
1479 struct svc_i3c_cmd *cmd = &xfer->cmds[i]; in svc_i3c_master_priv_xfers()
1481 cmd->xfer = &xfers[i]; in svc_i3c_master_priv_xfers()
1482 cmd->addr = master->addrs[data->index]; in svc_i3c_master_priv_xfers()
1483 cmd->rnw = xfers[i].rnw; in svc_i3c_master_priv_xfers()
1484 cmd->in = xfers[i].rnw ? xfers[i].data.in : NULL; in svc_i3c_master_priv_xfers()
1485 cmd->out = xfers[i].rnw ? NULL : xfers[i].data.out; in svc_i3c_master_priv_xfers()
1486 cmd->len = xfers[i].len; in svc_i3c_master_priv_xfers()
1487 cmd->actual_len = xfers[i].rnw ? xfers[i].len : 0; in svc_i3c_master_priv_xfers()
1488 cmd->continued = (i + 1) < nxfers; in svc_i3c_master_priv_xfers()
1491 mutex_lock(&master->lock); in svc_i3c_master_priv_xfers()
1492 svc_i3c_master_enqueue_xfer(master, xfer); in svc_i3c_master_priv_xfers()
1493 if (!wait_for_completion_timeout(&xfer->comp, msecs_to_jiffies(1000))) in svc_i3c_master_priv_xfers()
1494 svc_i3c_master_dequeue_xfer(master, xfer); in svc_i3c_master_priv_xfers()
1495 mutex_unlock(&master->lock); in svc_i3c_master_priv_xfers()
1497 ret = xfer->ret; in svc_i3c_master_priv_xfers()
1508 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_i2c_xfers() local
1513 xfer = svc_i3c_master_alloc_xfer(master, nxfers); in svc_i3c_master_i2c_xfers()
1515 return -ENOMEM; in svc_i3c_master_i2c_xfers()
1517 xfer->type = SVC_I3C_MCTRL_TYPE_I2C; in svc_i3c_master_i2c_xfers()
1520 struct svc_i3c_cmd *cmd = &xfer->cmds[i]; in svc_i3c_master_i2c_xfers()
1522 cmd->addr = master->addrs[data->index]; in svc_i3c_master_i2c_xfers()
1523 cmd->rnw = xfers[i].flags & I2C_M_RD; in svc_i3c_master_i2c_xfers()
1524 cmd->in = cmd->rnw ? xfers[i].buf : NULL; in svc_i3c_master_i2c_xfers()
1525 cmd->out = cmd->rnw ? NULL : xfers[i].buf; in svc_i3c_master_i2c_xfers()
1526 cmd->len = xfers[i].len; in svc_i3c_master_i2c_xfers()
1527 cmd->actual_len = cmd->rnw ? xfers[i].len : 0; in svc_i3c_master_i2c_xfers()
1528 cmd->continued = (i + 1 < nxfers); in svc_i3c_master_i2c_xfers()
1531 mutex_lock(&master->lock); in svc_i3c_master_i2c_xfers()
1532 svc_i3c_master_enqueue_xfer(master, xfer); in svc_i3c_master_i2c_xfers()
1533 if (!wait_for_completion_timeout(&xfer->comp, msecs_to_jiffies(1000))) in svc_i3c_master_i2c_xfers()
1534 svc_i3c_master_dequeue_xfer(master, xfer); in svc_i3c_master_i2c_xfers()
1535 mutex_unlock(&master->lock); in svc_i3c_master_i2c_xfers()
1537 ret = xfer->ret; in svc_i3c_master_i2c_xfers()
1547 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_request_ibi() local
1552 if (dev->ibi->max_payload_len > SVC_I3C_FIFO_SIZE) { in svc_i3c_master_request_ibi()
1553 dev_err(master->dev, "IBI max payload %d should be < %d\n", in svc_i3c_master_request_ibi()
1554 dev->ibi->max_payload_len, SVC_I3C_FIFO_SIZE); in svc_i3c_master_request_ibi()
1555 return -ERANGE; in svc_i3c_master_request_ibi()
1558 data->ibi_pool = i3c_generic_ibi_alloc_pool(dev, req); in svc_i3c_master_request_ibi()
1559 if (IS_ERR(data->ibi_pool)) in svc_i3c_master_request_ibi()
1560 return PTR_ERR(data->ibi_pool); in svc_i3c_master_request_ibi()
1562 spin_lock_irqsave(&master->ibi.lock, flags); in svc_i3c_master_request_ibi()
1563 for (i = 0; i < master->ibi.num_slots; i++) { in svc_i3c_master_request_ibi()
1564 if (!master->ibi.slots[i]) { in svc_i3c_master_request_ibi()
1565 data->ibi = i; in svc_i3c_master_request_ibi()
1566 master->ibi.slots[i] = dev; in svc_i3c_master_request_ibi()
1570 spin_unlock_irqrestore(&master->ibi.lock, flags); in svc_i3c_master_request_ibi()
1572 if (i < master->ibi.num_slots) in svc_i3c_master_request_ibi()
1575 i3c_generic_ibi_free_pool(data->ibi_pool); in svc_i3c_master_request_ibi()
1576 data->ibi_pool = NULL; in svc_i3c_master_request_ibi()
1578 return -ENOSPC; in svc_i3c_master_request_ibi()
1584 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_free_ibi() local
1588 spin_lock_irqsave(&master->ibi.lock, flags); in svc_i3c_master_free_ibi()
1589 master->ibi.slots[data->ibi] = NULL; in svc_i3c_master_free_ibi()
1590 data->ibi = -1; in svc_i3c_master_free_ibi()
1591 spin_unlock_irqrestore(&master->ibi.lock, flags); in svc_i3c_master_free_ibi()
1593 i3c_generic_ibi_free_pool(data->ibi_pool); in svc_i3c_master_free_ibi()
1599 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_enable_ibi() local
1602 ret = pm_runtime_resume_and_get(master->dev); in svc_i3c_master_enable_ibi()
1604 dev_err(master->dev, "<%s> Cannot get runtime PM.\n", __func__); in svc_i3c_master_enable_ibi()
1608 master->enabled_events++; in svc_i3c_master_enable_ibi()
1609 svc_i3c_master_enable_interrupts(master, SVC_I3C_MINT_SLVSTART); in svc_i3c_master_enable_ibi()
1611 return i3c_master_enec_locked(m, dev->info.dyn_addr, I3C_CCC_EVENT_SIR); in svc_i3c_master_enable_ibi()
1617 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_disable_ibi() local
1620 master->enabled_events--; in svc_i3c_master_disable_ibi()
1621 if (!master->enabled_events) in svc_i3c_master_disable_ibi()
1622 svc_i3c_master_disable_interrupts(master); in svc_i3c_master_disable_ibi()
1624 ret = i3c_master_disec_locked(m, dev->info.dyn_addr, I3C_CCC_EVENT_SIR); in svc_i3c_master_disable_ibi()
1626 pm_runtime_mark_last_busy(master->dev); in svc_i3c_master_disable_ibi()
1627 pm_runtime_put_autosuspend(master->dev); in svc_i3c_master_disable_ibi()
1634 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_enable_hotjoin() local
1637 ret = pm_runtime_resume_and_get(master->dev); in svc_i3c_master_enable_hotjoin()
1639 dev_err(master->dev, "<%s> Cannot get runtime PM.\n", __func__); in svc_i3c_master_enable_hotjoin()
1643 master->enabled_events |= SVC_I3C_EVENT_HOTJOIN; in svc_i3c_master_enable_hotjoin()
1645 svc_i3c_master_enable_interrupts(master, SVC_I3C_MINT_SLVSTART); in svc_i3c_master_enable_hotjoin()
1652 struct svc_i3c_master *master = to_svc_i3c_master(m); in svc_i3c_master_disable_hotjoin() local
1654 master->enabled_events &= ~SVC_I3C_EVENT_HOTJOIN; in svc_i3c_master_disable_hotjoin()
1656 if (!master->enabled_events) in svc_i3c_master_disable_hotjoin()
1657 svc_i3c_master_disable_interrupts(master); in svc_i3c_master_disable_hotjoin()
1659 pm_runtime_mark_last_busy(master->dev); in svc_i3c_master_disable_hotjoin()
1660 pm_runtime_put_autosuspend(master->dev); in svc_i3c_master_disable_hotjoin()
1670 i3c_generic_ibi_recycle_slot(data->ibi_pool, slot); in svc_i3c_master_recycle_ibi_slot()
1696 static int svc_i3c_master_prepare_clks(struct svc_i3c_master *master) in svc_i3c_master_prepare_clks() argument
1700 ret = clk_prepare_enable(master->pclk); in svc_i3c_master_prepare_clks()
1704 ret = clk_prepare_enable(master->fclk); in svc_i3c_master_prepare_clks()
1706 clk_disable_unprepare(master->pclk); in svc_i3c_master_prepare_clks()
1710 ret = clk_prepare_enable(master->sclk); in svc_i3c_master_prepare_clks()
1712 clk_disable_unprepare(master->pclk); in svc_i3c_master_prepare_clks()
1713 clk_disable_unprepare(master->fclk); in svc_i3c_master_prepare_clks()
1720 static void svc_i3c_master_unprepare_clks(struct svc_i3c_master *master) in svc_i3c_master_unprepare_clks() argument
1722 clk_disable_unprepare(master->pclk); in svc_i3c_master_unprepare_clks()
1723 clk_disable_unprepare(master->fclk); in svc_i3c_master_unprepare_clks()
1724 clk_disable_unprepare(master->sclk); in svc_i3c_master_unprepare_clks()
1729 struct device *dev = &pdev->dev; in svc_i3c_master_probe()
1730 struct svc_i3c_master *master; in svc_i3c_master_probe() local
1733 master = devm_kzalloc(dev, sizeof(*master), GFP_KERNEL); in svc_i3c_master_probe()
1734 if (!master) in svc_i3c_master_probe()
1735 return -ENOMEM; in svc_i3c_master_probe()
1737 master->regs = devm_platform_ioremap_resource(pdev, 0); in svc_i3c_master_probe()
1738 if (IS_ERR(master->regs)) in svc_i3c_master_probe()
1739 return PTR_ERR(master->regs); in svc_i3c_master_probe()
1741 master->pclk = devm_clk_get(dev, "pclk"); in svc_i3c_master_probe()
1742 if (IS_ERR(master->pclk)) in svc_i3c_master_probe()
1743 return PTR_ERR(master->pclk); in svc_i3c_master_probe()
1745 master->fclk = devm_clk_get(dev, "fast_clk"); in svc_i3c_master_probe()
1746 if (IS_ERR(master->fclk)) in svc_i3c_master_probe()
1747 return PTR_ERR(master->fclk); in svc_i3c_master_probe()
1749 master->sclk = devm_clk_get(dev, "slow_clk"); in svc_i3c_master_probe()
1750 if (IS_ERR(master->sclk)) in svc_i3c_master_probe()
1751 return PTR_ERR(master->sclk); in svc_i3c_master_probe()
1753 master->irq = platform_get_irq(pdev, 0); in svc_i3c_master_probe()
1754 if (master->irq < 0) in svc_i3c_master_probe()
1755 return master->irq; in svc_i3c_master_probe()
1757 master->dev = dev; in svc_i3c_master_probe()
1759 ret = svc_i3c_master_prepare_clks(master); in svc_i3c_master_probe()
1763 INIT_WORK(&master->hj_work, svc_i3c_master_hj_work); in svc_i3c_master_probe()
1764 INIT_WORK(&master->ibi_work, svc_i3c_master_ibi_work); in svc_i3c_master_probe()
1765 mutex_init(&master->lock); in svc_i3c_master_probe()
1767 ret = devm_request_irq(dev, master->irq, svc_i3c_master_irq_handler, in svc_i3c_master_probe()
1768 IRQF_NO_SUSPEND, "svc-i3c-irq", master); in svc_i3c_master_probe()
1772 master->free_slots = GENMASK(SVC_I3C_MAX_DEVS - 1, 0); in svc_i3c_master_probe()
1774 spin_lock_init(&master->xferqueue.lock); in svc_i3c_master_probe()
1775 INIT_LIST_HEAD(&master->xferqueue.list); in svc_i3c_master_probe()
1777 spin_lock_init(&master->ibi.lock); in svc_i3c_master_probe()
1778 master->ibi.num_slots = SVC_I3C_MAX_DEVS; in svc_i3c_master_probe()
1779 master->ibi.slots = devm_kcalloc(&pdev->dev, master->ibi.num_slots, in svc_i3c_master_probe()
1780 sizeof(*master->ibi.slots), in svc_i3c_master_probe()
1782 if (!master->ibi.slots) { in svc_i3c_master_probe()
1783 ret = -ENOMEM; in svc_i3c_master_probe()
1787 platform_set_drvdata(pdev, master); in svc_i3c_master_probe()
1789 pm_runtime_set_autosuspend_delay(&pdev->dev, SVC_I3C_PM_TIMEOUT_MS); in svc_i3c_master_probe()
1790 pm_runtime_use_autosuspend(&pdev->dev); in svc_i3c_master_probe()
1791 pm_runtime_get_noresume(&pdev->dev); in svc_i3c_master_probe()
1792 pm_runtime_set_active(&pdev->dev); in svc_i3c_master_probe()
1793 pm_runtime_enable(&pdev->dev); in svc_i3c_master_probe()
1795 svc_i3c_master_reset(master); in svc_i3c_master_probe()
1797 /* Register the master */ in svc_i3c_master_probe()
1798 ret = i3c_master_register(&master->base, &pdev->dev, in svc_i3c_master_probe()
1803 pm_runtime_mark_last_busy(&pdev->dev); in svc_i3c_master_probe()
1804 pm_runtime_put_autosuspend(&pdev->dev); in svc_i3c_master_probe()
1809 pm_runtime_dont_use_autosuspend(&pdev->dev); in svc_i3c_master_probe()
1810 pm_runtime_put_noidle(&pdev->dev); in svc_i3c_master_probe()
1811 pm_runtime_disable(&pdev->dev); in svc_i3c_master_probe()
1812 pm_runtime_set_suspended(&pdev->dev); in svc_i3c_master_probe()
1815 svc_i3c_master_unprepare_clks(master); in svc_i3c_master_probe()
1822 struct svc_i3c_master *master = platform_get_drvdata(pdev); in svc_i3c_master_remove() local
1824 cancel_work_sync(&master->hj_work); in svc_i3c_master_remove()
1825 i3c_master_unregister(&master->base); in svc_i3c_master_remove()
1827 pm_runtime_dont_use_autosuspend(&pdev->dev); in svc_i3c_master_remove()
1828 pm_runtime_disable(&pdev->dev); in svc_i3c_master_remove()
1831 static void svc_i3c_save_regs(struct svc_i3c_master *master) in svc_i3c_save_regs() argument
1833 master->saved_regs.mconfig = readl(master->regs + SVC_I3C_MCONFIG); in svc_i3c_save_regs()
1834 master->saved_regs.mdynaddr = readl(master->regs + SVC_I3C_MDYNADDR); in svc_i3c_save_regs()
1837 static void svc_i3c_restore_regs(struct svc_i3c_master *master) in svc_i3c_restore_regs() argument
1839 if (readl(master->regs + SVC_I3C_MDYNADDR) != in svc_i3c_restore_regs()
1840 master->saved_regs.mdynaddr) { in svc_i3c_restore_regs()
1841 writel(master->saved_regs.mconfig, in svc_i3c_restore_regs()
1842 master->regs + SVC_I3C_MCONFIG); in svc_i3c_restore_regs()
1843 writel(master->saved_regs.mdynaddr, in svc_i3c_restore_regs()
1844 master->regs + SVC_I3C_MDYNADDR); in svc_i3c_restore_regs()
1850 struct svc_i3c_master *master = dev_get_drvdata(dev); in svc_i3c_runtime_suspend() local
1852 svc_i3c_save_regs(master); in svc_i3c_runtime_suspend()
1853 svc_i3c_master_unprepare_clks(master); in svc_i3c_runtime_suspend()
1861 struct svc_i3c_master *master = dev_get_drvdata(dev); in svc_i3c_runtime_resume() local
1864 svc_i3c_master_prepare_clks(master); in svc_i3c_runtime_resume()
1866 svc_i3c_restore_regs(master); in svc_i3c_runtime_resume()
1879 { .compatible = "silvaco,i3c-master" },
1888 .name = "silvaco-i3c-master",
1897 MODULE_DESCRIPTION("Silvaco dual-role I3C master driver");