[<prev] [next>] [<thread-prev] [thread-next>] [day] [month] [year] [list]
Message-ID: <2e42bee0-937e-1dcf-2d18-91b362d35be4@starfivetech.com>
Date: Mon, 11 Sep 2023 19:14:45 +0800
From: Joshua Yeong <joshua.yeong@...rfivetech.com>
To: Frank Li <Frank.Li@....com>, <miquel.raynal@...tlin.com>
CC: <alexandre.belloni@...tlin.com>, <conor.culhane@...vaco.com>,
<imx@...ts.linux.dev>, <linux-i3c@...ts.infradead.org>,
<linux-kernel@...r.kernel.org>
Subject: Re: [RFC PATCH 5/9] i3c: add slave mode support
>--- 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 ?
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@....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@....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@....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@....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@....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
> +
> +
Powered by blists - more mailing lists