Messages in this thread | | | Date | Mon, 11 Sep 2023 18:17:20 -0400 | From | Frank Li <> | Subject | Re: [RFC PATCH 5/9] i3c: add slave mode support |
| |
On Mon, Sep 11, 2023 at 07:14:45PM +0800, Joshua Yeong wrote: > > >--- a/drivers/i3c/Makefile > >+++ b/drivers/i3c/Makefile > >@@ -2,3 +2,5 @@ > >i3c-y := device.o master.o > > obj-$(CONFIG_I3C) += i3c.o > > obj-$(CONFIG_I3C) += master/ > >+obj-$(CONFIG_I3C_SLAVE) += slave.o > >+obj-$(CONFIG_I3C_SLAVE_CONFIGFS) += i3c-cfs.o > > Shall we consider to include the content of i3c-cfs.c part of slave.c ? >
PCI and USB's cfs is indepent file. It is logically seperated with slave.o I still think seperate file are better.
Frank
> > On 06-Sep-23 5:38 AM, Frank Li wrote: > > Introduce a new slave core layer in order to support slave functions in > > linux kernel. This comprises the controller library and function library. > > Controller library implements functions specific to an slave controller > > and function library implements functions specific to an slave function. > > > > Introduce a new configfs entry to configure the slave function configuring > > and bind the slave function with slave controller. > > > > Signed-off-by: Frank Li <Frank.Li@nxp.com> > > --- > > drivers/i3c/Kconfig | 29 +++ > > drivers/i3c/Makefile | 2 + > > drivers/i3c/i3c-cfs.c | 361 ++++++++++++++++++++++++++++++ > > drivers/i3c/slave.c | 441 ++++++++++++++++++++++++++++++++++++ > > include/linux/i3c/slave.h | 458 ++++++++++++++++++++++++++++++++++++++ > > 5 files changed, 1291 insertions(+) > > create mode 100644 drivers/i3c/i3c-cfs.c > > create mode 100644 drivers/i3c/slave.c > > create mode 100644 include/linux/i3c/slave.h > > > > diff --git a/drivers/i3c/Kconfig b/drivers/i3c/Kconfig > > index 30a441506f61c..bdc173bc0da12 100644 > > --- a/drivers/i3c/Kconfig > > +++ b/drivers/i3c/Kconfig > > @@ -22,3 +22,32 @@ menuconfig I3C > > if I3C > > source "drivers/i3c/master/Kconfig" > > endif # I3C > > + > > +config I3C_SLAVE > > + bool "I3C Slave Support" > > + help > > + Support I3C Slave Mode. > > + > > + Enable this configuration option to support configurable I3C slave. > > + This should be enabled if the platform has a I3C controller that can > > + operate in slave mode. > > + > > + Enabling this option will build the I3C slave library, which includes > > + slave controller library and slave function library. > > + > > + If in doubt, say "N" to disable slave support. > > + > > +config I3C_SLAVE_CONFIGFS > > + bool "I3C Slave Configfs Support" > > + depends on I3C_SLAVE > > + select CONFIGFS_FS > > + help > > + Configfs entry for slave function and controller. > > + > > + This will enable the configfs entry that can be used to configure > > + the slave function and used to bind the function with a slave > > + controller. > > + > > +if I3C_SLAVE > > +source "drivers/i3c/slave/Kconfig" > > +endif #I#C_SLAVE > > diff --git a/drivers/i3c/Makefile b/drivers/i3c/Makefile > > index 11982efbc6d91..6407ddec3a4a9 100644 > > --- a/drivers/i3c/Makefile > > +++ b/drivers/i3c/Makefile > > @@ -2,3 +2,5 @@ > > i3c-y := device.o master.o > > obj-$(CONFIG_I3C) += i3c.o > > obj-$(CONFIG_I3C) += master/ > > +obj-$(CONFIG_I3C_SLAVE) += slave.o > > +obj-$(CONFIG_I3C_SLAVE_CONFIGFS) += i3c-cfs.o > > diff --git a/drivers/i3c/i3c-cfs.c b/drivers/i3c/i3c-cfs.c > > new file mode 100644 > > index 0000000000000..1f53fada43645 > > --- /dev/null > > +++ b/drivers/i3c/i3c-cfs.c > > @@ -0,0 +1,361 @@ > > +// SPDX-License-Identifier: GPL-2.0 > > +/* > > + * Configfs to configure the I3C Slave > > + * > > + * Copyright (C) 2023 NXP > > + * Author: Frank Li <Frank.Li@nxp.com> > > + */ > > + > > +#include <linux/configfs.h> > > +#include <linux/module.h> > > +#include <linux/i3c/slave.h> > > +#include <linux/idr.h> > > +#include <linux/slab.h> > > + > > +static DEFINE_MUTEX(functions_mutex); > > +static struct config_group *functions_group; > > +static struct config_group *controllers_group; > > + > > +struct i3c_slave_func_group { > > + struct config_group group; > > + struct i3c_slave_func *func; > > +}; > > + > > +struct i3c_slave_ctrl_group { > > + struct config_group group; > > + struct i3c_slave_ctrl *ctrl; > > +}; > > + > > +static inline struct i3c_slave_func_group *to_i3c_slave_func_group(struct config_item *item) > > +{ > > + return container_of(to_config_group(item), struct i3c_slave_func_group, group); > > +} > > + > > +static inline struct i3c_slave_ctrl_group *to_i3c_slave_ctrl_group(struct config_item *item) > > +{ > > + return container_of(to_config_group(item), struct i3c_slave_ctrl_group, group); > > +} > > + > > +static int i3c_slave_ctrl_func_link(struct config_item *ctrl_cfg, struct config_item *func_cfg) > > +{ > > + struct i3c_slave_func_group *func_group = to_i3c_slave_func_group(func_cfg); > > + struct i3c_slave_ctrl_group *ctrl_group = to_i3c_slave_ctrl_group(ctrl_cfg); > > + struct i3c_slave_ctrl *ctrl = ctrl_group->ctrl; > > + struct i3c_slave_func *func = func_group->func; > > + int ret; > > + > > + ret = i3c_slave_ctrl_add_func(ctrl, func); > > + if (ret) > > + return ret; > > + > > + ret = i3c_slave_func_bind(func); > > + if (ret) { > > + i3c_slave_ctrl_remove_func(ctrl, func); > > + return ret; > > + } > > + > > + return 0; > > +} > > + > > +static void i3c_slave_ctrl_func_unlink(struct config_item *ctrl_cfg, struct config_item *func_cfg) > > +{ > > + struct i3c_slave_func_group *func_group = to_i3c_slave_func_group(func_cfg->ci_parent); > > + struct i3c_slave_ctrl_group *ctrl_group = to_i3c_slave_ctrl_group(ctrl_cfg); > > + struct i3c_slave_ctrl *ctrl = ctrl_group->ctrl; > > + struct i3c_slave_func *func = func_group->func; > > + > > + i3c_slave_func_unbind(func); > > + i3c_slave_ctrl_remove_func(ctrl, func); > > +} > > + > > +static struct configfs_item_operations i3c_slave_ctrl_item_ops = { > > + .allow_link = i3c_slave_ctrl_func_link, > > + .drop_link = i3c_slave_ctrl_func_unlink, > > +}; > > + > > +static const struct config_item_type i3c_slave_ctrl_type = { > > + .ct_item_ops = &i3c_slave_ctrl_item_ops, > > + .ct_owner = THIS_MODULE, > > +}; > > + > > +/** > > + * i3c_slave_cfs_add_ctrl_group() - add I3C slave controller group > > + * @ctrl: I3C slave controller device > > + * > > + * Return: Pointer to struct config_group > > + */ > > +struct config_group *i3c_slave_cfs_add_ctrl_group(struct i3c_slave_ctrl *ctrl) > > +{ > > + struct i3c_slave_ctrl_group *ctrl_group; > > + struct config_group *group; > > + int ret; > > + > > + ctrl_group = kzalloc(sizeof(*ctrl_group), GFP_KERNEL); > > + if (!ctrl_group) { > > + ret = -ENOMEM; > > + goto err; > > + } > > + > > + group = &ctrl_group->group; > > + > > + config_group_init_type_name(group, dev_name(&ctrl->dev), &i3c_slave_ctrl_type); > > + ret = configfs_register_group(controllers_group, group); > > + if (ret) { > > + pr_err("failed to register configfs group for %s\n", dev_name(&ctrl->dev)); > > + goto err_register_group; > > + } > > + > > + ctrl_group->ctrl = ctrl; > > + > > + return group; > > + > > +err_register_group: > > + kfree(ctrl_group); > > + > > +err: > > + return ERR_PTR(ret); > > +} > > +EXPORT_SYMBOL(i3c_slave_cfs_add_ctrl_group); > > + > > +/** > > + * i3c_slave_cfs_remove_ctrl_group() - remove I3C slave controller group > > + * @group: the group to be removed > > + */ > > +void i3c_slave_cfs_remove_ctrl_group(struct config_group *group) > > +{ > > + struct i3c_slave_ctrl_group *ctrl_group; > > + > > + if (!group) > > + return; > > + > > + ctrl_group = container_of(group, struct i3c_slave_ctrl_group, group); > > + i3c_slave_ctrl_put(ctrl_group->ctrl); > > + configfs_unregister_group(&ctrl_group->group); > > + kfree(ctrl_group); > > +} > > +EXPORT_SYMBOL(i3c_slave_cfs_remove_ctrl_group); > > + > > +#define I3C_SLAVE_ATTR_R(_name) \ > > +static ssize_t i3c_slave_func_##_name##_show(struct config_item *item, char *page) \ > > +{ \ > > + struct i3c_slave_func *func = to_i3c_slave_func_group(item)->func; \ > > + return sysfs_emit(page, "0x%04x\n", func->_name); \ > > +} > > + > > +#define I3C_SLAVE_ATTR_W(_name, _u) \ > > +static ssize_t i3c_slave_func_##_name##_store(struct config_item *item, \ > > + const char *page, size_t len) \ > > +{ \ > > + _u val; \ > > + struct i3c_slave_func *func = to_i3c_slave_func_group(item)->func; \ > > + if (kstrto##_u(page, 0, &val) < 0) \ > > + return -EINVAL; \ > > + func->_name = val; \ > > + return len; \ > > +} > > + > > +I3C_SLAVE_ATTR_R(vendor_id); > > +I3C_SLAVE_ATTR_W(vendor_id, u16); > > +CONFIGFS_ATTR(i3c_slave_func_, vendor_id); > > + > > +I3C_SLAVE_ATTR_R(vendor_info); > > +I3C_SLAVE_ATTR_W(vendor_info, u16); > > +CONFIGFS_ATTR(i3c_slave_func_, vendor_info); > > + > > +I3C_SLAVE_ATTR_R(part_id); > > +I3C_SLAVE_ATTR_W(part_id, u16); > > +CONFIGFS_ATTR(i3c_slave_func_, part_id); > > + > > +I3C_SLAVE_ATTR_R(instance_id); > > +I3C_SLAVE_ATTR_W(instance_id, u8); > > +CONFIGFS_ATTR(i3c_slave_func_, instance_id); > > + > > +I3C_SLAVE_ATTR_R(ext_id); > > +I3C_SLAVE_ATTR_W(ext_id, u16); > > +CONFIGFS_ATTR(i3c_slave_func_, ext_id); > > + > > +I3C_SLAVE_ATTR_R(max_write_len); > > +I3C_SLAVE_ATTR_W(max_write_len, u16); > > +CONFIGFS_ATTR(i3c_slave_func_, max_write_len); > > + > > +I3C_SLAVE_ATTR_R(max_read_len); > > +I3C_SLAVE_ATTR_W(max_read_len, u16); > > +CONFIGFS_ATTR(i3c_slave_func_, max_read_len); > > + > > +I3C_SLAVE_ATTR_R(bcr); > > +I3C_SLAVE_ATTR_W(bcr, u8); > > +CONFIGFS_ATTR(i3c_slave_func_, bcr); > > + > > +I3C_SLAVE_ATTR_R(dcr); > > +I3C_SLAVE_ATTR_W(dcr, u8); > > +CONFIGFS_ATTR(i3c_slave_func_, dcr); > > + > > +static struct configfs_attribute *i3c_slave_func_attrs[] = { > > + &i3c_slave_func_attr_vendor_id, > > + &i3c_slave_func_attr_vendor_info, > > + &i3c_slave_func_attr_part_id, > > + &i3c_slave_func_attr_instance_id, > > + &i3c_slave_func_attr_ext_id, > > + &i3c_slave_func_attr_max_write_len, > > + &i3c_slave_func_attr_max_read_len, > > + &i3c_slave_func_attr_bcr, > > + &i3c_slave_func_attr_dcr, > > + NULL, > > +}; > > + > > +static const struct config_item_type i3c_slave_func_type = { > > + .ct_attrs = i3c_slave_func_attrs, > > + .ct_owner = THIS_MODULE, > > +}; > > + > > +static struct config_group *i3c_slave_func_make(struct config_group *group, const char *name) > > +{ > > + struct i3c_slave_func_group *func_group; > > + struct i3c_slave_func *func; > > + int err; > > + > > + func_group = kzalloc(sizeof(*func_group), GFP_KERNEL); > > + if (!func_group) > > + return ERR_PTR(-ENOMEM); > > + > > + config_group_init_type_name(&func_group->group, name, &i3c_slave_func_type); > > + > > + func = i3c_slave_func_create(group->cg_item.ci_name, name); > > + if (IS_ERR(func)) { > > + pr_err("failed to create i3c slave function device\n"); > > + err = -EINVAL; > > + goto free_group; > > + } > > + > > + func->group = &func_group->group; > > + > > + func_group->func = func; > > + > > + return &func_group->group; > > + > > +free_group: > > + kfree(func_group); > > + > > + return ERR_PTR(err); > > +} > > + > > +static void i3c_slave_func_drop(struct config_group *group, struct config_item *item) > > +{ > > + config_item_put(item); > > +} > > + > > +static struct configfs_group_operations i3c_slave_func_group_ops = { > > + .make_group = &i3c_slave_func_make, > > + .drop_item = &i3c_slave_func_drop, > > +}; > > + > > +static const struct config_item_type i3c_slave_func_group_type = { > > + .ct_group_ops = &i3c_slave_func_group_ops, > > + .ct_owner = THIS_MODULE, > > +}; > > + > > +/** > > + * i3c_slave_cfs_add_func_group() - add I3C slave function group > > + * @name: group name > > + * > > + * Return: Pointer to struct config_group > > + */ > > +struct config_group *i3c_slave_cfs_add_func_group(const char *name) > > +{ > > + struct config_group *group; > > + > > + group = configfs_register_default_group(functions_group, name, > > + &i3c_slave_func_group_type); > > + if (IS_ERR(group)) > > + pr_err("failed to register configfs group for %s function\n", > > + name); > > + > > + return group; > > +} > > +EXPORT_SYMBOL(i3c_slave_cfs_add_func_group); > > + > > +/** > > + * i3c_slave_cfs_remove_func_group() - add I3C slave function group > > + * @group: group to be removed > > + */ > > +void i3c_slave_cfs_remove_func_group(struct config_group *group) > > +{ > > + if (IS_ERR_OR_NULL(group)) > > + return; > > + > > + configfs_unregister_default_group(group); > > +} > > +EXPORT_SYMBOL(i3c_slave_cfs_remove_func_group); > > + > > +static const struct config_item_type i3c_slave_controllers_type = { > > + .ct_owner = THIS_MODULE, > > +}; > > + > > +static const struct config_item_type i3c_slave_functions_type = { > > + .ct_owner = THIS_MODULE, > > +}; > > + > > +static const struct config_item_type i3c_slave_type = { > > + .ct_owner = THIS_MODULE, > > +}; > > + > > +static struct configfs_subsystem i3c_slave_cfs_subsys = { > > + .su_group = { > > + .cg_item = { > > + .ci_namebuf = "i3c_slave", > > + .ci_type = &i3c_slave_type, > > + }, > > + }, > > + .su_mutex = __MUTEX_INITIALIZER(i3c_slave_cfs_subsys.su_mutex), > > +}; > > + > > +static int __init i3c_slave_cfs_init(void) > > +{ > > + int ret; > > + struct config_group *root = &i3c_slave_cfs_subsys.su_group; > > + > > + config_group_init(root); > > + > > + ret = configfs_register_subsystem(&i3c_slave_cfs_subsys); > > + if (ret) { > > + pr_err("Error %d while registering subsystem %s\n", > > + ret, root->cg_item.ci_namebuf); > > + goto err; > > + } > > + > > + functions_group = configfs_register_default_group(root, "functions", > > + &i3c_slave_functions_type); > > + if (IS_ERR(functions_group)) { > > + ret = PTR_ERR(functions_group); > > + pr_err("Error %d while registering functions group\n", > > + ret); > > + goto err_functions_group; > > + } > > + > > + controllers_group = > > + configfs_register_default_group(root, "controllers", > > + &i3c_slave_controllers_type); > > + if (IS_ERR(controllers_group)) { > > + ret = PTR_ERR(controllers_group); > > + pr_err("Error %d while registering controllers group\n", > > + ret); > > + goto err_controllers_group; > > + } > > + > > + return 0; > > + > > +err_controllers_group: > > + configfs_unregister_default_group(functions_group); > > + > > +err_functions_group: > > + configfs_unregister_subsystem(&i3c_slave_cfs_subsys); > > + > > +err: > > + return ret; > > +} > > +module_init(i3c_slave_cfs_init); > > + > > +MODULE_DESCRIPTION("I3C FUNC CONFIGFS"); > > +MODULE_AUTHOR("Frank Li <Frank.Li@nxp.com>"); > > + > > + > > diff --git a/drivers/i3c/slave.c b/drivers/i3c/slave.c > > new file mode 100644 > > index 0000000000000..edd7a2888271b > > --- /dev/null > > +++ b/drivers/i3c/slave.c > > @@ -0,0 +1,441 @@ > > +// SPDX-License-Identifier: GPL-2.0 > > +/* > > + * configfs to configure the I3C Slave > > + * > > + * Copyright (C) 2023 NXP > > + * Author: Frank Li <Frank.Li@nxp.com> > > + */ > > + > > +#include <linux/configfs.h> > > +#include <linux/module.h> > > +#include <linux/i3c/slave.h> > > +#include <linux/idr.h> > > +#include <linux/slab.h> > > + > > +static DEFINE_MUTEX(func_lock); > > +static struct class *i3c_slave_ctrl_class; > > + > > +static void i3c_slave_func_dev_release(struct device *dev) > > +{ > > + struct i3c_slave_func *func = to_i3c_slave_func(dev); > > + > > + kfree(func->name); > > + kfree(func); > > +} > > + > > +static const struct device_type i3c_slave_func_type = { > > + .release = i3c_slave_func_dev_release, > > +}; > > + > > +static int i3c_slave_func_match_driver(struct device *dev, struct device_driver *drv) > > +{ > > + return !strncmp(dev_name(dev), drv->name, strlen(drv->name)); > > +} > > + > > +static int i3c_slave_func_device_probe(struct device *dev) > > +{ > > + struct i3c_slave_func *func = to_i3c_slave_func(dev); > > + struct i3c_slave_func_driver *driver = to_i3c_slave_func_driver(dev->driver); > > + > > + if (!driver->probe) > > + return -ENODEV; > > + > > + func->driver = driver; > > + > > + return driver->probe(func); > > +} > > + > > +static void i3c_slave_func_device_remove(struct device *dev) > > +{ > > + struct i3c_slave_func *func = to_i3c_slave_func(dev); > > + struct i3c_slave_func_driver *driver = to_i3c_slave_func_driver(dev->driver); > > + > > + if (driver->remove) > > + driver->remove(func); > > + func->driver = NULL; > > +} > > + > > +static const struct bus_type i3c_slave_func_bus_type = { > > + .name = "i3c_slave_func", > > + .probe = i3c_slave_func_device_probe, > > + .remove = i3c_slave_func_device_remove, > > + .match = i3c_slave_func_match_driver, > > +}; > > + > > +static void i3c_slave_ctrl_release(struct device *dev) > > +{ > > + kfree(to_i3c_slave_ctrl(dev)); > > +} > > + > > +static void devm_i3c_slave_ctrl_release(struct device *dev, void *res) > > +{ > > + struct i3c_slave_ctrl *ctrl = *(struct i3c_slave_ctrl **)res; > > + > > + i3c_slave_ctrl_destroy(ctrl); > > +} > > + > > +struct i3c_slave_ctrl * > > +__devm_i3c_slave_ctrl_create(struct device *dev, const struct i3c_slave_ctrl_ops *ops, > > + struct module *owner) > > +{ > > + struct i3c_slave_ctrl **ptr, *ctrl; > > + > > + ptr = devres_alloc(devm_i3c_slave_ctrl_release, sizeof(*ptr), GFP_KERNEL); > > + if (!ptr) > > + return ERR_PTR(-ENOMEM); > > + > > + ctrl = __i3c_slave_ctrl_create(dev, ops, owner); > > + if (!IS_ERR(ctrl)) { > > + *ptr = ctrl; > > + devres_add(dev, ptr); > > + } else { > > + devres_free(ptr); > > + } > > + > > + return ctrl; > > +} > > + > > +static int devm_i3c_slave_ctrl_match(struct device *dev, void *res, void *match_data) > > +{ > > + struct i3c_slave_ctrl **ptr = res; > > + > > + return *ptr == match_data; > > +} > > + > > +/** > > + * __i3c_slave_ctrl_create() - create a new slave controller device > > + * @dev: device that is creating the new slave controller > > + * @ops: function pointers for performing slave controller operations > > + * @owner: the owner of the module that creates the slave controller device > > + * > > + * Return: Pointer to struct i3c_slave_ctrl > > + */ > > +struct i3c_slave_ctrl * > > +__i3c_slave_ctrl_create(struct device *dev, const struct i3c_slave_ctrl_ops *ops, > > + struct module *owner) > > +{ > > + struct i3c_slave_ctrl *ctrl; > > + int ret; > > + > > + if (WARN_ON(!dev)) > > + return ERR_PTR(-EINVAL); > > + > > + ctrl = kzalloc(sizeof(*ctrl), GFP_KERNEL); > > + if (!ctrl) > > + return ERR_PTR(-ENOMEM); > > + > > + device_initialize(&ctrl->dev); > > + ctrl->dev.class = i3c_slave_ctrl_class; > > + ctrl->dev.parent = dev; > > + ctrl->dev.release = i3c_slave_ctrl_release; > > + ctrl->ops = ops; > > + > > + ret = dev_set_name(&ctrl->dev, "%s", dev_name(dev)); > > + if (ret) > > + goto put_dev; > > + > > + ret = device_add(&ctrl->dev); > > + if (ret) > > + goto put_dev; > > + > > + ctrl->group = i3c_slave_cfs_add_ctrl_group(ctrl); > > + if (!ctrl->group) > > + goto put_dev; > > + > > + return ctrl; > > + > > +put_dev: > > + put_device(&ctrl->dev); > > + kfree(ctrl); > > + > > + return ERR_PTR(ret); > > +} > > +EXPORT_SYMBOL_GPL(__i3c_slave_ctrl_create); > > + > > +/** > > + * devm_i3c_slave_ctrl_destroy() - destroy the slave controller device > > + * @dev: device that is creating the new slave controller device > > + * @ops: function pointers for performing slave controller operations > > + * @owner: the owner of the module that creates the slave controller device > > + * > > + * Invoke to create a new slave controller device and add it to i3c_slave class. While at that, it > > + * also associates the device with the i3c_slave using devres. On driver detach, release function is > > + * invoked on the devres data, then devres data is freed. > > + */ > > +void devm_i3c_slave_ctrl_destroy(struct device *dev, struct i3c_slave_ctrl *ctrl) > > +{ > > + int r; > > + > > + r = devres_destroy(dev, devm_i3c_slave_ctrl_release, devm_i3c_slave_ctrl_match, > > + ctrl); > > + dev_WARN_ONCE(dev, r, "couldn't find I3C controller resource\n"); > > +} > > +EXPORT_SYMBOL_GPL(devm_i3c_slave_ctrl_destroy); > > + > > + > > + > > +/** > > + * i3c_slave_ctrl_destroy() - destroy the slave controller device > > + * @ctrl: the slave controller device that has to be destroyed > > + * > > + * Invoke to destroy the I3C slave device > > + */ > > +void i3c_slave_ctrl_destroy(struct i3c_slave_ctrl *ctrl) > > +{ > > + i3c_slave_cfs_remove_ctrl_group(ctrl->group); > > + device_unregister(&ctrl->dev); > > +} > > +EXPORT_SYMBOL_GPL(i3c_slave_ctrl_destroy); > > + > > +/** > > + * i3c_slave_ctrl_add_func() - bind I3C slave function to an slave controller > > + * @ctrl: the controller device to which the slave function should be added > > + * @func: the slave function to be added > > + * > > + * An I3C slave device can have only one functions. > > + */ > > +int i3c_slave_ctrl_add_func(struct i3c_slave_ctrl *ctrl, struct i3c_slave_func *func) > > +{ > > + if (ctrl->func) > > + return -EBUSY; > > + > > + ctrl->func = func; > > + func->ctrl = ctrl; > > + > > + return 0; > > +} > > +EXPORT_SYMBOL_GPL(i3c_slave_ctrl_add_func); > > + > > +/** > > + * i3c_slave_ctrl_remove_func() - unbind I3C slave function to an slave controller > > + * @ctrl: the controller device to which the slave function should be removed > > + * @func: the slave function to be removed > > + * > > + * An I3C slave device can have only one functions. > > + */ > > +void i3c_slave_ctrl_remove_func(struct i3c_slave_ctrl *ctrl, struct i3c_slave_func *func) > > +{ > > + ctrl->func = NULL; > > +} > > +EXPORT_SYMBOL_GPL(i3c_slave_ctrl_remove_func); > > + > > + > > +/** > > + * i3c_slave_ctrl() - get the I3C slave controller > > + * @name: device name of the slave controller > > + * > > + * Invoke to get struct i3c_slave_ctrl * corresponding to the device name of the > > + * slave controller > > + */ > > +struct i3c_slave_ctrl *i3c_slave_ctrl_get(const char *name) > > +{ > > + int ret = -EINVAL; > > + struct i3c_slave_ctrl *ctrl; > > + struct device *dev; > > + struct class_dev_iter iter; > > + > > + class_dev_iter_init(&iter, i3c_slave_ctrl_class, NULL, NULL); > > + while ((dev = class_dev_iter_next(&iter))) { > > + if (strcmp(name, dev_name(dev))) > > + continue; > > + > > + ctrl = to_i3c_slave_ctrl(dev); > > + if (!try_module_get(ctrl->ops->owner)) { > > + ret = -EINVAL; > > + goto err; > > + } > > + > > + class_dev_iter_exit(&iter); > > + get_device(&ctrl->dev); > > + return ctrl; > > + } > > + > > +err: > > + class_dev_iter_exit(&iter); > > + return ERR_PTR(ret); > > + > > +} > > +EXPORT_SYMBOL_GPL(i3c_slave_ctrl_get); > > + > > +/** > > + * i3c_slave_ctrl_put() - release the I3C endpoint controller > > + * @slave: slave returned by pci_slave_get() > > + * > > + * release the refcount the caller obtained by invoking i3c_slave_ctrl_get() > > + */ > > +void i3c_slave_ctrl_put(struct i3c_slave_ctrl *ctrl) > > +{ > > + if (!ctrl || IS_ERR(ctrl)) > > + return; > > + > > + module_put(ctrl->ops->owner); > > + put_device(&ctrl->dev); > > +} > > +EXPORT_SYMBOL_GPL(i3c_slave_ctrl_put); > > + > > +/** > > + * i3c_slave_func_bind() - Notify the function driver that the function device has been bound to a > > + * controller device > > + * @func: the function device which has been bound to the controller device > > + * > > + * Invoke to notify the function driver that it has been bound to a controller device > > + */ > > +int i3c_slave_func_bind(struct i3c_slave_func *func) > > +{ > > + struct device *dev = &func->dev; > > + int ret; > > + > > + if (!func->driver) { > > + dev_WARN(dev, "func device not bound to driver\n"); > > + return -EINVAL; > > + } > > + > > + if (!try_module_get(func->driver->owner)) > > + return -EAGAIN; > > + > > + mutex_lock(&func->lock); > > + ret = func->driver->ops->bind(func); > > + if (!ret) > > + func->is_bound = true; > > + mutex_unlock(&func->lock); > > + > > + return ret; > > +} > > +EXPORT_SYMBOL_GPL(i3c_slave_func_bind); > > + > > +/** > > + * i3c_slave_func_unbind() - Notify the function driver that the binding between the function device > > + * and controller device has been lost > > + * @func: the function device which has lost the binding with the controller device > > + * > > + * Invoke to notify the function driver that the binding between the function device and controller > > + * device has been lost. > > + */ > > +void i3c_slave_func_unbind(struct i3c_slave_func *func) > > +{ > > + if (!func->driver) { > > + dev_WARN(&func->dev, "func device not bound to driver\n"); > > + return; > > + } > > + > > + mutex_lock(&func->lock); > > + if (func->is_bound) > > + func->driver->ops->unbind(func); > > + mutex_unlock(&func->lock); > > + > > + module_put(func->driver->owner); > > +} > > +EXPORT_SYMBOL_GPL(i3c_slave_func_unbind); > > + > > +/** > > + * i3c_slave_func_create() - create a new I3C function device > > + * @drv_name: the driver name of the I3C function device. > > + * @name: the name of the function device. > > + * > > + * Invoke to create a new I3C function device by providing the name of the function device. > > + */ > > +struct i3c_slave_func *i3c_slave_func_create(const char *drv_name, const char *name) > > +{ > > + struct i3c_slave_func *func; > > + struct device *dev; > > + int ret; > > + > > + func = kzalloc(sizeof(*func), GFP_KERNEL); > > + if (!func) > > + return ERR_PTR(-ENOMEM); > > + > > + dev = &func->dev; > > + device_initialize(dev); > > + dev->bus = &i3c_slave_func_bus_type; > > + dev->type = &i3c_slave_func_type; > > + mutex_init(&func->lock); > > + > > + ret = dev_set_name(dev, "%s.%s", drv_name, name); > > + if (ret) { > > + put_device(dev); > > + return ERR_PTR(ret); > > + } > > + > > + ret = device_add(dev); > > + if (ret) { > > + put_device(dev); > > + return ERR_PTR(ret); > > + } > > + > > + return func; > > +} > > +EXPORT_SYMBOL_GPL(i3c_slave_func_create); > > + > > +/** > > + * __i3c_slave_func_register_driver() - register a new I3C function driver > > + * @driver: structure representing I3C function driver > > + * @owner: the owner of the module that registers the I3C function driver > > + * > > + * Invoke to register a new I3C function driver. > > + */ > > +int __i3c_slave_func_register_driver(struct i3c_slave_func_driver *driver, struct module *owner) > > +{ > > + int ret = -EEXIST; > > + > > + if (!driver->ops) > > + return -EINVAL; > > + > > + if (!driver->ops->bind || !driver->ops->unbind) > > + return -EINVAL; > > + > > + driver->driver.bus = &i3c_slave_func_bus_type; > > + driver->driver.owner = owner; > > + > > + ret = driver_register(&driver->driver); > > + if (ret) > > + return ret; > > + > > + i3c_slave_cfs_add_func_group(driver->driver.name); > > + > > + return 0; > > +} > > +EXPORT_SYMBOL_GPL(__i3c_slave_func_register_driver); > > + > > +/** > > + * i3c_slave_func_unregister_driver() - unregister the I3C function driver > > + * @driver: the I3C function driver that has to be unregistered > > + * > > + * Invoke to unregister the I3C function driver. > > + */ > > +void i3c_slave_func_unregister_driver(struct i3c_slave_func_driver *fd) > > +{ > > + mutex_lock(&func_lock); > > + mutex_unlock(&func_lock); > > +} > > +EXPORT_SYMBOL_GPL(i3c_slave_func_unregister_driver); > > + > > +static int __init i3c_slave_init(void) > > +{ > > + int ret; > > + > > + i3c_slave_ctrl_class = class_create("i3c_slave"); > > + if (IS_ERR(i3c_slave_ctrl_class)) { > > + pr_err("failed to create i3c slave class --> %ld\n", > > + PTR_ERR(i3c_slave_ctrl_class)); > > + return PTR_ERR(i3c_slave_ctrl_class); > > + } > > + > > + ret = bus_register(&i3c_slave_func_bus_type); > > + if (ret) { > > + class_destroy(i3c_slave_ctrl_class); > > + pr_err("failed to register i3c slave func bus --> %d\n", ret); > > + return ret; > > + } > > + > > + return 0; > > +} > > +module_init(i3c_slave_init); > > + > > +static void __exit i3c_slave_exit(void) > > +{ > > + class_destroy(i3c_slave_ctrl_class); > > + bus_unregister(&i3c_slave_func_bus_type); > > + > > +} > > +module_exit(i3c_slave_exit); > > + > > diff --git a/include/linux/i3c/slave.h b/include/linux/i3c/slave.h > > new file mode 100644 > > index 0000000000000..a4cbbfc6d6ea9 > > --- /dev/null > > +++ b/include/linux/i3c/slave.h > > @@ -0,0 +1,458 @@ > > +/* SPDX-License-Identifier: GPL-2.0 */ > > +/* > > + * Copyright 2023 NXP. > > + * > > + * Author: Frank Li <Frank.Li@nxp.com> > > + */ > > + > > +#ifndef I3C_SLAVE_H > > +#define I3C_SLAVE_H > > + > > +#include <linux/device.h> > > + > > +struct i3c_slave_func; > > +struct i3c_slave_ctrl; > > + > > +/** > > + * struct i3c_slave_func_ops - set of function pointers for performing i3c slave function operations > > + * @bind: ops to perform when a controller device has been bound to function device > > + * @unbind: ops to perform when a binding has been lost between a controller device and function > > + * device > > + */ > > +struct i3c_slave_func_ops { > > + int (*bind)(struct i3c_slave_func *func); > > + void (*unbind)(struct i3c_slave_func *func); > > +}; > > + > > +/** > > + * struct i3c_slave_func_driver - represents the I3C function driver > > + * @probe: ops to perform when a new function device has been bound to the function driver > > + * @remove: ops to perform when the binding between the function device and function driver is > > + * broken > > + * @driver: I3C Function driver > > + * @ops: set of function pointers for performing function operations > > + * @owner: the owner of the module that registers the I3C function driver > > + * @epf_group: list of configfs group corresponding to the I3C function driver > > + */ > > +struct i3c_slave_func_driver { > > + int (*probe)(struct i3c_slave_func *func); > > + void (*remove)(struct i3c_slave_func *func); > > + > > + char *name; > > + struct device_driver driver; > > + struct i3c_slave_func_ops *ops; > > + struct module *owner; > > +}; > > + > > +/** > > + * struct i3c_slave_func - represents the I3C function device > > + * @dev: the I3C function device > > + * @name: the name of the I3C function device > > + * @driver: the function driver to which this function device is bound > > + * @group: configfs group associated with the EPF device > > + * @lock: mutex to protect i3c_slave_func_ops > > + * @ctrl: binded I3C controller device > > + * @is_bound: indicates if bind notification to function driver has been invoked > > + * @vednor_id: vendor id > > + * @part_id: part id > > + * @instance_id: instance id > > + * @ext_id: ext id > > + * @vendor_info: vendor info > > + * @static_addr: static address for I2C. It is 0 for I3C. > > + * @max_write_len: maxium write length > > + * @max_read_len: maxium read length > > + * @bcr: bus characteristics register (BCR) > > + * @dcr: device characteristics register (DCR) > > + */ > > +struct i3c_slave_func { > > + struct device dev; > > + char *name; > > + struct i3c_slave_func_driver *driver; > > + struct config_group *group; > > + /* mutex to protect against concurrent access of i3c_slave_func_ops */ > > + struct mutex lock; > > + struct i3c_slave_ctrl *ctrl; > > + bool is_bound; > > + > > + u16 vendor_id; > > + u16 part_id; > > + u8 instance_id; > > + u16 ext_id; > > + u8 vendor_info; > > + u16 static_addr; > > + u16 max_write_len; //0 is hardware default max value > > + u16 max_read_len; //0 is hardware default max value > > + u8 bcr; > > + u8 dcr; > > +}; > > + > > +enum i3c_request_stat { > > + I3C_REQUEST_OKAY, > > + I3C_REQUEST_PARTIAL, > > + I3C_REQUEST_ERR, > > + I3C_REQUEST_CANCEL, > > +}; > > + > > +/** > > + * struct i3c_request - represents the an I3C transfer request > > + * @buf: data buffer > > + * @length: data length > > + * @complete: call back function when request finished or cancelled > > + * @context: general data for complete callback function > > + * @status: transfer status > > + * @actual: how much actually transferred > > + * @ctrl: I3C slave controller associate with this request > > + * @tx: transfer direction, 1: slave to master, 0: master to slave > > + */ > > +struct i3c_request { > > + void *buf; > > + unsigned int length; > > + > > + void (*complete)(struct i3c_request *req); > > + void *context; > > + struct list_head list; > > + > > + enum i3c_request_stat status; > > + unsigned int actual; > > + struct i3c_slave_ctrl *ctrl; > > + bool tx; > > +}; > > + > > +/** > > + * struct i3c_slave_ctrl_features - represents I3C slave controller features. > > + * @tx_fifo_sz: tx hardware fifo size > > + * @rx_fifo_sz: rx hardware fifo size > > + */ > > +struct i3c_slave_ctrl_features { > > + u32 tx_fifo_sz; > > + u32 rx_fifo_sz; > > +}; > > + > > +/** > > + * struct i3c_slave_ctrl_ops - set of function pointers for performing controller operations > > + * @set_config: set I3C controller configuration > > + * @enable: enable I3C controller > > + * @disable: disable I3C controller > > + * @raise_ibi: rasie IBI interrupt to master > > + * @queue: queue an I3C transfer > > + * @dequeue: dequeue an I3C transfer > > + * @cancel_all_reqs: call all pending requests > > + * @fifo_status: current FIFO status > > + * @fifo_flush: flush hardware FIFO > > + * @get_features: ops to get the features supported by the I3C slave controller > > + * @owner: the module owner containing the ops > > + */ > > +struct i3c_slave_ctrl_ops { > > + int (*set_config)(struct i3c_slave_ctrl *ctrl, struct i3c_slave_func *func); > > + int (*enable)(struct i3c_slave_ctrl *ctrl); > > + int (*disable)(struct i3c_slave_ctrl *ctrl); > > + int (*raise_ibi)(struct i3c_slave_ctrl *ctrl, void *p, u8 size); > > + > > + struct i3c_request *(*alloc_request)(struct i3c_slave_ctrl *ctrl, gfp_t gfp_flags); > > + void (*free_request)(struct i3c_request *req); > > + > > + int (*queue)(struct i3c_request *req, gfp_t gfp_flags); > > + int (*dequeue)(struct i3c_request *req); > > + > > + void (*cancel_all_reqs)(struct i3c_slave_ctrl *ctrl, bool tx); > > + > > + int (*fifo_status)(struct i3c_slave_ctrl *ctrl, bool tx); > > + void (*fifo_flush)(struct i3c_slave_ctrl *ctrl, bool tx); > > + > > + const struct i3c_slave_ctrl_features *(*get_features)(struct i3c_slave_ctrl *ctrl); > > + struct module *owner; > > +}; > > + > > +/** > > + * struct i3c_slave_ctrl - represents the I3C slave device > > + * @dev: I3C slave device > > + * @ops: function pointers for performing endpoint operations > > + * @func: slave functions present in this controller device > > + * @group: configfs group representing the I3C controller device > > + */ > > +struct i3c_slave_ctrl { > > + struct device dev; > > + const struct i3c_slave_ctrl_ops *ops; > > + struct i3c_slave_func *func; > > + struct config_group *group; > > +}; > > + > > +/** > > + * i3c_slave_ctrl_raise_ibi() - Raise IBI to master > > + * @ctrl: I3C slave controller > > + * @p: optional data for IBI > > + * @size: size of optional data > > + * > > + * Returns: Zero for success, or an error code in case of failure > > + */ > > +static inline int i3c_slave_ctrl_raise_ibi(struct i3c_slave_ctrl *ctrl, void *p, u8 size) > > +{ > > + if (ctrl && ctrl->ops && ctrl->ops->raise_ibi) > > + return ctrl->ops->raise_ibi(ctrl, p, size); > > + > > + return -EINVAL; > > +} > > + > > +/** > > + * i3c_slave_ctrl_cancel_all_reqs() - Cancel all pending request > > + * @ctrl: I3C slave controller > > + * @tx: Transfer diretion queue > > + * @size: size of optional data > > + */ > > +static inline void i3c_slave_ctrl_cancel_all_reqs(struct i3c_slave_ctrl *ctrl, bool tx) > > +{ > > + if (ctrl && ctrl->ops && ctrl->ops->cancel_all_reqs) > > + ctrl->ops->cancel_all_reqs(ctrl, tx); > > +} > > + > > +/** > > + * i3c_slave_ctrl_set_config() - Set controller configuration > > + * @ctrl: I3C slave controller device > > + * @func: Function device > > + * > > + * Returns: Zero for success, or an error code in case of failure > > + */ > > +static inline int > > +i3c_slave_ctrl_set_config(struct i3c_slave_ctrl *ctrl, struct i3c_slave_func *func) > > +{ > > + if (ctrl && ctrl->ops && ctrl->ops->set_config) > > + return ctrl->ops->set_config(ctrl, func); > > + > > + return -EINVAL; > > +} > > + > > +/** > > + * i3c_slave_ctrl_enable() - Enable I3C controller > > + * @ctrl: I3C slave controller device > > + * > > + * Returns: Zero for success, or an error code in case of failure > > + */ > > +static inline int > > +i3c_slave_ctrl_enable(struct i3c_slave_ctrl *ctrl) > > +{ > > + if (ctrl && ctrl->ops && ctrl->ops->enable) > > + return ctrl->ops->enable(ctrl); > > + > > + return -EINVAL; > > +} > > + > > +/** > > + * i3c_slave_ctrl_disable() - Disable I3C controller > > + * @ctrl: I3C slave controller device > > + * > > + * Returns: Zero for success, or an error code in case of failure > > + */ > > +static inline int > > +i3c_slave_ctrl_disable(struct i3c_slave_ctrl *ctrl) > > +{ > > + if (ctrl && ctrl->ops && ctrl->ops->disable) > > + return ctrl->ops->disable(ctrl); > > + > > + return -EINVAL; > > +} > > + > > +/** > > + * i3c_slave_ctrl_alloc_request() - Alloc an I3C transfer > > + * @ctrl: I3C slave controller device > > + * gfp_flags: additional gfp flags used when allocating the buffers > > + * > > + * Returns: Zero for success, or an error code in case of failure > > + */ > > +static inline struct i3c_request * > > +i3c_slave_ctrl_alloc_request(struct i3c_slave_ctrl *ctrl, gfp_t gfp_flags) > > +{ > > + struct i3c_request *req = NULL; > > + > > + if (ctrl && ctrl->ops && ctrl->ops->alloc_request) > > + req = ctrl->ops->alloc_request(ctrl, gfp_flags); > > + else > > + req = kzalloc(sizeof(*req), gfp_flags); > > + > > + if (req) > > + req->ctrl = ctrl; > > + > > + return req; > > +} > > + > > +/** > > + * i3c_slave_ctrl_free_request() - Free an I3C transfer > > + * @ctrl: I3C slave controller device > > + * > > + * Returns: Zero for success, or an error code in case of failure > > + */ > > +static inline void > > +i3c_slave_ctrl_free_request(struct i3c_request *req) > > +{ > > + struct i3c_slave_ctrl *ctrl; > > + > > + if (!req) > > + return; > > + > > + ctrl = req->ctrl; > > + if (ctrl && ctrl->ops && ctrl->ops->free_request) > > + ctrl->ops->free_request(req); > > + else > > + kfree(req); > > +} > > + > > +/** > > + * i3c_slave_ctrl_queue() - Queue an I3C transfer > > + * @ctrl: I3C slave controller device > > + * gfp_flags: additional gfp flags used when allocating the buffers > > + * > > + * Returns: Zero for success, or an error code in case of failure > > + */ > > +static inline int > > +i3c_slave_ctrl_queue(struct i3c_request *req, gfp_t gfp_flags) > > +{ > > + struct i3c_slave_ctrl *ctrl; > > + int ret = -EINVAL; > > + > > + if (!req) > > + return -EINVAL; > > + > > + ctrl = req->ctrl; > > + > > + req->actual = 0; > > + req->status = 0; > > + if (ctrl && ctrl->ops && ctrl->ops->queue) > > + ret = ctrl->ops->queue(req, gfp_flags); > > + > > + return ret; > > +} > > + > > +/** > > + * i3c_slave_ctrl_dequeue() - Dequeue an I3C transfer > > + * @ctrl: I3C slave controller device > > + * > > + * Returns: Zero for success, or an error code in case of failure > > + */ > > +static inline int > > +i3c_slave_ctrl_dequeue(struct i3c_request *req) > > +{ > > + struct i3c_slave_ctrl *ctrl; > > + int ret = -EINVAL; > > + > > + if (!req) > > + return -EINVAL; > > + > > + ctrl = req->ctrl; > > + if (ctrl && ctrl->ops && ctrl->ops->dequeue) > > + ret = ctrl->ops->dequeue(req); > > + > > + return ret; > > +} > > + > > +/** > > + * i3c_slave_ctrl_fifo_status() - Get controller FIFO status > > + * @ctrl: I3C slave controller device > > + * @tx: 1: Slave to master, 0: master to slave > > + * > > + * Returns: How much data in FIFO > > + */ > > +static inline int > > +i3c_slave_ctrl_fifo_status(struct i3c_slave_ctrl *ctrl, bool tx) > > +{ > > + if (ctrl && ctrl->ops && ctrl->ops->fifo_status) > > + return ctrl->ops->fifo_status(ctrl, tx); > > + > > + return 0; > > +} > > + > > +/** > > + * i3c_slave_ctrl_fifo_flush() - Flush controller FIFO > > + * @ctrl: I3C slave controller device > > + * @tx: 1: Slave to master, 0: master to slave > > + * > > + */ > > +static inline void > > +i3c_slave_ctrl_fifo_flush(struct i3c_slave_ctrl *ctrl, bool tx) > > +{ > > + if (ctrl && ctrl->ops && ctrl->ops->fifo_flush) > > + return ctrl->ops->fifo_flush(ctrl, tx); > > +} > > + > > +/** > > + * i3c_slave_ctrl_get_features() - Get controller supported features > > + * @ctrl: I3C slave controller device > > + * > > + * Returns: The pointer to struct i3c_slave_ctrl_features > > + */ > > +static inline const struct i3c_slave_ctrl_features* > > +i3c_slave_ctrl_get_features(struct i3c_slave_ctrl *ctrl) > > +{ > > + if (ctrl && ctrl->ops && ctrl->ops->get_features) > > + return ctrl->ops->get_features(ctrl); > > + > > + return NULL; > > +} > > + > > +#define to_i3c_slave_ctrl(device) container_of((device), struct i3c_slave_ctrl, dev) > > + > > +#define to_i3c_slave_func(func_dev) container_of((func_dev), struct i3c_slave_func, dev) > > +#define to_i3c_slave_func_driver(drv) (container_of((drv), struct i3c_slave_func_driver, driver)) > > + > > +#define i3c_slave_ctrl_create(dev, ops) \ > > + __i3c_slave_ctrl_create((dev), (ops), THIS_MODULE) > > +#define devm_i3c_slave_ctrl_create(dev, ops) \ > > + __devm_i3c_slave_ctrl_create((dev), (ops), THIS_MODULE) > > + > > +struct i3c_slave_ctrl * > > +__devm_i3c_slave_ctrl_create(struct device *dev, const struct i3c_slave_ctrl_ops *ops, > > + struct module *owner); > > +struct i3c_slave_ctrl * > > +__i3c_slave_ctrl_create(struct device *dev, const struct i3c_slave_ctrl_ops *ops, > > + struct module *owner); > > + > > +void devm_i3c_slave_ctrl_destroy(struct device *dev, struct i3c_slave_ctrl *epc); > > +void i3c_slave_ctrl_destroy(struct i3c_slave_ctrl *epc); > > + > > + > > +int i3c_slave_ctrl_add_func(struct i3c_slave_ctrl *ctrl, struct i3c_slave_func *func); > > +void i3c_slave_ctrl_remove_func(struct i3c_slave_ctrl *ctrl, struct i3c_slave_func *func); > > + > > +struct config_group *i3c_slave_cfs_add_ctrl_group(struct i3c_slave_ctrl *ctrl); > > + > > + > > +void i3c_slave_cfs_remove_ctrl_group(struct config_group *group); > > +struct config_group *i3c_slave_cfs_add_func_group(const char *name); > > +void i3c_slave_cfs_remove_func_group(struct config_group *group); > > +struct i3c_slave_ctrl *i3c_slave_ctrl_get(const char *name); > > +void i3c_slave_ctrl_put(struct i3c_slave_ctrl *ctrl); > > + > > +int i3c_slave_func_bind(struct i3c_slave_func *func); > > +void i3c_slave_func_unbind(struct i3c_slave_func *func); > > +struct i3c_slave_func *i3c_slave_func_create(const char *drv_name, const char *name); > > + > > +#define i3c_slave_func_register_driver(drv) \ > > + __i3c_slave_func_register_driver(drv, THIS_MODULE) > > + > > +int __i3c_slave_func_register_driver(struct i3c_slave_func_driver *drv, struct module *owner); > > +void i3c_slave_func_unregister_driver(struct i3c_slave_func_driver *drv); > > + > > +#define DECLARE_I3C_SLAVE_FUNC(_name, _probe, _remove, _ops) \ > > + static struct i3c_slave_func_driver _name ## i3c_func = { \ > > + .driver.name = __stringify(_name), \ > > + .owner = THIS_MODULE, \ > > + .probe = _probe, \ > > + .remove = _remove, \ > > + .ops = _ops \ > > + }; \ > > + MODULE_ALIAS("i3cfunc:"__stringify(_name)) > > + > > +#define DECLARE_I3C_SLAVE_INIT(_name, _probe, _remove, _ops) \ > > + DECLARE_I3C_SLAVE_FUNC(_name, _probe, _remove, _ops); \ > > + static int __init _name ## mod_init(void) \ > > + { \ > > + return i3c_slave_func_register_driver(&_name ## i3c_func); \ > > + } \ > > + static void __exit _name ## mod_exit(void) \ > > + { \ > > + i3c_slave_func_unregister_driver(&_name ## i3c_func); \ > > + } \ > > + module_init(_name ## mod_init); \ > > + module_exit(_name ## mod_exit) > > + > > +#endif > > + > > +
| |