Lines Matching +full:bus +full:- +full:addr
1 // SPDX-License-Identifier: GPL-2.0
11 #include <linux/dma-mapping.h>
30 * i3c_bus_maintenance_lock - Lock the bus for a maintenance operation
31 * @bus: I3C bus to take the lock on
33 * This function takes the bus lock so that no other operations can occur on
34 * the bus. This is needed for all kind of bus maintenance operation, like
35 * - enabling/disabling slave events
36 * - re-triggering DAA
37 * - changing the dynamic address of a device
38 * - relinquishing mastership
39 * - ...
45 static void i3c_bus_maintenance_lock(struct i3c_bus *bus) in i3c_bus_maintenance_lock() argument
47 down_write(&bus->lock); in i3c_bus_maintenance_lock()
51 * i3c_bus_maintenance_unlock - Release the bus lock after a maintenance
53 * @bus: I3C bus to release the lock on
55 * Should be called when the bus maintenance operation is done. See
59 static void i3c_bus_maintenance_unlock(struct i3c_bus *bus) in i3c_bus_maintenance_unlock() argument
61 up_write(&bus->lock); in i3c_bus_maintenance_unlock()
65 * i3c_bus_normaluse_lock - Lock the bus for a normal operation
66 * @bus: I3C bus to take the lock on
68 * This function takes the bus lock for any operation that is not a maintenance
69 * operation (see i3c_bus_maintenance_lock() for a non-exhaustive list of
71 * normal operations (HDR, SDR transfers or CCC commands that do not change bus
77 * sure two different communications are not inter-mixed, or access to the
80 void i3c_bus_normaluse_lock(struct i3c_bus *bus) in i3c_bus_normaluse_lock() argument
82 down_read(&bus->lock); in i3c_bus_normaluse_lock()
86 * i3c_bus_normaluse_unlock - Release the bus lock after a normal operation
87 * @bus: I3C bus to release the lock on
93 void i3c_bus_normaluse_unlock(struct i3c_bus *bus) in i3c_bus_normaluse_unlock() argument
95 up_read(&bus->lock); in i3c_bus_normaluse_unlock()
101 return container_of(i3cbus, struct i3c_master_controller, bus); in i3c_bus_to_i3c_master()
115 if (dev->type == &i3c_device_type) in dev_to_i3cbus()
116 return dev_to_i3cdev(dev)->bus; in dev_to_i3cbus()
120 return &master->bus; in dev_to_i3cbus()
127 if (dev->type == &i3c_device_type) in dev_to_i3cdesc()
128 return dev_to_i3cdev(dev)->desc; in dev_to_i3cdesc()
132 return master->this; in dev_to_i3cdesc()
139 struct i3c_bus *bus = dev_to_i3cbus(dev); in bcr_show() local
143 i3c_bus_normaluse_lock(bus); in bcr_show()
145 ret = sprintf(buf, "0x%02x\n", desc->info.bcr); in bcr_show()
146 i3c_bus_normaluse_unlock(bus); in bcr_show()
156 struct i3c_bus *bus = dev_to_i3cbus(dev); in dcr_show() local
160 i3c_bus_normaluse_lock(bus); in dcr_show()
162 ret = sprintf(buf, "0x%02x\n", desc->info.dcr); in dcr_show()
163 i3c_bus_normaluse_unlock(bus); in dcr_show()
173 struct i3c_bus *bus = dev_to_i3cbus(dev); in pid_show() local
177 i3c_bus_normaluse_lock(bus); in pid_show()
179 ret = sprintf(buf, "%llx\n", desc->info.pid); in pid_show()
180 i3c_bus_normaluse_unlock(bus); in pid_show()
190 struct i3c_bus *bus = dev_to_i3cbus(dev); in dynamic_address_show() local
194 i3c_bus_normaluse_lock(bus); in dynamic_address_show()
196 ret = sprintf(buf, "%02x\n", desc->info.dyn_addr); in dynamic_address_show()
197 i3c_bus_normaluse_unlock(bus); in dynamic_address_show()
204 "hdr-ddr", "hdr-tsp", "hdr-tsl",
211 struct i3c_bus *bus = dev_to_i3cbus(dev); in hdrcap_show() local
217 i3c_bus_normaluse_lock(bus); in hdrcap_show()
219 caps = desc->info.hdr_cap; in hdrcap_show()
242 i3c_bus_normaluse_unlock(bus); in hdrcap_show()
286 if (i3cdev->desc) in i3c_device_uevent()
287 devinfo = i3cdev->desc->info; in i3c_device_uevent()
311 if (dev->type != &i3c_device_type) in i3c_device_match()
316 if (i3c_device_match_id(i3cdev, i3cdrv->id_table)) in i3c_device_match()
325 struct i3c_driver *driver = drv_to_i3cdrv(dev->driver); in i3c_device_probe()
327 return driver->probe(i3cdev); in i3c_device_probe()
333 struct i3c_driver *driver = drv_to_i3cdrv(dev->driver); in i3c_device_remove()
335 if (driver->remove) in i3c_device_remove()
336 driver->remove(i3cdev); in i3c_device_remove()
348 i3c_bus_get_addr_slot_status_mask(struct i3c_bus *bus, u16 addr, u32 mask) in i3c_bus_get_addr_slot_status_mask() argument
351 int bitpos = addr * I3C_ADDR_SLOT_STATUS_BITS; in i3c_bus_get_addr_slot_status_mask()
353 if (addr > I2C_MAX_ADDR) in i3c_bus_get_addr_slot_status_mask()
356 status = bus->addrslots[bitpos / BITS_PER_LONG]; in i3c_bus_get_addr_slot_status_mask()
363 i3c_bus_get_addr_slot_status(struct i3c_bus *bus, u16 addr) in i3c_bus_get_addr_slot_status() argument
365 return i3c_bus_get_addr_slot_status_mask(bus, addr, I3C_ADDR_SLOT_STATUS_MASK); in i3c_bus_get_addr_slot_status()
368 static void i3c_bus_set_addr_slot_status_mask(struct i3c_bus *bus, u16 addr, in i3c_bus_set_addr_slot_status_mask() argument
371 int bitpos = addr * I3C_ADDR_SLOT_STATUS_BITS; in i3c_bus_set_addr_slot_status_mask()
374 if (addr > I2C_MAX_ADDR) in i3c_bus_set_addr_slot_status_mask()
377 ptr = bus->addrslots + (bitpos / BITS_PER_LONG); in i3c_bus_set_addr_slot_status_mask()
382 static void i3c_bus_set_addr_slot_status(struct i3c_bus *bus, u16 addr, in i3c_bus_set_addr_slot_status() argument
385 i3c_bus_set_addr_slot_status_mask(bus, addr, status, I3C_ADDR_SLOT_STATUS_MASK); in i3c_bus_set_addr_slot_status()
388 static bool i3c_bus_dev_addr_is_avail(struct i3c_bus *bus, u8 addr) in i3c_bus_dev_addr_is_avail() argument
392 status = i3c_bus_get_addr_slot_status(bus, addr); in i3c_bus_dev_addr_is_avail()
403 * └─►│Sr│7'h7E RnW=1 │ACK│48bit UID BCR DCR│Assign 7bit Addr│PAR│ ACK/NACK│
406 * sending it out to the I3C bus. This means that a 7-bit dynamic address needs to be allocated
410 * typically specified by the DT-'s assigned-address property. Lower addresses having higher IBI
413 * the "init_dyn_addr" to switch to its "init_dyn_addr" when it hot-joins the I3C bus. Otherwise,
420 static int i3c_bus_get_free_addr(struct i3c_bus *bus, u8 start_addr) in i3c_bus_get_free_addr() argument
423 u8 addr; in i3c_bus_get_free_addr() local
425 for (addr = start_addr; addr < I3C_MAX_ADDR; addr++) { in i3c_bus_get_free_addr()
426 status = i3c_bus_get_addr_slot_status_mask(bus, addr, in i3c_bus_get_free_addr()
429 return addr; in i3c_bus_get_free_addr()
432 for (addr = start_addr; addr < I3C_MAX_ADDR; addr++) { in i3c_bus_get_free_addr()
433 status = i3c_bus_get_addr_slot_status_mask(bus, addr, in i3c_bus_get_free_addr()
436 return addr; in i3c_bus_get_free_addr()
439 return -ENOMEM; in i3c_bus_get_free_addr()
442 static void i3c_bus_init_addrslots(struct i3c_bus *bus) in i3c_bus_init_addrslots() argument
448 i3c_bus_set_addr_slot_status(bus, i, I3C_ADDR_SLOT_RSVD); in i3c_bus_init_addrslots()
454 i3c_bus_set_addr_slot_status(bus, I3C_BROADCAST_ADDR, in i3c_bus_init_addrslots()
457 i3c_bus_set_addr_slot_status(bus, I3C_BROADCAST_ADDR ^ BIT(i), in i3c_bus_init_addrslots()
464 idr_remove(&i3c_bus_idr, i3cbus->id); in i3c_bus_cleanup()
470 int ret, start, end, id = -1; in i3c_bus_init()
472 init_rwsem(&i3cbus->lock); in i3c_bus_init()
473 INIT_LIST_HEAD(&i3cbus->devs.i2c); in i3c_bus_init()
474 INIT_LIST_HEAD(&i3cbus->devs.i3c); in i3c_bus_init()
476 i3cbus->mode = I3C_BUS_MODE_PURE; in i3c_bus_init()
496 i3cbus->id = ret; in i3c_bus_init()
501 void i3c_for_each_bus_locked(int (*fn)(struct i3c_bus *bus, void *data), in i3c_for_each_bus_locked() argument
504 struct i3c_bus *bus; in i3c_for_each_bus_locked() local
508 idr_for_each_entry(&i3c_bus_idr, bus, id) in i3c_for_each_bus_locked()
509 fn(bus, data); in i3c_for_each_bus_locked()
526 static void i3c_bus_notify(struct i3c_bus *bus, unsigned int action) in i3c_bus_notify() argument
528 blocking_notifier_call_chain(&i3c_bus_notifier, action, bus); in i3c_bus_notify()
533 [I3C_BUS_MODE_MIXED_FAST] = "mixed-fast",
534 [I3C_BUS_MODE_MIXED_LIMITED] = "mixed-limited",
535 [I3C_BUS_MODE_MIXED_SLOW] = "mixed-slow",
546 if (i3cbus->mode < 0 || in mode_show()
547 i3cbus->mode >= ARRAY_SIZE(i3c_bus_mode_strings) || in mode_show()
548 !i3c_bus_mode_strings[i3cbus->mode]) in mode_show()
551 ret = sprintf(buf, "%s\n", i3c_bus_mode_strings[i3cbus->mode]); in mode_show()
566 ret = sprintf(buf, "%d-%llx\n", i3cbus->id, in current_master_show()
567 i3cbus->cur_master->info.pid); in current_master_show()
582 ret = sprintf(buf, "%ld\n", i3cbus->scl_rate.i3c); in i3c_scl_frequency_show()
597 ret = sprintf(buf, "%ld\n", i3cbus->scl_rate.i2c); in i2c_scl_frequency_show()
608 if (!master || !master->ops) in i3c_set_hotjoin()
609 return -EINVAL; in i3c_set_hotjoin()
611 if (!master->ops->enable_hotjoin || !master->ops->disable_hotjoin) in i3c_set_hotjoin()
612 return -EINVAL; in i3c_set_hotjoin()
614 i3c_bus_normaluse_lock(&master->bus); in i3c_set_hotjoin()
617 ret = master->ops->enable_hotjoin(master); in i3c_set_hotjoin()
619 ret = master->ops->disable_hotjoin(master); in i3c_set_hotjoin()
621 master->hotjoin = enable; in i3c_set_hotjoin()
623 i3c_bus_normaluse_unlock(&master->bus); in i3c_set_hotjoin()
635 if (!i3cbus->cur_master) in hotjoin_store()
636 return -EINVAL; in hotjoin_store()
639 return -EINVAL; in hotjoin_store()
641 ret = i3c_set_hotjoin(i3cbus->cur_master->common.master, res); in hotjoin_store()
649 * i3c_master_enable_hotjoin - Enable hotjoin
661 * i3c_master_disable_hotjoin - Disable hotjoin
678 ret = sysfs_emit(buf, "%d\n", i3cbus->cur_master->common.master->hotjoin); in hotjoin_show()
704 struct i3c_bus *bus = dev_to_i3cbus(dev); in i3c_masterdev_release() local
706 if (master->wq) in i3c_masterdev_release()
707 destroy_workqueue(master->wq); in i3c_masterdev_release()
709 WARN_ON(!list_empty(&bus->devs.i2c) || !list_empty(&bus->devs.i3c)); in i3c_masterdev_release()
710 i3c_bus_cleanup(bus); in i3c_masterdev_release()
712 of_node_put(dev->of_node); in i3c_masterdev_release()
724 i3cbus->mode = mode; in i3c_bus_set_mode()
726 switch (i3cbus->mode) { in i3c_bus_set_mode()
728 if (!i3cbus->scl_rate.i3c) in i3c_bus_set_mode()
729 i3cbus->scl_rate.i3c = I3C_BUS_I3C_SCL_TYP_RATE; in i3c_bus_set_mode()
733 if (!i3cbus->scl_rate.i3c) in i3c_bus_set_mode()
734 i3cbus->scl_rate.i3c = I3C_BUS_I3C_SCL_TYP_RATE; in i3c_bus_set_mode()
735 if (!i3cbus->scl_rate.i2c) in i3c_bus_set_mode()
736 i3cbus->scl_rate.i2c = max_i2c_scl_rate; in i3c_bus_set_mode()
739 if (!i3cbus->scl_rate.i2c) in i3c_bus_set_mode()
740 i3cbus->scl_rate.i2c = max_i2c_scl_rate; in i3c_bus_set_mode()
741 if (!i3cbus->scl_rate.i3c || in i3c_bus_set_mode()
742 i3cbus->scl_rate.i3c > i3cbus->scl_rate.i2c) in i3c_bus_set_mode()
743 i3cbus->scl_rate.i3c = i3cbus->scl_rate.i2c; in i3c_bus_set_mode()
746 return -EINVAL; in i3c_bus_set_mode()
749 dev_dbg(&master->dev, "i2c-scl = %ld Hz i3c-scl = %ld Hz\n", in i3c_bus_set_mode()
750 i3cbus->scl_rate.i2c, i3cbus->scl_rate.i3c); in i3c_bus_set_mode()
753 * I3C/I2C frequency may have been overridden, check that user-provided in i3c_bus_set_mode()
756 if (i3cbus->scl_rate.i3c > I3C_BUS_I3C_SCL_MAX_RATE || in i3c_bus_set_mode()
757 i3cbus->scl_rate.i2c > I3C_BUS_I2C_FM_PLUS_SCL_MAX_RATE) in i3c_bus_set_mode()
758 return -EINVAL; in i3c_bus_set_mode()
772 return &master->i2c; in i3c_master_to_i2c_adapter()
782 u16 addr, u8 lvr) in i3c_master_alloc_i2c_dev() argument
788 return ERR_PTR(-ENOMEM); in i3c_master_alloc_i2c_dev()
790 dev->common.master = master; in i3c_master_alloc_i2c_dev()
791 dev->addr = addr; in i3c_master_alloc_i2c_dev()
792 dev->lvr = lvr; in i3c_master_alloc_i2c_dev()
797 static void *i3c_ccc_cmd_dest_init(struct i3c_ccc_cmd_dest *dest, u8 addr, in i3c_ccc_cmd_dest_init() argument
800 dest->addr = addr; in i3c_ccc_cmd_dest_init()
801 dest->payload.len = payloadlen; in i3c_ccc_cmd_dest_init()
803 dest->payload.data = kzalloc(payloadlen, GFP_KERNEL); in i3c_ccc_cmd_dest_init()
805 dest->payload.data = NULL; in i3c_ccc_cmd_dest_init()
807 return dest->payload.data; in i3c_ccc_cmd_dest_init()
812 kfree(dest->payload.data); in i3c_ccc_cmd_dest_cleanup()
819 cmd->rnw = rnw ? 1 : 0; in i3c_ccc_cmd_init()
820 cmd->id = id; in i3c_ccc_cmd_init()
821 cmd->dests = dests; in i3c_ccc_cmd_init()
822 cmd->ndests = ndests; in i3c_ccc_cmd_init()
823 cmd->err = I3C_ERROR_UNKNOWN; in i3c_ccc_cmd_init()
832 return -EINVAL; in i3c_master_send_ccc_cmd_locked()
834 if (WARN_ON(master->init_done && in i3c_master_send_ccc_cmd_locked()
835 !rwsem_is_locked(&master->bus.lock))) in i3c_master_send_ccc_cmd_locked()
836 return -EINVAL; in i3c_master_send_ccc_cmd_locked()
838 if (!master->ops->send_ccc_cmd) in i3c_master_send_ccc_cmd_locked()
839 return -EOPNOTSUPP; in i3c_master_send_ccc_cmd_locked()
841 if ((cmd->id & I3C_CCC_DIRECT) && (!cmd->dests || !cmd->ndests)) in i3c_master_send_ccc_cmd_locked()
842 return -EINVAL; in i3c_master_send_ccc_cmd_locked()
844 if (master->ops->supports_ccc_cmd && in i3c_master_send_ccc_cmd_locked()
845 !master->ops->supports_ccc_cmd(master, cmd)) in i3c_master_send_ccc_cmd_locked()
846 return -EOPNOTSUPP; in i3c_master_send_ccc_cmd_locked()
848 ret = master->ops->send_ccc_cmd(master, cmd); in i3c_master_send_ccc_cmd_locked()
850 if (cmd->err != I3C_ERROR_UNKNOWN) in i3c_master_send_ccc_cmd_locked()
851 return cmd->err; in i3c_master_send_ccc_cmd_locked()
861 u16 addr) in i3c_master_find_i2c_dev_by_addr() argument
865 i3c_bus_for_each_i2cdev(&master->bus, dev) { in i3c_master_find_i2c_dev_by_addr()
866 if (dev->addr == addr) in i3c_master_find_i2c_dev_by_addr()
874 * i3c_master_get_free_addr() - get a free address on the bus
878 * This function must be called with the bus lock held in write mode.
880 * Return: the first free address starting at @start_addr (included) or -ENOMEM
886 return i3c_bus_get_free_addr(&master->bus, start_addr); in i3c_master_get_free_addr()
894 WARN_ON(i3cdev->desc); in i3c_device_release()
896 of_node_put(i3cdev->dev.of_node); in i3c_device_release()
913 return ERR_PTR(-ENOMEM); in i3c_master_alloc_i3c_dev()
915 dev->common.master = master; in i3c_master_alloc_i3c_dev()
916 dev->info = *info; in i3c_master_alloc_i3c_dev()
917 mutex_init(&dev->ibi_lock); in i3c_master_alloc_i3c_dev()
923 u8 addr) in i3c_master_rstdaa_locked() argument
931 return -EINVAL; in i3c_master_rstdaa_locked()
933 addrstat = i3c_bus_get_addr_slot_status(&master->bus, addr); in i3c_master_rstdaa_locked()
934 if (addr != I3C_BROADCAST_ADDR && addrstat != I3C_ADDR_SLOT_I3C_DEV) in i3c_master_rstdaa_locked()
935 return -EINVAL; in i3c_master_rstdaa_locked()
937 i3c_ccc_cmd_dest_init(&dest, addr, 0); in i3c_master_rstdaa_locked()
939 I3C_CCC_RSTDAA(addr == I3C_BROADCAST_ADDR), in i3c_master_rstdaa_locked()
948 * i3c_master_entdaa_locked() - start a DAA (Dynamic Address Assignment)
950 * @master: master used to send frames on the bus
958 * This function must be called with the bus lock held in write mode.
979 u8 addr, bool enable, u8 evts) in i3c_master_enec_disec_locked() argument
986 events = i3c_ccc_cmd_dest_init(&dest, addr, sizeof(*events)); in i3c_master_enec_disec_locked()
988 return -ENOMEM; in i3c_master_enec_disec_locked()
990 events->events = evts; in i3c_master_enec_disec_locked()
993 I3C_CCC_ENEC(addr == I3C_BROADCAST_ADDR) : in i3c_master_enec_disec_locked()
994 I3C_CCC_DISEC(addr == I3C_BROADCAST_ADDR), in i3c_master_enec_disec_locked()
1003 * i3c_master_disec_locked() - send a DISEC CCC command
1004 * @master: master used to send frames on the bus
1005 * @addr: a valid I3C slave address or %I3C_BROADCAST_ADDR
1009 * specific slave, or all devices if @addr is %I3C_BROADCAST_ADDR.
1011 * This function must be called with the bus lock held in write mode.
1016 int i3c_master_disec_locked(struct i3c_master_controller *master, u8 addr, in i3c_master_disec_locked() argument
1019 return i3c_master_enec_disec_locked(master, addr, false, evts); in i3c_master_disec_locked()
1024 * i3c_master_enec_locked() - send an ENEC CCC command
1025 * @master: master used to send frames on the bus
1026 * @addr: a valid I3C slave address or %I3C_BROADCAST_ADDR
1030 * specific slave, or all devices if @addr is %I3C_BROADCAST_ADDR.
1032 * This function must be called with the bus lock held in write mode.
1037 int i3c_master_enec_locked(struct i3c_master_controller *master, u8 addr, in i3c_master_enec_locked() argument
1040 return i3c_master_enec_disec_locked(master, addr, true, evts); in i3c_master_enec_locked()
1045 * i3c_master_defslvs_locked() - send a DEFSLVS CCC command
1046 * @master: master used to send frames on the bus
1049 * This is useful when you have secondary masters on the bus to propagate
1054 * &i3c_master_controller_ops->bus_init().
1055 * It should also be called if a master ACKed an Hot-Join request and assigned
1056 * a dynamic address to the device joining the bus.
1058 * This function must be called with the bus lock held in write mode.
1071 struct i3c_bus *bus; in i3c_master_defslvs_locked() local
1076 return -EINVAL; in i3c_master_defslvs_locked()
1078 bus = i3c_master_get_bus(master); in i3c_master_defslvs_locked()
1079 i3c_bus_for_each_i3cdev(bus, i3cdev) { in i3c_master_defslvs_locked()
1082 if (i3cdev == master->this) in i3c_master_defslvs_locked()
1085 if (I3C_BCR_DEVICE_ROLE(i3cdev->info.bcr) == in i3c_master_defslvs_locked()
1090 /* No other master on the bus, skip DEFSLVS. */ in i3c_master_defslvs_locked()
1094 i3c_bus_for_each_i2cdev(bus, i2cdev) in i3c_master_defslvs_locked()
1099 ndevs - 1)); in i3c_master_defslvs_locked()
1101 return -ENOMEM; in i3c_master_defslvs_locked()
1103 defslvs->count = ndevs; in i3c_master_defslvs_locked()
1104 defslvs->master.bcr = master->this->info.bcr; in i3c_master_defslvs_locked()
1105 defslvs->master.dcr = master->this->info.dcr; in i3c_master_defslvs_locked()
1106 defslvs->master.dyn_addr = master->this->info.dyn_addr << 1; in i3c_master_defslvs_locked()
1107 defslvs->master.static_addr = I3C_BROADCAST_ADDR << 1; in i3c_master_defslvs_locked()
1109 desc = defslvs->slaves; in i3c_master_defslvs_locked()
1110 i3c_bus_for_each_i2cdev(bus, i2cdev) { in i3c_master_defslvs_locked()
1111 desc->lvr = i2cdev->lvr; in i3c_master_defslvs_locked()
1112 desc->static_addr = i2cdev->addr << 1; in i3c_master_defslvs_locked()
1116 i3c_bus_for_each_i3cdev(bus, i3cdev) { in i3c_master_defslvs_locked()
1118 if (i3cdev == master->this) in i3c_master_defslvs_locked()
1121 desc->bcr = i3cdev->info.bcr; in i3c_master_defslvs_locked()
1122 desc->dcr = i3cdev->info.dcr; in i3c_master_defslvs_locked()
1123 desc->dyn_addr = i3cdev->info.dyn_addr << 1; in i3c_master_defslvs_locked()
1124 desc->static_addr = i3cdev->info.static_addr << 1; in i3c_master_defslvs_locked()
1145 return -EINVAL; in i3c_master_setda_locked()
1149 return -ENOMEM; in i3c_master_setda_locked()
1151 setda->addr = newaddr << 1; in i3c_master_setda_locked()
1181 mrl = i3c_ccc_cmd_dest_init(&dest, info->dyn_addr, sizeof(*mrl)); in i3c_master_getmrl_locked()
1183 return -ENOMEM; in i3c_master_getmrl_locked()
1189 if (!(info->bcr & I3C_BCR_IBI_PAYLOAD)) in i3c_master_getmrl_locked()
1190 dest.payload.len -= 1; in i3c_master_getmrl_locked()
1199 info->max_ibi_len = mrl->ibi_len; in i3c_master_getmrl_locked()
1202 info->max_read_len = be16_to_cpu(mrl->read_len); in i3c_master_getmrl_locked()
1205 ret = -EIO; in i3c_master_getmrl_locked()
1223 mwl = i3c_ccc_cmd_dest_init(&dest, info->dyn_addr, sizeof(*mwl)); in i3c_master_getmwl_locked()
1225 return -ENOMEM; in i3c_master_getmwl_locked()
1233 ret = -EIO; in i3c_master_getmwl_locked()
1237 info->max_write_len = be16_to_cpu(mwl->len); in i3c_master_getmwl_locked()
1253 getmaxds = i3c_ccc_cmd_dest_init(&dest, info->dyn_addr, in i3c_master_getmxds_locked()
1256 return -ENOMEM; in i3c_master_getmxds_locked()
1265 dest.payload.len -= 3; in i3c_master_getmxds_locked()
1272 ret = -EIO; in i3c_master_getmxds_locked()
1276 info->max_read_ds = getmaxds->maxrd; in i3c_master_getmxds_locked()
1277 info->max_write_ds = getmaxds->maxwr; in i3c_master_getmxds_locked()
1279 info->max_read_turnaround = getmaxds->maxrdturn[0] | in i3c_master_getmxds_locked()
1280 ((u32)getmaxds->maxrdturn[1] << 8) | in i3c_master_getmxds_locked()
1281 ((u32)getmaxds->maxrdturn[2] << 16); in i3c_master_getmxds_locked()
1297 gethdrcap = i3c_ccc_cmd_dest_init(&dest, info->dyn_addr, in i3c_master_gethdrcap_locked()
1300 return -ENOMEM; in i3c_master_gethdrcap_locked()
1308 ret = -EIO; in i3c_master_gethdrcap_locked()
1312 info->hdr_cap = gethdrcap->modes; in i3c_master_gethdrcap_locked()
1328 getpid = i3c_ccc_cmd_dest_init(&dest, info->dyn_addr, sizeof(*getpid)); in i3c_master_getpid_locked()
1330 return -ENOMEM; in i3c_master_getpid_locked()
1337 info->pid = 0; in i3c_master_getpid_locked()
1338 for (i = 0; i < sizeof(getpid->pid); i++) { in i3c_master_getpid_locked()
1339 int sft = (sizeof(getpid->pid) - i - 1) * 8; in i3c_master_getpid_locked()
1341 info->pid |= (u64)getpid->pid[i] << sft; in i3c_master_getpid_locked()
1358 getbcr = i3c_ccc_cmd_dest_init(&dest, info->dyn_addr, sizeof(*getbcr)); in i3c_master_getbcr_locked()
1360 return -ENOMEM; in i3c_master_getbcr_locked()
1367 info->bcr = getbcr->bcr; in i3c_master_getbcr_locked()
1383 getdcr = i3c_ccc_cmd_dest_init(&dest, info->dyn_addr, sizeof(*getdcr)); in i3c_master_getdcr_locked()
1385 return -ENOMEM; in i3c_master_getdcr_locked()
1392 info->dcr = getdcr->dcr; in i3c_master_getdcr_locked()
1406 if (!dev->info.dyn_addr) in i3c_master_retrieve_dev_info()
1407 return -EINVAL; in i3c_master_retrieve_dev_info()
1409 slot_status = i3c_bus_get_addr_slot_status(&master->bus, in i3c_master_retrieve_dev_info()
1410 dev->info.dyn_addr); in i3c_master_retrieve_dev_info()
1413 return -EINVAL; in i3c_master_retrieve_dev_info()
1415 ret = i3c_master_getpid_locked(master, &dev->info); in i3c_master_retrieve_dev_info()
1419 ret = i3c_master_getbcr_locked(master, &dev->info); in i3c_master_retrieve_dev_info()
1423 ret = i3c_master_getdcr_locked(master, &dev->info); in i3c_master_retrieve_dev_info()
1427 if (dev->info.bcr & I3C_BCR_MAX_DATA_SPEED_LIM) { in i3c_master_retrieve_dev_info()
1428 ret = i3c_master_getmxds_locked(master, &dev->info); in i3c_master_retrieve_dev_info()
1433 if (dev->info.bcr & I3C_BCR_IBI_PAYLOAD) in i3c_master_retrieve_dev_info()
1434 dev->info.max_ibi_len = 1; in i3c_master_retrieve_dev_info()
1436 i3c_master_getmrl_locked(master, &dev->info); in i3c_master_retrieve_dev_info()
1437 i3c_master_getmwl_locked(master, &dev->info); in i3c_master_retrieve_dev_info()
1439 if (dev->info.bcr & I3C_BCR_HDR_CAP) { in i3c_master_retrieve_dev_info()
1440 ret = i3c_master_gethdrcap_locked(master, &dev->info); in i3c_master_retrieve_dev_info()
1441 if (ret && ret != -EOPNOTSUPP) in i3c_master_retrieve_dev_info()
1452 if (dev->info.static_addr) in i3c_master_put_i3c_addrs()
1453 i3c_bus_set_addr_slot_status(&master->bus, in i3c_master_put_i3c_addrs()
1454 dev->info.static_addr, in i3c_master_put_i3c_addrs()
1457 if (dev->info.dyn_addr) in i3c_master_put_i3c_addrs()
1458 i3c_bus_set_addr_slot_status(&master->bus, dev->info.dyn_addr, in i3c_master_put_i3c_addrs()
1461 if (dev->boardinfo && dev->boardinfo->init_dyn_addr) in i3c_master_put_i3c_addrs()
1462 i3c_bus_set_addr_slot_status(&master->bus, dev->boardinfo->init_dyn_addr, in i3c_master_put_i3c_addrs()
1471 if (!dev->info.static_addr && !dev->info.dyn_addr) in i3c_master_get_i3c_addrs()
1474 if (dev->info.static_addr) { in i3c_master_get_i3c_addrs()
1475 status = i3c_bus_get_addr_slot_status(&master->bus, in i3c_master_get_i3c_addrs()
1476 dev->info.static_addr); in i3c_master_get_i3c_addrs()
1481 dev->info.static_addr != dev->boardinfo->init_dyn_addr) in i3c_master_get_i3c_addrs()
1482 return -EBUSY; in i3c_master_get_i3c_addrs()
1484 i3c_bus_set_addr_slot_status(&master->bus, in i3c_master_get_i3c_addrs()
1485 dev->info.static_addr, in i3c_master_get_i3c_addrs()
1490 * ->init_dyn_addr should have been reserved before that, so, if we're in i3c_master_get_i3c_addrs()
1491 * trying to apply a pre-reserved dynamic address, we should not try in i3c_master_get_i3c_addrs()
1494 if (dev->info.dyn_addr && in i3c_master_get_i3c_addrs()
1495 (!dev->boardinfo || in i3c_master_get_i3c_addrs()
1496 dev->boardinfo->init_dyn_addr != dev->info.dyn_addr)) { in i3c_master_get_i3c_addrs()
1497 status = i3c_bus_get_addr_slot_status(&master->bus, in i3c_master_get_i3c_addrs()
1498 dev->info.dyn_addr); in i3c_master_get_i3c_addrs()
1502 i3c_bus_set_addr_slot_status(&master->bus, dev->info.dyn_addr, in i3c_master_get_i3c_addrs()
1509 if (dev->info.static_addr) in i3c_master_get_i3c_addrs()
1510 i3c_bus_set_addr_slot_status(&master->bus, in i3c_master_get_i3c_addrs()
1511 dev->info.static_addr, in i3c_master_get_i3c_addrs()
1514 return -EBUSY; in i3c_master_get_i3c_addrs()
1524 * addressable on the bus. in i3c_master_attach_i3c_dev()
1526 if (!dev->info.static_addr && !dev->info.dyn_addr) in i3c_master_attach_i3c_dev()
1534 if (master->this != dev && master->ops->attach_i3c_dev) { in i3c_master_attach_i3c_dev()
1535 ret = master->ops->attach_i3c_dev(dev); in i3c_master_attach_i3c_dev()
1542 list_add_tail(&dev->common.node, &master->bus.devs.i3c); in i3c_master_attach_i3c_dev()
1553 if (dev->info.dyn_addr != old_dyn_addr) { in i3c_master_reattach_i3c_dev()
1554 i3c_bus_set_addr_slot_status(&master->bus, in i3c_master_reattach_i3c_dev()
1555 dev->info.dyn_addr, in i3c_master_reattach_i3c_dev()
1558 i3c_bus_set_addr_slot_status(&master->bus, old_dyn_addr, in i3c_master_reattach_i3c_dev()
1562 if (master->ops->reattach_i3c_dev) { in i3c_master_reattach_i3c_dev()
1563 ret = master->ops->reattach_i3c_dev(dev, old_dyn_addr); in i3c_master_reattach_i3c_dev()
1578 if (master->this != dev && master->ops->detach_i3c_dev) in i3c_master_detach_i3c_dev()
1579 master->ops->detach_i3c_dev(dev); in i3c_master_detach_i3c_dev()
1582 list_del(&dev->common.node); in i3c_master_detach_i3c_dev()
1590 if (master->ops->attach_i2c_dev) { in i3c_master_attach_i2c_dev()
1591 ret = master->ops->attach_i2c_dev(dev); in i3c_master_attach_i2c_dev()
1596 list_add_tail(&dev->common.node, &master->bus.devs.i2c); in i3c_master_attach_i2c_dev()
1605 list_del(&dev->common.node); in i3c_master_detach_i2c_dev()
1607 if (master->ops->detach_i2c_dev) in i3c_master_detach_i2c_dev()
1608 master->ops->detach_i2c_dev(dev); in i3c_master_detach_i2c_dev()
1615 .static_addr = boardinfo->static_addr, in i3c_master_early_i3c_dev_add()
1616 .pid = boardinfo->pid, in i3c_master_early_i3c_dev_add()
1623 return -ENOMEM; in i3c_master_early_i3c_dev_add()
1625 i3cdev->boardinfo = boardinfo; in i3c_master_early_i3c_dev_add()
1631 ret = i3c_master_setdasa_locked(master, i3cdev->info.static_addr, in i3c_master_early_i3c_dev_add()
1632 i3cdev->boardinfo->init_dyn_addr); in i3c_master_early_i3c_dev_add()
1636 i3cdev->info.dyn_addr = i3cdev->boardinfo->init_dyn_addr; in i3c_master_early_i3c_dev_add()
1648 i3c_master_rstdaa_locked(master, i3cdev->boardinfo->init_dyn_addr); in i3c_master_early_i3c_dev_add()
1663 if (!master->init_done) in i3c_master_register_new_i3c_devs()
1666 i3c_bus_for_each_i3cdev(&master->bus, desc) { in i3c_master_register_new_i3c_devs()
1667 if (desc->dev || !desc->info.dyn_addr || desc == master->this) in i3c_master_register_new_i3c_devs()
1670 desc->dev = kzalloc(sizeof(*desc->dev), GFP_KERNEL); in i3c_master_register_new_i3c_devs()
1671 if (!desc->dev) in i3c_master_register_new_i3c_devs()
1674 desc->dev->bus = &master->bus; in i3c_master_register_new_i3c_devs()
1675 desc->dev->desc = desc; in i3c_master_register_new_i3c_devs()
1676 desc->dev->dev.parent = &master->dev; in i3c_master_register_new_i3c_devs()
1677 desc->dev->dev.type = &i3c_device_type; in i3c_master_register_new_i3c_devs()
1678 desc->dev->dev.bus = &i3c_bus_type; in i3c_master_register_new_i3c_devs()
1679 desc->dev->dev.release = i3c_device_release; in i3c_master_register_new_i3c_devs()
1680 dev_set_name(&desc->dev->dev, "%d-%llx", master->bus.id, in i3c_master_register_new_i3c_devs()
1681 desc->info.pid); in i3c_master_register_new_i3c_devs()
1683 if (desc->boardinfo) in i3c_master_register_new_i3c_devs()
1684 desc->dev->dev.of_node = desc->boardinfo->of_node; in i3c_master_register_new_i3c_devs()
1686 ret = device_register(&desc->dev->dev); in i3c_master_register_new_i3c_devs()
1688 dev_err(&master->dev, in i3c_master_register_new_i3c_devs()
1690 put_device(&desc->dev->dev); in i3c_master_register_new_i3c_devs()
1696 * i3c_master_do_daa() - do a DAA (Dynamic Address Assignment)
1706 * This function must be called with the bus lock held in write mode.
1714 i3c_bus_maintenance_lock(&master->bus); in i3c_master_do_daa()
1715 ret = master->ops->do_daa(master); in i3c_master_do_daa()
1716 i3c_bus_maintenance_unlock(&master->bus); in i3c_master_do_daa()
1721 i3c_bus_normaluse_lock(&master->bus); in i3c_master_do_daa()
1723 i3c_bus_normaluse_unlock(&master->bus); in i3c_master_do_daa()
1730 * i3c_master_dma_map_single() - Map buffer for single DMA transfer
1752 dma_xfer->dev = dev; in i3c_master_dma_map_single()
1753 dma_xfer->buf = buf; in i3c_master_dma_map_single()
1754 dma_xfer->dir = dir; in i3c_master_dma_map_single()
1755 dma_xfer->len = len; in i3c_master_dma_map_single()
1756 dma_xfer->map_len = len; in i3c_master_dma_map_single()
1762 dma_xfer->map_len = ALIGN(len, cache_line_size()); in i3c_master_dma_map_single()
1764 bounce = kzalloc(dma_xfer->map_len, GFP_KERNEL); in i3c_master_dma_map_single()
1766 bounce = kmemdup(buf, dma_xfer->map_len, GFP_KERNEL); in i3c_master_dma_map_single()
1772 dma_xfer->addr = dma_map_single(dev, dma_buf, dma_xfer->map_len, dir); in i3c_master_dma_map_single()
1773 if (dma_mapping_error(dev, dma_xfer->addr)) in i3c_master_dma_map_single()
1776 dma_xfer->bounce_buf = no_free_ptr(bounce); in i3c_master_dma_map_single()
1782 * i3c_master_dma_unmap_single() - Unmap buffer after DMA
1789 dma_unmap_single(dma_xfer->dev, dma_xfer->addr, in i3c_master_dma_unmap_single()
1790 dma_xfer->map_len, dma_xfer->dir); in i3c_master_dma_unmap_single()
1791 if (dma_xfer->bounce_buf) { in i3c_master_dma_unmap_single()
1792 if (dma_xfer->dir == DMA_FROM_DEVICE) in i3c_master_dma_unmap_single()
1793 memcpy(dma_xfer->buf, dma_xfer->bounce_buf, in i3c_master_dma_unmap_single()
1794 dma_xfer->len); in i3c_master_dma_unmap_single()
1795 kfree(dma_xfer->bounce_buf); in i3c_master_dma_unmap_single()
1802 * i3c_master_set_info() - set master device information
1803 * @master: master used to send frames on the bus
1807 * &i3c_master_controller_ops->bus_init().
1812 * - &i3c_device_info->dyn_addr
1813 * - &i3c_device_info->bcr
1814 * - &i3c_device_info->dcr
1815 * - &i3c_device_info->pid
1816 * - &i3c_device_info->hdr_cap if %I3C_BCR_HDR_CAP bit is set in
1817 * &i3c_device_info->bcr
1819 * This function must be called with the bus lock held in maintenance mode.
1822 * information can be checked, but we can at least make sure @info->dyn_addr
1823 * and @info->bcr are correct), -EINVAL otherwise.
1831 if (!i3c_bus_dev_addr_is_avail(&master->bus, info->dyn_addr)) in i3c_master_set_info()
1832 return -EINVAL; in i3c_master_set_info()
1834 if (I3C_BCR_DEVICE_ROLE(info->bcr) == I3C_BCR_I3C_MASTER && in i3c_master_set_info()
1835 master->secondary) in i3c_master_set_info()
1836 return -EINVAL; in i3c_master_set_info()
1838 if (master->this) in i3c_master_set_info()
1839 return -EINVAL; in i3c_master_set_info()
1845 master->this = i3cdev; in i3c_master_set_info()
1846 master->bus.cur_master = master->this; in i3c_master_set_info()
1866 list_for_each_entry_safe(i3cdev, i3ctmp, &master->bus.devs.i3c, in i3c_master_detach_free_devs()
1870 if (i3cdev->boardinfo && i3cdev->boardinfo->init_dyn_addr) in i3c_master_detach_free_devs()
1871 i3c_bus_set_addr_slot_status(&master->bus, in i3c_master_detach_free_devs()
1872 i3cdev->boardinfo->init_dyn_addr, in i3c_master_detach_free_devs()
1878 list_for_each_entry_safe(i2cdev, i2ctmp, &master->bus.devs.i2c, in i3c_master_detach_free_devs()
1881 i3c_bus_set_addr_slot_status(&master->bus, in i3c_master_detach_free_devs()
1882 i2cdev->addr, in i3c_master_detach_free_devs()
1889 * i3c_master_bus_init() - initialize an I3C bus
1890 * @master: main master initializing the bus
1898 * 2. Call &i3c_master_controller_ops->bus_init() method to initialize
1899 * the master controller. That's usually where the bus mode is selected
1900 * (pure bus or mixed fast/slow bus)
1902 * 3. Instruct all devices on the bus to drop their dynamic address. This is
1903 * particularly important when the bus was previously configured by someone
1909 * also have static_addr, try to pre-assign dynamic addresses requested by
1932 list_for_each_entry(i2cboardinfo, &master->boardinfo.i2c, node) { in i3c_master_bus_init()
1933 status = i3c_bus_get_addr_slot_status(&master->bus, in i3c_master_bus_init()
1934 i2cboardinfo->base.addr); in i3c_master_bus_init()
1936 ret = -EBUSY; in i3c_master_bus_init()
1940 i3c_bus_set_addr_slot_status(&master->bus, in i3c_master_bus_init()
1941 i2cboardinfo->base.addr, in i3c_master_bus_init()
1945 i2cboardinfo->base.addr, in i3c_master_bus_init()
1946 i2cboardinfo->lvr); in i3c_master_bus_init()
1960 * Now execute the controller specific ->bus_init() routine, which in i3c_master_bus_init()
1961 * might configure its internal logic to match the bus limitations. in i3c_master_bus_init()
1963 ret = master->ops->bus_init(master); in i3c_master_bus_init()
1968 * The master device should have been instantiated in ->bus_init(), in i3c_master_bus_init()
1971 if (!master->this) { in i3c_master_bus_init()
1972 dev_err(&master->dev, in i3c_master_bus_init()
1973 "master_set_info() was not called in ->bus_init()\n"); in i3c_master_bus_init()
1974 ret = -EINVAL; in i3c_master_bus_init()
1978 if (master->ops->set_speed) { in i3c_master_bus_init()
1979 ret = master->ops->set_speed(master, I3C_OPEN_DRAIN_SLOW_SPEED); in i3c_master_bus_init()
1992 if (master->ops->set_speed) { in i3c_master_bus_init()
1993 ret = master->ops->set_speed(master, I3C_OPEN_DRAIN_NORMAL_SPEED); in i3c_master_bus_init()
2006 * Reserve init_dyn_addr first, and then try to pre-assign dynamic in i3c_master_bus_init()
2008 * In case pre-assign dynamic address fails, setting dynamic address to in i3c_master_bus_init()
2012 list_for_each_entry(i3cboardinfo, &master->boardinfo.i3c, node) { in i3c_master_bus_init()
2018 if (!i3cboardinfo->init_dyn_addr) in i3c_master_bus_init()
2021 ret = i3c_bus_get_addr_slot_status(&master->bus, in i3c_master_bus_init()
2022 i3cboardinfo->init_dyn_addr); in i3c_master_bus_init()
2024 ret = -EBUSY; in i3c_master_bus_init()
2028 /* Do not mark as occupied until real device exist in bus */ in i3c_master_bus_init()
2029 i3c_bus_set_addr_slot_status_mask(&master->bus, in i3c_master_bus_init()
2030 i3cboardinfo->init_dyn_addr, in i3c_master_bus_init()
2042 if (i3cboardinfo->static_addr) in i3c_master_bus_init()
2056 if (master->ops->bus_cleanup) in i3c_master_bus_init()
2057 master->ops->bus_cleanup(master); in i3c_master_bus_init()
2067 if (master->ops->bus_cleanup) in i3c_master_bus_cleanup()
2068 master->ops->bus_cleanup(master); in i3c_master_bus_cleanup()
2075 struct i3c_master_controller *master = i3cdev->common.master; in i3c_master_attach_boardinfo()
2078 list_for_each_entry(i3cboardinfo, &master->boardinfo.i3c, node) { in i3c_master_attach_boardinfo()
2079 if (i3cdev->info.pid != i3cboardinfo->pid) in i3c_master_attach_boardinfo()
2082 i3cdev->boardinfo = i3cboardinfo; in i3c_master_attach_boardinfo()
2083 i3cdev->info.static_addr = i3cboardinfo->static_addr; in i3c_master_attach_boardinfo()
2094 i3c_bus_for_each_i3cdev(&master->bus, i3cdev) { in i3c_master_search_i3c_dev_duplicate()
2095 if (i3cdev != refdev && i3cdev->info.pid == refdev->info.pid) in i3c_master_search_i3c_dev_duplicate()
2103 * i3c_master_add_i3c_dev_locked() - add an I3C slave to the bus
2104 * @master: master used to send frames on the bus
2105 * @addr: I3C slave dynamic address assigned to the device
2114 * This function must be called with the bus lock held in write mode.
2119 u8 addr) in i3c_master_add_i3c_dev_locked() argument
2121 struct i3c_device_info info = { .dyn_addr = addr }; in i3c_master_add_i3c_dev_locked()
2123 u8 old_dyn_addr = addr, expected_dyn_addr; in i3c_master_add_i3c_dev_locked()
2129 return -EINVAL; in i3c_master_add_i3c_dev_locked()
2147 newdev->dev = olddev->dev; in i3c_master_add_i3c_dev_locked()
2148 if (newdev->dev) in i3c_master_add_i3c_dev_locked()
2149 newdev->dev->desc = newdev; in i3c_master_add_i3c_dev_locked()
2157 mutex_lock(&olddev->ibi_lock); in i3c_master_add_i3c_dev_locked()
2158 if (olddev->ibi) { in i3c_master_add_i3c_dev_locked()
2159 ibireq.handler = olddev->ibi->handler; in i3c_master_add_i3c_dev_locked()
2160 ibireq.max_payload_len = olddev->ibi->max_payload_len; in i3c_master_add_i3c_dev_locked()
2161 ibireq.num_slots = olddev->ibi->num_slots; in i3c_master_add_i3c_dev_locked()
2163 if (olddev->ibi->enabled) in i3c_master_add_i3c_dev_locked()
2167 * i3c bus as it does not exist and has been assigned in i3c_master_add_i3c_dev_locked()
2169 * So, update the olddev->ibi->enabled flag to false in i3c_master_add_i3c_dev_locked()
2172 olddev->ibi->enabled = false; in i3c_master_add_i3c_dev_locked()
2175 mutex_unlock(&olddev->ibi_lock); in i3c_master_add_i3c_dev_locked()
2177 old_dyn_addr = olddev->info.dyn_addr; in i3c_master_add_i3c_dev_locked()
2186 * - if the device already had a dynamic address assigned, let's try to in i3c_master_add_i3c_dev_locked()
2187 * re-apply this one in i3c_master_add_i3c_dev_locked()
2188 * - if the device did not have a dynamic address and the firmware in i3c_master_add_i3c_dev_locked()
2190 * - in any other case, keep the address automatically assigned by the in i3c_master_add_i3c_dev_locked()
2193 if (old_dyn_addr && old_dyn_addr != newdev->info.dyn_addr) in i3c_master_add_i3c_dev_locked()
2195 else if (newdev->boardinfo && newdev->boardinfo->init_dyn_addr) in i3c_master_add_i3c_dev_locked()
2196 expected_dyn_addr = newdev->boardinfo->init_dyn_addr; in i3c_master_add_i3c_dev_locked()
2198 expected_dyn_addr = newdev->info.dyn_addr; in i3c_master_add_i3c_dev_locked()
2200 if (newdev->info.dyn_addr != expected_dyn_addr && in i3c_master_add_i3c_dev_locked()
2201 i3c_bus_get_addr_slot_status(&master->bus, expected_dyn_addr) == I3C_ADDR_SLOT_FREE) { in i3c_master_add_i3c_dev_locked()
2207 newdev->info.dyn_addr, in i3c_master_add_i3c_dev_locked()
2210 old_dyn_addr = newdev->info.dyn_addr; in i3c_master_add_i3c_dev_locked()
2211 newdev->info.dyn_addr = expected_dyn_addr; in i3c_master_add_i3c_dev_locked()
2214 dev_err(&master->dev, in i3c_master_add_i3c_dev_locked()
2216 master->bus.id, newdev->info.pid); in i3c_master_add_i3c_dev_locked()
2228 mutex_lock(&newdev->ibi_lock); in i3c_master_add_i3c_dev_locked()
2231 dev_err(&master->dev, in i3c_master_add_i3c_dev_locked()
2232 "Failed to request IBI on device %d-%llx", in i3c_master_add_i3c_dev_locked()
2233 master->bus.id, newdev->info.pid); in i3c_master_add_i3c_dev_locked()
2237 dev_err(&master->dev, in i3c_master_add_i3c_dev_locked()
2238 "Failed to re-enable IBI on device %d-%llx", in i3c_master_add_i3c_dev_locked()
2239 master->bus.id, newdev->info.pid); in i3c_master_add_i3c_dev_locked()
2241 mutex_unlock(&newdev->ibi_lock); in i3c_master_add_i3c_dev_locked()
2247 if (newdev->dev && newdev->dev->desc) in i3c_master_add_i3c_dev_locked()
2248 newdev->dev->desc = NULL; in i3c_master_add_i3c_dev_locked()
2266 struct device *dev = &master->dev; in of_i3c_master_add_i2c_boardinfo()
2271 return -ENOMEM; in of_i3c_master_add_i2c_boardinfo()
2273 ret = of_i2c_get_board_info(dev, node, &boardinfo->base); in of_i3c_master_add_i2c_boardinfo()
2278 * The I3C Specification does not clearly say I2C devices with 10-bit in of_i3c_master_add_i2c_boardinfo()
2282 if (boardinfo->base.flags & I2C_CLIENT_TEN) { in of_i3c_master_add_i2c_boardinfo()
2284 return -EOPNOTSUPP; in of_i3c_master_add_i2c_boardinfo()
2288 boardinfo->lvr = reg[2]; in of_i3c_master_add_i2c_boardinfo()
2290 list_add_tail(&boardinfo->node, &master->boardinfo.i2c); in of_i3c_master_add_i2c_boardinfo()
2301 struct device *dev = &master->dev; in of_i3c_master_add_i3c_boardinfo()
2307 return -ENOMEM; in of_i3c_master_add_i3c_boardinfo()
2311 return -EINVAL; in of_i3c_master_add_i3c_boardinfo()
2313 addrstatus = i3c_bus_get_addr_slot_status(&master->bus, in of_i3c_master_add_i3c_boardinfo()
2316 return -EINVAL; in of_i3c_master_add_i3c_boardinfo()
2319 boardinfo->static_addr = reg[0]; in of_i3c_master_add_i3c_boardinfo()
2321 if (!of_property_read_u32(node, "assigned-address", &init_dyn_addr)) { in of_i3c_master_add_i3c_boardinfo()
2323 return -EINVAL; in of_i3c_master_add_i3c_boardinfo()
2325 addrstatus = i3c_bus_get_addr_slot_status(&master->bus, in of_i3c_master_add_i3c_boardinfo()
2328 return -EINVAL; in of_i3c_master_add_i3c_boardinfo()
2331 boardinfo->pid = ((u64)reg[1] << 32) | reg[2]; in of_i3c_master_add_i3c_boardinfo()
2333 if ((boardinfo->pid & GENMASK_ULL(63, 48)) || in of_i3c_master_add_i3c_boardinfo()
2334 I3C_PID_RND_LOWER_32BITS(boardinfo->pid)) in of_i3c_master_add_i3c_boardinfo()
2335 return -EINVAL; in of_i3c_master_add_i3c_boardinfo()
2337 boardinfo->init_dyn_addr = init_dyn_addr; in of_i3c_master_add_i3c_boardinfo()
2338 boardinfo->of_node = of_node_get(node); in of_i3c_master_add_i3c_boardinfo()
2339 list_add_tail(&boardinfo->node, &master->boardinfo.i3c); in of_i3c_master_add_i3c_boardinfo()
2351 return -EINVAL; in of_i3c_master_add_dev()
2371 struct device *dev = &master->dev; in of_populate_i3c_bus()
2372 struct device_node *i3cbus_np = dev->of_node; in of_populate_i3c_bus()
2390 * on the bus are not supporting typical rates, or if the bus topology in of_populate_i3c_bus()
2393 if (!of_property_read_u32(i3cbus_np, "i2c-scl-hz", &val)) in of_populate_i3c_bus()
2394 master->bus.scl_rate.i2c = val; in of_populate_i3c_bus()
2396 if (!of_property_read_u32(i3cbus_np, "i3c-scl-hz", &val)) in of_populate_i3c_bus()
2397 master->bus.scl_rate.i3c = val; in of_populate_i3c_bus()
2408 u16 addr; in i3c_master_i2c_adapter_xfer() local
2411 return -EINVAL; in i3c_master_i2c_adapter_xfer()
2413 if (!master->ops->i2c_xfers) in i3c_master_i2c_adapter_xfer()
2414 return -EOPNOTSUPP; in i3c_master_i2c_adapter_xfer()
2417 addr = xfers[0].addr; in i3c_master_i2c_adapter_xfer()
2419 if (addr != xfers[i].addr) in i3c_master_i2c_adapter_xfer()
2420 return -EOPNOTSUPP; in i3c_master_i2c_adapter_xfer()
2423 i3c_bus_normaluse_lock(&master->bus); in i3c_master_i2c_adapter_xfer()
2424 dev = i3c_master_find_i2c_dev_by_addr(master, addr); in i3c_master_i2c_adapter_xfer()
2426 ret = -ENOENT; in i3c_master_i2c_adapter_xfer()
2428 ret = master->ops->i2c_xfers(dev, xfers, nxfers); in i3c_master_i2c_adapter_xfer()
2429 i3c_bus_normaluse_unlock(&master->bus); in i3c_master_i2c_adapter_xfer()
2441 /* Fall back to no spike filters and FM bus mode. */ in i3c_master_i2c_get_lvr()
2445 if (!of_property_read_u32_array(client->dev.of_node, "reg", reg, ARRAY_SIZE(reg))) in i3c_master_i2c_get_lvr()
2459 if (i3c_master_find_i2c_dev_by_addr(master, client->addr)) in i3c_master_i2c_attach()
2462 status = i3c_bus_get_addr_slot_status(&master->bus, client->addr); in i3c_master_i2c_attach()
2464 return -EBUSY; in i3c_master_i2c_attach()
2466 i3c_bus_set_addr_slot_status(&master->bus, client->addr, in i3c_master_i2c_attach()
2469 i2cdev = i3c_master_alloc_i2c_dev(master, client->addr, in i3c_master_i2c_attach()
2485 i3c_bus_set_addr_slot_status(&master->bus, client->addr, in i3c_master_i2c_attach()
2496 dev = i3c_master_find_i2c_dev_by_addr(master, client->addr); in i3c_master_i2c_detach()
2498 return -ENODEV; in i3c_master_i2c_detach()
2501 i3c_bus_set_addr_slot_status(&master->bus, dev->addr, in i3c_master_i2c_detach()
2522 if (dev->type != &i2c_client_type) in i3c_i2c_notifier_call()
2526 adap = client->adapter; in i3c_i2c_notifier_call()
2528 if (adap->algo != &i3c_master_i2c_algo) in i3c_i2c_notifier_call()
2533 i3c_bus_maintenance_lock(&master->bus); in i3c_i2c_notifier_call()
2542 ret = -EINVAL; in i3c_i2c_notifier_call()
2544 i3c_bus_maintenance_unlock(&master->bus); in i3c_i2c_notifier_call()
2560 adap->dev.parent = master->dev.parent; in i3c_master_i2c_adapter_init()
2561 adap->owner = master->dev.parent->driver->owner; in i3c_master_i2c_adapter_init()
2562 adap->algo = &i3c_master_i2c_algo; in i3c_master_i2c_adapter_init()
2563 strscpy(adap->name, dev_name(master->dev.parent), sizeof(adap->name)); in i3c_master_i2c_adapter_init()
2564 adap->timeout = HZ; in i3c_master_i2c_adapter_init()
2565 adap->retries = 3; in i3c_master_i2c_adapter_init()
2567 id = of_alias_get_id(master->dev.of_node, "i2c"); in i3c_master_i2c_adapter_init()
2569 adap->nr = id; in i3c_master_i2c_adapter_init()
2578 * We silently ignore failures here. The bus should keep working in i3c_master_i2c_adapter_init()
2581 list_for_each_entry(i2cboardinfo, &master->boardinfo.i2c, node) { in i3c_master_i2c_adapter_init()
2583 i2cboardinfo->base.addr); in i3c_master_i2c_adapter_init()
2586 i2cdev->dev = i2c_new_client_device(adap, &i2cboardinfo->base); in i3c_master_i2c_adapter_init()
2596 i2c_del_adapter(&master->i2c); in i3c_master_i2c_adapter_cleanup()
2598 i3c_bus_for_each_i2cdev(&master->bus, i2cdev) in i3c_master_i2c_adapter_cleanup()
2599 i2cdev->dev = NULL; in i3c_master_i2c_adapter_cleanup()
2606 i3c_bus_for_each_i3cdev(&master->bus, i3cdev) { in i3c_master_unregister_i3c_devs()
2607 if (!i3cdev->dev) in i3c_master_unregister_i3c_devs()
2610 i3cdev->dev->desc = NULL; in i3c_master_unregister_i3c_devs()
2611 if (device_is_registered(&i3cdev->dev->dev)) in i3c_master_unregister_i3c_devs()
2612 device_unregister(&i3cdev->dev->dev); in i3c_master_unregister_i3c_devs()
2614 put_device(&i3cdev->dev->dev); in i3c_master_unregister_i3c_devs()
2615 i3cdev->dev = NULL; in i3c_master_unregister_i3c_devs()
2620 * i3c_master_queue_ibi() - Queue an IBI
2629 if (!dev->ibi || !slot) in i3c_master_queue_ibi()
2632 atomic_inc(&dev->ibi->pending_ibis); in i3c_master_queue_ibi()
2633 queue_work(dev->ibi->wq, &slot->work); in i3c_master_queue_ibi()
2641 struct i3c_dev_desc *dev = slot->dev; in i3c_master_handle_ibi()
2645 payload.data = slot->data; in i3c_master_handle_ibi()
2646 payload.len = slot->len; in i3c_master_handle_ibi()
2648 if (dev->dev) in i3c_master_handle_ibi()
2649 dev->ibi->handler(dev->dev, &payload); in i3c_master_handle_ibi()
2651 master->ops->recycle_ibi_slot(dev, slot); in i3c_master_handle_ibi()
2652 if (atomic_dec_and_test(&dev->ibi->pending_ibis)) in i3c_master_handle_ibi()
2653 complete(&dev->ibi->all_ibis_handled); in i3c_master_handle_ibi()
2659 slot->dev = dev; in i3c_master_init_ibi_slot()
2660 INIT_WORK(&slot->work, i3c_master_handle_ibi); in i3c_master_init_ibi_slot()
2678 * i3c_generic_ibi_free_pool() - Free a generic IBI pool
2688 while (!list_empty(&pool->free_slots)) { in i3c_generic_ibi_free_pool()
2689 slot = list_first_entry(&pool->free_slots, in i3c_generic_ibi_free_pool()
2691 list_del(&slot->node); in i3c_generic_ibi_free_pool()
2699 WARN_ON(nslots != pool->num_slots); in i3c_generic_ibi_free_pool()
2701 kfree(pool->payload_buf); in i3c_generic_ibi_free_pool()
2702 kfree(pool->slots); in i3c_generic_ibi_free_pool()
2708 * i3c_generic_ibi_alloc_pool() - Create a generic IBI pool
2727 return ERR_PTR(-ENOMEM); in i3c_generic_ibi_alloc_pool()
2729 spin_lock_init(&pool->lock); in i3c_generic_ibi_alloc_pool()
2730 INIT_LIST_HEAD(&pool->free_slots); in i3c_generic_ibi_alloc_pool()
2731 INIT_LIST_HEAD(&pool->pending); in i3c_generic_ibi_alloc_pool()
2733 pool->slots = kcalloc(req->num_slots, sizeof(*slot), GFP_KERNEL); in i3c_generic_ibi_alloc_pool()
2734 if (!pool->slots) { in i3c_generic_ibi_alloc_pool()
2735 ret = -ENOMEM; in i3c_generic_ibi_alloc_pool()
2739 if (req->max_payload_len) { in i3c_generic_ibi_alloc_pool()
2740 pool->payload_buf = kcalloc(req->num_slots, in i3c_generic_ibi_alloc_pool()
2741 req->max_payload_len, GFP_KERNEL); in i3c_generic_ibi_alloc_pool()
2742 if (!pool->payload_buf) { in i3c_generic_ibi_alloc_pool()
2743 ret = -ENOMEM; in i3c_generic_ibi_alloc_pool()
2748 for (i = 0; i < req->num_slots; i++) { in i3c_generic_ibi_alloc_pool()
2749 slot = &pool->slots[i]; in i3c_generic_ibi_alloc_pool()
2750 i3c_master_init_ibi_slot(dev, &slot->base); in i3c_generic_ibi_alloc_pool()
2752 if (req->max_payload_len) in i3c_generic_ibi_alloc_pool()
2753 slot->base.data = pool->payload_buf + in i3c_generic_ibi_alloc_pool()
2754 (i * req->max_payload_len); in i3c_generic_ibi_alloc_pool()
2756 list_add_tail(&slot->node, &pool->free_slots); in i3c_generic_ibi_alloc_pool()
2757 pool->num_slots++; in i3c_generic_ibi_alloc_pool()
2769 * i3c_generic_ibi_get_free_slot() - Get a free slot from a generic IBI pool
2784 spin_lock_irqsave(&pool->lock, flags); in i3c_generic_ibi_get_free_slot()
2785 slot = list_first_entry_or_null(&pool->free_slots, in i3c_generic_ibi_get_free_slot()
2788 list_del(&slot->node); in i3c_generic_ibi_get_free_slot()
2789 spin_unlock_irqrestore(&pool->lock, flags); in i3c_generic_ibi_get_free_slot()
2791 return slot ? &slot->base : NULL; in i3c_generic_ibi_get_free_slot()
2796 * i3c_generic_ibi_recycle_slot() - Return a slot to a generic IBI pool
2801 * master driver struct_master_controller_ops->recycle_ibi() method.
2813 spin_lock_irqsave(&pool->lock, flags); in i3c_generic_ibi_recycle_slot()
2814 list_add_tail(&slot->node, &pool->free_slots); in i3c_generic_ibi_recycle_slot()
2815 spin_unlock_irqrestore(&pool->lock, flags); in i3c_generic_ibi_recycle_slot()
2821 if (!ops || !ops->bus_init || !ops->i3c_xfers || in i3c_master_check_ops()
2822 !ops->send_ccc_cmd || !ops->do_daa || !ops->i2c_xfers) in i3c_master_check_ops()
2823 return -EINVAL; in i3c_master_check_ops()
2825 if (ops->request_ibi && in i3c_master_check_ops()
2826 (!ops->enable_ibi || !ops->disable_ibi || !ops->free_ibi || in i3c_master_check_ops()
2827 !ops->recycle_ibi_slot)) in i3c_master_check_ops()
2828 return -EINVAL; in i3c_master_check_ops()
2834 * i3c_master_register() - register an I3C master
2835 * @master: master used to send frames on the bus
2840 * -EOPNOTSUPP if set to true since secondary masters are not yet
2845 * - creates and initializes the I3C bus
2846 * - populates the bus with static I2C devs if @parent->of_node is not
2848 * - registers all I3C devices added by the controller during bus
2850 * - registers the I2C adapter and all I2C devices
2867 return -EOPNOTSUPP; in i3c_master_register()
2873 master->dev.parent = parent; in i3c_master_register()
2874 master->dev.of_node = of_node_get(parent->of_node); in i3c_master_register()
2875 master->dev.bus = &i3c_bus_type; in i3c_master_register()
2876 master->dev.type = &i3c_masterdev_type; in i3c_master_register()
2877 master->dev.release = i3c_masterdev_release; in i3c_master_register()
2878 master->ops = ops; in i3c_master_register()
2879 master->secondary = secondary; in i3c_master_register()
2880 INIT_LIST_HEAD(&master->boardinfo.i2c); in i3c_master_register()
2881 INIT_LIST_HEAD(&master->boardinfo.i3c); in i3c_master_register()
2883 device_initialize(&master->dev); in i3c_master_register()
2884 dev_set_name(&master->dev, "i3c-%d", i3cbus->id); in i3c_master_register()
2886 master->dev.dma_mask = parent->dma_mask; in i3c_master_register()
2887 master->dev.coherent_dma_mask = parent->coherent_dma_mask; in i3c_master_register()
2888 master->dev.dma_parms = parent->dma_parms; in i3c_master_register()
2890 ret = i3c_bus_init(i3cbus, master->dev.of_node); in i3c_master_register()
2898 list_for_each_entry(i2cbi, &master->boardinfo.i2c, node) { in i3c_master_register()
2899 switch (i2cbi->lvr & I3C_LVR_I2C_INDEX_MASK) { in i3c_master_register()
2913 ret = -EINVAL; in i3c_master_register()
2917 if (i2cbi->lvr & I3C_LVR_I2C_FM_MODE) in i3c_master_register()
2925 master->wq = alloc_workqueue("%s", WQ_PERCPU, 0, dev_name(parent)); in i3c_master_register()
2926 if (!master->wq) { in i3c_master_register()
2927 ret = -ENOMEM; in i3c_master_register()
2935 ret = device_add(&master->dev); in i3c_master_register()
2940 * Expose our I3C bus as an I2C adapter so that I2C devices are exposed in i3c_master_register()
2949 pm_runtime_no_callbacks(&master->dev); in i3c_master_register()
2950 pm_suspend_ignore_children(&master->dev, true); in i3c_master_register()
2951 pm_runtime_enable(&master->dev); in i3c_master_register()
2954 * We're done initializing the bus and the controller, we can now in i3c_master_register()
2957 master->init_done = true; in i3c_master_register()
2958 i3c_bus_normaluse_lock(&master->bus); in i3c_master_register()
2960 i3c_bus_normaluse_unlock(&master->bus); in i3c_master_register()
2965 device_del(&master->dev); in i3c_master_register()
2971 put_device(&master->dev); in i3c_master_register()
2978 * i3c_master_unregister() - unregister an I3C master
2979 * @master: master used to send frames on the bus
2985 i3c_bus_notify(&master->bus, I3C_NOTIFY_BUS_REMOVE); in i3c_master_unregister()
2990 pm_runtime_disable(&master->dev); in i3c_master_unregister()
2991 device_unregister(&master->dev); in i3c_master_unregister()
3000 return -ENOENT; in i3c_dev_setdasa_locked()
3004 return -EINVAL; in i3c_dev_setdasa_locked()
3006 if (!dev->boardinfo || !dev->boardinfo->init_dyn_addr || in i3c_dev_setdasa_locked()
3007 !dev->boardinfo->static_addr) in i3c_dev_setdasa_locked()
3008 return -EINVAL; in i3c_dev_setdasa_locked()
3010 return i3c_master_setdasa_locked(master, dev->info.static_addr, in i3c_dev_setdasa_locked()
3011 dev->boardinfo->init_dyn_addr); in i3c_dev_setdasa_locked()
3020 return -ENOENT; in i3c_dev_do_xfers_locked()
3024 return -EINVAL; in i3c_dev_do_xfers_locked()
3026 if (mode != I3C_SDR && !(master->this->info.hdr_cap & BIT(mode))) in i3c_dev_do_xfers_locked()
3027 return -EOPNOTSUPP; in i3c_dev_do_xfers_locked()
3029 return master->ops->i3c_xfers(dev, xfers, nxfers, mode); in i3c_dev_do_xfers_locked()
3037 if (!dev->ibi) in i3c_dev_disable_ibi_locked()
3038 return -EINVAL; in i3c_dev_disable_ibi_locked()
3041 ret = master->ops->disable_ibi(dev); in i3c_dev_disable_ibi_locked()
3045 reinit_completion(&dev->ibi->all_ibis_handled); in i3c_dev_disable_ibi_locked()
3046 if (atomic_read(&dev->ibi->pending_ibis)) in i3c_dev_disable_ibi_locked()
3047 wait_for_completion(&dev->ibi->all_ibis_handled); in i3c_dev_disable_ibi_locked()
3049 dev->ibi->enabled = false; in i3c_dev_disable_ibi_locked()
3059 if (!dev->ibi) in i3c_dev_enable_ibi_locked()
3060 return -EINVAL; in i3c_dev_enable_ibi_locked()
3062 ret = master->ops->enable_ibi(dev); in i3c_dev_enable_ibi_locked()
3064 dev->ibi->enabled = true; in i3c_dev_enable_ibi_locked()
3076 if (!master->ops->request_ibi) in i3c_dev_request_ibi_locked()
3077 return -EOPNOTSUPP; in i3c_dev_request_ibi_locked()
3079 if (dev->ibi) in i3c_dev_request_ibi_locked()
3080 return -EBUSY; in i3c_dev_request_ibi_locked()
3084 return -ENOMEM; in i3c_dev_request_ibi_locked()
3086 ibi->wq = alloc_ordered_workqueue(dev_name(i3cdev_to_dev(dev->dev)), WQ_MEM_RECLAIM); in i3c_dev_request_ibi_locked()
3087 if (!ibi->wq) { in i3c_dev_request_ibi_locked()
3089 return -ENOMEM; in i3c_dev_request_ibi_locked()
3092 atomic_set(&ibi->pending_ibis, 0); in i3c_dev_request_ibi_locked()
3093 init_completion(&ibi->all_ibis_handled); in i3c_dev_request_ibi_locked()
3094 ibi->handler = req->handler; in i3c_dev_request_ibi_locked()
3095 ibi->max_payload_len = req->max_payload_len; in i3c_dev_request_ibi_locked()
3096 ibi->num_slots = req->num_slots; in i3c_dev_request_ibi_locked()
3098 dev->ibi = ibi; in i3c_dev_request_ibi_locked()
3099 ret = master->ops->request_ibi(dev, req); in i3c_dev_request_ibi_locked()
3102 dev->ibi = NULL; in i3c_dev_request_ibi_locked()
3112 if (!dev->ibi) in i3c_dev_free_ibi_locked()
3115 if (WARN_ON(dev->ibi->enabled)) in i3c_dev_free_ibi_locked()
3118 master->ops->free_ibi(dev); in i3c_dev_free_ibi_locked()
3120 if (dev->ibi->wq) { in i3c_dev_free_ibi_locked()
3121 destroy_workqueue(dev->ibi->wq); in i3c_dev_free_ibi_locked()
3122 dev->ibi->wq = NULL; in i3c_dev_free_ibi_locked()
3125 kfree(dev->ibi); in i3c_dev_free_ibi_locked()
3126 dev->ibi = NULL; in i3c_dev_free_ibi_locked()