Add API to allow userspace to create any type of topology in vimc using
basic system calls such as mkdir/rmdir/read/write.
Signed-off-by: Helen Koike <[email protected]>
---
Hi,
This patch introduces the configufs API for configuring the topology in
vimc while it removes the hardcoded topology, so now, when you load the
module you need to create a device (no device will appear in your system
by default) using mkdir/rmdir/write/read.
Please see documentation in the patch.
I was thinking in adding a device by default, but if I do it in
configfs, userspace won't be able to delete the device (which might not
be a problem), as I need to create it as a "default" group in configfs,
or I can just not expose the default device in the configfs.
What do you think?
Thanks
Helen
Documentation/media/v4l-drivers/vimc.rst | 172 +++++
drivers/media/platform/vimc/Kconfig | 7 +-
drivers/media/platform/vimc/Makefile | 7 +-
drivers/media/platform/vimc/vimc-capture.c | 46 +-
drivers/media/platform/vimc/vimc-common.h | 58 +-
drivers/media/platform/vimc/vimc-configfs.c | 665 ++++++++++++++++++++
drivers/media/platform/vimc/vimc-configfs.h | 30 +
drivers/media/platform/vimc/vimc-core.c | 283 ++-------
drivers/media/platform/vimc/vimc-core.h | 17 +
drivers/media/platform/vimc/vimc-debayer.c | 51 +-
drivers/media/platform/vimc/vimc-scaler.c | 49 +-
drivers/media/platform/vimc/vimc-sensor.c | 43 +-
12 files changed, 1153 insertions(+), 275 deletions(-)
create mode 100644 Documentation/media/v4l-drivers/vimc.rst
create mode 100644 drivers/media/platform/vimc/vimc-configfs.c
create mode 100644 drivers/media/platform/vimc/vimc-configfs.h
create mode 100644 drivers/media/platform/vimc/vimc-core.h
diff --git a/Documentation/media/v4l-drivers/vimc.rst b/Documentation/media/v4l-drivers/vimc.rst
new file mode 100644
index 000000000000..28d3b02c7d30
--- /dev/null
+++ b/Documentation/media/v4l-drivers/vimc.rst
@@ -0,0 +1,172 @@
+The Virtual Media Controller Driver (vimc)
+=========================================
+
+This driver emulates video4linux hardware of varios media topologies. It exposes
+media devices through /dev/mediaX notes, video capture devices through
+/dev/videoX and sub-devices through /dev/v4l-subdevX.
+
+A subdevice can be a sensor, a debayer or a scaler.
+
+To configure a media device of a given topology, a ConfigFS API is provided.
+
+
+Configuring the driver through ConfigFS (Experimental)
+------------------------------------------------------
+
+.. note::
+This API is not finished yet and might change in the future.
+
+Mount configfs:
+::
+ $ mkdir /configfs
+ $ mount -t configfs none /configfs
+
+When loading the module, you see a folders name vimc
+::
+ $ tree /configfs/
+ /configfs/
+ `-- vimc
+
+1) Creating a media device
+~~~~~~~~~~~~~~~~~~~~~~~~~~
+
+To create a media device just create a new folder under /configfs/vimc/
+
+Example:
+::
+ $ mkdir /configfs/vimc/mdev
+ $ tree /configfs/vimc/mdev
+ /configfs/vimc/mdev/
+ |-- entities/
+ |-- hotplug
+ `-- links/
+
+ 2 directories, 1 file
+
+2) Creating entities
+~~~~~~~~~~~~~~~~~~~~
+
+To create an entity in the media device's topology, just create a folder under
+/configfs/vimc/<mdev-name>/entities/ with the following format:
+
+ <sub-module>:<name>
+
+Where <sub-module> is one of the following:
+::
+ vimc-sensor
+ vimc-scaler
+ vimc-debayer
+ vimc-capture
+
+Example:
+::
+ $ mkdir /configfs/vimc/mdev/entities/vimc-sensor:my-sensor
+ $ mkdir /configfs/vimc/mdev/entities/vimc-capture:my-capture
+ $ tree /configfs/
+ /configfs/
+ `-- vimc/
+ `-- mdev/
+ |-- entities/
+ | |-- vimc-capture:my-capture/
+ | | `-- pad:sink:0/
+ | `-- vimc-sensor:my-sensor/
+ | `-- pad:source:0/
+ |-- hotplug
+ `-- links/
+
+ 8 directories, 1 file
+
+3) Creating links
+~~~~~~~~~~~~~~~~~
+
+To create links between two entities in the topology, just create a folder under
+/configfs/vimc/<mdev-name>/links/ with the following format:
+
+ "<entity1-name><pad-source>:<entity2-name><pad-sink>"
+
+Example:
+::
+ $ mkdir "/configfs/vimc/mdev/links/my-sensor:0->my-capture:0"
+ $ tree /configfs
+ /configfs/
+ `-- vimc/
+ `-- mdev/
+ |-- entities/
+ | |-- vimc-capture:my-capture/
+ | | `-- pad:sink:0/
+ | `-- vimc-sensor:my-sensor/
+ | `-- pad:source:0/
+ |-- hotplug
+ `-- links/
+ `-- my-sensor:0->my-capture:0/
+ `-- flags
+
+ 9 directories, 2 files
+
+Change the attributes of the link by writing in the file
+"/configfs/vimc/<mdev-name>/links/<my-link>/flags"
+
+Flag values are defined in :ref:`include/uapi/linux/media.h <media_header>`
+( seek for ``MEDIA_LNK_FL_*``)
+
+1 - Enabled
+ Indicates the link will be enabled when the media device is created.
+
+3 - Enabled and Immutable
+ Indicates that the link enabled state can't be modified at runtime.
+
+Example:
+::
+ $ echo 3 > "/configfs/vimc/mdev/links/my-sensor:0->my-capture:0/flags"
+
+4) Activating/Deactivating device
+~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
+
+To activate the device, write one of "plugged", "plug" or "1" to file
+/configfs/vimc/<ndev-name>/hotplug
+
+Example:
+::
+ $ echo 1 > /configfs/vimc/mdev/hotplug
+
+You should see a new node /dev/mediaX in your devfs.
+
+To deactivate the device, write one of "unplugged", "unplug" or "0" to file
+/configfs/vimc/<ndev-name>/hotplug
+
+Example:
+::
+ $ echo 0 > /configfs/vimc/mdev/hotplug
+
+Subdevices
+----------
+
+Subdevices defines the behavior of an entity in the topology. Depending on the
+subdevice, the entity can have multiple pads of type source or sink.
+
+vimc-sensor:
+ Generates images in several formats using video test pattern generator.
+ Exposes:
+
+ * 1 Pad source
+
+vimc-debayer:
+ Transforms images in bayer format into a non bayer format.
+ Exposes:
+
+ * 1 Pad sink
+ * 1 Pad source
+
+vimc-scaler:
+ Mutiplies the size of the image by 3.
+ Exposes:
+
+ * 1 Pad sink
+ * 1 Pad source
+
+vimc-capture:
+ Exposes node /dev/videoX to allow userspace to capture the stream.
+ Exposes:
+
+ * 1 Pad sink
+ * 1 Pad source
diff --git a/drivers/media/platform/vimc/Kconfig b/drivers/media/platform/vimc/Kconfig
index 71c9fe7d3370..7f1fb550d4c3 100644
--- a/drivers/media/platform/vimc/Kconfig
+++ b/drivers/media/platform/vimc/Kconfig
@@ -1,15 +1,14 @@
config VIDEO_VIMC
tristate "Virtual Media Controller Driver (VIMC)"
- depends on VIDEO_DEV && VIDEO_V4L2 && VIDEO_V4L2_SUBDEV_API
+ depends on VIDEO_DEV && VIDEO_V4L2 && VIDEO_V4L2_SUBDEV_API && CONFIGFS_FS
select VIDEOBUF2_VMALLOC
select VIDEO_V4L2_TPG
default n
---help---
- Skeleton driver for Virtual Media Controller
+ Virtual Media Controller Driver
This driver can be compared to the vivid driver for emulating
a media node that exposes a complex media topology. The topology
- is hard coded for now but is meant to be highly configurable in
- the future.
+ is configurable through configfs API.
When in doubt, say N.
diff --git a/drivers/media/platform/vimc/Makefile b/drivers/media/platform/vimc/Makefile
index 4b2e3de7856e..5d926a5ef15c 100644
--- a/drivers/media/platform/vimc/Makefile
+++ b/drivers/media/platform/vimc/Makefile
@@ -1,10 +1,9 @@
# SPDX-License-Identifier: GPL-2.0
-vimc-objs := vimc-core.o
+vimc-objs := vimc-core.o vimc-common.o vimc-configfs.o
vimc_capture-objs := vimc-capture.o
-vimc_common-objs := vimc-common.o
vimc_debayer-objs := vimc-debayer.o
vimc_scaler-objs := vimc-scaler.o
vimc_sensor-objs := vimc-sensor.o
-obj-$(CONFIG_VIDEO_VIMC) += vimc.o vimc_capture.o vimc_common.o vimc-debayer.o \
- vimc_scaler.o vimc_sensor.o
+obj-$(CONFIG_VIDEO_VIMC) += vimc.o vimc_capture.o vimc-debayer.o vimc_scaler.o \
+ vimc_sensor.o
diff --git a/drivers/media/platform/vimc/vimc-capture.c b/drivers/media/platform/vimc/vimc-capture.c
index 3f7e9ed56633..55a5f85b4591 100644
--- a/drivers/media/platform/vimc/vimc-capture.c
+++ b/drivers/media/platform/vimc/vimc-capture.c
@@ -23,6 +23,7 @@
#include <media/videobuf2-core.h>
#include <media/videobuf2-vmalloc.h>
+#include "vimc-configfs.h"
#include "vimc-common.h"
#define VIMC_CAP_DRV_NAME "vimc-capture"
@@ -418,7 +419,7 @@ static int vimc_cap_comp_bind(struct device *comp, struct device *master,
}
/* Initialize the media entity */
- vcap->vdev.entity.name = pdata->entity_name;
+ vcap->vdev.entity.name = pdata->name;
vcap->vdev.entity.function = MEDIA_ENT_F_IO_V4L;
ret = media_entity_pads_init(&vcap->vdev.entity,
1, vcap->ved.pads);
@@ -443,7 +444,7 @@ static int vimc_cap_comp_bind(struct device *comp, struct device *master,
ret = vb2_queue_init(q);
if (ret) {
dev_err(comp, "%s: vb2 queue init failed (err=%d)\n",
- pdata->entity_name, ret);
+ pdata->name, ret);
goto err_clean_m_ent;
}
@@ -476,7 +477,7 @@ static int vimc_cap_comp_bind(struct device *comp, struct device *master,
vdev->queue = q;
vdev->v4l2_dev = v4l2_dev;
vdev->vfl_dir = VFL_DIR_RX;
- strscpy(vdev->name, pdata->entity_name, sizeof(vdev->name));
+ strscpy(vdev->name, pdata->name, sizeof(vdev->name));
video_set_drvdata(vdev, &vcap->ved);
/* Register the video_device with the v4l2 and the media framework */
@@ -534,7 +535,44 @@ static struct platform_driver vimc_cap_pdrv = {
},
};
-module_platform_driver(vimc_cap_pdrv);
+static struct config_item_type vimc_cap_cfs_pad_type = {
+ .ct_owner = THIS_MODULE,
+};
+
+static struct config_group vimc_cap_cfs_sink_pad_group;
+
+static void vimc_cap_configfs_cb(struct config_group *group)
+{
+ config_group_init_type_name(&vimc_cap_cfs_sink_pad_group,
+ VIMC_CFS_SINK_PAD_NAME(0),
+ &vimc_cap_cfs_pad_type);
+ configfs_add_default_group(&vimc_cap_cfs_sink_pad_group, group);
+}
+
+struct vimc_cfs_drv vimc_cap_cfs_drv = {
+ .name = VIMC_CAP_DRV_NAME,
+ .configfs_cb = vimc_cap_configfs_cb,
+};
+
+static int __init vimc_cap_init(void)
+{
+ int ret = platform_driver_register(&vimc_cap_pdrv);
+
+ if (ret)
+ return ret;
+
+ vimc_cfs_drv_register(&vimc_cap_cfs_drv);
+ return 0;
+}
+
+static void __exit vimc_cap_exit(void)
+{
+ platform_driver_unregister(&vimc_cap_pdrv);
+ vimc_cfs_drv_unregister(&vimc_cap_cfs_drv);
+}
+
+module_init(vimc_cap_init);
+module_exit(vimc_cap_exit);
MODULE_DEVICE_TABLE(platform, vimc_cap_driver_ids);
diff --git a/drivers/media/platform/vimc/vimc-common.h b/drivers/media/platform/vimc/vimc-common.h
index 2e9981b18166..9a33e7901b72 100644
--- a/drivers/media/platform/vimc/vimc-common.h
+++ b/drivers/media/platform/vimc/vimc-common.h
@@ -22,6 +22,8 @@
#include <media/media-device.h>
#include <media/v4l2-device.h>
+#define VIMC_MAX_NAME_LEN 32
+
/* VIMC-specific controls */
#define VIMC_CID_VIMC_BASE (0x00f00000 | 0xf000)
#define VIMC_CID_VIMC_CLASS (0x00f00000 | 1)
@@ -63,16 +65,62 @@ do { \
/**
* struct vimc_platform_data - platform data to components
*
- * @entity_name: The name of the entity to be created
+ * @name: The name of the device
+ * @group: The configfs group the device belongs
*
* Board setup code will often provide additional information using the device's
* platform_data field to hold additional information.
- * When injecting a new platform_device in the component system the core needs
- * to provide to the corresponding submodules the name of the entity that should
- * be used when registering the subdevice in the Media Controller system.
+ * When injecting a new platform_device in the component system, the name of the
+ * device is required to allow the system to register it with a proper name.
+ * Also the configfs group is given to allow the driver to add custom items in
+ * the group.
+ * This struct is used by the entity submodules and the core system to be able
+ * to retrieve the name to register the device in the Media Controller system.
*/
struct vimc_platform_data {
- char entity_name[32];
+ char name[VIMC_MAX_NAME_LEN];
+ struct config_group *group;
+};
+
+/**
+ * struct vimc_platform_data_link - platform data to components of type link
+ *
+ * @source: source component of the link
+ * @source_pad: source pad of the link
+ * @sink: sink component of the link
+ * @sink_pad: sink pad of the link
+ * @flags: flags of the link
+ *
+ * Board setup code will often provide additional information using the device's
+ * platform_data field to hold additional information.
+ * When injecting a new platform_device representing a link in the component
+ * system, source and sink information is required to allow the link module to
+ * create the proper link between entities.
+ */
+struct vimc_platform_data_link {
+ struct platform_device *source;
+ u16 source_pad;
+ struct platform_device *sink;
+ u16 sink_pad;
+ u32 flags;
+ struct list_head list;
+};
+
+/**
+ * struct vimc_platform_data_core - platform data to the core
+ *
+ * @data: see struct vimc_platform_data
+ * @links: list of struct vimc_platform_data_link
+ *
+ * Board setup code will often provide additional information using the device's
+ * platform_data field to hold additional information.
+ * When injecting a new platform_device representing the core component, a list
+ * of struct vimc_platform_data_list is required to allow the core to create
+ * create the proper links between entities.
+ */
+struct vimc_platform_data_core {
+ struct vimc_platform_data data;
+ struct list_head *links;
};
/**
diff --git a/drivers/media/platform/vimc/vimc-configfs.c b/drivers/media/platform/vimc/vimc-configfs.c
new file mode 100644
index 000000000000..68e5f1ea736b
--- /dev/null
+++ b/drivers/media/platform/vimc/vimc-configfs.c
@@ -0,0 +1,665 @@
+// SPDX-License-Identifier: GPL-2.0+
+/*
+ * vimc-configfs.c Virtual Media Controller Driver
+ *
+ * Copyright (C) 2018 Helen Koike <[email protected]>
+ */
+
+#include <linux/component.h>
+#include <linux/module.h>
+#include <linux/slab.h>
+#include <linux/platform_device.h>
+
+#include "vimc-common.h"
+#include "vimc-configfs.h"
+#include "vimc-core.h"
+
+#define CHAR_SEPARATOR ':'
+#define LINK_SEPARATOR "->"
+#define CFS_SUBSYS_NAME "vimc"
+
+#define ci_err(ci, fmt, ...) \
+ pr_err("vimc: %s: " pr_fmt(fmt), (ci)->ci_name, ##__VA_ARGS__)
+#define cg_err(cg, ...) ci_err(&(cg)->cg_item, ##__VA_ARGS__)
+#define ci_warn(ci, fmt, ...) \
+ pr_warn("vimc: %s: " pr_fmt(fmt), (ci)->ci_name, ##__VA_ARGS__)
+#define cg_warn(cg, ...) ci_warn(&(cg)->cg_item, ##__VA_ARGS__)
+#define ci_dbg(ci, fmt, ...) \
+ pr_debug("vimc: %s: " pr_fmt(fmt), (ci)->ci_name, ##__VA_ARGS__)
+#define cg_dbg(cg, ...) ci_dbg(&(cg)->cg_item, ##__VA_ARGS__)
+
+#define is_plugged(cfs) (!!(cfs)->pdev)
+
+enum vimc_cfs_hotplug_state {
+ VIMC_CFS_HOTPLUG_STATE_UNPLUGGED = 0,
+ VIMC_CFS_HOTPLUG_STATE_PLUGGED = 1,
+};
+
+const static char *vimc_cfs_hotplug_values[2][3] = {
+ [VIMC_CFS_HOTPLUG_STATE_UNPLUGGED] = {"unplugged\n", "unplug\n", "0\n"},
+ [VIMC_CFS_HOTPLUG_STATE_PLUGGED] = {"plugged\n", "plug\n", "1\n"},
+};
+
+/* --------------------------------------------------------------------------
+ * Pipeline structures
+ */
+
+static struct vimc_cfs_subsystem {
+ struct configfs_subsystem subsys;
+ struct list_head drvs;
+} vimc_cfs_subsys;
+
+/* Structure which describes the whole topology */
+struct vimc_cfs_device {
+ struct platform_device *pdev;
+ struct vimc_platform_data_core pdata;
+ struct list_head ents;
+ struct list_head links;
+ struct config_group gdev;
+ struct config_group gents;
+ struct config_group glinks;
+};
+
+/* Structure which describes individual configuration for each entity */
+struct vimc_cfs_ent {
+ struct platform_device *pdev;
+ struct vimc_platform_data pdata;
+ char drv[VIMC_MAX_NAME_LEN];
+ struct list_head list;
+ struct config_group cg;
+};
+
+/* Structure which describes links between entities */
+struct vimc_cfs_link {
+ struct vimc_platform_data_link pdata;
+ char source_name[VIMC_MAX_NAME_LEN];
+ char sink_name[VIMC_MAX_NAME_LEN];
+ struct config_item ci;
+};
+
+void vimc_cfs_drv_register(struct vimc_cfs_drv *c_drv)
+{
+ list_add(&c_drv->list, &vimc_cfs_subsys.drvs);
+}
+EXPORT_SYMBOL_GPL(vimc_cfs_drv_register);
+
+void vimc_cfs_drv_unregister(struct vimc_cfs_drv *c_drv)
+{
+ list_del(&c_drv->list);
+}
+EXPORT_SYMBOL_GPL(vimc_cfs_drv_unregister);
+
+/* --------------------------------------------------------------------------
+ * Platform Device builders
+ */
+
+static int vimc_cfs_link_get_entities(const struct vimc_cfs_device *cfs,
+ struct vimc_cfs_link *c_link)
+{
+ struct vimc_cfs_ent *c_ent;
+
+ c_link->pdata.source = NULL;
+ c_link->pdata.sink = NULL;
+ list_for_each_entry(c_ent, &cfs->ents, list) {
+ if (!c_link->pdata.source &&
+ !strcmp(c_ent->pdata.name, c_link->source_name))
+ c_link->pdata.source = c_ent->pdev;
+ if (!c_link->pdata.sink &&
+ !strcmp(c_ent->pdata.name, c_link->sink_name))
+ c_link->pdata.sink = c_ent->pdev;
+ if (c_link->pdata.source && c_link->pdata.sink)
+ return 0;
+ }
+ return -EINVAL;
+}
+
+static int vimc_cfs_comp_compare(struct device *comp, void *data)
+{
+ dev_dbg(comp, "comp compare %p %p", comp, data);
+
+ return comp == data;
+}
+
+static const struct component_master_ops vimc_cfs_comp_ops = {
+ .bind = vimc_core_comp_bind,
+ .unbind = vimc_core_comp_unbind,
+};
+
+static void vimc_cfs_device_unplug(struct vimc_cfs_device *cfs)
+{
+ struct vimc_cfs_ent *c_ent;
+
+ dev_dbg(&cfs->pdev->dev, "Unplugging device");
+
+ component_master_del(&cfs->pdev->dev, &vimc_cfs_comp_ops);
+ list_for_each_entry(c_ent, &cfs->ents, list) {
+ platform_device_unregister(c_ent->pdev);
+ c_ent->pdev = NULL;
+ }
+ platform_device_unregister(cfs->pdev);
+ cfs->pdev = NULL;
+}
+
+static int vimc_cfs_device_plug(struct vimc_cfs_device *cfs)
+{
+ struct component_match *match = NULL;
+ struct vimc_cfs_ent *c_ent;
+ struct vimc_cfs_link *c_link;
+ int ret = 0;
+
+ cg_dbg(&cfs->gdev, "Plugging device");
+
+ if (list_empty(&cfs->ents)) {
+ /* TODO: add support for a default topology */
+ cg_err(&cfs->gdev,
+ "At least an entity is required to plug the device");
+ return -EINVAL;
+ }
+
+ cfs->pdev = platform_device_register_data(NULL, VIMC_CORE_PDEV_NAME,
+ PLATFORM_DEVID_AUTO,
+ &cfs->pdata,
+ sizeof(cfs->pdata));
+ if (IS_ERR(cfs->pdev))
+ return PTR_ERR(cfs->pdev);
+
+ /* Add component_match for inner structure of the pipeline */
+ list_for_each_entry(c_ent, &cfs->ents, list) {
+ cg_dbg(&c_ent->cg, "registering entity %s:%s", c_ent->drv,
+ c_ent->pdata.name);
+ if (c_ent->pdev)
+ cg_err(&c_ent->cg, "pdev is not null");
+ c_ent->pdev = platform_device_register_data(&cfs->pdev->dev,
+ c_ent->drv,
+ PLATFORM_DEVID_AUTO,
+ &c_ent->pdata,
+ sizeof(c_ent->pdata));
+ if (IS_ERR(c_ent->pdev)) {
+ ret = PTR_ERR(c_ent->pdev);
+ goto unregister_ents;
+ }
+ component_match_add(&cfs->pdev->dev, &match,
+ vimc_cfs_comp_compare, &c_ent->pdev->dev);
+ }
+ list_for_each_entry(c_link, cfs->pdata.links, pdata.list) {
+ ret = vimc_cfs_link_get_entities(cfs, c_link);
+ if (ret) {
+ ci_err(&c_link->ci, "could not validate link");
+ goto unregister_ents;
+ }
+ }
+
+ dev_dbg(&cfs->pdev->dev, "Adding master device");
+ ret = component_master_add_with_match(&cfs->pdev->dev,
+ &vimc_cfs_comp_ops, match);
+ if (ret)
+ goto unregister_ents;
+
+ return 0;
+
+unregister_ents:
+ list_for_each_entry_continue_reverse(c_ent, &cfs->ents, list) {
+ platform_device_unregister(c_ent->pdev);
+ c_ent->pdev = NULL;
+ }
+
+ platform_device_unregister(cfs->pdev);
+ cfs->pdev = NULL;
+
+ return ret;
+}
+
+/* --------------------------------------------------------------------------
+ * Links
+ */
+
+static ssize_t vimc_cfs_links_attr_flags_show(struct config_item *item,
+ char *buf)
+{
+ struct vimc_cfs_link *c_link = container_of(item, struct vimc_cfs_link,
+ ci);
+
+ sprintf(buf, "%d\n", c_link->pdata.flags);
+ return strlen(buf);
+}
+
+static ssize_t vimc_cfs_links_attr_flags_store(struct config_item *item,
+ const char *buf, size_t size)
+{
+ struct vimc_cfs_link *c_link = container_of(item, struct vimc_cfs_link,
+ ci);
+
+ if (kstrtou32(buf, 0, &c_link->pdata.flags))
+ return -EINVAL;
+
+ return size;
+}
+
+CONFIGFS_ATTR(vimc_cfs_links_attr_, flags);
+
+static struct configfs_attribute *vimc_cfs_link_attrs[] = {
+ &vimc_cfs_links_attr_attr_flags,
+ NULL,
+};
+
+static void vimc_cfs_link_release(struct config_item *item)
+{
+ struct vimc_cfs_link *c_link = container_of(item, struct vimc_cfs_link,
+ ci);
+
+ kfree(c_link);
+}
+
+static struct configfs_item_operations vimc_cfs_link_item_ops = {
+ .release = vimc_cfs_link_release,
+};
+
+static struct config_item_type vimc_cfs_link_type = {
+ .ct_item_ops = &vimc_cfs_link_item_ops,
+ .ct_attrs = vimc_cfs_link_attrs,
+ .ct_owner = THIS_MODULE,
+};
+
+static void vimc_cfs_link_drop_item(struct config_group *group,
+ struct config_item *item)
+{
+ struct vimc_cfs_link *link = container_of(item,
+ struct vimc_cfs_link, ci);
+ struct vimc_cfs_device *cfs = container_of(group,
+ struct vimc_cfs_device,
+ glinks);
+
+ if (is_plugged(cfs))
+ vimc_cfs_device_unplug(cfs);
+ list_del(&link->pdata.list);
+}
+
+static struct config_item *vimc_cfs_link_make_item(struct config_group *group,
+ const char *name)
+{
+ struct vimc_cfs_device *cfs = container_of(group,
+ struct vimc_cfs_device,
+ glinks);
+ size_t src_pad_strlen, sink_pad_strlen, sink_namelen, source_namelen;
+ const char *sep, *src_pad_str, *sink_pad_str, *sink_name,
+ *source_name = name;
+ struct vimc_cfs_link *c_link;
+ u16 source_pad, sink_pad;
+ char tmp[4];
+
+ cg_dbg(&cfs->gdev, "Creating link %s", name);
+
+ if (is_plugged(cfs))
+ vimc_cfs_device_unplug(cfs);
+
+ /* Parse format "source_name:source_pad->sink_name:sink_pad" */
+ sep = strchr(source_name, CHAR_SEPARATOR);
+ if (!sep)
+ goto syntax_error;
+ source_namelen = (size_t)(sep - source_name);
+
+ src_pad_str = &sep[1];
+ sep = strstr(src_pad_str, LINK_SEPARATOR);
+ if (!sep)
+ goto syntax_error;
+ src_pad_strlen = (size_t)(sep - src_pad_str);
+
+ sink_name = &sep[strlen(LINK_SEPARATOR)];
+ sep = strchr(sink_name, CHAR_SEPARATOR);
+ if (!sep)
+ goto syntax_error;
+ sink_namelen = (size_t)(sep - sink_name);
+
+ sink_pad_str = &sep[1];
+ sink_pad_strlen = strlen(sink_pad_str);
+
+ /* Validate sizes */
+ if (!src_pad_strlen || !sink_pad_strlen ||
+ !sink_namelen || !source_namelen)
+ goto syntax_error;
+
+ /* we limit the size here so we don't need to allocate another buffer */
+ if (src_pad_strlen >= sizeof(tmp) || sink_pad_strlen >= sizeof(tmp)) {
+ cg_err(&cfs->gdev,
+ "Pad with more then %ld digits is not supported",
+ sizeof(tmp) - 1);
+ goto syntax_error;
+ }
+ strscpy(tmp, src_pad_str, src_pad_strlen + 1);
+ if (kstrtou16(tmp, 0, &source_pad)) {
+ cg_err(&cfs->gdev, "Couldn't convert pad %s to number", tmp);
+ goto syntax_error;
+ }
+ strscpy(tmp, sink_pad_str, sink_pad_strlen + 1);
+ if (kstrtou16(tmp, 0, &sink_pad)) {
+ cg_err(&cfs->gdev, "Couldn't convert pad %s to number", tmp);
+ goto syntax_error;
+ }
+
+ c_link = kzalloc(sizeof(*c_link), GFP_KERNEL);
+ if (!c_link)
+ return ERR_PTR(-ENOMEM);
+
+ c_link->pdata.source_pad = source_pad;
+ c_link->pdata.sink_pad = sink_pad;
+ strscpy(c_link->source_name, source_name, source_namelen + 1);
+ strscpy(c_link->sink_name, sink_name, sink_namelen + 1);
+
+ /* Configure group */
+ list_add(&c_link->pdata.list, cfs->pdata.links);
+ config_item_init_type_name(&c_link->ci, name, &vimc_cfs_link_type);
+
+ return &c_link->ci;
+
+syntax_error:
+ cg_err(&cfs->gdev,
+ "Couldn't create link %s, wrong syntax.", name);
+ return ERR_PTR(-EINVAL);
+}
+
+/* --------------------------------------------------------------------------
+ * Entities
+ */
+
+/* *TODO: add support for hotplug in entity level */
+
+static int vimc_cfs_drv_cb(const char *drv_name, struct config_group *group)
+{
+ struct vimc_cfs_drv *c_drv = NULL;
+
+ list_for_each_entry(c_drv, &vimc_cfs_subsys.drvs, list) {
+ if (!strcmp(drv_name, c_drv->name))
+ break;
+ }
+ if (!c_drv)
+ return -EINVAL;
+
+ if (c_drv->configfs_cb)
+ c_drv->configfs_cb(group);
+
+ return 0;
+}
+
+static void vimc_cfs_ent_release(struct config_item *item)
+{
+ struct vimc_cfs_ent *c_ent = container_of(item, struct vimc_cfs_ent,
+ cg.cg_item);
+
+ kfree(c_ent);
+}
+
+static struct configfs_item_operations vimc_cfs_ent_item_ops = {
+ .release = vimc_cfs_ent_release,
+};
+
+static struct config_item_type vimc_cfs_ent_type = {
+ .ct_item_ops = &vimc_cfs_ent_item_ops,
+ .ct_owner = THIS_MODULE,
+};
+
+static void vimc_cfs_ent_drop_item(struct config_group *group,
+ struct config_item *item)
+{
+ struct vimc_cfs_ent *c_ent = container_of(item, struct vimc_cfs_ent,
+ cg.cg_item);
+ struct vimc_cfs_device *cfs = container_of(group,
+ struct vimc_cfs_device,
+ gents);
+
+ if (is_plugged(cfs))
+ vimc_cfs_device_unplug(cfs);
+ list_del(&c_ent->list);
+}
+
+static struct config_group *vimc_cfs_ent_make_group(struct config_group *group,
+ const char *name)
+{
+ struct vimc_cfs_device *cfs = container_of(group,
+ struct vimc_cfs_device,
+ gents);
+ const char *drv_name = name;
+ char *ent_name, *sep = strchr(drv_name, CHAR_SEPARATOR);
+ struct vimc_cfs_ent *c_ent;
+ size_t drv_namelen;
+
+ if (is_plugged(cfs))
+ vimc_cfs_device_unplug(cfs);
+
+ /* Parse format "drv_name:ent_name" */
+ if (!sep) {
+ cg_err(&cfs->gdev,
+ "Could not find separator '%c'", CHAR_SEPARATOR);
+ goto syntax_error;
+ }
+ drv_namelen = (size_t)(sep - drv_name);
+ ent_name = &sep[1];
+ if (!*ent_name || !drv_namelen) {
+ cg_err(&cfs->gdev,
+ "%s: Driver name and entity name can't be empty.",
+ name);
+ goto syntax_error;
+ }
+ if (drv_namelen >= sizeof(c_ent->drv)) {
+ cg_err(&cfs->gdev,
+ "%s: Driver name length should be less then %ld.",
+ name, sizeof(c_ent->drv));
+ goto syntax_error;
+ }
+
+ c_ent = kzalloc(sizeof(*c_ent), GFP_KERNEL);
+ if (!c_ent)
+ return ERR_PTR(-ENOMEM);
+
+ /* Configure platform device */
+ strscpy(c_ent->drv, drv_name, drv_namelen + 1);
+ strscpy(c_ent->pdata.name, ent_name, sizeof(c_ent->pdata.name));
+ c_ent->pdata.group = &c_ent->cg;
+
+ cg_dbg(&cfs->gdev, "New entity %s:%s", c_ent->drv, c_ent->pdata.name);
+
+ /* Configure group */
+ config_group_init_type_name(&c_ent->cg, name, &vimc_cfs_ent_type);
+ if (vimc_cfs_drv_cb(c_ent->drv, &c_ent->cg)) {
+ cg_err(&c_ent->cg, "Module %s not found", c_ent->drv);
+ kfree(c_ent);
+ return ERR_PTR(-EINVAL);
+ }
+ list_add(&c_ent->list, &cfs->ents);
+
+ return &c_ent->cg;
+
+syntax_error:
+ cg_err(&cfs->gdev,
+ "Couldn't create entity %s, wrong syntax.", name);
+ return ERR_PTR(-EINVAL);
+}
+
+/* --------------------------------------------------------------------------
+ * Default group: Links
+ */
+
+static struct configfs_group_operations vimc_cfs_dlink_group_ops = {
+ .make_item = vimc_cfs_link_make_item,
+ .drop_item = vimc_cfs_link_drop_item,
+};
+
+static struct config_item_type vimc_cfs_dlink_type = {
+ .ct_group_ops = &vimc_cfs_dlink_group_ops,
+ .ct_owner = THIS_MODULE,
+};
+
+void vimc_cfs_dlink_add_default_group(struct vimc_cfs_device *cfs)
+{
+ config_group_init_type_name(&cfs->glinks, "links",
+ &vimc_cfs_dlink_type);
+ configfs_add_default_group(&cfs->glinks, &cfs->gdev);
+}
+
+/* --------------------------------------------------------------------------
+ * Default group: Entities
+ */
+
+static struct configfs_group_operations vimc_cfs_dent_group_ops = {
+ .make_group = vimc_cfs_ent_make_group,
+ .drop_item = vimc_cfs_ent_drop_item,
+};
+
+static struct config_item_type vimc_cfs_dent_type = {
+ .ct_group_ops = &vimc_cfs_dent_group_ops,
+ .ct_owner = THIS_MODULE,
+};
+
+void vimc_cfs_dent_add_default_group(struct vimc_cfs_device *cfs)
+{
+ config_group_init_type_name(&cfs->gents, "entities",
+ &vimc_cfs_dent_type);
+ configfs_add_default_group(&cfs->gents, &cfs->gdev);
+}
+
+/* --------------------------------------------------------------------------
+ * Device instance
+ */
+
+static int vimc_cfs_decode_state(const char *buf, size_t size)
+{
+ unsigned int i, j;
+
+ for (i = 0; i < ARRAY_SIZE(vimc_cfs_hotplug_values); i++) {
+ for (j = 0; j < ARRAY_SIZE(vimc_cfs_hotplug_values[0]); j++) {
+ if (!strncmp(buf, vimc_cfs_hotplug_values[i][j], size))
+ return i;
+ }
+ }
+ return -EINVAL;
+}
+
+static ssize_t vimc_cfs_dev_attr_hotplug_show(struct config_item *item,
+ char *buf)
+{
+ struct vimc_cfs_device *cfs = container_of(item, struct vimc_cfs_device,
+ gdev.cg_item);
+
+ strcpy(buf, vimc_cfs_hotplug_values[is_plugged(cfs)][0]);
+ return strlen(buf);
+}
+
+static int vimc_cfs_hotplug_set(struct vimc_cfs_device *cfs,
+ enum vimc_cfs_hotplug_state state)
+{
+ if (state == is_plugged(cfs)) {
+ return 0;
+ } else if (state == VIMC_CFS_HOTPLUG_STATE_UNPLUGGED) {
+ vimc_cfs_device_unplug(cfs);
+ return 0;
+ } else if (state == VIMC_CFS_HOTPLUG_STATE_PLUGGED) {
+ return vimc_cfs_device_plug(cfs);
+ }
+ return -EINVAL;
+}
+
+static ssize_t vimc_cfs_dev_attr_hotplug_store(struct config_item *item,
+ const char *buf, size_t size)
+{
+ struct vimc_cfs_device *cfs = container_of(item, struct vimc_cfs_device,
+ gdev.cg_item);
+ int state = vimc_cfs_decode_state(buf, size);
+
+ if (vimc_cfs_hotplug_set(cfs, state))
+ return -EINVAL;
+ return size;
+}
+
+CONFIGFS_ATTR(vimc_cfs_dev_attr_, hotplug);
+
+static struct configfs_attribute *vimc_cfs_dev_attrs[] = {
+ &vimc_cfs_dev_attr_attr_hotplug,
+ NULL,
+};
+
+static void vimc_cfs_dev_release(struct config_item *item)
+{
+ struct vimc_cfs_device *cfs = container_of(item, struct vimc_cfs_device,
+ gdev.cg_item);
+
+ kfree(cfs);
+}
+
+static struct configfs_item_operations vimc_cfs_dev_item_ops = {
+ .release = vimc_cfs_dev_release,
+};
+
+static struct config_item_type vimc_cfs_dev_type = {
+ .ct_item_ops = &vimc_cfs_dev_item_ops,
+ .ct_attrs = vimc_cfs_dev_attrs,
+ .ct_owner = THIS_MODULE,
+};
+
+static void vimc_cfs_dev_drop_item(struct config_group *group,
+ struct config_item *item)
+{
+ struct vimc_cfs_device *cfs = container_of(group,
+ struct vimc_cfs_device,
+ gdev);
+
+ if (is_plugged(cfs))
+ vimc_cfs_device_unplug(cfs);
+}
+
+static struct config_group *vimc_cfs_dev_make_group(
+ struct config_group *group, const char *name)
+{
+ struct vimc_cfs_device *cfs = kzalloc(sizeof(*cfs), GFP_KERNEL);
+
+ if (!cfs)
+ return ERR_PTR(-ENOMEM);
+
+ /* Configure pipeline */
+ INIT_LIST_HEAD(&cfs->ents);
+ INIT_LIST_HEAD(&cfs->links);
+
+ /* Configure platform data */
+ strscpy(cfs->pdata.data.name, name, sizeof(cfs->pdata.data.name));
+ cfs->pdata.data.group = &cfs->gdev;
+ cfs->pdata.links = &cfs->links;
+
+ /* Configure configfs group */
+ config_group_init_type_name(&cfs->gdev, name, &vimc_cfs_dev_type);
+ vimc_cfs_dent_add_default_group(cfs);
+ vimc_cfs_dlink_add_default_group(cfs);
+
+ return &cfs->gdev;
+}
+
+/* --------------------------------------------------------------------------
+ * Subsystem
+ */
+
+static struct configfs_group_operations vimc_cfs_subsys_group_ops = {
+ /* Create vimc devices */
+ .make_group = vimc_cfs_dev_make_group,
+ .drop_item = vimc_cfs_dev_drop_item,
+};
+
+static struct config_item_type vimc_cfs_subsys_type = {
+ .ct_group_ops = &vimc_cfs_subsys_group_ops,
+ .ct_owner = THIS_MODULE,
+};
+
+int vimc_cfs_subsys_register(void)
+{
+ struct configfs_subsystem *subsys = &vimc_cfs_subsys.subsys;
+ int ret;
+
+ INIT_LIST_HEAD(&vimc_cfs_subsys.drvs);
+ config_group_init_type_name(&subsys->su_group, CFS_SUBSYS_NAME,
+ &vimc_cfs_subsys_type);
+ mutex_init(&subsys->su_mutex);
+ ret = configfs_register_subsystem(subsys);
+
+ return ret;
+}
+
+void vimc_cfs_subsys_unregister(void)
+{
+ configfs_unregister_subsystem(&vimc_cfs_subsys.subsys);
+}
diff --git a/drivers/media/platform/vimc/vimc-configfs.h b/drivers/media/platform/vimc/vimc-configfs.h
new file mode 100644
index 000000000000..6278b53d11ba
--- /dev/null
+++ b/drivers/media/platform/vimc/vimc-configfs.h
@@ -0,0 +1,30 @@
+/* SPDX-License-Identifier: GPL-2.0+ */
+/*
+ * vimc-configfs.h Virtual Media Controller Driver
+ *
+ * Copyright (C) 2018 Helen Koike <[email protected]>
+ */
+
+#ifndef _VIMC_CONFIGFS_H_
+#define _VIMC_CONFIGFS_H_
+
+#include <linux/configfs.h>
+
+#define VIMC_CFS_SRC_PAD_NAME(n) "pad:source:" #n
+#define VIMC_CFS_SINK_PAD_NAME(n) "pad:sink:" #n
+
+struct vimc_cfs_drv {
+ const char *name;
+ void (*const configfs_cb)(struct config_group *group);
+ struct list_head list;
+};
+
+int vimc_cfs_subsys_register(void);
+
+void vimc_cfs_subsys_unregister(void);
+
+void vimc_cfs_drv_register(struct vimc_cfs_drv *c_drv);
+
+void vimc_cfs_drv_unregister(struct vimc_cfs_drv *c_drv);
+
+#endif
diff --git a/drivers/media/platform/vimc/vimc-core.c b/drivers/media/platform/vimc/vimc-core.c
index ce809d2e3d53..816015e7c8f6 100644
--- a/drivers/media/platform/vimc/vimc-core.c
+++ b/drivers/media/platform/vimc/vimc-core.c
@@ -23,150 +23,29 @@
#include <media/v4l2-device.h>
#include "vimc-common.h"
-
-#define VIMC_PDEV_NAME "vimc"
-#define VIMC_MDEV_MODEL_NAME "VIMC MDEV"
-
-#define VIMC_ENT_LINK(src, srcpad, sink, sinkpad, link_flags) { \
- .src_ent = src, \
- .src_pad = srcpad, \
- .sink_ent = sink, \
- .sink_pad = sinkpad, \
- .flags = link_flags, \
-}
+#include "vimc-configfs.h"
struct vimc_device {
- /* The platform device */
- struct platform_device pdev;
-
- /* The pipeline configuration */
- const struct vimc_pipeline_config *pipe_cfg;
-
/* The Associated media_device parent */
struct media_device mdev;
/* Internal v4l2 parent device*/
struct v4l2_device v4l2_dev;
-
- /* Subdevices */
- struct platform_device **subdevs;
-};
-
-/* Structure which describes individual configuration for each entity */
-struct vimc_ent_config {
- const char *name;
- const char *drv;
-};
-
-/* Structure which describes links between entities */
-struct vimc_ent_link {
- unsigned int src_ent;
- u16 src_pad;
- unsigned int sink_ent;
- u16 sink_pad;
- u32 flags;
-};
-
-/* Structure which describes the whole topology */
-struct vimc_pipeline_config {
- const struct vimc_ent_config *ents;
- size_t num_ents;
- const struct vimc_ent_link *links;
- size_t num_links;
-};
-
-/* --------------------------------------------------------------------------
- * Topology Configuration
- */
-
-static const struct vimc_ent_config ent_config[] = {
- {
- .name = "Sensor A",
- .drv = "vimc-sensor",
- },
- {
- .name = "Sensor B",
- .drv = "vimc-sensor",
- },
- {
- .name = "Debayer A",
- .drv = "vimc-debayer",
- },
- {
- .name = "Debayer B",
- .drv = "vimc-debayer",
- },
- {
- .name = "Raw Capture 0",
- .drv = "vimc-capture",
- },
- {
- .name = "Raw Capture 1",
- .drv = "vimc-capture",
- },
- {
- .name = "RGB/YUV Input",
- /* TODO: change this to vimc-input when it is implemented */
- .drv = "vimc-sensor",
- },
- {
- .name = "Scaler",
- .drv = "vimc-scaler",
- },
- {
- .name = "RGB/YUV Capture",
- .drv = "vimc-capture",
- },
-};
-
-static const struct vimc_ent_link ent_links[] = {
- /* Link: Sensor A (Pad 0)->(Pad 0) Debayer A */
- VIMC_ENT_LINK(0, 0, 2, 0, MEDIA_LNK_FL_ENABLED | MEDIA_LNK_FL_IMMUTABLE),
- /* Link: Sensor A (Pad 0)->(Pad 0) Raw Capture 0 */
- VIMC_ENT_LINK(0, 0, 4, 0, MEDIA_LNK_FL_ENABLED | MEDIA_LNK_FL_IMMUTABLE),
- /* Link: Sensor B (Pad 0)->(Pad 0) Debayer B */
- VIMC_ENT_LINK(1, 0, 3, 0, MEDIA_LNK_FL_ENABLED | MEDIA_LNK_FL_IMMUTABLE),
- /* Link: Sensor B (Pad 0)->(Pad 0) Raw Capture 1 */
- VIMC_ENT_LINK(1, 0, 5, 0, MEDIA_LNK_FL_ENABLED | MEDIA_LNK_FL_IMMUTABLE),
- /* Link: Debayer A (Pad 1)->(Pad 0) Scaler */
- VIMC_ENT_LINK(2, 1, 7, 0, MEDIA_LNK_FL_ENABLED),
- /* Link: Debayer B (Pad 1)->(Pad 0) Scaler */
- VIMC_ENT_LINK(3, 1, 7, 0, 0),
- /* Link: RGB/YUV Input (Pad 0)->(Pad 0) Scaler */
- VIMC_ENT_LINK(6, 0, 7, 0, 0),
- /* Link: Scaler (Pad 1)->(Pad 0) RGB/YUV Capture */
- VIMC_ENT_LINK(7, 1, 8, 0, MEDIA_LNK_FL_ENABLED | MEDIA_LNK_FL_IMMUTABLE),
-};
-
-static const struct vimc_pipeline_config pipe_cfg = {
- .ents = ent_config,
- .num_ents = ARRAY_SIZE(ent_config),
- .links = ent_links,
- .num_links = ARRAY_SIZE(ent_links)
};
-/* -------------------------------------------------------------------------- */
-
-static int vimc_create_links(struct vimc_device *vimc)
+static int vimc_core_links_create(const struct device *master)
{
- unsigned int i;
+ struct vimc_platform_data_core *pdata = master->platform_data;
+ struct vimc_ent_device *ved_src, *ved_sink;
+ struct vimc_platform_data_link *plink;
int ret;
- /* Initialize the links between entities */
- for (i = 0; i < vimc->pipe_cfg->num_links; i++) {
- const struct vimc_ent_link *link = &vimc->pipe_cfg->links[i];
- /*
- * TODO: Check another way of retrieving ved struct without
- * relying on platform_get_drvdata
- */
- struct vimc_ent_device *ved_src =
- platform_get_drvdata(vimc->subdevs[link->src_ent]);
- struct vimc_ent_device *ved_sink =
- platform_get_drvdata(vimc->subdevs[link->sink_ent]);
-
- ret = media_create_pad_link(ved_src->ent, link->src_pad,
- ved_sink->ent, link->sink_pad,
- link->flags);
+ list_for_each_entry(plink, pdata->links, list) {
+ ved_src = platform_get_drvdata(plink->source);
+ ved_sink = platform_get_drvdata(plink->sink);
+ ret = media_create_pad_link(ved_src->ent, plink->source_pad,
+ ved_sink->ent, plink->sink_pad,
+ plink->flags);
if (ret)
return ret;
}
@@ -174,10 +53,10 @@ static int vimc_create_links(struct vimc_device *vimc)
return 0;
}
-static int vimc_comp_bind(struct device *master)
+int vimc_core_comp_bind(struct device *master)
{
- struct vimc_device *vimc = container_of(to_platform_device(master),
- struct vimc_device, pdev);
+ struct vimc_device *vimc =
+ platform_get_drvdata(to_platform_device(master));
int ret;
dev_dbg(master, "bind");
@@ -194,9 +73,7 @@ static int vimc_comp_bind(struct device *master)
ret = component_bind_all(master, &vimc->v4l2_dev);
if (ret)
goto err_v4l2_unregister;
-
- /* Initialize links */
- ret = vimc_create_links(vimc);
+ ret = vimc_core_links_create(master);
if (ret)
goto err_comp_unbind_all;
@@ -228,11 +105,12 @@ static int vimc_comp_bind(struct device *master)
return ret;
}
+EXPORT_SYMBOL_GPL(vimc_core_comp_bind);
-static void vimc_comp_unbind(struct device *master)
+void vimc_core_comp_unbind(struct device *master)
{
- struct vimc_device *vimc = container_of(to_platform_device(master),
- struct vimc_device, pdev);
+ struct vimc_device *vimc =
+ platform_get_drvdata(to_platform_device(master));
dev_dbg(master, "unbind");
@@ -240,147 +118,56 @@ static void vimc_comp_unbind(struct device *master)
component_unbind_all(master, NULL);
v4l2_device_unregister(&vimc->v4l2_dev);
}
-
-static int vimc_comp_compare(struct device *comp, void *data)
-{
- const struct platform_device *pdev = to_platform_device(comp);
- const char *name = data;
-
- return !strcmp(pdev->dev.platform_data, name);
-}
-
-static struct component_match *vimc_add_subdevs(struct vimc_device *vimc)
-{
- struct component_match *match = NULL;
- struct vimc_platform_data pdata;
- int i;
-
- for (i = 0; i < vimc->pipe_cfg->num_ents; i++) {
- dev_dbg(&vimc->pdev.dev, "new pdev for %s\n",
- vimc->pipe_cfg->ents[i].drv);
-
- strscpy(pdata.entity_name, vimc->pipe_cfg->ents[i].name,
- sizeof(pdata.entity_name));
-
- vimc->subdevs[i] = platform_device_register_data(&vimc->pdev.dev,
- vimc->pipe_cfg->ents[i].drv,
- PLATFORM_DEVID_AUTO,
- &pdata,
- sizeof(pdata));
- if (IS_ERR(vimc->subdevs[i])) {
- match = ERR_CAST(vimc->subdevs[i]);
- while (--i >= 0)
- platform_device_unregister(vimc->subdevs[i]);
-
- return match;
- }
-
- component_match_add(&vimc->pdev.dev, &match, vimc_comp_compare,
- (void *)vimc->pipe_cfg->ents[i].name);
- }
-
- return match;
-}
-
-static void vimc_rm_subdevs(struct vimc_device *vimc)
-{
- unsigned int i;
-
- for (i = 0; i < vimc->pipe_cfg->num_ents; i++)
- platform_device_unregister(vimc->subdevs[i]);
-}
-
-static const struct component_master_ops vimc_comp_ops = {
- .bind = vimc_comp_bind,
- .unbind = vimc_comp_unbind,
-};
+EXPORT_SYMBOL_GPL(vimc_core_comp_unbind);
static int vimc_probe(struct platform_device *pdev)
{
- struct vimc_device *vimc = container_of(pdev, struct vimc_device, pdev);
- struct component_match *match = NULL;
- int ret;
+ const struct vimc_platform_data_core *pdata = pdev->dev.platform_data;
+ struct vimc_device *vimc = devm_kzalloc(&pdev->dev, sizeof(*vimc),
+ GFP_KERNEL);
dev_dbg(&pdev->dev, "probe");
- /* Create platform_device for each entity in the topology*/
- vimc->subdevs = devm_kcalloc(&vimc->pdev.dev, vimc->pipe_cfg->num_ents,
- sizeof(*vimc->subdevs), GFP_KERNEL);
- if (!vimc->subdevs)
- return -ENOMEM;
-
- match = vimc_add_subdevs(vimc);
- if (IS_ERR(match))
- return PTR_ERR(match);
-
- /* Link the media device within the v4l2_device */
- vimc->v4l2_dev.mdev = &vimc->mdev;
-
/* Initialize media device */
- strscpy(vimc->mdev.model, VIMC_MDEV_MODEL_NAME,
- sizeof(vimc->mdev.model));
+ strscpy(vimc->mdev.model, pdata->data.name, sizeof(vimc->mdev.model));
vimc->mdev.dev = &pdev->dev;
media_device_init(&vimc->mdev);
+ vimc->v4l2_dev.mdev = &vimc->mdev;
- /* Add self to the component system */
- ret = component_master_add_with_match(&pdev->dev, &vimc_comp_ops,
- match);
- if (ret) {
- media_device_cleanup(&vimc->mdev);
- vimc_rm_subdevs(vimc);
- return ret;
- }
+ platform_set_drvdata(pdev, vimc);
return 0;
}
static int vimc_remove(struct platform_device *pdev)
{
- struct vimc_device *vimc = container_of(pdev, struct vimc_device, pdev);
+ struct vimc_device *vimc = platform_get_drvdata(pdev);
dev_dbg(&pdev->dev, "remove");
- component_master_del(&pdev->dev, &vimc_comp_ops);
- vimc_rm_subdevs(vimc);
+ media_device_cleanup(&vimc->mdev);
return 0;
}
-static void vimc_dev_release(struct device *dev)
-{
-}
-
-static struct vimc_device vimc_dev = {
- .pipe_cfg = &pipe_cfg,
- .pdev = {
- .name = VIMC_PDEV_NAME,
- .dev.release = vimc_dev_release,
- }
-};
-
static struct platform_driver vimc_pdrv = {
.probe = vimc_probe,
.remove = vimc_remove,
.driver = {
- .name = VIMC_PDEV_NAME,
- },
+ .name = "vimc-core",
+ }
};
static int __init vimc_init(void)
{
int ret;
- ret = platform_device_register(&vimc_dev.pdev);
- if (ret) {
- dev_err(&vimc_dev.pdev.dev,
- "platform device registration failed (err=%d)\n", ret);
+ ret = platform_driver_register(&vimc_pdrv);
+ if (ret)
return ret;
- }
- ret = platform_driver_register(&vimc_pdrv);
+ ret = vimc_cfs_subsys_register();
if (ret) {
- dev_err(&vimc_dev.pdev.dev,
- "platform driver registration failed (err=%d)\n", ret);
platform_driver_unregister(&vimc_pdrv);
return ret;
}
@@ -390,9 +177,9 @@ static int __init vimc_init(void)
static void __exit vimc_exit(void)
{
- platform_driver_unregister(&vimc_pdrv);
+ vimc_cfs_subsys_unregister();
- platform_device_unregister(&vimc_dev.pdev);
+ platform_driver_unregister(&vimc_pdrv);
}
module_init(vimc_init);
diff --git a/drivers/media/platform/vimc/vimc-core.h b/drivers/media/platform/vimc/vimc-core.h
new file mode 100644
index 000000000000..42c8f92354af
--- /dev/null
+++ b/drivers/media/platform/vimc/vimc-core.h
@@ -0,0 +1,17 @@
+/* SPDX-License-Identifier: GPL-2.0+ */
+/*
+ * vimc-core.h Virtual Media Controller Driver
+ *
+ * Copyright (C) 2018 Helen Koike <[email protected]>
+ */
+
+#ifndef _VIMC_CORE_H_
+#define _VIMC_CORE_H_
+
+#define VIMC_CORE_PDEV_NAME "vimc-core"
+
+int vimc_core_comp_bind(struct device *master);
+
+void vimc_core_comp_unbind(struct device *master);
+
+#endif
diff --git a/drivers/media/platform/vimc/vimc-debayer.c b/drivers/media/platform/vimc/vimc-debayer.c
index 77887f66f323..fa326dbb7562 100644
--- a/drivers/media/platform/vimc/vimc-debayer.c
+++ b/drivers/media/platform/vimc/vimc-debayer.c
@@ -23,6 +23,7 @@
#include <linux/v4l2-mediabus.h>
#include <media/v4l2-subdev.h>
+#include "vimc-configfs.h"
#include "vimc-common.h"
#define VIMC_DEB_DRV_NAME "vimc-debayer"
@@ -522,7 +523,7 @@ static int vimc_deb_comp_bind(struct device *comp, struct device *master,
void *master_data)
{
struct v4l2_device *v4l2_dev = master_data;
- struct vimc_platform_data *pdata = comp->platform_data;
+ struct vimc_platform_data *pdata = dev_get_platdata(comp);
struct vimc_deb_device *vdeb;
int ret;
@@ -532,8 +533,7 @@ static int vimc_deb_comp_bind(struct device *comp, struct device *master,
return -ENOMEM;
/* Initialize ved and sd */
- ret = vimc_ent_sd_register(&vdeb->ved, &vdeb->sd, v4l2_dev,
- pdata->entity_name,
+ ret = vimc_ent_sd_register(&vdeb->ved, &vdeb->sd, v4l2_dev, pdata->name,
MEDIA_ENT_F_PROC_VIDEO_PIXEL_ENC_CONV, 2,
(const unsigned long[2]) {MEDIA_PAD_FL_SINK,
MEDIA_PAD_FL_SOURCE},
@@ -594,7 +594,50 @@ static struct platform_driver vimc_deb_pdrv = {
},
};
-module_platform_driver(vimc_deb_pdrv);
+static struct config_item_type vimc_deb_cfs_pad_type = {
+ .ct_owner = THIS_MODULE,
+};
+
+static struct config_group vimc_deb_cfs_sink_pad_group;
+static struct config_group vimc_deb_cfs_src_pad_group;
+
+static void vimc_deb_configfs_cb(struct config_group *group)
+{
+ config_group_init_type_name(&vimc_deb_cfs_sink_pad_group,
+ VIMC_CFS_SINK_PAD_NAME(0),
+ &vimc_deb_cfs_pad_type);
+ configfs_add_default_group(&vimc_deb_cfs_sink_pad_group, group);
+
+ config_group_init_type_name(&vimc_deb_cfs_src_pad_group,
+ VIMC_CFS_SRC_PAD_NAME(1),
+ &vimc_deb_cfs_pad_type);
+ configfs_add_default_group(&vimc_deb_cfs_src_pad_group, group);
+}
+
+struct vimc_cfs_drv vimc_deb_cfs_drv = {
+ .name = VIMC_DEB_DRV_NAME,
+ .configfs_cb = vimc_deb_configfs_cb,
+};
+
+static int __init vimc_deb_init(void)
+{
+ int ret = platform_driver_register(&vimc_deb_pdrv);
+
+ if (ret)
+ return ret;
+
+ vimc_cfs_drv_register(&vimc_deb_cfs_drv);
+ return 0;
+}
+
+static void __exit vimc_deb_exit(void)
+{
+ platform_driver_unregister(&vimc_deb_pdrv);
+ vimc_cfs_drv_unregister(&vimc_deb_cfs_drv);
+}
+
+module_init(vimc_deb_init);
+module_exit(vimc_deb_exit);
MODULE_DEVICE_TABLE(platform, vimc_deb_driver_ids);
diff --git a/drivers/media/platform/vimc/vimc-scaler.c b/drivers/media/platform/vimc/vimc-scaler.c
index b0952ee86296..efb29384197d 100644
--- a/drivers/media/platform/vimc/vimc-scaler.c
+++ b/drivers/media/platform/vimc/vimc-scaler.c
@@ -23,6 +23,7 @@
#include <linux/v4l2-mediabus.h>
#include <media/v4l2-subdev.h>
+#include "vimc-configfs.h"
#include "vimc-common.h"
#define VIMC_SCA_DRV_NAME "vimc-scaler"
@@ -394,8 +395,7 @@ static int vimc_sca_comp_bind(struct device *comp, struct device *master,
return -ENOMEM;
/* Initialize ved and sd */
- ret = vimc_ent_sd_register(&vsca->ved, &vsca->sd, v4l2_dev,
- pdata->entity_name,
+ ret = vimc_ent_sd_register(&vsca->ved, &vsca->sd, v4l2_dev, pdata->name,
MEDIA_ENT_F_PROC_VIDEO_SCALER, 2,
(const unsigned long[2]) {MEDIA_PAD_FL_SINK,
MEDIA_PAD_FL_SOURCE},
@@ -448,7 +448,50 @@ static struct platform_driver vimc_sca_pdrv = {
},
};
-module_platform_driver(vimc_sca_pdrv);
+static struct config_item_type vimc_sca_cfs_pad_type = {
+ .ct_owner = THIS_MODULE,
+};
+
+static struct config_group vimc_sca_cfs_sink_pad_group;
+static struct config_group vimc_sca_cfs_src_pad_group;
+
+static void vimc_sca_configfs_cb(struct config_group *group)
+{
+ config_group_init_type_name(&vimc_sca_cfs_sink_pad_group,
+ VIMC_CFS_SINK_PAD_NAME(0),
+ &vimc_sca_cfs_pad_type);
+ configfs_add_default_group(&vimc_sca_cfs_sink_pad_group, group);
+
+ config_group_init_type_name(&vimc_sca_cfs_src_pad_group,
+ VIMC_CFS_SRC_PAD_NAME(1),
+ &vimc_sca_cfs_pad_type);
+ configfs_add_default_group(&vimc_sca_cfs_src_pad_group, group);
+}
+
+struct vimc_cfs_drv vimc_sca_cfs_drv = {
+ .name = VIMC_SCA_DRV_NAME,
+ .configfs_cb = vimc_sca_configfs_cb,
+};
+
+static int __init vimc_sca_init(void)
+{
+ int ret = platform_driver_register(&vimc_sca_pdrv);
+
+ if (ret)
+ return ret;
+
+ vimc_cfs_drv_register(&vimc_sca_cfs_drv);
+ return 0;
+}
+
+static void __exit vimc_sca_exit(void)
+{
+ platform_driver_unregister(&vimc_sca_pdrv);
+ vimc_cfs_drv_unregister(&vimc_sca_cfs_drv);
+}
+
+module_init(vimc_sca_init);
+module_exit(vimc_sca_exit);
MODULE_DEVICE_TABLE(platform, vimc_sca_driver_ids);
diff --git a/drivers/media/platform/vimc/vimc-sensor.c b/drivers/media/platform/vimc/vimc-sensor.c
index 32ca9c6172b1..37540e72c6bc 100644
--- a/drivers/media/platform/vimc/vimc-sensor.c
+++ b/drivers/media/platform/vimc/vimc-sensor.c
@@ -28,6 +28,7 @@
#include <media/v4l2-subdev.h>
#include <media/tpg/v4l2-tpg.h>
+#include "vimc-configfs.h"
#include "vimc-common.h"
#define VIMC_SEN_DRV_NAME "vimc-sensor"
@@ -405,8 +406,7 @@ static int vimc_sen_comp_bind(struct device *comp, struct device *master,
}
/* Initialize ved and sd */
- ret = vimc_ent_sd_register(&vsen->ved, &vsen->sd, v4l2_dev,
- pdata->entity_name,
+ ret = vimc_ent_sd_register(&vsen->ved, &vsen->sd, v4l2_dev, pdata->name,
MEDIA_ENT_F_CAM_SENSOR, 1,
(const unsigned long[1]) {MEDIA_PAD_FL_SOURCE},
&vimc_sen_ops);
@@ -471,7 +471,44 @@ static struct platform_driver vimc_sen_pdrv = {
},
};
-module_platform_driver(vimc_sen_pdrv);
+static struct config_item_type vimc_sen_cfs_pad_type = {
+ .ct_owner = THIS_MODULE,
+};
+
+static struct config_group vimc_sen_cfs_src_pad_group;
+
+static void vimc_sen_configfs_cb(struct config_group *group)
+{
+ config_group_init_type_name(&vimc_sen_cfs_src_pad_group,
+ VIMC_CFS_SRC_PAD_NAME(0),
+ &vimc_sen_cfs_pad_type);
+ configfs_add_default_group(&vimc_sen_cfs_src_pad_group, group);
+}
+
+struct vimc_cfs_drv vimc_sen_cfs_drv = {
+ .name = VIMC_SEN_DRV_NAME,
+ .configfs_cb = vimc_sen_configfs_cb,
+};
+
+static int __init vimc_sen_init(void)
+{
+ int ret = platform_driver_register(&vimc_sen_pdrv);
+
+ if (ret)
+ return ret;
+
+ vimc_cfs_drv_register(&vimc_sen_cfs_drv);
+ return 0;
+}
+
+static void __exit vimc_sen_exit(void)
+{
+ platform_driver_unregister(&vimc_sen_pdrv);
+ vimc_cfs_drv_unregister(&vimc_sen_cfs_drv);
+}
+
+module_init(vimc_sen_init);
+module_exit(vimc_sen_exit);
MODULE_DEVICE_TABLE(platform, vimc_sen_driver_ids);
--
2.19.1
Hi Helen,
I love your patch! Perhaps something to improve:
[auto build test WARNING on linuxtv-media/master]
[also build test WARNING on v4.20-rc5 next-20181207]
[if your patch is applied to the wrong git tree, please drop us a note to help improve the system]
url: https://github.com/0day-ci/linux/commits/Helen-Koike/media-vimc-add-configfs-API-to-configure-the-topology/20181208-071726
base: git://linuxtv.org/media_tree.git master
config: arm-allmodconfig (attached as .config)
compiler: arm-linux-gnueabi-gcc (Debian 7.2.0-11) 7.2.0
reproduce:
wget https://raw.githubusercontent.com/intel/lkp-tests/master/sbin/make.cross -O ~/bin/make.cross
chmod +x ~/bin/make.cross
# save the attached .config to linux build tree
GCC_VERSION=7.2.0 make.cross ARCH=arm
All warnings (new ones prefixed by >>):
In file included from include/linux/printk.h:7:0,
from include/linux/kernel.h:14,
from include/linux/list.h:9,
from include/linux/module.h:9,
from drivers/media//platform/vimc/vimc-configfs.c:9:
drivers/media//platform/vimc/vimc-configfs.c: In function 'vimc_cfs_link_make_item':
include/linux/kern_levels.h:5:18: warning: format '%ld' expects argument of type 'long int', but argument 3 has type 'unsigned int' [-Wformat=]
#define KERN_SOH "\001" /* ASCII Start Of Header */
^
include/linux/kern_levels.h:11:18: note: in expansion of macro 'KERN_SOH'
#define KERN_ERR KERN_SOH "3" /* error conditions */
^~~~~~~~
include/linux/printk.h:308:9: note: in expansion of macro 'KERN_ERR'
printk(KERN_ERR pr_fmt(fmt), ##__VA_ARGS__)
^~~~~~~~
>> drivers/media//platform/vimc/vimc-configfs.c:22:2: note: in expansion of macro 'pr_err'
pr_err("vimc: %s: " pr_fmt(fmt), (ci)->ci_name, ##__VA_ARGS__)
^~~~~~
>> drivers/media//platform/vimc/vimc-configfs.c:23:25: note: in expansion of macro 'ci_err'
#define cg_err(cg, ...) ci_err(&(cg)->cg_item, ##__VA_ARGS__)
^~~~~~
>> drivers/media//platform/vimc/vimc-configfs.c:323:3: note: in expansion of macro 'cg_err'
cg_err(&cfs->gdev,
^~~~~~
drivers/media//platform/vimc/vimc-configfs.c:324:32: note: format string is defined here
"Pad with more then %ld digits is not supported",
~~^
%d
In file included from include/linux/printk.h:7:0,
from include/linux/kernel.h:14,
from include/linux/list.h:9,
from include/linux/module.h:9,
from drivers/media//platform/vimc/vimc-configfs.c:9:
drivers/media//platform/vimc/vimc-configfs.c: In function 'vimc_cfs_ent_make_group':
include/linux/kern_levels.h:5:18: warning: format '%ld' expects argument of type 'long int', but argument 4 has type 'unsigned int' [-Wformat=]
#define KERN_SOH "\001" /* ASCII Start Of Header */
^
include/linux/kern_levels.h:11:18: note: in expansion of macro 'KERN_SOH'
#define KERN_ERR KERN_SOH "3" /* error conditions */
^~~~~~~~
include/linux/printk.h:308:9: note: in expansion of macro 'KERN_ERR'
printk(KERN_ERR pr_fmt(fmt), ##__VA_ARGS__)
^~~~~~~~
>> drivers/media//platform/vimc/vimc-configfs.c:22:2: note: in expansion of macro 'pr_err'
pr_err("vimc: %s: " pr_fmt(fmt), (ci)->ci_name, ##__VA_ARGS__)
^~~~~~
>> drivers/media//platform/vimc/vimc-configfs.c:23:25: note: in expansion of macro 'ci_err'
#define cg_err(cg, ...) ci_err(&(cg)->cg_item, ##__VA_ARGS__)
^~~~~~
drivers/media//platform/vimc/vimc-configfs.c:443:3: note: in expansion of macro 'cg_err'
cg_err(&cfs->gdev,
^~~~~~
drivers/media//platform/vimc/vimc-configfs.c:444:56: note: format string is defined here
"%s: Driver name length should be less then %ld.",
~~^
%d
vim +/pr_err +22 drivers/media//platform/vimc/vimc-configfs.c
20
21 #define ci_err(ci, fmt, ...) \
> 22 pr_err("vimc: %s: " pr_fmt(fmt), (ci)->ci_name, ##__VA_ARGS__)
> 23 #define cg_err(cg, ...) ci_err(&(cg)->cg_item, ##__VA_ARGS__)
24 #define ci_warn(ci, fmt, ...) \
25 pr_warn("vimc: %s: " pr_fmt(fmt), (ci)->ci_name, ##__VA_ARGS__)
26 #define cg_warn(cg, ...) ci_warn(&(cg)->cg_item, ##__VA_ARGS__)
27 #define ci_dbg(ci, fmt, ...) \
28 pr_debug("vimc: %s: " pr_fmt(fmt), (ci)->ci_name, ##__VA_ARGS__)
29 #define cg_dbg(cg, ...) ci_dbg(&(cg)->cg_item, ##__VA_ARGS__)
30
---
0-DAY kernel test infrastructure Open Source Technology Center
https://lists.01.org/pipermail/kbuild-all Intel Corporation
On 12/7/18 7:22 PM, Helen Koike wrote:
> Add API to allow userspace to create any type of topology in vimc using
> basic system calls such as mkdir/rmdir/read/write.
>
> Signed-off-by: Helen Koike <[email protected]>
>
> ---
> Hi,
>
> This patch introduces the configufs API for configuring the topology in
> vimc while it removes the hardcoded topology, so now, when you load the
> module you need to create a device (no device will appear in your system
> by default) using mkdir/rmdir/write/read.
> Please see documentation in the patch.
> I was thinking in adding a device by default, but if I do it in
> configfs, userspace won't be able to delete the device (which might not
> be a problem), as I need to create it as a "default" group in configfs,
> or I can just not expose the default device in the configfs.
> What do you think?
I don't like the idea of having a special default device.
So I think the way this patch does it is fine.
>
> Thanks
> Helen
>
> Documentation/media/v4l-drivers/vimc.rst | 172 +++++
> drivers/media/platform/vimc/Kconfig | 7 +-
> drivers/media/platform/vimc/Makefile | 7 +-
> drivers/media/platform/vimc/vimc-capture.c | 46 +-
> drivers/media/platform/vimc/vimc-common.h | 58 +-
> drivers/media/platform/vimc/vimc-configfs.c | 665 ++++++++++++++++++++
> drivers/media/platform/vimc/vimc-configfs.h | 30 +
> drivers/media/platform/vimc/vimc-core.c | 283 ++-------
> drivers/media/platform/vimc/vimc-core.h | 17 +
> drivers/media/platform/vimc/vimc-debayer.c | 51 +-
> drivers/media/platform/vimc/vimc-scaler.c | 49 +-
> drivers/media/platform/vimc/vimc-sensor.c | 43 +-
> 12 files changed, 1153 insertions(+), 275 deletions(-)
> create mode 100644 Documentation/media/v4l-drivers/vimc.rst
> create mode 100644 drivers/media/platform/vimc/vimc-configfs.c
> create mode 100644 drivers/media/platform/vimc/vimc-configfs.h
> create mode 100644 drivers/media/platform/vimc/vimc-core.h
>
> diff --git a/Documentation/media/v4l-drivers/vimc.rst b/Documentation/media/v4l-drivers/vimc.rst
> new file mode 100644
> index 000000000000..28d3b02c7d30
> --- /dev/null
> +++ b/Documentation/media/v4l-drivers/vimc.rst
> @@ -0,0 +1,172 @@
> +The Virtual Media Controller Driver (vimc)
> +=========================================
> +
> +This driver emulates video4linux hardware of varios media topologies. It exposes
varios -> various
> +media devices through /dev/mediaX notes, video capture devices through
notes -> nodes
> +/dev/videoX and sub-devices through /dev/v4l-subdevX.
I'd add 'nodes' after videoX and v4l-subdevX as well.
> +
> +A subdevice can be a sensor, a debayer or a scaler.
> +
> +To configure a media device of a given topology, a ConfigFS API is provided.
> +
> +
> +Configuring the driver through ConfigFS (Experimental)
> +------------------------------------------------------
> +
> +.. note::
> +This API is not finished yet and might change in the future.
> +
> +Mount configfs:
> +::
> + $ mkdir /configfs
> + $ mount -t configfs none /configfs
> +
> +When loading the module, you see a folders name vimc
> +::
> + $ tree /configfs/
> + /configfs/
> + `-- vimc
> +
> +1) Creating a media device
> +~~~~~~~~~~~~~~~~~~~~~~~~~~
> +
> +To create a media device just create a new folder under /configfs/vimc/
> +
> +Example:
> +::
> + $ mkdir /configfs/vimc/mdev
> + $ tree /configfs/vimc/mdev
> + /configfs/vimc/mdev/
> + |-- entities/
> + |-- hotplug
> + `-- links/
> +
> + 2 directories, 1 file
> +
> +2) Creating entities
> +~~~~~~~~~~~~~~~~~~~~
> +
> +To create an entity in the media device's topology, just create a folder under
> +/configfs/vimc/<mdev-name>/entities/ with the following format:
> +
> + <sub-module>:<name>
> +
> +Where <sub-module> is one of the following:
> +::
> + vimc-sensor
> + vimc-scaler
> + vimc-debayer
> + vimc-capture
> +
> +Example:
> +::
> + $ mkdir /configfs/vimc/mdev/entities/vimc-sensor:my-sensor
> + $ mkdir /configfs/vimc/mdev/entities/vimc-capture:my-capture
> + $ tree /configfs/
> + /configfs/
> + `-- vimc/
> + `-- mdev/
> + |-- entities/
> + | |-- vimc-capture:my-capture/
> + | | `-- pad:sink:0/
> + | `-- vimc-sensor:my-sensor/
> + | `-- pad:source:0/
> + |-- hotplug
> + `-- links/
> +
> + 8 directories, 1 file
> +
> +3) Creating links
> +~~~~~~~~~~~~~~~~~
> +
> +To create links between two entities in the topology, just create a folder under
> +/configfs/vimc/<mdev-name>/links/ with the following format:
> +
> + "<entity1-name><pad-source>:<entity2-name><pad-sink>"
> +
> +Example:
> +::
> + $ mkdir "/configfs/vimc/mdev/links/my-sensor:0->my-capture:0"
> + $ tree /configfs
> + /configfs/
> + `-- vimc/
> + `-- mdev/
> + |-- entities/
> + | |-- vimc-capture:my-capture/
> + | | `-- pad:sink:0/
> + | `-- vimc-sensor:my-sensor/
> + | `-- pad:source:0/
> + |-- hotplug
> + `-- links/
> + `-- my-sensor:0->my-capture:0/
> + `-- flags
> +
> + 9 directories, 2 files
> +
> +Change the attributes of the link by writing in the file
> +"/configfs/vimc/<mdev-name>/links/<my-link>/flags"
> +
> +Flag values are defined in :ref:`include/uapi/linux/media.h <media_header>`
> +( seek for ``MEDIA_LNK_FL_*``)
> +
> +1 - Enabled
> + Indicates the link will be enabled when the media device is created.
> +
> +3 - Enabled and Immutable
> + Indicates that the link enabled state can't be modified at runtime.
> +
> +Example:
> +::
> + $ echo 3 > "/configfs/vimc/mdev/links/my-sensor:0->my-capture:0/flags"
> +
> +4) Activating/Deactivating device
> +~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
> +
> +To activate the device, write one of "plugged", "plug" or "1" to file
> +/configfs/vimc/<ndev-name>/hotplug
> +
> +Example:
> +::
> + $ echo 1 > /configfs/vimc/mdev/hotplug
> +
> +You should see a new node /dev/mediaX in your devfs.
> +
> +To deactivate the device, write one of "unplugged", "unplug" or "0" to file
> +/configfs/vimc/<ndev-name>/hotplug
> +
> +Example:
> +::
> + $ echo 0 > /configfs/vimc/mdev/hotplug
> +
> +Subdevices
> +----------
> +
> +Subdevices defines the behavior of an entity in the topology. Depending on the
defines -> define
> +subdevice, the entity can have multiple pads of type source or sink.
> +
> +vimc-sensor:
> + Generates images in several formats using video test pattern generator.
> + Exposes:
> +
> + * 1 Pad source
> +
> +vimc-debayer:
> + Transforms images in bayer format into a non bayer format.
non bayer -> non-bayer
> + Exposes:
> +
> + * 1 Pad sink
> + * 1 Pad source
> +
> +vimc-scaler:
> + Mutiplies the size of the image by 3.
Mutiplies -> Multiplies
This needs clarification: does this mean that the width and height are both
multiplied by three? So the size is then multiplied by 9!
So this is a fixed scaler, i.e. the scaling factors cannot be changed, right?
If so, then that should be clearly stated here.
> + Exposes:
> +
> + * 1 Pad sink
> + * 1 Pad source
> +
> +vimc-capture:
> + Exposes node /dev/videoX to allow userspace to capture the stream.
> + Exposes:
> +
> + * 1 Pad sink
> + * 1 Pad source
What you need to add to this document are a few example topologies.
I'm thinking one simple pipeline (sensor -> debayer -> scaler -> vimc-capture)
and a complex one, something that looks closer to the OMAP3 pipeline.
That would be very helpful, and the complex version can also serve as the
example for testing regressions.
Laurent gave me an omap3 topology (as was used in Nokia phones):
https://hverkuil.home.xs4all.nl/omap3-mc.jpg
CCP2 is effectively (for vimc purposes) similar to CSI2.
The CCDC handles BT.656, lens shading correction, black level compensation and some form
of dead pixel correction (thanks Laurent!), but in vimc terms it really acts like a
splitter, taking one input and splitting it over two outputs.
The previewer is effectively similar to a debayer block.
AEWB, AF and histogram are for auto-whitebalance, autofocus and histogram statistics.
This isn't supported by vimc, and is a 'nice-to-have' for the future.
The main missing bits in vimc are a CSI block and a splitter block. It should be simple
to add the CSI block since it really doesn't do anything in an emulated environment.
A splitter might be more complicated, I'm not sure.
An initial version could start with a sensor -> debayer -> scaler -> video capture
but with support to bypass the debayer and/or scaler blocks, and adding video capture
nodes for the sensor and debayer blocks.
If it is as easy as I think it is to add a csi entity, then that would make it
easier to closely emulate the omap3. And even better with a splitter :-)
CSI blocks are very common, so that would be very nice to add.
> diff --git a/drivers/media/platform/vimc/Kconfig b/drivers/media/platform/vimc/Kconfig
> index 71c9fe7d3370..7f1fb550d4c3 100644
> --- a/drivers/media/platform/vimc/Kconfig
> +++ b/drivers/media/platform/vimc/Kconfig
> @@ -1,15 +1,14 @@
> config VIDEO_VIMC
> tristate "Virtual Media Controller Driver (VIMC)"
> - depends on VIDEO_DEV && VIDEO_V4L2 && VIDEO_V4L2_SUBDEV_API
> + depends on VIDEO_DEV && VIDEO_V4L2 && VIDEO_V4L2_SUBDEV_API && CONFIGFS_FS
> select VIDEOBUF2_VMALLOC
> select VIDEO_V4L2_TPG
> default n
> ---help---
> - Skeleton driver for Virtual Media Controller
> + Virtual Media Controller Driver
>
> This driver can be compared to the vivid driver for emulating
I'd change this line to:
This driver emulates
> a media node that exposes a complex media topology. The topology
> - is hard coded for now but is meant to be highly configurable in
> - the future.
> + is configurable through configfs API.
through -> through the
>
> When in doubt, say N.
> diff --git a/drivers/media/platform/vimc/Makefile b/drivers/media/platform/vimc/Makefile
> index 4b2e3de7856e..5d926a5ef15c 100644
> --- a/drivers/media/platform/vimc/Makefile
> +++ b/drivers/media/platform/vimc/Makefile
> @@ -1,10 +1,9 @@
> # SPDX-License-Identifier: GPL-2.0
> -vimc-objs := vimc-core.o
> +vimc-objs := vimc-core.o vimc-common.o vimc-configfs.o
> vimc_capture-objs := vimc-capture.o
> -vimc_common-objs := vimc-common.o
> vimc_debayer-objs := vimc-debayer.o
> vimc_scaler-objs := vimc-scaler.o
> vimc_sensor-objs := vimc-sensor.o
>
> -obj-$(CONFIG_VIDEO_VIMC) += vimc.o vimc_capture.o vimc_common.o vimc-debayer.o \
> - vimc_scaler.o vimc_sensor.o
> +obj-$(CONFIG_VIDEO_VIMC) += vimc.o vimc_capture.o vimc-debayer.o vimc_scaler.o \
> + vimc_sensor.o
> diff --git a/drivers/media/platform/vimc/vimc-capture.c b/drivers/media/platform/vimc/vimc-capture.c
> index 3f7e9ed56633..55a5f85b4591 100644
> --- a/drivers/media/platform/vimc/vimc-capture.c
> +++ b/drivers/media/platform/vimc/vimc-capture.c
> @@ -23,6 +23,7 @@
> #include <media/videobuf2-core.h>
> #include <media/videobuf2-vmalloc.h>
>
> +#include "vimc-configfs.h"
> #include "vimc-common.h"
>
> #define VIMC_CAP_DRV_NAME "vimc-capture"
> @@ -418,7 +419,7 @@ static int vimc_cap_comp_bind(struct device *comp, struct device *master,
> }
>
> /* Initialize the media entity */
> - vcap->vdev.entity.name = pdata->entity_name;
> + vcap->vdev.entity.name = pdata->name;
> vcap->vdev.entity.function = MEDIA_ENT_F_IO_V4L;
> ret = media_entity_pads_init(&vcap->vdev.entity,
> 1, vcap->ved.pads);
> @@ -443,7 +444,7 @@ static int vimc_cap_comp_bind(struct device *comp, struct device *master,
> ret = vb2_queue_init(q);
> if (ret) {
> dev_err(comp, "%s: vb2 queue init failed (err=%d)\n",
> - pdata->entity_name, ret);
> + pdata->name, ret);
> goto err_clean_m_ent;
> }
>
> @@ -476,7 +477,7 @@ static int vimc_cap_comp_bind(struct device *comp, struct device *master,
> vdev->queue = q;
> vdev->v4l2_dev = v4l2_dev;
> vdev->vfl_dir = VFL_DIR_RX;
> - strscpy(vdev->name, pdata->entity_name, sizeof(vdev->name));
> + strscpy(vdev->name, pdata->name, sizeof(vdev->name));
> video_set_drvdata(vdev, &vcap->ved);
>
> /* Register the video_device with the v4l2 and the media framework */
> @@ -534,7 +535,44 @@ static struct platform_driver vimc_cap_pdrv = {
> },
> };
>
> -module_platform_driver(vimc_cap_pdrv);
> +static struct config_item_type vimc_cap_cfs_pad_type = {
> + .ct_owner = THIS_MODULE,
> +};
> +
> +static struct config_group vimc_cap_cfs_sink_pad_group;
> +
> +static void vimc_cap_configfs_cb(struct config_group *group)
> +{
> + config_group_init_type_name(&vimc_cap_cfs_sink_pad_group,
> + VIMC_CFS_SINK_PAD_NAME(0),
> + &vimc_cap_cfs_pad_type);
> + configfs_add_default_group(&vimc_cap_cfs_sink_pad_group, group);
> +}
> +
> +struct vimc_cfs_drv vimc_cap_cfs_drv = {
> + .name = VIMC_CAP_DRV_NAME,
> + .configfs_cb = vimc_cap_configfs_cb,
> +};
> +
> +static int __init vimc_cap_init(void)
> +{
> + int ret = platform_driver_register(&vimc_cap_pdrv);
> +
> + if (ret)
> + return ret;
> +
> + vimc_cfs_drv_register(&vimc_cap_cfs_drv);
> + return 0;
> +}
> +
> +static void __exit vimc_cap_exit(void)
> +{
> + platform_driver_unregister(&vimc_cap_pdrv);
> + vimc_cfs_drv_unregister(&vimc_cap_cfs_drv);
> +}
> +
> +module_init(vimc_cap_init);
> +module_exit(vimc_cap_exit);
>
> MODULE_DEVICE_TABLE(platform, vimc_cap_driver_ids);
>
> diff --git a/drivers/media/platform/vimc/vimc-common.h b/drivers/media/platform/vimc/vimc-common.h
> index 2e9981b18166..9a33e7901b72 100644
> --- a/drivers/media/platform/vimc/vimc-common.h
> +++ b/drivers/media/platform/vimc/vimc-common.h
> @@ -22,6 +22,8 @@
> #include <media/media-device.h>
> #include <media/v4l2-device.h>
>
> +#define VIMC_MAX_NAME_LEN 32
> +
> /* VIMC-specific controls */
> #define VIMC_CID_VIMC_BASE (0x00f00000 | 0xf000)
> #define VIMC_CID_VIMC_CLASS (0x00f00000 | 1)
> @@ -63,16 +65,62 @@ do { \
> /**
> * struct vimc_platform_data - platform data to components
> *
> - * @entity_name: The name of the entity to be created
> + * @name: The name of the device
> + * @group: The configfs group the device belongs
> *
> * Board setup code will often provide additional information using the device's
> * platform_data field to hold additional information.
> - * When injecting a new platform_device in the component system the core needs
> - * to provide to the corresponding submodules the name of the entity that should
> - * be used when registering the subdevice in the Media Controller system.
> + * When injecting a new platform_device in the component system, the name of the
> + * device is required to allow the system to register it with a proper name.
> + * Also the configfs group is given to allow the driver to add custom items in
> + * the group.
> + * This struct is used by the entity submodules and the core system to be able
> + * to retrieve the name to register the device in the Media Controller system.
> */
> struct vimc_platform_data {
> - char entity_name[32];
> + char name[VIMC_MAX_NAME_LEN];
> + struct config_group *group;
> +};
> +
> +/**
> + * struct vimc_platform_data_link - platform data to components of type link
> + *
> + * @source: source component of the link
> + * @source_pad: source pad of the link
> + * @sink: sink component of the link
> + * @sink_pad: sink pad of the link
> + * @flags: flags of the link
> + *
> + * Board setup code will often provide additional information using the device's
> + * platform_data field to hold additional information.
> + * When injecting a new platform_device representing a link in the component
> + * system, source and sink information is required to allow the link module to
> + * create the proper link between entities.
> + */
> +struct vimc_platform_data_link {
> + struct platform_device *source;
> + u16 source_pad;
> + struct platform_device *sink;
> + u16 sink_pad;
> + u32 flags;
> + struct list_head list;
> +};
> +
> +/**
> + * struct vimc_platform_data_core - platform data to the core
> + *
> + * @data: see struct vimc_platform_data
> + * @links: list of struct vimc_platform_data_link
> + *
> + * Board setup code will often provide additional information using the device's
> + * platform_data field to hold additional information.
> + * When injecting a new platform_device representing the core component, a list
> + * of struct vimc_platform_data_list is required to allow the core to create
> + * create the proper links between entities.
> + */
> +struct vimc_platform_data_core {
> + struct vimc_platform_data data;
> + struct list_head *links;
> };
>
> /**
> diff --git a/drivers/media/platform/vimc/vimc-configfs.c b/drivers/media/platform/vimc/vimc-configfs.c
> new file mode 100644
> index 000000000000..68e5f1ea736b
> --- /dev/null
> +++ b/drivers/media/platform/vimc/vimc-configfs.c
> @@ -0,0 +1,665 @@
> +// SPDX-License-Identifier: GPL-2.0+
> +/*
> + * vimc-configfs.c Virtual Media Controller Driver
> + *
> + * Copyright (C) 2018 Helen Koike <[email protected]>
> + */
> +
> +#include <linux/component.h>
> +#include <linux/module.h>
> +#include <linux/slab.h>
> +#include <linux/platform_device.h>
> +
> +#include "vimc-common.h"
> +#include "vimc-configfs.h"
> +#include "vimc-core.h"
> +
> +#define CHAR_SEPARATOR ':'
> +#define LINK_SEPARATOR "->"
> +#define CFS_SUBSYS_NAME "vimc"
> +
> +#define ci_err(ci, fmt, ...) \
> + pr_err("vimc: %s: " pr_fmt(fmt), (ci)->ci_name, ##__VA_ARGS__)
> +#define cg_err(cg, ...) ci_err(&(cg)->cg_item, ##__VA_ARGS__)
> +#define ci_warn(ci, fmt, ...) \
> + pr_warn("vimc: %s: " pr_fmt(fmt), (ci)->ci_name, ##__VA_ARGS__)
> +#define cg_warn(cg, ...) ci_warn(&(cg)->cg_item, ##__VA_ARGS__)
> +#define ci_dbg(ci, fmt, ...) \
> + pr_debug("vimc: %s: " pr_fmt(fmt), (ci)->ci_name, ##__VA_ARGS__)
> +#define cg_dbg(cg, ...) ci_dbg(&(cg)->cg_item, ##__VA_ARGS__)
> +
> +#define is_plugged(cfs) (!!(cfs)->pdev)
> +
> +enum vimc_cfs_hotplug_state {
> + VIMC_CFS_HOTPLUG_STATE_UNPLUGGED = 0,
> + VIMC_CFS_HOTPLUG_STATE_PLUGGED = 1,
> +};
> +
> +const static char *vimc_cfs_hotplug_values[2][3] = {
> + [VIMC_CFS_HOTPLUG_STATE_UNPLUGGED] = {"unplugged\n", "unplug\n", "0\n"},
> + [VIMC_CFS_HOTPLUG_STATE_PLUGGED] = {"plugged\n", "plug\n", "1\n"},
> +};
> +
> +/* --------------------------------------------------------------------------
> + * Pipeline structures
> + */
> +
> +static struct vimc_cfs_subsystem {
> + struct configfs_subsystem subsys;
> + struct list_head drvs;
> +} vimc_cfs_subsys;
> +
> +/* Structure which describes the whole topology */
> +struct vimc_cfs_device {
> + struct platform_device *pdev;
> + struct vimc_platform_data_core pdata;
> + struct list_head ents;
> + struct list_head links;
> + struct config_group gdev;
> + struct config_group gents;
> + struct config_group glinks;
> +};
> +
> +/* Structure which describes individual configuration for each entity */
> +struct vimc_cfs_ent {
> + struct platform_device *pdev;
> + struct vimc_platform_data pdata;
> + char drv[VIMC_MAX_NAME_LEN];
> + struct list_head list;
> + struct config_group cg;
> +};
> +
> +/* Structure which describes links between entities */
> +struct vimc_cfs_link {
> + struct vimc_platform_data_link pdata;
> + char source_name[VIMC_MAX_NAME_LEN];
> + char sink_name[VIMC_MAX_NAME_LEN];
> + struct config_item ci;
> +};
> +
> +void vimc_cfs_drv_register(struct vimc_cfs_drv *c_drv)
> +{
> + list_add(&c_drv->list, &vimc_cfs_subsys.drvs);
> +}
> +EXPORT_SYMBOL_GPL(vimc_cfs_drv_register);
> +
> +void vimc_cfs_drv_unregister(struct vimc_cfs_drv *c_drv)
> +{
> + list_del(&c_drv->list);
> +}
> +EXPORT_SYMBOL_GPL(vimc_cfs_drv_unregister);
> +
> +/* --------------------------------------------------------------------------
> + * Platform Device builders
> + */
> +
> +static int vimc_cfs_link_get_entities(const struct vimc_cfs_device *cfs,
> + struct vimc_cfs_link *c_link)
> +{
> + struct vimc_cfs_ent *c_ent;
> +
> + c_link->pdata.source = NULL;
> + c_link->pdata.sink = NULL;
> + list_for_each_entry(c_ent, &cfs->ents, list) {
> + if (!c_link->pdata.source &&
> + !strcmp(c_ent->pdata.name, c_link->source_name))
> + c_link->pdata.source = c_ent->pdev;
> + if (!c_link->pdata.sink &&
> + !strcmp(c_ent->pdata.name, c_link->sink_name))
> + c_link->pdata.sink = c_ent->pdev;
> + if (c_link->pdata.source && c_link->pdata.sink)
> + return 0;
> + }
> + return -EINVAL;
> +}
> +
> +static int vimc_cfs_comp_compare(struct device *comp, void *data)
> +{
> + dev_dbg(comp, "comp compare %p %p", comp, data);
> +
> + return comp == data;
> +}
> +
> +static const struct component_master_ops vimc_cfs_comp_ops = {
> + .bind = vimc_core_comp_bind,
> + .unbind = vimc_core_comp_unbind,
> +};
> +
> +static void vimc_cfs_device_unplug(struct vimc_cfs_device *cfs)
> +{
> + struct vimc_cfs_ent *c_ent;
> +
> + dev_dbg(&cfs->pdev->dev, "Unplugging device");
> +
> + component_master_del(&cfs->pdev->dev, &vimc_cfs_comp_ops);
> + list_for_each_entry(c_ent, &cfs->ents, list) {
> + platform_device_unregister(c_ent->pdev);
> + c_ent->pdev = NULL;
> + }
> + platform_device_unregister(cfs->pdev);
> + cfs->pdev = NULL;
> +}
> +
> +static int vimc_cfs_device_plug(struct vimc_cfs_device *cfs)
> +{
> + struct component_match *match = NULL;
> + struct vimc_cfs_ent *c_ent;
> + struct vimc_cfs_link *c_link;
> + int ret = 0;
> +
> + cg_dbg(&cfs->gdev, "Plugging device");
> +
> + if (list_empty(&cfs->ents)) {
> + /* TODO: add support for a default topology */
> + cg_err(&cfs->gdev,
> + "At least an entity is required to plug the device");
> + return -EINVAL;
> + }
> +
> + cfs->pdev = platform_device_register_data(NULL, VIMC_CORE_PDEV_NAME,
> + PLATFORM_DEVID_AUTO,
> + &cfs->pdata,
> + sizeof(cfs->pdata));
> + if (IS_ERR(cfs->pdev))
> + return PTR_ERR(cfs->pdev);
> +
> + /* Add component_match for inner structure of the pipeline */
> + list_for_each_entry(c_ent, &cfs->ents, list) {
> + cg_dbg(&c_ent->cg, "registering entity %s:%s", c_ent->drv,
> + c_ent->pdata.name);
> + if (c_ent->pdev)
> + cg_err(&c_ent->cg, "pdev is not null");
> + c_ent->pdev = platform_device_register_data(&cfs->pdev->dev,
> + c_ent->drv,
> + PLATFORM_DEVID_AUTO,
> + &c_ent->pdata,
> + sizeof(c_ent->pdata));
> + if (IS_ERR(c_ent->pdev)) {
> + ret = PTR_ERR(c_ent->pdev);
> + goto unregister_ents;
> + }
> + component_match_add(&cfs->pdev->dev, &match,
> + vimc_cfs_comp_compare, &c_ent->pdev->dev);
> + }
> + list_for_each_entry(c_link, cfs->pdata.links, pdata.list) {
> + ret = vimc_cfs_link_get_entities(cfs, c_link);
> + if (ret) {
> + ci_err(&c_link->ci, "could not validate link");
> + goto unregister_ents;
> + }
> + }
> +
> + dev_dbg(&cfs->pdev->dev, "Adding master device");
> + ret = component_master_add_with_match(&cfs->pdev->dev,
> + &vimc_cfs_comp_ops, match);
> + if (ret)
> + goto unregister_ents;
> +
> + return 0;
> +
> +unregister_ents:
> + list_for_each_entry_continue_reverse(c_ent, &cfs->ents, list) {
> + platform_device_unregister(c_ent->pdev);
> + c_ent->pdev = NULL;
> + }
> +
> + platform_device_unregister(cfs->pdev);
> + cfs->pdev = NULL;
> +
> + return ret;
> +}
> +
> +/* --------------------------------------------------------------------------
> + * Links
> + */
> +
> +static ssize_t vimc_cfs_links_attr_flags_show(struct config_item *item,
> + char *buf)
> +{
> + struct vimc_cfs_link *c_link = container_of(item, struct vimc_cfs_link,
> + ci);
> +
> + sprintf(buf, "%d\n", c_link->pdata.flags);
> + return strlen(buf);
> +}
> +
> +static ssize_t vimc_cfs_links_attr_flags_store(struct config_item *item,
> + const char *buf, size_t size)
> +{
> + struct vimc_cfs_link *c_link = container_of(item, struct vimc_cfs_link,
> + ci);
> +
> + if (kstrtou32(buf, 0, &c_link->pdata.flags))
> + return -EINVAL;
> +
> + return size;
> +}
> +
> +CONFIGFS_ATTR(vimc_cfs_links_attr_, flags);
> +
> +static struct configfs_attribute *vimc_cfs_link_attrs[] = {
> + &vimc_cfs_links_attr_attr_flags,
> + NULL,
> +};
> +
> +static void vimc_cfs_link_release(struct config_item *item)
> +{
> + struct vimc_cfs_link *c_link = container_of(item, struct vimc_cfs_link,
> + ci);
> +
> + kfree(c_link);
> +}
> +
> +static struct configfs_item_operations vimc_cfs_link_item_ops = {
> + .release = vimc_cfs_link_release,
> +};
> +
> +static struct config_item_type vimc_cfs_link_type = {
> + .ct_item_ops = &vimc_cfs_link_item_ops,
> + .ct_attrs = vimc_cfs_link_attrs,
> + .ct_owner = THIS_MODULE,
> +};
> +
> +static void vimc_cfs_link_drop_item(struct config_group *group,
> + struct config_item *item)
> +{
> + struct vimc_cfs_link *link = container_of(item,
> + struct vimc_cfs_link, ci);
> + struct vimc_cfs_device *cfs = container_of(group,
> + struct vimc_cfs_device,
> + glinks);
> +
> + if (is_plugged(cfs))
> + vimc_cfs_device_unplug(cfs);
> + list_del(&link->pdata.list);
> +}
> +
> +static struct config_item *vimc_cfs_link_make_item(struct config_group *group,
> + const char *name)
> +{
> + struct vimc_cfs_device *cfs = container_of(group,
> + struct vimc_cfs_device,
> + glinks);
> + size_t src_pad_strlen, sink_pad_strlen, sink_namelen, source_namelen;
> + const char *sep, *src_pad_str, *sink_pad_str, *sink_name,
> + *source_name = name;
> + struct vimc_cfs_link *c_link;
> + u16 source_pad, sink_pad;
> + char tmp[4];
> +
> + cg_dbg(&cfs->gdev, "Creating link %s", name);
> +
> + if (is_plugged(cfs))
> + vimc_cfs_device_unplug(cfs);
> +
> + /* Parse format "source_name:source_pad->sink_name:sink_pad" */
> + sep = strchr(source_name, CHAR_SEPARATOR);
> + if (!sep)
> + goto syntax_error;
> + source_namelen = (size_t)(sep - source_name);
> +
> + src_pad_str = &sep[1];
> + sep = strstr(src_pad_str, LINK_SEPARATOR);
> + if (!sep)
> + goto syntax_error;
> + src_pad_strlen = (size_t)(sep - src_pad_str);
> +
> + sink_name = &sep[strlen(LINK_SEPARATOR)];
> + sep = strchr(sink_name, CHAR_SEPARATOR);
> + if (!sep)
> + goto syntax_error;
> + sink_namelen = (size_t)(sep - sink_name);
> +
> + sink_pad_str = &sep[1];
> + sink_pad_strlen = strlen(sink_pad_str);
> +
> + /* Validate sizes */
> + if (!src_pad_strlen || !sink_pad_strlen ||
> + !sink_namelen || !source_namelen)
> + goto syntax_error;
> +
> + /* we limit the size here so we don't need to allocate another buffer */
> + if (src_pad_strlen >= sizeof(tmp) || sink_pad_strlen >= sizeof(tmp)) {
> + cg_err(&cfs->gdev,
> + "Pad with more then %ld digits is not supported",
> + sizeof(tmp) - 1);
> + goto syntax_error;
> + }
> + strscpy(tmp, src_pad_str, src_pad_strlen + 1);
> + if (kstrtou16(tmp, 0, &source_pad)) {
> + cg_err(&cfs->gdev, "Couldn't convert pad %s to number", tmp);
> + goto syntax_error;
> + }
> + strscpy(tmp, sink_pad_str, sink_pad_strlen + 1);
> + if (kstrtou16(tmp, 0, &sink_pad)) {
> + cg_err(&cfs->gdev, "Couldn't convert pad %s to number", tmp);
> + goto syntax_error;
> + }
> +
> + c_link = kzalloc(sizeof(*c_link), GFP_KERNEL);
> + if (!c_link)
> + return ERR_PTR(-ENOMEM);
> +
> + c_link->pdata.source_pad = source_pad;
> + c_link->pdata.sink_pad = sink_pad;
> + strscpy(c_link->source_name, source_name, source_namelen + 1);
> + strscpy(c_link->sink_name, sink_name, sink_namelen + 1);
> +
> + /* Configure group */
> + list_add(&c_link->pdata.list, cfs->pdata.links);
> + config_item_init_type_name(&c_link->ci, name, &vimc_cfs_link_type);
> +
> + return &c_link->ci;
> +
> +syntax_error:
> + cg_err(&cfs->gdev,
> + "Couldn't create link %s, wrong syntax.", name);
> + return ERR_PTR(-EINVAL);
> +}
> +
> +/* --------------------------------------------------------------------------
> + * Entities
> + */
> +
> +/* *TODO: add support for hotplug in entity level */
*TODO -> TODO
in entity -> at entity
> +
> +static int vimc_cfs_drv_cb(const char *drv_name, struct config_group *group)
> +{
> + struct vimc_cfs_drv *c_drv = NULL;
> +
> + list_for_each_entry(c_drv, &vimc_cfs_subsys.drvs, list) {
> + if (!strcmp(drv_name, c_drv->name))
> + break;
> + }
> + if (!c_drv)
> + return -EINVAL;
> +
> + if (c_drv->configfs_cb)
> + c_drv->configfs_cb(group);
> +
> + return 0;
> +}
> +
> +static void vimc_cfs_ent_release(struct config_item *item)
> +{
> + struct vimc_cfs_ent *c_ent = container_of(item, struct vimc_cfs_ent,
> + cg.cg_item);
> +
> + kfree(c_ent);
> +}
> +
> +static struct configfs_item_operations vimc_cfs_ent_item_ops = {
> + .release = vimc_cfs_ent_release,
> +};
> +
> +static struct config_item_type vimc_cfs_ent_type = {
> + .ct_item_ops = &vimc_cfs_ent_item_ops,
> + .ct_owner = THIS_MODULE,
> +};
> +
> +static void vimc_cfs_ent_drop_item(struct config_group *group,
> + struct config_item *item)
> +{
> + struct vimc_cfs_ent *c_ent = container_of(item, struct vimc_cfs_ent,
> + cg.cg_item);
> + struct vimc_cfs_device *cfs = container_of(group,
> + struct vimc_cfs_device,
> + gents);
> +
> + if (is_plugged(cfs))
> + vimc_cfs_device_unplug(cfs);
> + list_del(&c_ent->list);
> +}
> +
> +static struct config_group *vimc_cfs_ent_make_group(struct config_group *group,
> + const char *name)
> +{
> + struct vimc_cfs_device *cfs = container_of(group,
> + struct vimc_cfs_device,
> + gents);
> + const char *drv_name = name;
> + char *ent_name, *sep = strchr(drv_name, CHAR_SEPARATOR);
> + struct vimc_cfs_ent *c_ent;
> + size_t drv_namelen;
> +
> + if (is_plugged(cfs))
> + vimc_cfs_device_unplug(cfs);
> +
> + /* Parse format "drv_name:ent_name" */
> + if (!sep) {
> + cg_err(&cfs->gdev,
> + "Could not find separator '%c'", CHAR_SEPARATOR);
> + goto syntax_error;
> + }
> + drv_namelen = (size_t)(sep - drv_name);
> + ent_name = &sep[1];
> + if (!*ent_name || !drv_namelen) {
> + cg_err(&cfs->gdev,
> + "%s: Driver name and entity name can't be empty.",
> + name);
> + goto syntax_error;
> + }
> + if (drv_namelen >= sizeof(c_ent->drv)) {
> + cg_err(&cfs->gdev,
> + "%s: Driver name length should be less then %ld.",
> + name, sizeof(c_ent->drv));
> + goto syntax_error;
> + }
> +
> + c_ent = kzalloc(sizeof(*c_ent), GFP_KERNEL);
> + if (!c_ent)
> + return ERR_PTR(-ENOMEM);
> +
> + /* Configure platform device */
> + strscpy(c_ent->drv, drv_name, drv_namelen + 1);
> + strscpy(c_ent->pdata.name, ent_name, sizeof(c_ent->pdata.name));
> + c_ent->pdata.group = &c_ent->cg;
> +
> + cg_dbg(&cfs->gdev, "New entity %s:%s", c_ent->drv, c_ent->pdata.name);
> +
> + /* Configure group */
> + config_group_init_type_name(&c_ent->cg, name, &vimc_cfs_ent_type);
> + if (vimc_cfs_drv_cb(c_ent->drv, &c_ent->cg)) {
> + cg_err(&c_ent->cg, "Module %s not found", c_ent->drv);
> + kfree(c_ent);
> + return ERR_PTR(-EINVAL);
> + }
> + list_add(&c_ent->list, &cfs->ents);
> +
> + return &c_ent->cg;
> +
> +syntax_error:
> + cg_err(&cfs->gdev,
> + "Couldn't create entity %s, wrong syntax.", name);
> + return ERR_PTR(-EINVAL);
> +}
> +
> +/* --------------------------------------------------------------------------
> + * Default group: Links
> + */
> +
> +static struct configfs_group_operations vimc_cfs_dlink_group_ops = {
> + .make_item = vimc_cfs_link_make_item,
> + .drop_item = vimc_cfs_link_drop_item,
> +};
> +
> +static struct config_item_type vimc_cfs_dlink_type = {
> + .ct_group_ops = &vimc_cfs_dlink_group_ops,
> + .ct_owner = THIS_MODULE,
> +};
> +
> +void vimc_cfs_dlink_add_default_group(struct vimc_cfs_device *cfs)
> +{
> + config_group_init_type_name(&cfs->glinks, "links",
> + &vimc_cfs_dlink_type);
> + configfs_add_default_group(&cfs->glinks, &cfs->gdev);
> +}
> +
> +/* --------------------------------------------------------------------------
> + * Default group: Entities
> + */
> +
> +static struct configfs_group_operations vimc_cfs_dent_group_ops = {
> + .make_group = vimc_cfs_ent_make_group,
> + .drop_item = vimc_cfs_ent_drop_item,
> +};
> +
> +static struct config_item_type vimc_cfs_dent_type = {
> + .ct_group_ops = &vimc_cfs_dent_group_ops,
> + .ct_owner = THIS_MODULE,
> +};
> +
> +void vimc_cfs_dent_add_default_group(struct vimc_cfs_device *cfs)
> +{
> + config_group_init_type_name(&cfs->gents, "entities",
> + &vimc_cfs_dent_type);
> + configfs_add_default_group(&cfs->gents, &cfs->gdev);
> +}
> +
> +/* --------------------------------------------------------------------------
> + * Device instance
> + */
> +
> +static int vimc_cfs_decode_state(const char *buf, size_t size)
> +{
> + unsigned int i, j;
> +
> + for (i = 0; i < ARRAY_SIZE(vimc_cfs_hotplug_values); i++) {
> + for (j = 0; j < ARRAY_SIZE(vimc_cfs_hotplug_values[0]); j++) {
> + if (!strncmp(buf, vimc_cfs_hotplug_values[i][j], size))
> + return i;
> + }
> + }
> + return -EINVAL;
> +}
> +
> +static ssize_t vimc_cfs_dev_attr_hotplug_show(struct config_item *item,
> + char *buf)
> +{
> + struct vimc_cfs_device *cfs = container_of(item, struct vimc_cfs_device,
> + gdev.cg_item);
> +
> + strcpy(buf, vimc_cfs_hotplug_values[is_plugged(cfs)][0]);
> + return strlen(buf);
> +}
> +
> +static int vimc_cfs_hotplug_set(struct vimc_cfs_device *cfs,
> + enum vimc_cfs_hotplug_state state)
> +{
> + if (state == is_plugged(cfs)) {
> + return 0;
> + } else if (state == VIMC_CFS_HOTPLUG_STATE_UNPLUGGED) {
> + vimc_cfs_device_unplug(cfs);
> + return 0;
> + } else if (state == VIMC_CFS_HOTPLUG_STATE_PLUGGED) {
> + return vimc_cfs_device_plug(cfs);
> + }
> + return -EINVAL;
> +}
> +
> +static ssize_t vimc_cfs_dev_attr_hotplug_store(struct config_item *item,
> + const char *buf, size_t size)
> +{
> + struct vimc_cfs_device *cfs = container_of(item, struct vimc_cfs_device,
> + gdev.cg_item);
> + int state = vimc_cfs_decode_state(buf, size);
> +
> + if (vimc_cfs_hotplug_set(cfs, state))
> + return -EINVAL;
> + return size;
> +}
> +
> +CONFIGFS_ATTR(vimc_cfs_dev_attr_, hotplug);
> +
> +static struct configfs_attribute *vimc_cfs_dev_attrs[] = {
> + &vimc_cfs_dev_attr_attr_hotplug,
> + NULL,
> +};
> +
> +static void vimc_cfs_dev_release(struct config_item *item)
> +{
> + struct vimc_cfs_device *cfs = container_of(item, struct vimc_cfs_device,
> + gdev.cg_item);
> +
> + kfree(cfs);
> +}
> +
> +static struct configfs_item_operations vimc_cfs_dev_item_ops = {
> + .release = vimc_cfs_dev_release,
> +};
> +
> +static struct config_item_type vimc_cfs_dev_type = {
> + .ct_item_ops = &vimc_cfs_dev_item_ops,
> + .ct_attrs = vimc_cfs_dev_attrs,
> + .ct_owner = THIS_MODULE,
> +};
> +
> +static void vimc_cfs_dev_drop_item(struct config_group *group,
> + struct config_item *item)
> +{
> + struct vimc_cfs_device *cfs = container_of(group,
> + struct vimc_cfs_device,
> + gdev);
> +
> + if (is_plugged(cfs))
> + vimc_cfs_device_unplug(cfs);
> +}
> +
> +static struct config_group *vimc_cfs_dev_make_group(
> + struct config_group *group, const char *name)
> +{
> + struct vimc_cfs_device *cfs = kzalloc(sizeof(*cfs), GFP_KERNEL);
> +
> + if (!cfs)
> + return ERR_PTR(-ENOMEM);
> +
> + /* Configure pipeline */
> + INIT_LIST_HEAD(&cfs->ents);
> + INIT_LIST_HEAD(&cfs->links);
> +
> + /* Configure platform data */
> + strscpy(cfs->pdata.data.name, name, sizeof(cfs->pdata.data.name));
> + cfs->pdata.data.group = &cfs->gdev;
> + cfs->pdata.links = &cfs->links;
> +
> + /* Configure configfs group */
> + config_group_init_type_name(&cfs->gdev, name, &vimc_cfs_dev_type);
> + vimc_cfs_dent_add_default_group(cfs);
> + vimc_cfs_dlink_add_default_group(cfs);
> +
> + return &cfs->gdev;
> +}
> +
> +/* --------------------------------------------------------------------------
> + * Subsystem
> + */
> +
> +static struct configfs_group_operations vimc_cfs_subsys_group_ops = {
> + /* Create vimc devices */
> + .make_group = vimc_cfs_dev_make_group,
> + .drop_item = vimc_cfs_dev_drop_item,
> +};
> +
> +static struct config_item_type vimc_cfs_subsys_type = {
> + .ct_group_ops = &vimc_cfs_subsys_group_ops,
> + .ct_owner = THIS_MODULE,
> +};
> +
> +int vimc_cfs_subsys_register(void)
> +{
> + struct configfs_subsystem *subsys = &vimc_cfs_subsys.subsys;
> + int ret;
> +
> + INIT_LIST_HEAD(&vimc_cfs_subsys.drvs);
> + config_group_init_type_name(&subsys->su_group, CFS_SUBSYS_NAME,
> + &vimc_cfs_subsys_type);
> + mutex_init(&subsys->su_mutex);
> + ret = configfs_register_subsystem(subsys);
> +
> + return ret;
> +}
> +
> +void vimc_cfs_subsys_unregister(void)
> +{
> + configfs_unregister_subsystem(&vimc_cfs_subsys.subsys);
> +}
> diff --git a/drivers/media/platform/vimc/vimc-configfs.h b/drivers/media/platform/vimc/vimc-configfs.h
> new file mode 100644
> index 000000000000..6278b53d11ba
> --- /dev/null
> +++ b/drivers/media/platform/vimc/vimc-configfs.h
> @@ -0,0 +1,30 @@
> +/* SPDX-License-Identifier: GPL-2.0+ */
> +/*
> + * vimc-configfs.h Virtual Media Controller Driver
> + *
> + * Copyright (C) 2018 Helen Koike <[email protected]>
> + */
> +
> +#ifndef _VIMC_CONFIGFS_H_
> +#define _VIMC_CONFIGFS_H_
> +
> +#include <linux/configfs.h>
> +
> +#define VIMC_CFS_SRC_PAD_NAME(n) "pad:source:" #n
> +#define VIMC_CFS_SINK_PAD_NAME(n) "pad:sink:" #n
> +
> +struct vimc_cfs_drv {
> + const char *name;
> + void (*const configfs_cb)(struct config_group *group);
> + struct list_head list;
> +};
> +
> +int vimc_cfs_subsys_register(void);
> +
> +void vimc_cfs_subsys_unregister(void);
> +
> +void vimc_cfs_drv_register(struct vimc_cfs_drv *c_drv);
> +
> +void vimc_cfs_drv_unregister(struct vimc_cfs_drv *c_drv);
> +
> +#endif
> diff --git a/drivers/media/platform/vimc/vimc-core.c b/drivers/media/platform/vimc/vimc-core.c
> index ce809d2e3d53..816015e7c8f6 100644
> --- a/drivers/media/platform/vimc/vimc-core.c
> +++ b/drivers/media/platform/vimc/vimc-core.c
> @@ -23,150 +23,29 @@
> #include <media/v4l2-device.h>
>
> #include "vimc-common.h"
> -
> -#define VIMC_PDEV_NAME "vimc"
> -#define VIMC_MDEV_MODEL_NAME "VIMC MDEV"
> -
> -#define VIMC_ENT_LINK(src, srcpad, sink, sinkpad, link_flags) { \
> - .src_ent = src, \
> - .src_pad = srcpad, \
> - .sink_ent = sink, \
> - .sink_pad = sinkpad, \
> - .flags = link_flags, \
> -}
> +#include "vimc-configfs.h"
>
> struct vimc_device {
> - /* The platform device */
> - struct platform_device pdev;
> -
> - /* The pipeline configuration */
> - const struct vimc_pipeline_config *pipe_cfg;
> -
> /* The Associated media_device parent */
> struct media_device mdev;
>
> /* Internal v4l2 parent device*/
> struct v4l2_device v4l2_dev;
> -
> - /* Subdevices */
> - struct platform_device **subdevs;
> -};
> -
> -/* Structure which describes individual configuration for each entity */
> -struct vimc_ent_config {
> - const char *name;
> - const char *drv;
> -};
> -
> -/* Structure which describes links between entities */
> -struct vimc_ent_link {
> - unsigned int src_ent;
> - u16 src_pad;
> - unsigned int sink_ent;
> - u16 sink_pad;
> - u32 flags;
> -};
> -
> -/* Structure which describes the whole topology */
> -struct vimc_pipeline_config {
> - const struct vimc_ent_config *ents;
> - size_t num_ents;
> - const struct vimc_ent_link *links;
> - size_t num_links;
> -};
> -
> -/* --------------------------------------------------------------------------
> - * Topology Configuration
> - */
> -
> -static const struct vimc_ent_config ent_config[] = {
> - {
> - .name = "Sensor A",
> - .drv = "vimc-sensor",
> - },
> - {
> - .name = "Sensor B",
> - .drv = "vimc-sensor",
> - },
> - {
> - .name = "Debayer A",
> - .drv = "vimc-debayer",
> - },
> - {
> - .name = "Debayer B",
> - .drv = "vimc-debayer",
> - },
> - {
> - .name = "Raw Capture 0",
> - .drv = "vimc-capture",
> - },
> - {
> - .name = "Raw Capture 1",
> - .drv = "vimc-capture",
> - },
> - {
> - .name = "RGB/YUV Input",
> - /* TODO: change this to vimc-input when it is implemented */
> - .drv = "vimc-sensor",
> - },
> - {
> - .name = "Scaler",
> - .drv = "vimc-scaler",
> - },
> - {
> - .name = "RGB/YUV Capture",
> - .drv = "vimc-capture",
> - },
> -};
> -
> -static const struct vimc_ent_link ent_links[] = {
> - /* Link: Sensor A (Pad 0)->(Pad 0) Debayer A */
> - VIMC_ENT_LINK(0, 0, 2, 0, MEDIA_LNK_FL_ENABLED | MEDIA_LNK_FL_IMMUTABLE),
> - /* Link: Sensor A (Pad 0)->(Pad 0) Raw Capture 0 */
> - VIMC_ENT_LINK(0, 0, 4, 0, MEDIA_LNK_FL_ENABLED | MEDIA_LNK_FL_IMMUTABLE),
> - /* Link: Sensor B (Pad 0)->(Pad 0) Debayer B */
> - VIMC_ENT_LINK(1, 0, 3, 0, MEDIA_LNK_FL_ENABLED | MEDIA_LNK_FL_IMMUTABLE),
> - /* Link: Sensor B (Pad 0)->(Pad 0) Raw Capture 1 */
> - VIMC_ENT_LINK(1, 0, 5, 0, MEDIA_LNK_FL_ENABLED | MEDIA_LNK_FL_IMMUTABLE),
> - /* Link: Debayer A (Pad 1)->(Pad 0) Scaler */
> - VIMC_ENT_LINK(2, 1, 7, 0, MEDIA_LNK_FL_ENABLED),
> - /* Link: Debayer B (Pad 1)->(Pad 0) Scaler */
> - VIMC_ENT_LINK(3, 1, 7, 0, 0),
> - /* Link: RGB/YUV Input (Pad 0)->(Pad 0) Scaler */
> - VIMC_ENT_LINK(6, 0, 7, 0, 0),
> - /* Link: Scaler (Pad 1)->(Pad 0) RGB/YUV Capture */
> - VIMC_ENT_LINK(7, 1, 8, 0, MEDIA_LNK_FL_ENABLED | MEDIA_LNK_FL_IMMUTABLE),
> -};
> -
> -static const struct vimc_pipeline_config pipe_cfg = {
> - .ents = ent_config,
> - .num_ents = ARRAY_SIZE(ent_config),
> - .links = ent_links,
> - .num_links = ARRAY_SIZE(ent_links)
> };
>
> -/* -------------------------------------------------------------------------- */
> -
> -static int vimc_create_links(struct vimc_device *vimc)
> +static int vimc_core_links_create(const struct device *master)
> {
> - unsigned int i;
> + struct vimc_platform_data_core *pdata = master->platform_data;
> + struct vimc_ent_device *ved_src, *ved_sink;
> + struct vimc_platform_data_link *plink;
> int ret;
>
> - /* Initialize the links between entities */
> - for (i = 0; i < vimc->pipe_cfg->num_links; i++) {
> - const struct vimc_ent_link *link = &vimc->pipe_cfg->links[i];
> - /*
> - * TODO: Check another way of retrieving ved struct without
> - * relying on platform_get_drvdata
> - */
> - struct vimc_ent_device *ved_src =
> - platform_get_drvdata(vimc->subdevs[link->src_ent]);
> - struct vimc_ent_device *ved_sink =
> - platform_get_drvdata(vimc->subdevs[link->sink_ent]);
> -
> - ret = media_create_pad_link(ved_src->ent, link->src_pad,
> - ved_sink->ent, link->sink_pad,
> - link->flags);
> + list_for_each_entry(plink, pdata->links, list) {
> + ved_src = platform_get_drvdata(plink->source);
> + ved_sink = platform_get_drvdata(plink->sink);
> + ret = media_create_pad_link(ved_src->ent, plink->source_pad,
> + ved_sink->ent, plink->sink_pad,
> + plink->flags);
> if (ret)
> return ret;
> }
> @@ -174,10 +53,10 @@ static int vimc_create_links(struct vimc_device *vimc)
> return 0;
> }
>
> -static int vimc_comp_bind(struct device *master)
> +int vimc_core_comp_bind(struct device *master)
> {
> - struct vimc_device *vimc = container_of(to_platform_device(master),
> - struct vimc_device, pdev);
> + struct vimc_device *vimc =
> + platform_get_drvdata(to_platform_device(master));
> int ret;
>
> dev_dbg(master, "bind");
> @@ -194,9 +73,7 @@ static int vimc_comp_bind(struct device *master)
> ret = component_bind_all(master, &vimc->v4l2_dev);
> if (ret)
> goto err_v4l2_unregister;
> -
> - /* Initialize links */
> - ret = vimc_create_links(vimc);
> + ret = vimc_core_links_create(master);
> if (ret)
> goto err_comp_unbind_all;
>
> @@ -228,11 +105,12 @@ static int vimc_comp_bind(struct device *master)
>
> return ret;
> }
> +EXPORT_SYMBOL_GPL(vimc_core_comp_bind);
>
> -static void vimc_comp_unbind(struct device *master)
> +void vimc_core_comp_unbind(struct device *master)
> {
> - struct vimc_device *vimc = container_of(to_platform_device(master),
> - struct vimc_device, pdev);
> + struct vimc_device *vimc =
> + platform_get_drvdata(to_platform_device(master));
>
> dev_dbg(master, "unbind");
>
> @@ -240,147 +118,56 @@ static void vimc_comp_unbind(struct device *master)
> component_unbind_all(master, NULL);
> v4l2_device_unregister(&vimc->v4l2_dev);
> }
> -
> -static int vimc_comp_compare(struct device *comp, void *data)
> -{
> - const struct platform_device *pdev = to_platform_device(comp);
> - const char *name = data;
> -
> - return !strcmp(pdev->dev.platform_data, name);
> -}
> -
> -static struct component_match *vimc_add_subdevs(struct vimc_device *vimc)
> -{
> - struct component_match *match = NULL;
> - struct vimc_platform_data pdata;
> - int i;
> -
> - for (i = 0; i < vimc->pipe_cfg->num_ents; i++) {
> - dev_dbg(&vimc->pdev.dev, "new pdev for %s\n",
> - vimc->pipe_cfg->ents[i].drv);
> -
> - strscpy(pdata.entity_name, vimc->pipe_cfg->ents[i].name,
> - sizeof(pdata.entity_name));
> -
> - vimc->subdevs[i] = platform_device_register_data(&vimc->pdev.dev,
> - vimc->pipe_cfg->ents[i].drv,
> - PLATFORM_DEVID_AUTO,
> - &pdata,
> - sizeof(pdata));
> - if (IS_ERR(vimc->subdevs[i])) {
> - match = ERR_CAST(vimc->subdevs[i]);
> - while (--i >= 0)
> - platform_device_unregister(vimc->subdevs[i]);
> -
> - return match;
> - }
> -
> - component_match_add(&vimc->pdev.dev, &match, vimc_comp_compare,
> - (void *)vimc->pipe_cfg->ents[i].name);
> - }
> -
> - return match;
> -}
> -
> -static void vimc_rm_subdevs(struct vimc_device *vimc)
> -{
> - unsigned int i;
> -
> - for (i = 0; i < vimc->pipe_cfg->num_ents; i++)
> - platform_device_unregister(vimc->subdevs[i]);
> -}
> -
> -static const struct component_master_ops vimc_comp_ops = {
> - .bind = vimc_comp_bind,
> - .unbind = vimc_comp_unbind,
> -};
> +EXPORT_SYMBOL_GPL(vimc_core_comp_unbind);
>
> static int vimc_probe(struct platform_device *pdev)
> {
> - struct vimc_device *vimc = container_of(pdev, struct vimc_device, pdev);
> - struct component_match *match = NULL;
> - int ret;
> + const struct vimc_platform_data_core *pdata = pdev->dev.platform_data;
> + struct vimc_device *vimc = devm_kzalloc(&pdev->dev, sizeof(*vimc),
> + GFP_KERNEL);
>
> dev_dbg(&pdev->dev, "probe");
>
> - /* Create platform_device for each entity in the topology*/
> - vimc->subdevs = devm_kcalloc(&vimc->pdev.dev, vimc->pipe_cfg->num_ents,
> - sizeof(*vimc->subdevs), GFP_KERNEL);
> - if (!vimc->subdevs)
> - return -ENOMEM;
> -
> - match = vimc_add_subdevs(vimc);
> - if (IS_ERR(match))
> - return PTR_ERR(match);
> -
> - /* Link the media device within the v4l2_device */
> - vimc->v4l2_dev.mdev = &vimc->mdev;
> -
> /* Initialize media device */
> - strscpy(vimc->mdev.model, VIMC_MDEV_MODEL_NAME,
> - sizeof(vimc->mdev.model));
> + strscpy(vimc->mdev.model, pdata->data.name, sizeof(vimc->mdev.model));
You'll need to fill in the bus_info as well. This will be needed by v4l2-compliance
in case that there are multiple vimc media devices created, so it will know which
media device to open.
The bus_info should match the bus_info returned by VIDIOC_QUERYCAP for video nodes
and should be unique for each media device.
> vimc->mdev.dev = &pdev->dev;
> media_device_init(&vimc->mdev);
> + vimc->v4l2_dev.mdev = &vimc->mdev;
>
> - /* Add self to the component system */
> - ret = component_master_add_with_match(&pdev->dev, &vimc_comp_ops,
> - match);
> - if (ret) {
> - media_device_cleanup(&vimc->mdev);
> - vimc_rm_subdevs(vimc);
> - return ret;
> - }
> + platform_set_drvdata(pdev, vimc);
>
> return 0;
> }
>
> static int vimc_remove(struct platform_device *pdev)
> {
> - struct vimc_device *vimc = container_of(pdev, struct vimc_device, pdev);
> + struct vimc_device *vimc = platform_get_drvdata(pdev);
>
> dev_dbg(&pdev->dev, "remove");
>
> - component_master_del(&pdev->dev, &vimc_comp_ops);
> - vimc_rm_subdevs(vimc);
> + media_device_cleanup(&vimc->mdev);
>
> return 0;
> }
>
> -static void vimc_dev_release(struct device *dev)
> -{
> -}
> -
> -static struct vimc_device vimc_dev = {
> - .pipe_cfg = &pipe_cfg,
> - .pdev = {
> - .name = VIMC_PDEV_NAME,
> - .dev.release = vimc_dev_release,
> - }
> -};
> -
> static struct platform_driver vimc_pdrv = {
> .probe = vimc_probe,
> .remove = vimc_remove,
> .driver = {
> - .name = VIMC_PDEV_NAME,
> - },
> + .name = "vimc-core",
> + }
> };
>
> static int __init vimc_init(void)
> {
> int ret;
>
> - ret = platform_device_register(&vimc_dev.pdev);
> - if (ret) {
> - dev_err(&vimc_dev.pdev.dev,
> - "platform device registration failed (err=%d)\n", ret);
> + ret = platform_driver_register(&vimc_pdrv);
> + if (ret)
> return ret;
> - }
>
> - ret = platform_driver_register(&vimc_pdrv);
> + ret = vimc_cfs_subsys_register();
> if (ret) {
> - dev_err(&vimc_dev.pdev.dev,
> - "platform driver registration failed (err=%d)\n", ret);
> platform_driver_unregister(&vimc_pdrv);
> return ret;
> }
> @@ -390,9 +177,9 @@ static int __init vimc_init(void)
>
> static void __exit vimc_exit(void)
> {
> - platform_driver_unregister(&vimc_pdrv);
> + vimc_cfs_subsys_unregister();
>
> - platform_device_unregister(&vimc_dev.pdev);
> + platform_driver_unregister(&vimc_pdrv);
> }
>
> module_init(vimc_init);
> diff --git a/drivers/media/platform/vimc/vimc-core.h b/drivers/media/platform/vimc/vimc-core.h
> new file mode 100644
> index 000000000000..42c8f92354af
> --- /dev/null
> +++ b/drivers/media/platform/vimc/vimc-core.h
> @@ -0,0 +1,17 @@
> +/* SPDX-License-Identifier: GPL-2.0+ */
> +/*
> + * vimc-core.h Virtual Media Controller Driver
> + *
> + * Copyright (C) 2018 Helen Koike <[email protected]>
> + */
> +
> +#ifndef _VIMC_CORE_H_
> +#define _VIMC_CORE_H_
> +
> +#define VIMC_CORE_PDEV_NAME "vimc-core"
> +
> +int vimc_core_comp_bind(struct device *master);
> +
> +void vimc_core_comp_unbind(struct device *master);
> +
> +#endif
> diff --git a/drivers/media/platform/vimc/vimc-debayer.c b/drivers/media/platform/vimc/vimc-debayer.c
> index 77887f66f323..fa326dbb7562 100644
> --- a/drivers/media/platform/vimc/vimc-debayer.c
> +++ b/drivers/media/platform/vimc/vimc-debayer.c
> @@ -23,6 +23,7 @@
> #include <linux/v4l2-mediabus.h>
> #include <media/v4l2-subdev.h>
>
> +#include "vimc-configfs.h"
> #include "vimc-common.h"
>
> #define VIMC_DEB_DRV_NAME "vimc-debayer"
> @@ -522,7 +523,7 @@ static int vimc_deb_comp_bind(struct device *comp, struct device *master,
> void *master_data)
> {
> struct v4l2_device *v4l2_dev = master_data;
> - struct vimc_platform_data *pdata = comp->platform_data;
> + struct vimc_platform_data *pdata = dev_get_platdata(comp);
> struct vimc_deb_device *vdeb;
> int ret;
>
> @@ -532,8 +533,7 @@ static int vimc_deb_comp_bind(struct device *comp, struct device *master,
> return -ENOMEM;
>
> /* Initialize ved and sd */
> - ret = vimc_ent_sd_register(&vdeb->ved, &vdeb->sd, v4l2_dev,
> - pdata->entity_name,
> + ret = vimc_ent_sd_register(&vdeb->ved, &vdeb->sd, v4l2_dev, pdata->name,
> MEDIA_ENT_F_PROC_VIDEO_PIXEL_ENC_CONV, 2,
> (const unsigned long[2]) {MEDIA_PAD_FL_SINK,
> MEDIA_PAD_FL_SOURCE},
> @@ -594,7 +594,50 @@ static struct platform_driver vimc_deb_pdrv = {
> },
> };
>
> -module_platform_driver(vimc_deb_pdrv);
> +static struct config_item_type vimc_deb_cfs_pad_type = {
> + .ct_owner = THIS_MODULE,
> +};
> +
> +static struct config_group vimc_deb_cfs_sink_pad_group;
> +static struct config_group vimc_deb_cfs_src_pad_group;
> +
> +static void vimc_deb_configfs_cb(struct config_group *group)
> +{
> + config_group_init_type_name(&vimc_deb_cfs_sink_pad_group,
> + VIMC_CFS_SINK_PAD_NAME(0),
> + &vimc_deb_cfs_pad_type);
> + configfs_add_default_group(&vimc_deb_cfs_sink_pad_group, group);
> +
> + config_group_init_type_name(&vimc_deb_cfs_src_pad_group,
> + VIMC_CFS_SRC_PAD_NAME(1),
> + &vimc_deb_cfs_pad_type);
> + configfs_add_default_group(&vimc_deb_cfs_src_pad_group, group);
> +}
> +
> +struct vimc_cfs_drv vimc_deb_cfs_drv = {
> + .name = VIMC_DEB_DRV_NAME,
> + .configfs_cb = vimc_deb_configfs_cb,
> +};
> +
> +static int __init vimc_deb_init(void)
> +{
> + int ret = platform_driver_register(&vimc_deb_pdrv);
> +
> + if (ret)
> + return ret;
> +
> + vimc_cfs_drv_register(&vimc_deb_cfs_drv);
> + return 0;
> +}
> +
> +static void __exit vimc_deb_exit(void)
> +{
> + platform_driver_unregister(&vimc_deb_pdrv);
> + vimc_cfs_drv_unregister(&vimc_deb_cfs_drv);
> +}
> +
> +module_init(vimc_deb_init);
> +module_exit(vimc_deb_exit);
>
> MODULE_DEVICE_TABLE(platform, vimc_deb_driver_ids);
>
> diff --git a/drivers/media/platform/vimc/vimc-scaler.c b/drivers/media/platform/vimc/vimc-scaler.c
> index b0952ee86296..efb29384197d 100644
> --- a/drivers/media/platform/vimc/vimc-scaler.c
> +++ b/drivers/media/platform/vimc/vimc-scaler.c
> @@ -23,6 +23,7 @@
> #include <linux/v4l2-mediabus.h>
> #include <media/v4l2-subdev.h>
>
> +#include "vimc-configfs.h"
> #include "vimc-common.h"
>
> #define VIMC_SCA_DRV_NAME "vimc-scaler"
> @@ -394,8 +395,7 @@ static int vimc_sca_comp_bind(struct device *comp, struct device *master,
> return -ENOMEM;
>
> /* Initialize ved and sd */
> - ret = vimc_ent_sd_register(&vsca->ved, &vsca->sd, v4l2_dev,
> - pdata->entity_name,
> + ret = vimc_ent_sd_register(&vsca->ved, &vsca->sd, v4l2_dev, pdata->name,
> MEDIA_ENT_F_PROC_VIDEO_SCALER, 2,
> (const unsigned long[2]) {MEDIA_PAD_FL_SINK,
> MEDIA_PAD_FL_SOURCE},
> @@ -448,7 +448,50 @@ static struct platform_driver vimc_sca_pdrv = {
> },
> };
>
> -module_platform_driver(vimc_sca_pdrv);
> +static struct config_item_type vimc_sca_cfs_pad_type = {
> + .ct_owner = THIS_MODULE,
> +};
> +
> +static struct config_group vimc_sca_cfs_sink_pad_group;
> +static struct config_group vimc_sca_cfs_src_pad_group;
> +
> +static void vimc_sca_configfs_cb(struct config_group *group)
> +{
> + config_group_init_type_name(&vimc_sca_cfs_sink_pad_group,
> + VIMC_CFS_SINK_PAD_NAME(0),
> + &vimc_sca_cfs_pad_type);
> + configfs_add_default_group(&vimc_sca_cfs_sink_pad_group, group);
> +
> + config_group_init_type_name(&vimc_sca_cfs_src_pad_group,
> + VIMC_CFS_SRC_PAD_NAME(1),
> + &vimc_sca_cfs_pad_type);
> + configfs_add_default_group(&vimc_sca_cfs_src_pad_group, group);
> +}
> +
> +struct vimc_cfs_drv vimc_sca_cfs_drv = {
> + .name = VIMC_SCA_DRV_NAME,
> + .configfs_cb = vimc_sca_configfs_cb,
> +};
> +
> +static int __init vimc_sca_init(void)
> +{
> + int ret = platform_driver_register(&vimc_sca_pdrv);
> +
> + if (ret)
> + return ret;
> +
> + vimc_cfs_drv_register(&vimc_sca_cfs_drv);
> + return 0;
> +}
> +
> +static void __exit vimc_sca_exit(void)
> +{
> + platform_driver_unregister(&vimc_sca_pdrv);
> + vimc_cfs_drv_unregister(&vimc_sca_cfs_drv);
> +}
> +
> +module_init(vimc_sca_init);
> +module_exit(vimc_sca_exit);
>
> MODULE_DEVICE_TABLE(platform, vimc_sca_driver_ids);
>
> diff --git a/drivers/media/platform/vimc/vimc-sensor.c b/drivers/media/platform/vimc/vimc-sensor.c
> index 32ca9c6172b1..37540e72c6bc 100644
> --- a/drivers/media/platform/vimc/vimc-sensor.c
> +++ b/drivers/media/platform/vimc/vimc-sensor.c
> @@ -28,6 +28,7 @@
> #include <media/v4l2-subdev.h>
> #include <media/tpg/v4l2-tpg.h>
>
> +#include "vimc-configfs.h"
> #include "vimc-common.h"
>
> #define VIMC_SEN_DRV_NAME "vimc-sensor"
> @@ -405,8 +406,7 @@ static int vimc_sen_comp_bind(struct device *comp, struct device *master,
> }
>
> /* Initialize ved and sd */
> - ret = vimc_ent_sd_register(&vsen->ved, &vsen->sd, v4l2_dev,
> - pdata->entity_name,
> + ret = vimc_ent_sd_register(&vsen->ved, &vsen->sd, v4l2_dev, pdata->name,
> MEDIA_ENT_F_CAM_SENSOR, 1,
> (const unsigned long[1]) {MEDIA_PAD_FL_SOURCE},
> &vimc_sen_ops);
> @@ -471,7 +471,44 @@ static struct platform_driver vimc_sen_pdrv = {
> },
> };
>
> -module_platform_driver(vimc_sen_pdrv);
> +static struct config_item_type vimc_sen_cfs_pad_type = {
> + .ct_owner = THIS_MODULE,
> +};
> +
> +static struct config_group vimc_sen_cfs_src_pad_group;
> +
> +static void vimc_sen_configfs_cb(struct config_group *group)
> +{
> + config_group_init_type_name(&vimc_sen_cfs_src_pad_group,
> + VIMC_CFS_SRC_PAD_NAME(0),
> + &vimc_sen_cfs_pad_type);
> + configfs_add_default_group(&vimc_sen_cfs_src_pad_group, group);
> +}
> +
> +struct vimc_cfs_drv vimc_sen_cfs_drv = {
> + .name = VIMC_SEN_DRV_NAME,
> + .configfs_cb = vimc_sen_configfs_cb,
> +};
> +
> +static int __init vimc_sen_init(void)
> +{
> + int ret = platform_driver_register(&vimc_sen_pdrv);
> +
> + if (ret)
> + return ret;
> +
> + vimc_cfs_drv_register(&vimc_sen_cfs_drv);
> + return 0;
> +}
> +
> +static void __exit vimc_sen_exit(void)
> +{
> + platform_driver_unregister(&vimc_sen_pdrv);
> + vimc_cfs_drv_unregister(&vimc_sen_cfs_drv);
> +}
> +
> +module_init(vimc_sen_init);
> +module_exit(vimc_sen_exit);
>
> MODULE_DEVICE_TABLE(platform, vimc_sen_driver_ids);
>
>
Regards,
Hans
Hi Hans,
On 12/10/18 9:31 AM, Hans Verkuil wrote:
> On 12/7/18 7:22 PM, Helen Koike wrote:
>> Add API to allow userspace to create any type of topology in vimc using
>> basic system calls such as mkdir/rmdir/read/write.
>>
>> Signed-off-by: Helen Koike <[email protected]>
>>
>> ---
>> Hi,
>>
>> This patch introduces the configufs API for configuring the topology in
>> vimc while it removes the hardcoded topology, so now, when you load the
>> module you need to create a device (no device will appear in your system
>> by default) using mkdir/rmdir/write/read.
>> Please see documentation in the patch.
>> I was thinking in adding a device by default, but if I do it in
>> configfs, userspace won't be able to delete the device (which might not
>> be a problem), as I need to create it as a "default" group in configfs,
>> or I can just not expose the default device in the configfs.
>> What do you think?
>
> I don't like the idea of having a special default device.
>
> So I think the way this patch does it is fine.
ok, nice.
>
>>
>> Thanks
>> Helen
>>
>> Documentation/media/v4l-drivers/vimc.rst | 172 +++++
>> drivers/media/platform/vimc/Kconfig | 7 +-
>> drivers/media/platform/vimc/Makefile | 7 +-
>> drivers/media/platform/vimc/vimc-capture.c | 46 +-
>> drivers/media/platform/vimc/vimc-common.h | 58 +-
>> drivers/media/platform/vimc/vimc-configfs.c | 665 ++++++++++++++++++++
>> drivers/media/platform/vimc/vimc-configfs.h | 30 +
>> drivers/media/platform/vimc/vimc-core.c | 283 ++-------
>> drivers/media/platform/vimc/vimc-core.h | 17 +
>> drivers/media/platform/vimc/vimc-debayer.c | 51 +-
>> drivers/media/platform/vimc/vimc-scaler.c | 49 +-
>> drivers/media/platform/vimc/vimc-sensor.c | 43 +-
>> 12 files changed, 1153 insertions(+), 275 deletions(-)
>> create mode 100644 Documentation/media/v4l-drivers/vimc.rst
>> create mode 100644 drivers/media/platform/vimc/vimc-configfs.c
>> create mode 100644 drivers/media/platform/vimc/vimc-configfs.h
>> create mode 100644 drivers/media/platform/vimc/vimc-core.h
>>
>> diff --git a/Documentation/media/v4l-drivers/vimc.rst b/Documentation/media/v4l-drivers/vimc.rst
>> new file mode 100644
>> index 000000000000..28d3b02c7d30
>> --- /dev/null
>> +++ b/Documentation/media/v4l-drivers/vimc.rst
>> @@ -0,0 +1,172 @@
>> +The Virtual Media Controller Driver (vimc)
>> +=========================================
>> +
>> +This driver emulates video4linux hardware of varios media topologies. It exposes
>
> varios -> various
ops, sorry about so many spelling mistakes, I'll pay more attention on
this next time.
>
>> +media devices through /dev/mediaX notes, video capture devices through
>
> notes -> nodes
>
>> +/dev/videoX and sub-devices through /dev/v4l-subdevX.
>
> I'd add 'nodes' after videoX and v4l-subdevX as well.
>
>> +
>> +A subdevice can be a sensor, a debayer or a scaler.
>> +
>> +To configure a media device of a given topology, a ConfigFS API is provided.
>> +
>> +
>> +Configuring the driver through ConfigFS (Experimental)
>> +------------------------------------------------------
>> +
>> +.. note::
>> +This API is not finished yet and might change in the future.
>> +
>> +Mount configfs:
>> +::
>> + $ mkdir /configfs
>> + $ mount -t configfs none /configfs
>> +
>> +When loading the module, you see a folders name vimc
>> +::
>> + $ tree /configfs/
>> + /configfs/
>> + `-- vimc
>> +
>> +1) Creating a media device
>> +~~~~~~~~~~~~~~~~~~~~~~~~~~
>> +
>> +To create a media device just create a new folder under /configfs/vimc/
>> +
>> +Example:
>> +::
>> + $ mkdir /configfs/vimc/mdev
>> + $ tree /configfs/vimc/mdev
>> + /configfs/vimc/mdev/
>> + |-- entities/
>> + |-- hotplug
>> + `-- links/
>> +
>> + 2 directories, 1 file
>> +
>> +2) Creating entities
>> +~~~~~~~~~~~~~~~~~~~~
>> +
>> +To create an entity in the media device's topology, just create a folder under
>> +/configfs/vimc/<mdev-name>/entities/ with the following format:
>> +
>> + <sub-module>:<name>
>> +
>> +Where <sub-module> is one of the following:
>> +::
>> + vimc-sensor
>> + vimc-scaler
>> + vimc-debayer
>> + vimc-capture
>> +
>> +Example:
>> +::
>> + $ mkdir /configfs/vimc/mdev/entities/vimc-sensor:my-sensor
>> + $ mkdir /configfs/vimc/mdev/entities/vimc-capture:my-capture
>> + $ tree /configfs/
>> + /configfs/
>> + `-- vimc/
>> + `-- mdev/
>> + |-- entities/
>> + | |-- vimc-capture:my-capture/
>> + | | `-- pad:sink:0/
>> + | `-- vimc-sensor:my-sensor/
>> + | `-- pad:source:0/
>> + |-- hotplug
>> + `-- links/
>> +
>> + 8 directories, 1 file
>> +
>> +3) Creating links
>> +~~~~~~~~~~~~~~~~~
>> +
>> +To create links between two entities in the topology, just create a folder under
>> +/configfs/vimc/<mdev-name>/links/ with the following format:
>> +
>> + "<entity1-name><pad-source>:<entity2-name><pad-sink>"
>> +
>> +Example:
>> +::
>> + $ mkdir "/configfs/vimc/mdev/links/my-sensor:0->my-capture:0"
>> + $ tree /configfs
>> + /configfs/
>> + `-- vimc/
>> + `-- mdev/
>> + |-- entities/
>> + | |-- vimc-capture:my-capture/
>> + | | `-- pad:sink:0/
>> + | `-- vimc-sensor:my-sensor/
>> + | `-- pad:source:0/
>> + |-- hotplug
>> + `-- links/
>> + `-- my-sensor:0->my-capture:0/
>> + `-- flags
>> +
>> + 9 directories, 2 files
>> +
>> +Change the attributes of the link by writing in the file
>> +"/configfs/vimc/<mdev-name>/links/<my-link>/flags"
>> +
>> +Flag values are defined in :ref:`include/uapi/linux/media.h <media_header>`
>> +( seek for ``MEDIA_LNK_FL_*``)
>> +
>> +1 - Enabled
>> + Indicates the link will be enabled when the media device is created.
>> +
>> +3 - Enabled and Immutable
>> + Indicates that the link enabled state can't be modified at runtime.
>> +
>> +Example:
>> +::
>> + $ echo 3 > "/configfs/vimc/mdev/links/my-sensor:0->my-capture:0/flags"
>> +
>> +4) Activating/Deactivating device
>> +~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
>> +
>> +To activate the device, write one of "plugged", "plug" or "1" to file
>> +/configfs/vimc/<ndev-name>/hotplug
>> +
>> +Example:
>> +::
>> + $ echo 1 > /configfs/vimc/mdev/hotplug
>> +
>> +You should see a new node /dev/mediaX in your devfs.
>> +
>> +To deactivate the device, write one of "unplugged", "unplug" or "0" to file
>> +/configfs/vimc/<ndev-name>/hotplug
>> +
>> +Example:
>> +::
>> + $ echo 0 > /configfs/vimc/mdev/hotplug
>> +
>> +Subdevices
>> +----------
>> +
>> +Subdevices defines the behavior of an entity in the topology. Depending on the
>
> defines -> define
>
>> +subdevice, the entity can have multiple pads of type source or sink.
>> +
>> +vimc-sensor:
>> + Generates images in several formats using video test pattern generator.
>> + Exposes:
>> +
>> + * 1 Pad source
>> +
>> +vimc-debayer:
>> + Transforms images in bayer format into a non bayer format.
>
> non bayer -> non-bayer
>
>> + Exposes:
>> +
>> + * 1 Pad sink
>> + * 1 Pad source
>> +
>> +vimc-scaler:
>> + Mutiplies the size of the image by 3.
>
> Mutiplies -> Multiplies
>
> This needs clarification: does this mean that the width and height are both
> multiplied by three? So the size is then multiplied by 9!
ack, I'll make it clear in the docs.
>
> So this is a fixed scaler, i.e. the scaling factors cannot be changed, right?
> If so, then that should be clearly stated here.
ack
I want the scaling factor to be exposed in a control, but this is for
another patch.
>
>> + Exposes:
>> +
>> + * 1 Pad sink
>> + * 1 Pad source
>> +
>> +vimc-capture:
>> + Exposes node /dev/videoX to allow userspace to capture the stream.
>> + Exposes:
>> +
>> + * 1 Pad sink
>> + * 1 Pad source
>
> What you need to add to this document are a few example topologies.
>
> I'm thinking one simple pipeline (sensor -> debayer -> scaler -> vimc-capture)
> and a complex one, something that looks closer to the OMAP3 pipeline.
>
> That would be very helpful, and the complex version can also serve as the
> example for testing regressions.
>
> Laurent gave me an omap3 topology (as was used in Nokia phones):
>
> https://hverkuil.home.xs4all.nl/omap3-mc.jpg
>
> CCP2 is effectively (for vimc purposes) similar to CSI2.
right, I am not very familiar with those, I'll do some research.
>
> The CCDC handles BT.656, lens shading correction, black level compensation and some form
> of dead pixel correction (thanks Laurent!), but in vimc terms it really acts like a
> splitter, taking one input and splitting it over two outputs.
a simple splitter should be easy to implement in the current state of
the code.
>
> The previewer is effectively similar to a debayer block.
You mean the image it outputs?
>
> AEWB, AF and histogram are for auto-whitebalance, autofocus and histogram statistics.
> This isn't supported by vimc, and is a 'nice-to-have' for the future.
Right, I need to check how to include those. I am a bit confused as in
the omap3 topology they are seems to be just configuration points (I
mean, they are not really part of the image pipeline).
I was reading this
https://linuxtv.org/downloads/v4l-dvb-apis-new/v4l-drivers/omap3isp.html?highlight=histogram#statistic-blocks-ioctls
It says:
"The statistics are dequeueable by the user from the statistics subdev
nodes using private IOCTLs"
I suppose we should emulate those private IOCTLs in vimc? If you could
provide me some pointers in where I can find docs on these private
IOCTLs it would be great.
>
> The main missing bits in vimc are a CSI block and a splitter block. It should be simple
> to add the CSI block since it really doesn't do anything in an emulated environment.
CSI would be just a dummy entity with one sink pad and one source pad right?
>
> A splitter might be more complicated, I'm not sure.
splitter shouldn't that complicated in the current state of vimc, but
when we start optimizing the pipeline then it is going to be more
complicated.
>
> An initial version could start with a sensor -> debayer -> scaler -> video capture
> but with support to bypass the debayer and/or scaler blocks, and adding video capture
> nodes for the sensor and debayer blocks.
>
> If it is as easy as I think it is to add a csi entity, then that would make it
> easier to closely emulate the omap3. And even better with a splitter :-)
>
> CSI blocks are very common, so that would be very nice to add.
>
>> diff --git a/drivers/media/platform/vimc/Kconfig b/drivers/media/platform/vimc/Kconfig
>> index 71c9fe7d3370..7f1fb550d4c3 100644
>> --- a/drivers/media/platform/vimc/Kconfig
>> +++ b/drivers/media/platform/vimc/Kconfig
>> @@ -1,15 +1,14 @@
>> config VIDEO_VIMC
>> tristate "Virtual Media Controller Driver (VIMC)"
>> - depends on VIDEO_DEV && VIDEO_V4L2 && VIDEO_V4L2_SUBDEV_API
>> + depends on VIDEO_DEV && VIDEO_V4L2 && VIDEO_V4L2_SUBDEV_API && CONFIGFS_FS
>> select VIDEOBUF2_VMALLOC
>> select VIDEO_V4L2_TPG
>> default n
>> ---help---
>> - Skeleton driver for Virtual Media Controller
>> + Virtual Media Controller Driver
>>
>> This driver can be compared to the vivid driver for emulating
>
> I'd change this line to:
>
> This driver emulates
>
>> a media node that exposes a complex media topology. The topology
>> - is hard coded for now but is meant to be highly configurable in
>> - the future.
>> + is configurable through configfs API.
>
> through -> through the
>
>>
>> When in doubt, say N.
>> diff --git a/drivers/media/platform/vimc/Makefile b/drivers/media/platform/vimc/Makefile
>> index 4b2e3de7856e..5d926a5ef15c 100644
>> --- a/drivers/media/platform/vimc/Makefile
>> +++ b/drivers/media/platform/vimc/Makefile
>> @@ -1,10 +1,9 @@
>> # SPDX-License-Identifier: GPL-2.0
>> -vimc-objs := vimc-core.o
>> +vimc-objs := vimc-core.o vimc-common.o vimc-configfs.o
>> vimc_capture-objs := vimc-capture.o
>> -vimc_common-objs := vimc-common.o
>> vimc_debayer-objs := vimc-debayer.o
>> vimc_scaler-objs := vimc-scaler.o
>> vimc_sensor-objs := vimc-sensor.o
>>
>> -obj-$(CONFIG_VIDEO_VIMC) += vimc.o vimc_capture.o vimc_common.o vimc-debayer.o \
>> - vimc_scaler.o vimc_sensor.o
>> +obj-$(CONFIG_VIDEO_VIMC) += vimc.o vimc_capture.o vimc-debayer.o vimc_scaler.o \
>> + vimc_sensor.o
>> diff --git a/drivers/media/platform/vimc/vimc-capture.c b/drivers/media/platform/vimc/vimc-capture.c
>> index 3f7e9ed56633..55a5f85b4591 100644
>> --- a/drivers/media/platform/vimc/vimc-capture.c
>> +++ b/drivers/media/platform/vimc/vimc-capture.c
>> @@ -23,6 +23,7 @@
>> #include <media/videobuf2-core.h>
>> #include <media/videobuf2-vmalloc.h>
>>
>> +#include "vimc-configfs.h"
>> #include "vimc-common.h"
>>
>> #define VIMC_CAP_DRV_NAME "vimc-capture"
>> @@ -418,7 +419,7 @@ static int vimc_cap_comp_bind(struct device *comp, struct device *master,
>> }
>>
>> /* Initialize the media entity */
>> - vcap->vdev.entity.name = pdata->entity_name;
>> + vcap->vdev.entity.name = pdata->name;
>> vcap->vdev.entity.function = MEDIA_ENT_F_IO_V4L;
>> ret = media_entity_pads_init(&vcap->vdev.entity,
>> 1, vcap->ved.pads);
>> @@ -443,7 +444,7 @@ static int vimc_cap_comp_bind(struct device *comp, struct device *master,
>> ret = vb2_queue_init(q);
>> if (ret) {
>> dev_err(comp, "%s: vb2 queue init failed (err=%d)\n",
>> - pdata->entity_name, ret);
>> + pdata->name, ret);
>> goto err_clean_m_ent;
>> }
>>
>> @@ -476,7 +477,7 @@ static int vimc_cap_comp_bind(struct device *comp, struct device *master,
>> vdev->queue = q;
>> vdev->v4l2_dev = v4l2_dev;
>> vdev->vfl_dir = VFL_DIR_RX;
>> - strscpy(vdev->name, pdata->entity_name, sizeof(vdev->name));
>> + strscpy(vdev->name, pdata->name, sizeof(vdev->name));
>> video_set_drvdata(vdev, &vcap->ved);
>>
>> /* Register the video_device with the v4l2 and the media framework */
>> @@ -534,7 +535,44 @@ static struct platform_driver vimc_cap_pdrv = {
>> },
>> };
>>
>> -module_platform_driver(vimc_cap_pdrv);
>> +static struct config_item_type vimc_cap_cfs_pad_type = {
>> + .ct_owner = THIS_MODULE,
>> +};
>> +
>> +static struct config_group vimc_cap_cfs_sink_pad_group;
>> +
>> +static void vimc_cap_configfs_cb(struct config_group *group)
>> +{
>> + config_group_init_type_name(&vimc_cap_cfs_sink_pad_group,
>> + VIMC_CFS_SINK_PAD_NAME(0),
>> + &vimc_cap_cfs_pad_type);
>> + configfs_add_default_group(&vimc_cap_cfs_sink_pad_group, group);
>> +}
>> +
>> +struct vimc_cfs_drv vimc_cap_cfs_drv = {
>> + .name = VIMC_CAP_DRV_NAME,
>> + .configfs_cb = vimc_cap_configfs_cb,
>> +};
>> +
>> +static int __init vimc_cap_init(void)
>> +{
>> + int ret = platform_driver_register(&vimc_cap_pdrv);
>> +
>> + if (ret)
>> + return ret;
>> +
>> + vimc_cfs_drv_register(&vimc_cap_cfs_drv);
>> + return 0;
>> +}
>> +
>> +static void __exit vimc_cap_exit(void)
>> +{
>> + platform_driver_unregister(&vimc_cap_pdrv);
>> + vimc_cfs_drv_unregister(&vimc_cap_cfs_drv);
>> +}
>> +
>> +module_init(vimc_cap_init);
>> +module_exit(vimc_cap_exit);
>>
>> MODULE_DEVICE_TABLE(platform, vimc_cap_driver_ids);
>>
>> diff --git a/drivers/media/platform/vimc/vimc-common.h b/drivers/media/platform/vimc/vimc-common.h
>> index 2e9981b18166..9a33e7901b72 100644
>> --- a/drivers/media/platform/vimc/vimc-common.h
>> +++ b/drivers/media/platform/vimc/vimc-common.h
>> @@ -22,6 +22,8 @@
>> #include <media/media-device.h>
>> #include <media/v4l2-device.h>
>>
>> +#define VIMC_MAX_NAME_LEN 32
>> +
>> /* VIMC-specific controls */
>> #define VIMC_CID_VIMC_BASE (0x00f00000 | 0xf000)
>> #define VIMC_CID_VIMC_CLASS (0x00f00000 | 1)
>> @@ -63,16 +65,62 @@ do { \
>> /**
>> * struct vimc_platform_data - platform data to components
>> *
>> - * @entity_name: The name of the entity to be created
>> + * @name: The name of the device
>> + * @group: The configfs group the device belongs
>> *
>> * Board setup code will often provide additional information using the device's
>> * platform_data field to hold additional information.
>> - * When injecting a new platform_device in the component system the core needs
>> - * to provide to the corresponding submodules the name of the entity that should
>> - * be used when registering the subdevice in the Media Controller system.
>> + * When injecting a new platform_device in the component system, the name of the
>> + * device is required to allow the system to register it with a proper name.
>> + * Also the configfs group is given to allow the driver to add custom items in
>> + * the group.
>> + * This struct is used by the entity submodules and the core system to be able
>> + * to retrieve the name to register the device in the Media Controller system.
>> */
>> struct vimc_platform_data {
>> - char entity_name[32];
>> + char name[VIMC_MAX_NAME_LEN];
>> + struct config_group *group;
>> +};
>> +
>> +/**
>> + * struct vimc_platform_data_link - platform data to components of type link
>> + *
>> + * @source: source component of the link
>> + * @source_pad: source pad of the link
>> + * @sink: sink component of the link
>> + * @sink_pad: sink pad of the link
>> + * @flags: flags of the link
>> + *
>> + * Board setup code will often provide additional information using the device's
>> + * platform_data field to hold additional information.
>> + * When injecting a new platform_device representing a link in the component
>> + * system, source and sink information is required to allow the link module to
>> + * create the proper link between entities.
>> + */
>> +struct vimc_platform_data_link {
>> + struct platform_device *source;
>> + u16 source_pad;
>> + struct platform_device *sink;
>> + u16 sink_pad;
>> + u32 flags;
>> + struct list_head list;
>> +};
>> +
>> +/**
>> + * struct vimc_platform_data_core - platform data to the core
>> + *
>> + * @data: see struct vimc_platform_data
>> + * @links: list of struct vimc_platform_data_link
>> + *
>> + * Board setup code will often provide additional information using the device's
>> + * platform_data field to hold additional information.
>> + * When injecting a new platform_device representing the core component, a list
>> + * of struct vimc_platform_data_list is required to allow the core to create
>> + * create the proper links between entities.
>> + */
>> +struct vimc_platform_data_core {
>> + struct vimc_platform_data data;
>> + struct list_head *links;
>> };
>>
>> /**
>> diff --git a/drivers/media/platform/vimc/vimc-configfs.c b/drivers/media/platform/vimc/vimc-configfs.c
>> new file mode 100644
>> index 000000000000..68e5f1ea736b
>> --- /dev/null
>> +++ b/drivers/media/platform/vimc/vimc-configfs.c
>> @@ -0,0 +1,665 @@
>> +// SPDX-License-Identifier: GPL-2.0+
>> +/*
>> + * vimc-configfs.c Virtual Media Controller Driver
>> + *
>> + * Copyright (C) 2018 Helen Koike <[email protected]>
>> + */
>> +
>> +#include <linux/component.h>
>> +#include <linux/module.h>
>> +#include <linux/slab.h>
>> +#include <linux/platform_device.h>
>> +
>> +#include "vimc-common.h"
>> +#include "vimc-configfs.h"
>> +#include "vimc-core.h"
>> +
>> +#define CHAR_SEPARATOR ':'
>> +#define LINK_SEPARATOR "->"
>> +#define CFS_SUBSYS_NAME "vimc"
>> +
>> +#define ci_err(ci, fmt, ...) \
>> + pr_err("vimc: %s: " pr_fmt(fmt), (ci)->ci_name, ##__VA_ARGS__)
>> +#define cg_err(cg, ...) ci_err(&(cg)->cg_item, ##__VA_ARGS__)
>> +#define ci_warn(ci, fmt, ...) \
>> + pr_warn("vimc: %s: " pr_fmt(fmt), (ci)->ci_name, ##__VA_ARGS__)
>> +#define cg_warn(cg, ...) ci_warn(&(cg)->cg_item, ##__VA_ARGS__)
>> +#define ci_dbg(ci, fmt, ...) \
>> + pr_debug("vimc: %s: " pr_fmt(fmt), (ci)->ci_name, ##__VA_ARGS__)
>> +#define cg_dbg(cg, ...) ci_dbg(&(cg)->cg_item, ##__VA_ARGS__)
>> +
>> +#define is_plugged(cfs) (!!(cfs)->pdev)
>> +
>> +enum vimc_cfs_hotplug_state {
>> + VIMC_CFS_HOTPLUG_STATE_UNPLUGGED = 0,
>> + VIMC_CFS_HOTPLUG_STATE_PLUGGED = 1,
>> +};
>> +
>> +const static char *vimc_cfs_hotplug_values[2][3] = {
>> + [VIMC_CFS_HOTPLUG_STATE_UNPLUGGED] = {"unplugged\n", "unplug\n", "0\n"},
>> + [VIMC_CFS_HOTPLUG_STATE_PLUGGED] = {"plugged\n", "plug\n", "1\n"},
>> +};
>> +
>> +/* --------------------------------------------------------------------------
>> + * Pipeline structures
>> + */
>> +
>> +static struct vimc_cfs_subsystem {
>> + struct configfs_subsystem subsys;
>> + struct list_head drvs;
>> +} vimc_cfs_subsys;
>> +
>> +/* Structure which describes the whole topology */
>> +struct vimc_cfs_device {
>> + struct platform_device *pdev;
>> + struct vimc_platform_data_core pdata;
>> + struct list_head ents;
>> + struct list_head links;
>> + struct config_group gdev;
>> + struct config_group gents;
>> + struct config_group glinks;
>> +};
>> +
>> +/* Structure which describes individual configuration for each entity */
>> +struct vimc_cfs_ent {
>> + struct platform_device *pdev;
>> + struct vimc_platform_data pdata;
>> + char drv[VIMC_MAX_NAME_LEN];
>> + struct list_head list;
>> + struct config_group cg;
>> +};
>> +
>> +/* Structure which describes links between entities */
>> +struct vimc_cfs_link {
>> + struct vimc_platform_data_link pdata;
>> + char source_name[VIMC_MAX_NAME_LEN];
>> + char sink_name[VIMC_MAX_NAME_LEN];
>> + struct config_item ci;
>> +};
>> +
>> +void vimc_cfs_drv_register(struct vimc_cfs_drv *c_drv)
>> +{
>> + list_add(&c_drv->list, &vimc_cfs_subsys.drvs);
>> +}
>> +EXPORT_SYMBOL_GPL(vimc_cfs_drv_register);
>> +
>> +void vimc_cfs_drv_unregister(struct vimc_cfs_drv *c_drv)
>> +{
>> + list_del(&c_drv->list);
>> +}
>> +EXPORT_SYMBOL_GPL(vimc_cfs_drv_unregister);
>> +
>> +/* --------------------------------------------------------------------------
>> + * Platform Device builders
>> + */
>> +
>> +static int vimc_cfs_link_get_entities(const struct vimc_cfs_device *cfs,
>> + struct vimc_cfs_link *c_link)
>> +{
>> + struct vimc_cfs_ent *c_ent;
>> +
>> + c_link->pdata.source = NULL;
>> + c_link->pdata.sink = NULL;
>> + list_for_each_entry(c_ent, &cfs->ents, list) {
>> + if (!c_link->pdata.source &&
>> + !strcmp(c_ent->pdata.name, c_link->source_name))
>> + c_link->pdata.source = c_ent->pdev;
>> + if (!c_link->pdata.sink &&
>> + !strcmp(c_ent->pdata.name, c_link->sink_name))
>> + c_link->pdata.sink = c_ent->pdev;
>> + if (c_link->pdata.source && c_link->pdata.sink)
>> + return 0;
>> + }
>> + return -EINVAL;
>> +}
>> +
>> +static int vimc_cfs_comp_compare(struct device *comp, void *data)
>> +{
>> + dev_dbg(comp, "comp compare %p %p", comp, data);
>> +
>> + return comp == data;
>> +}
>> +
>> +static const struct component_master_ops vimc_cfs_comp_ops = {
>> + .bind = vimc_core_comp_bind,
>> + .unbind = vimc_core_comp_unbind,
>> +};
>> +
>> +static void vimc_cfs_device_unplug(struct vimc_cfs_device *cfs)
>> +{
>> + struct vimc_cfs_ent *c_ent;
>> +
>> + dev_dbg(&cfs->pdev->dev, "Unplugging device");
>> +
>> + component_master_del(&cfs->pdev->dev, &vimc_cfs_comp_ops);
>> + list_for_each_entry(c_ent, &cfs->ents, list) {
>> + platform_device_unregister(c_ent->pdev);
>> + c_ent->pdev = NULL;
>> + }
>> + platform_device_unregister(cfs->pdev);
>> + cfs->pdev = NULL;
>> +}
>> +
>> +static int vimc_cfs_device_plug(struct vimc_cfs_device *cfs)
>> +{
>> + struct component_match *match = NULL;
>> + struct vimc_cfs_ent *c_ent;
>> + struct vimc_cfs_link *c_link;
>> + int ret = 0;
>> +
>> + cg_dbg(&cfs->gdev, "Plugging device");
>> +
>> + if (list_empty(&cfs->ents)) {
>> + /* TODO: add support for a default topology */
>> + cg_err(&cfs->gdev,
>> + "At least an entity is required to plug the device");
>> + return -EINVAL;
>> + }
>> +
>> + cfs->pdev = platform_device_register_data(NULL, VIMC_CORE_PDEV_NAME,
>> + PLATFORM_DEVID_AUTO,
>> + &cfs->pdata,
>> + sizeof(cfs->pdata));
>> + if (IS_ERR(cfs->pdev))
>> + return PTR_ERR(cfs->pdev);
>> +
>> + /* Add component_match for inner structure of the pipeline */
>> + list_for_each_entry(c_ent, &cfs->ents, list) {
>> + cg_dbg(&c_ent->cg, "registering entity %s:%s", c_ent->drv,
>> + c_ent->pdata.name);
>> + if (c_ent->pdev)
>> + cg_err(&c_ent->cg, "pdev is not null");
>> + c_ent->pdev = platform_device_register_data(&cfs->pdev->dev,
>> + c_ent->drv,
>> + PLATFORM_DEVID_AUTO,
>> + &c_ent->pdata,
>> + sizeof(c_ent->pdata));
>> + if (IS_ERR(c_ent->pdev)) {
>> + ret = PTR_ERR(c_ent->pdev);
>> + goto unregister_ents;
>> + }
>> + component_match_add(&cfs->pdev->dev, &match,
>> + vimc_cfs_comp_compare, &c_ent->pdev->dev);
>> + }
>> + list_for_each_entry(c_link, cfs->pdata.links, pdata.list) {
>> + ret = vimc_cfs_link_get_entities(cfs, c_link);
>> + if (ret) {
>> + ci_err(&c_link->ci, "could not validate link");
>> + goto unregister_ents;
>> + }
>> + }
>> +
>> + dev_dbg(&cfs->pdev->dev, "Adding master device");
>> + ret = component_master_add_with_match(&cfs->pdev->dev,
>> + &vimc_cfs_comp_ops, match);
>> + if (ret)
>> + goto unregister_ents;
>> +
>> + return 0;
>> +
>> +unregister_ents:
>> + list_for_each_entry_continue_reverse(c_ent, &cfs->ents, list) {
>> + platform_device_unregister(c_ent->pdev);
>> + c_ent->pdev = NULL;
>> + }
>> +
>> + platform_device_unregister(cfs->pdev);
>> + cfs->pdev = NULL;
>> +
>> + return ret;
>> +}
>> +
>> +/* --------------------------------------------------------------------------
>> + * Links
>> + */
>> +
>> +static ssize_t vimc_cfs_links_attr_flags_show(struct config_item *item,
>> + char *buf)
>> +{
>> + struct vimc_cfs_link *c_link = container_of(item, struct vimc_cfs_link,
>> + ci);
>> +
>> + sprintf(buf, "%d\n", c_link->pdata.flags);
>> + return strlen(buf);
>> +}
>> +
>> +static ssize_t vimc_cfs_links_attr_flags_store(struct config_item *item,
>> + const char *buf, size_t size)
>> +{
>> + struct vimc_cfs_link *c_link = container_of(item, struct vimc_cfs_link,
>> + ci);
>> +
>> + if (kstrtou32(buf, 0, &c_link->pdata.flags))
>> + return -EINVAL;
>> +
>> + return size;
>> +}
>> +
>> +CONFIGFS_ATTR(vimc_cfs_links_attr_, flags);
>> +
>> +static struct configfs_attribute *vimc_cfs_link_attrs[] = {
>> + &vimc_cfs_links_attr_attr_flags,
>> + NULL,
>> +};
>> +
>> +static void vimc_cfs_link_release(struct config_item *item)
>> +{
>> + struct vimc_cfs_link *c_link = container_of(item, struct vimc_cfs_link,
>> + ci);
>> +
>> + kfree(c_link);
>> +}
>> +
>> +static struct configfs_item_operations vimc_cfs_link_item_ops = {
>> + .release = vimc_cfs_link_release,
>> +};
>> +
>> +static struct config_item_type vimc_cfs_link_type = {
>> + .ct_item_ops = &vimc_cfs_link_item_ops,
>> + .ct_attrs = vimc_cfs_link_attrs,
>> + .ct_owner = THIS_MODULE,
>> +};
>> +
>> +static void vimc_cfs_link_drop_item(struct config_group *group,
>> + struct config_item *item)
>> +{
>> + struct vimc_cfs_link *link = container_of(item,
>> + struct vimc_cfs_link, ci);
>> + struct vimc_cfs_device *cfs = container_of(group,
>> + struct vimc_cfs_device,
>> + glinks);
>> +
>> + if (is_plugged(cfs))
>> + vimc_cfs_device_unplug(cfs);
>> + list_del(&link->pdata.list);
>> +}
>> +
>> +static struct config_item *vimc_cfs_link_make_item(struct config_group *group,
>> + const char *name)
>> +{
>> + struct vimc_cfs_device *cfs = container_of(group,
>> + struct vimc_cfs_device,
>> + glinks);
>> + size_t src_pad_strlen, sink_pad_strlen, sink_namelen, source_namelen;
>> + const char *sep, *src_pad_str, *sink_pad_str, *sink_name,
>> + *source_name = name;
>> + struct vimc_cfs_link *c_link;
>> + u16 source_pad, sink_pad;
>> + char tmp[4];
>> +
>> + cg_dbg(&cfs->gdev, "Creating link %s", name);
>> +
>> + if (is_plugged(cfs))
>> + vimc_cfs_device_unplug(cfs);
>> +
>> + /* Parse format "source_name:source_pad->sink_name:sink_pad" */
>> + sep = strchr(source_name, CHAR_SEPARATOR);
>> + if (!sep)
>> + goto syntax_error;
>> + source_namelen = (size_t)(sep - source_name);
>> +
>> + src_pad_str = &sep[1];
>> + sep = strstr(src_pad_str, LINK_SEPARATOR);
>> + if (!sep)
>> + goto syntax_error;
>> + src_pad_strlen = (size_t)(sep - src_pad_str);
>> +
>> + sink_name = &sep[strlen(LINK_SEPARATOR)];
>> + sep = strchr(sink_name, CHAR_SEPARATOR);
>> + if (!sep)
>> + goto syntax_error;
>> + sink_namelen = (size_t)(sep - sink_name);
>> +
>> + sink_pad_str = &sep[1];
>> + sink_pad_strlen = strlen(sink_pad_str);
>> +
>> + /* Validate sizes */
>> + if (!src_pad_strlen || !sink_pad_strlen ||
>> + !sink_namelen || !source_namelen)
>> + goto syntax_error;
>> +
>> + /* we limit the size here so we don't need to allocate another buffer */
>> + if (src_pad_strlen >= sizeof(tmp) || sink_pad_strlen >= sizeof(tmp)) {
>> + cg_err(&cfs->gdev,
>> + "Pad with more then %ld digits is not supported",
>> + sizeof(tmp) - 1);
>> + goto syntax_error;
>> + }
>> + strscpy(tmp, src_pad_str, src_pad_strlen + 1);
>> + if (kstrtou16(tmp, 0, &source_pad)) {
>> + cg_err(&cfs->gdev, "Couldn't convert pad %s to number", tmp);
>> + goto syntax_error;
>> + }
>> + strscpy(tmp, sink_pad_str, sink_pad_strlen + 1);
>> + if (kstrtou16(tmp, 0, &sink_pad)) {
>> + cg_err(&cfs->gdev, "Couldn't convert pad %s to number", tmp);
>> + goto syntax_error;
>> + }
>> +
>> + c_link = kzalloc(sizeof(*c_link), GFP_KERNEL);
>> + if (!c_link)
>> + return ERR_PTR(-ENOMEM);
>> +
>> + c_link->pdata.source_pad = source_pad;
>> + c_link->pdata.sink_pad = sink_pad;
>> + strscpy(c_link->source_name, source_name, source_namelen + 1);
>> + strscpy(c_link->sink_name, sink_name, sink_namelen + 1);
>> +
>> + /* Configure group */
>> + list_add(&c_link->pdata.list, cfs->pdata.links);
>> + config_item_init_type_name(&c_link->ci, name, &vimc_cfs_link_type);
>> +
>> + return &c_link->ci;
>> +
>> +syntax_error:
>> + cg_err(&cfs->gdev,
>> + "Couldn't create link %s, wrong syntax.", name);
>> + return ERR_PTR(-EINVAL);
>> +}
>> +
>> +/* --------------------------------------------------------------------------
>> + * Entities
>> + */
>> +
>> +/* *TODO: add support for hotplug in entity level */
>
> *TODO -> TODO
>
> in entity -> at entity
>
>> +
>> +static int vimc_cfs_drv_cb(const char *drv_name, struct config_group *group)
>> +{
>> + struct vimc_cfs_drv *c_drv = NULL;
>> +
>> + list_for_each_entry(c_drv, &vimc_cfs_subsys.drvs, list) {
>> + if (!strcmp(drv_name, c_drv->name))
>> + break;
>> + }
>> + if (!c_drv)
>> + return -EINVAL;
>> +
>> + if (c_drv->configfs_cb)
>> + c_drv->configfs_cb(group);
>> +
>> + return 0;
>> +}
>> +
>> +static void vimc_cfs_ent_release(struct config_item *item)
>> +{
>> + struct vimc_cfs_ent *c_ent = container_of(item, struct vimc_cfs_ent,
>> + cg.cg_item);
>> +
>> + kfree(c_ent);
>> +}
>> +
>> +static struct configfs_item_operations vimc_cfs_ent_item_ops = {
>> + .release = vimc_cfs_ent_release,
>> +};
>> +
>> +static struct config_item_type vimc_cfs_ent_type = {
>> + .ct_item_ops = &vimc_cfs_ent_item_ops,
>> + .ct_owner = THIS_MODULE,
>> +};
>> +
>> +static void vimc_cfs_ent_drop_item(struct config_group *group,
>> + struct config_item *item)
>> +{
>> + struct vimc_cfs_ent *c_ent = container_of(item, struct vimc_cfs_ent,
>> + cg.cg_item);
>> + struct vimc_cfs_device *cfs = container_of(group,
>> + struct vimc_cfs_device,
>> + gents);
>> +
>> + if (is_plugged(cfs))
>> + vimc_cfs_device_unplug(cfs);
>> + list_del(&c_ent->list);
>> +}
>> +
>> +static struct config_group *vimc_cfs_ent_make_group(struct config_group *group,
>> + const char *name)
>> +{
>> + struct vimc_cfs_device *cfs = container_of(group,
>> + struct vimc_cfs_device,
>> + gents);
>> + const char *drv_name = name;
>> + char *ent_name, *sep = strchr(drv_name, CHAR_SEPARATOR);
>> + struct vimc_cfs_ent *c_ent;
>> + size_t drv_namelen;
>> +
>> + if (is_plugged(cfs))
>> + vimc_cfs_device_unplug(cfs);
>> +
>> + /* Parse format "drv_name:ent_name" */
>> + if (!sep) {
>> + cg_err(&cfs->gdev,
>> + "Could not find separator '%c'", CHAR_SEPARATOR);
>> + goto syntax_error;
>> + }
>> + drv_namelen = (size_t)(sep - drv_name);
>> + ent_name = &sep[1];
>> + if (!*ent_name || !drv_namelen) {
>> + cg_err(&cfs->gdev,
>> + "%s: Driver name and entity name can't be empty.",
>> + name);
>> + goto syntax_error;
>> + }
>> + if (drv_namelen >= sizeof(c_ent->drv)) {
>> + cg_err(&cfs->gdev,
>> + "%s: Driver name length should be less then %ld.",
>> + name, sizeof(c_ent->drv));
>> + goto syntax_error;
>> + }
>> +
>> + c_ent = kzalloc(sizeof(*c_ent), GFP_KERNEL);
>> + if (!c_ent)
>> + return ERR_PTR(-ENOMEM);
>> +
>> + /* Configure platform device */
>> + strscpy(c_ent->drv, drv_name, drv_namelen + 1);
>> + strscpy(c_ent->pdata.name, ent_name, sizeof(c_ent->pdata.name));
>> + c_ent->pdata.group = &c_ent->cg;
>> +
>> + cg_dbg(&cfs->gdev, "New entity %s:%s", c_ent->drv, c_ent->pdata.name);
>> +
>> + /* Configure group */
>> + config_group_init_type_name(&c_ent->cg, name, &vimc_cfs_ent_type);
>> + if (vimc_cfs_drv_cb(c_ent->drv, &c_ent->cg)) {
>> + cg_err(&c_ent->cg, "Module %s not found", c_ent->drv);
>> + kfree(c_ent);
>> + return ERR_PTR(-EINVAL);
>> + }
>> + list_add(&c_ent->list, &cfs->ents);
>> +
>> + return &c_ent->cg;
>> +
>> +syntax_error:
>> + cg_err(&cfs->gdev,
>> + "Couldn't create entity %s, wrong syntax.", name);
>> + return ERR_PTR(-EINVAL);
>> +}
>> +
>> +/* --------------------------------------------------------------------------
>> + * Default group: Links
>> + */
>> +
>> +static struct configfs_group_operations vimc_cfs_dlink_group_ops = {
>> + .make_item = vimc_cfs_link_make_item,
>> + .drop_item = vimc_cfs_link_drop_item,
>> +};
>> +
>> +static struct config_item_type vimc_cfs_dlink_type = {
>> + .ct_group_ops = &vimc_cfs_dlink_group_ops,
>> + .ct_owner = THIS_MODULE,
>> +};
>> +
>> +void vimc_cfs_dlink_add_default_group(struct vimc_cfs_device *cfs)
>> +{
>> + config_group_init_type_name(&cfs->glinks, "links",
>> + &vimc_cfs_dlink_type);
>> + configfs_add_default_group(&cfs->glinks, &cfs->gdev);
>> +}
>> +
>> +/* --------------------------------------------------------------------------
>> + * Default group: Entities
>> + */
>> +
>> +static struct configfs_group_operations vimc_cfs_dent_group_ops = {
>> + .make_group = vimc_cfs_ent_make_group,
>> + .drop_item = vimc_cfs_ent_drop_item,
>> +};
>> +
>> +static struct config_item_type vimc_cfs_dent_type = {
>> + .ct_group_ops = &vimc_cfs_dent_group_ops,
>> + .ct_owner = THIS_MODULE,
>> +};
>> +
>> +void vimc_cfs_dent_add_default_group(struct vimc_cfs_device *cfs)
>> +{
>> + config_group_init_type_name(&cfs->gents, "entities",
>> + &vimc_cfs_dent_type);
>> + configfs_add_default_group(&cfs->gents, &cfs->gdev);
>> +}
>> +
>> +/* --------------------------------------------------------------------------
>> + * Device instance
>> + */
>> +
>> +static int vimc_cfs_decode_state(const char *buf, size_t size)
>> +{
>> + unsigned int i, j;
>> +
>> + for (i = 0; i < ARRAY_SIZE(vimc_cfs_hotplug_values); i++) {
>> + for (j = 0; j < ARRAY_SIZE(vimc_cfs_hotplug_values[0]); j++) {
>> + if (!strncmp(buf, vimc_cfs_hotplug_values[i][j], size))
>> + return i;
>> + }
>> + }
>> + return -EINVAL;
>> +}
>> +
>> +static ssize_t vimc_cfs_dev_attr_hotplug_show(struct config_item *item,
>> + char *buf)
>> +{
>> + struct vimc_cfs_device *cfs = container_of(item, struct vimc_cfs_device,
>> + gdev.cg_item);
>> +
>> + strcpy(buf, vimc_cfs_hotplug_values[is_plugged(cfs)][0]);
>> + return strlen(buf);
>> +}
>> +
>> +static int vimc_cfs_hotplug_set(struct vimc_cfs_device *cfs,
>> + enum vimc_cfs_hotplug_state state)
>> +{
>> + if (state == is_plugged(cfs)) {
>> + return 0;
>> + } else if (state == VIMC_CFS_HOTPLUG_STATE_UNPLUGGED) {
>> + vimc_cfs_device_unplug(cfs);
>> + return 0;
>> + } else if (state == VIMC_CFS_HOTPLUG_STATE_PLUGGED) {
>> + return vimc_cfs_device_plug(cfs);
>> + }
>> + return -EINVAL;
>> +}
>> +
>> +static ssize_t vimc_cfs_dev_attr_hotplug_store(struct config_item *item,
>> + const char *buf, size_t size)
>> +{
>> + struct vimc_cfs_device *cfs = container_of(item, struct vimc_cfs_device,
>> + gdev.cg_item);
>> + int state = vimc_cfs_decode_state(buf, size);
>> +
>> + if (vimc_cfs_hotplug_set(cfs, state))
>> + return -EINVAL;
>> + return size;
>> +}
>> +
>> +CONFIGFS_ATTR(vimc_cfs_dev_attr_, hotplug);
>> +
>> +static struct configfs_attribute *vimc_cfs_dev_attrs[] = {
>> + &vimc_cfs_dev_attr_attr_hotplug,
>> + NULL,
>> +};
>> +
>> +static void vimc_cfs_dev_release(struct config_item *item)
>> +{
>> + struct vimc_cfs_device *cfs = container_of(item, struct vimc_cfs_device,
>> + gdev.cg_item);
>> +
>> + kfree(cfs);
>> +}
>> +
>> +static struct configfs_item_operations vimc_cfs_dev_item_ops = {
>> + .release = vimc_cfs_dev_release,
>> +};
>> +
>> +static struct config_item_type vimc_cfs_dev_type = {
>> + .ct_item_ops = &vimc_cfs_dev_item_ops,
>> + .ct_attrs = vimc_cfs_dev_attrs,
>> + .ct_owner = THIS_MODULE,
>> +};
>> +
>> +static void vimc_cfs_dev_drop_item(struct config_group *group,
>> + struct config_item *item)
>> +{
>> + struct vimc_cfs_device *cfs = container_of(group,
>> + struct vimc_cfs_device,
>> + gdev);
>> +
>> + if (is_plugged(cfs))
>> + vimc_cfs_device_unplug(cfs);
>> +}
>> +
>> +static struct config_group *vimc_cfs_dev_make_group(
>> + struct config_group *group, const char *name)
>> +{
>> + struct vimc_cfs_device *cfs = kzalloc(sizeof(*cfs), GFP_KERNEL);
>> +
>> + if (!cfs)
>> + return ERR_PTR(-ENOMEM);
>> +
>> + /* Configure pipeline */
>> + INIT_LIST_HEAD(&cfs->ents);
>> + INIT_LIST_HEAD(&cfs->links);
>> +
>> + /* Configure platform data */
>> + strscpy(cfs->pdata.data.name, name, sizeof(cfs->pdata.data.name));
>> + cfs->pdata.data.group = &cfs->gdev;
>> + cfs->pdata.links = &cfs->links;
>> +
>> + /* Configure configfs group */
>> + config_group_init_type_name(&cfs->gdev, name, &vimc_cfs_dev_type);
>> + vimc_cfs_dent_add_default_group(cfs);
>> + vimc_cfs_dlink_add_default_group(cfs);
>> +
>> + return &cfs->gdev;
>> +}
>> +
>> +/* --------------------------------------------------------------------------
>> + * Subsystem
>> + */
>> +
>> +static struct configfs_group_operations vimc_cfs_subsys_group_ops = {
>> + /* Create vimc devices */
>> + .make_group = vimc_cfs_dev_make_group,
>> + .drop_item = vimc_cfs_dev_drop_item,
>> +};
>> +
>> +static struct config_item_type vimc_cfs_subsys_type = {
>> + .ct_group_ops = &vimc_cfs_subsys_group_ops,
>> + .ct_owner = THIS_MODULE,
>> +};
>> +
>> +int vimc_cfs_subsys_register(void)
>> +{
>> + struct configfs_subsystem *subsys = &vimc_cfs_subsys.subsys;
>> + int ret;
>> +
>> + INIT_LIST_HEAD(&vimc_cfs_subsys.drvs);
>> + config_group_init_type_name(&subsys->su_group, CFS_SUBSYS_NAME,
>> + &vimc_cfs_subsys_type);
>> + mutex_init(&subsys->su_mutex);
>> + ret = configfs_register_subsystem(subsys);
>> +
>> + return ret;
>> +}
>> +
>> +void vimc_cfs_subsys_unregister(void)
>> +{
>> + configfs_unregister_subsystem(&vimc_cfs_subsys.subsys);
>> +}
>> diff --git a/drivers/media/platform/vimc/vimc-configfs.h b/drivers/media/platform/vimc/vimc-configfs.h
>> new file mode 100644
>> index 000000000000..6278b53d11ba
>> --- /dev/null
>> +++ b/drivers/media/platform/vimc/vimc-configfs.h
>> @@ -0,0 +1,30 @@
>> +/* SPDX-License-Identifier: GPL-2.0+ */
>> +/*
>> + * vimc-configfs.h Virtual Media Controller Driver
>> + *
>> + * Copyright (C) 2018 Helen Koike <[email protected]>
>> + */
>> +
>> +#ifndef _VIMC_CONFIGFS_H_
>> +#define _VIMC_CONFIGFS_H_
>> +
>> +#include <linux/configfs.h>
>> +
>> +#define VIMC_CFS_SRC_PAD_NAME(n) "pad:source:" #n
>> +#define VIMC_CFS_SINK_PAD_NAME(n) "pad:sink:" #n
>> +
>> +struct vimc_cfs_drv {
>> + const char *name;
>> + void (*const configfs_cb)(struct config_group *group);
>> + struct list_head list;
>> +};
>> +
>> +int vimc_cfs_subsys_register(void);
>> +
>> +void vimc_cfs_subsys_unregister(void);
>> +
>> +void vimc_cfs_drv_register(struct vimc_cfs_drv *c_drv);
>> +
>> +void vimc_cfs_drv_unregister(struct vimc_cfs_drv *c_drv);
>> +
>> +#endif
>> diff --git a/drivers/media/platform/vimc/vimc-core.c b/drivers/media/platform/vimc/vimc-core.c
>> index ce809d2e3d53..816015e7c8f6 100644
>> --- a/drivers/media/platform/vimc/vimc-core.c
>> +++ b/drivers/media/platform/vimc/vimc-core.c
>> @@ -23,150 +23,29 @@
>> #include <media/v4l2-device.h>
>>
>> #include "vimc-common.h"
>> -
>> -#define VIMC_PDEV_NAME "vimc"
>> -#define VIMC_MDEV_MODEL_NAME "VIMC MDEV"
>> -
>> -#define VIMC_ENT_LINK(src, srcpad, sink, sinkpad, link_flags) { \
>> - .src_ent = src, \
>> - .src_pad = srcpad, \
>> - .sink_ent = sink, \
>> - .sink_pad = sinkpad, \
>> - .flags = link_flags, \
>> -}
>> +#include "vimc-configfs.h"
>>
>> struct vimc_device {
>> - /* The platform device */
>> - struct platform_device pdev;
>> -
>> - /* The pipeline configuration */
>> - const struct vimc_pipeline_config *pipe_cfg;
>> -
>> /* The Associated media_device parent */
>> struct media_device mdev;
>>
>> /* Internal v4l2 parent device*/
>> struct v4l2_device v4l2_dev;
>> -
>> - /* Subdevices */
>> - struct platform_device **subdevs;
>> -};
>> -
>> -/* Structure which describes individual configuration for each entity */
>> -struct vimc_ent_config {
>> - const char *name;
>> - const char *drv;
>> -};
>> -
>> -/* Structure which describes links between entities */
>> -struct vimc_ent_link {
>> - unsigned int src_ent;
>> - u16 src_pad;
>> - unsigned int sink_ent;
>> - u16 sink_pad;
>> - u32 flags;
>> -};
>> -
>> -/* Structure which describes the whole topology */
>> -struct vimc_pipeline_config {
>> - const struct vimc_ent_config *ents;
>> - size_t num_ents;
>> - const struct vimc_ent_link *links;
>> - size_t num_links;
>> -};
>> -
>> -/* --------------------------------------------------------------------------
>> - * Topology Configuration
>> - */
>> -
>> -static const struct vimc_ent_config ent_config[] = {
>> - {
>> - .name = "Sensor A",
>> - .drv = "vimc-sensor",
>> - },
>> - {
>> - .name = "Sensor B",
>> - .drv = "vimc-sensor",
>> - },
>> - {
>> - .name = "Debayer A",
>> - .drv = "vimc-debayer",
>> - },
>> - {
>> - .name = "Debayer B",
>> - .drv = "vimc-debayer",
>> - },
>> - {
>> - .name = "Raw Capture 0",
>> - .drv = "vimc-capture",
>> - },
>> - {
>> - .name = "Raw Capture 1",
>> - .drv = "vimc-capture",
>> - },
>> - {
>> - .name = "RGB/YUV Input",
>> - /* TODO: change this to vimc-input when it is implemented */
>> - .drv = "vimc-sensor",
>> - },
>> - {
>> - .name = "Scaler",
>> - .drv = "vimc-scaler",
>> - },
>> - {
>> - .name = "RGB/YUV Capture",
>> - .drv = "vimc-capture",
>> - },
>> -};
>> -
>> -static const struct vimc_ent_link ent_links[] = {
>> - /* Link: Sensor A (Pad 0)->(Pad 0) Debayer A */
>> - VIMC_ENT_LINK(0, 0, 2, 0, MEDIA_LNK_FL_ENABLED | MEDIA_LNK_FL_IMMUTABLE),
>> - /* Link: Sensor A (Pad 0)->(Pad 0) Raw Capture 0 */
>> - VIMC_ENT_LINK(0, 0, 4, 0, MEDIA_LNK_FL_ENABLED | MEDIA_LNK_FL_IMMUTABLE),
>> - /* Link: Sensor B (Pad 0)->(Pad 0) Debayer B */
>> - VIMC_ENT_LINK(1, 0, 3, 0, MEDIA_LNK_FL_ENABLED | MEDIA_LNK_FL_IMMUTABLE),
>> - /* Link: Sensor B (Pad 0)->(Pad 0) Raw Capture 1 */
>> - VIMC_ENT_LINK(1, 0, 5, 0, MEDIA_LNK_FL_ENABLED | MEDIA_LNK_FL_IMMUTABLE),
>> - /* Link: Debayer A (Pad 1)->(Pad 0) Scaler */
>> - VIMC_ENT_LINK(2, 1, 7, 0, MEDIA_LNK_FL_ENABLED),
>> - /* Link: Debayer B (Pad 1)->(Pad 0) Scaler */
>> - VIMC_ENT_LINK(3, 1, 7, 0, 0),
>> - /* Link: RGB/YUV Input (Pad 0)->(Pad 0) Scaler */
>> - VIMC_ENT_LINK(6, 0, 7, 0, 0),
>> - /* Link: Scaler (Pad 1)->(Pad 0) RGB/YUV Capture */
>> - VIMC_ENT_LINK(7, 1, 8, 0, MEDIA_LNK_FL_ENABLED | MEDIA_LNK_FL_IMMUTABLE),
>> -};
>> -
>> -static const struct vimc_pipeline_config pipe_cfg = {
>> - .ents = ent_config,
>> - .num_ents = ARRAY_SIZE(ent_config),
>> - .links = ent_links,
>> - .num_links = ARRAY_SIZE(ent_links)
>> };
>>
>> -/* -------------------------------------------------------------------------- */
>> -
>> -static int vimc_create_links(struct vimc_device *vimc)
>> +static int vimc_core_links_create(const struct device *master)
>> {
>> - unsigned int i;
>> + struct vimc_platform_data_core *pdata = master->platform_data;
>> + struct vimc_ent_device *ved_src, *ved_sink;
>> + struct vimc_platform_data_link *plink;
>> int ret;
>>
>> - /* Initialize the links between entities */
>> - for (i = 0; i < vimc->pipe_cfg->num_links; i++) {
>> - const struct vimc_ent_link *link = &vimc->pipe_cfg->links[i];
>> - /*
>> - * TODO: Check another way of retrieving ved struct without
>> - * relying on platform_get_drvdata
>> - */
>> - struct vimc_ent_device *ved_src =
>> - platform_get_drvdata(vimc->subdevs[link->src_ent]);
>> - struct vimc_ent_device *ved_sink =
>> - platform_get_drvdata(vimc->subdevs[link->sink_ent]);
>> -
>> - ret = media_create_pad_link(ved_src->ent, link->src_pad,
>> - ved_sink->ent, link->sink_pad,
>> - link->flags);
>> + list_for_each_entry(plink, pdata->links, list) {
>> + ved_src = platform_get_drvdata(plink->source);
>> + ved_sink = platform_get_drvdata(plink->sink);
>> + ret = media_create_pad_link(ved_src->ent, plink->source_pad,
>> + ved_sink->ent, plink->sink_pad,
>> + plink->flags);
>> if (ret)
>> return ret;
>> }
>> @@ -174,10 +53,10 @@ static int vimc_create_links(struct vimc_device *vimc)
>> return 0;
>> }
>>
>> -static int vimc_comp_bind(struct device *master)
>> +int vimc_core_comp_bind(struct device *master)
>> {
>> - struct vimc_device *vimc = container_of(to_platform_device(master),
>> - struct vimc_device, pdev);
>> + struct vimc_device *vimc =
>> + platform_get_drvdata(to_platform_device(master));
>> int ret;
>>
>> dev_dbg(master, "bind");
>> @@ -194,9 +73,7 @@ static int vimc_comp_bind(struct device *master)
>> ret = component_bind_all(master, &vimc->v4l2_dev);
>> if (ret)
>> goto err_v4l2_unregister;
>> -
>> - /* Initialize links */
>> - ret = vimc_create_links(vimc);
>> + ret = vimc_core_links_create(master);
>> if (ret)
>> goto err_comp_unbind_all;
>>
>> @@ -228,11 +105,12 @@ static int vimc_comp_bind(struct device *master)
>>
>> return ret;
>> }
>> +EXPORT_SYMBOL_GPL(vimc_core_comp_bind);
>>
>> -static void vimc_comp_unbind(struct device *master)
>> +void vimc_core_comp_unbind(struct device *master)
>> {
>> - struct vimc_device *vimc = container_of(to_platform_device(master),
>> - struct vimc_device, pdev);
>> + struct vimc_device *vimc =
>> + platform_get_drvdata(to_platform_device(master));
>>
>> dev_dbg(master, "unbind");
>>
>> @@ -240,147 +118,56 @@ static void vimc_comp_unbind(struct device *master)
>> component_unbind_all(master, NULL);
>> v4l2_device_unregister(&vimc->v4l2_dev);
>> }
>> -
>> -static int vimc_comp_compare(struct device *comp, void *data)
>> -{
>> - const struct platform_device *pdev = to_platform_device(comp);
>> - const char *name = data;
>> -
>> - return !strcmp(pdev->dev.platform_data, name);
>> -}
>> -
>> -static struct component_match *vimc_add_subdevs(struct vimc_device *vimc)
>> -{
>> - struct component_match *match = NULL;
>> - struct vimc_platform_data pdata;
>> - int i;
>> -
>> - for (i = 0; i < vimc->pipe_cfg->num_ents; i++) {
>> - dev_dbg(&vimc->pdev.dev, "new pdev for %s\n",
>> - vimc->pipe_cfg->ents[i].drv);
>> -
>> - strscpy(pdata.entity_name, vimc->pipe_cfg->ents[i].name,
>> - sizeof(pdata.entity_name));
>> -
>> - vimc->subdevs[i] = platform_device_register_data(&vimc->pdev.dev,
>> - vimc->pipe_cfg->ents[i].drv,
>> - PLATFORM_DEVID_AUTO,
>> - &pdata,
>> - sizeof(pdata));
>> - if (IS_ERR(vimc->subdevs[i])) {
>> - match = ERR_CAST(vimc->subdevs[i]);
>> - while (--i >= 0)
>> - platform_device_unregister(vimc->subdevs[i]);
>> -
>> - return match;
>> - }
>> -
>> - component_match_add(&vimc->pdev.dev, &match, vimc_comp_compare,
>> - (void *)vimc->pipe_cfg->ents[i].name);
>> - }
>> -
>> - return match;
>> -}
>> -
>> -static void vimc_rm_subdevs(struct vimc_device *vimc)
>> -{
>> - unsigned int i;
>> -
>> - for (i = 0; i < vimc->pipe_cfg->num_ents; i++)
>> - platform_device_unregister(vimc->subdevs[i]);
>> -}
>> -
>> -static const struct component_master_ops vimc_comp_ops = {
>> - .bind = vimc_comp_bind,
>> - .unbind = vimc_comp_unbind,
>> -};
>> +EXPORT_SYMBOL_GPL(vimc_core_comp_unbind);
>>
>> static int vimc_probe(struct platform_device *pdev)
>> {
>> - struct vimc_device *vimc = container_of(pdev, struct vimc_device, pdev);
>> - struct component_match *match = NULL;
>> - int ret;
>> + const struct vimc_platform_data_core *pdata = pdev->dev.platform_data;
>> + struct vimc_device *vimc = devm_kzalloc(&pdev->dev, sizeof(*vimc),
>> + GFP_KERNEL);
>>
>> dev_dbg(&pdev->dev, "probe");
>>
>> - /* Create platform_device for each entity in the topology*/
>> - vimc->subdevs = devm_kcalloc(&vimc->pdev.dev, vimc->pipe_cfg->num_ents,
>> - sizeof(*vimc->subdevs), GFP_KERNEL);
>> - if (!vimc->subdevs)
>> - return -ENOMEM;
>> -
>> - match = vimc_add_subdevs(vimc);
>> - if (IS_ERR(match))
>> - return PTR_ERR(match);
>> -
>> - /* Link the media device within the v4l2_device */
>> - vimc->v4l2_dev.mdev = &vimc->mdev;
>> -
>> /* Initialize media device */
>> - strscpy(vimc->mdev.model, VIMC_MDEV_MODEL_NAME,
>> - sizeof(vimc->mdev.model));
>> + strscpy(vimc->mdev.model, pdata->data.name, sizeof(vimc->mdev.model));
>
> You'll need to fill in the bus_info as well. This will be needed by v4l2-compliance
> in case that there are multiple vimc media devices created, so it will know which
> media device to open.
>
> The bus_info should match the bus_info returned by VIDIOC_QUERYCAP for video nodes
> and should be unique for each media device.
>
>> vimc->mdev.dev = &pdev->dev;
>> media_device_init(&vimc->mdev);
>> + vimc->v4l2_dev.mdev = &vimc->mdev;
>>
>> - /* Add self to the component system */
>> - ret = component_master_add_with_match(&pdev->dev, &vimc_comp_ops,
>> - match);
>> - if (ret) {
>> - media_device_cleanup(&vimc->mdev);
>> - vimc_rm_subdevs(vimc);
>> - return ret;
>> - }
>> + platform_set_drvdata(pdev, vimc);
>>
>> return 0;
>> }
>>
>> static int vimc_remove(struct platform_device *pdev)
>> {
>> - struct vimc_device *vimc = container_of(pdev, struct vimc_device, pdev);
>> + struct vimc_device *vimc = platform_get_drvdata(pdev);
>>
>> dev_dbg(&pdev->dev, "remove");
>>
>> - component_master_del(&pdev->dev, &vimc_comp_ops);
>> - vimc_rm_subdevs(vimc);
>> + media_device_cleanup(&vimc->mdev);
>>
>> return 0;
>> }
>>
>> -static void vimc_dev_release(struct device *dev)
>> -{
>> -}
>> -
>> -static struct vimc_device vimc_dev = {
>> - .pipe_cfg = &pipe_cfg,
>> - .pdev = {
>> - .name = VIMC_PDEV_NAME,
>> - .dev.release = vimc_dev_release,
>> - }
>> -};
>> -
>> static struct platform_driver vimc_pdrv = {
>> .probe = vimc_probe,
>> .remove = vimc_remove,
>> .driver = {
>> - .name = VIMC_PDEV_NAME,
>> - },
>> + .name = "vimc-core",
>> + }
>> };
>>
>> static int __init vimc_init(void)
>> {
>> int ret;
>>
>> - ret = platform_device_register(&vimc_dev.pdev);
>> - if (ret) {
>> - dev_err(&vimc_dev.pdev.dev,
>> - "platform device registration failed (err=%d)\n", ret);
>> + ret = platform_driver_register(&vimc_pdrv);
>> + if (ret)
>> return ret;
>> - }
>>
>> - ret = platform_driver_register(&vimc_pdrv);
>> + ret = vimc_cfs_subsys_register();
>> if (ret) {
>> - dev_err(&vimc_dev.pdev.dev,
>> - "platform driver registration failed (err=%d)\n", ret);
>> platform_driver_unregister(&vimc_pdrv);
>> return ret;
>> }
>> @@ -390,9 +177,9 @@ static int __init vimc_init(void)
>>
>> static void __exit vimc_exit(void)
>> {
>> - platform_driver_unregister(&vimc_pdrv);
>> + vimc_cfs_subsys_unregister();
>>
>> - platform_device_unregister(&vimc_dev.pdev);
>> + platform_driver_unregister(&vimc_pdrv);
>> }
>>
>> module_init(vimc_init);
>> diff --git a/drivers/media/platform/vimc/vimc-core.h b/drivers/media/platform/vimc/vimc-core.h
>> new file mode 100644
>> index 000000000000..42c8f92354af
>> --- /dev/null
>> +++ b/drivers/media/platform/vimc/vimc-core.h
>> @@ -0,0 +1,17 @@
>> +/* SPDX-License-Identifier: GPL-2.0+ */
>> +/*
>> + * vimc-core.h Virtual Media Controller Driver
>> + *
>> + * Copyright (C) 2018 Helen Koike <[email protected]>
>> + */
>> +
>> +#ifndef _VIMC_CORE_H_
>> +#define _VIMC_CORE_H_
>> +
>> +#define VIMC_CORE_PDEV_NAME "vimc-core"
>> +
>> +int vimc_core_comp_bind(struct device *master);
>> +
>> +void vimc_core_comp_unbind(struct device *master);
>> +
>> +#endif
>> diff --git a/drivers/media/platform/vimc/vimc-debayer.c b/drivers/media/platform/vimc/vimc-debayer.c
>> index 77887f66f323..fa326dbb7562 100644
>> --- a/drivers/media/platform/vimc/vimc-debayer.c
>> +++ b/drivers/media/platform/vimc/vimc-debayer.c
>> @@ -23,6 +23,7 @@
>> #include <linux/v4l2-mediabus.h>
>> #include <media/v4l2-subdev.h>
>>
>> +#include "vimc-configfs.h"
>> #include "vimc-common.h"
>>
>> #define VIMC_DEB_DRV_NAME "vimc-debayer"
>> @@ -522,7 +523,7 @@ static int vimc_deb_comp_bind(struct device *comp, struct device *master,
>> void *master_data)
>> {
>> struct v4l2_device *v4l2_dev = master_data;
>> - struct vimc_platform_data *pdata = comp->platform_data;
>> + struct vimc_platform_data *pdata = dev_get_platdata(comp);
>> struct vimc_deb_device *vdeb;
>> int ret;
>>
>> @@ -532,8 +533,7 @@ static int vimc_deb_comp_bind(struct device *comp, struct device *master,
>> return -ENOMEM;
>>
>> /* Initialize ved and sd */
>> - ret = vimc_ent_sd_register(&vdeb->ved, &vdeb->sd, v4l2_dev,
>> - pdata->entity_name,
>> + ret = vimc_ent_sd_register(&vdeb->ved, &vdeb->sd, v4l2_dev, pdata->name,
>> MEDIA_ENT_F_PROC_VIDEO_PIXEL_ENC_CONV, 2,
>> (const unsigned long[2]) {MEDIA_PAD_FL_SINK,
>> MEDIA_PAD_FL_SOURCE},
>> @@ -594,7 +594,50 @@ static struct platform_driver vimc_deb_pdrv = {
>> },
>> };
>>
>> -module_platform_driver(vimc_deb_pdrv);
>> +static struct config_item_type vimc_deb_cfs_pad_type = {
>> + .ct_owner = THIS_MODULE,
>> +};
>> +
>> +static struct config_group vimc_deb_cfs_sink_pad_group;
>> +static struct config_group vimc_deb_cfs_src_pad_group;
>> +
>> +static void vimc_deb_configfs_cb(struct config_group *group)
>> +{
>> + config_group_init_type_name(&vimc_deb_cfs_sink_pad_group,
>> + VIMC_CFS_SINK_PAD_NAME(0),
>> + &vimc_deb_cfs_pad_type);
>> + configfs_add_default_group(&vimc_deb_cfs_sink_pad_group, group);
>> +
>> + config_group_init_type_name(&vimc_deb_cfs_src_pad_group,
>> + VIMC_CFS_SRC_PAD_NAME(1),
>> + &vimc_deb_cfs_pad_type);
>> + configfs_add_default_group(&vimc_deb_cfs_src_pad_group, group);
>> +}
>> +
>> +struct vimc_cfs_drv vimc_deb_cfs_drv = {
>> + .name = VIMC_DEB_DRV_NAME,
>> + .configfs_cb = vimc_deb_configfs_cb,
>> +};
>> +
>> +static int __init vimc_deb_init(void)
>> +{
>> + int ret = platform_driver_register(&vimc_deb_pdrv);
>> +
>> + if (ret)
>> + return ret;
>> +
>> + vimc_cfs_drv_register(&vimc_deb_cfs_drv);
>> + return 0;
>> +}
>> +
>> +static void __exit vimc_deb_exit(void)
>> +{
>> + platform_driver_unregister(&vimc_deb_pdrv);
>> + vimc_cfs_drv_unregister(&vimc_deb_cfs_drv);
>> +}
>> +
>> +module_init(vimc_deb_init);
>> +module_exit(vimc_deb_exit);
>>
>> MODULE_DEVICE_TABLE(platform, vimc_deb_driver_ids);
>>
>> diff --git a/drivers/media/platform/vimc/vimc-scaler.c b/drivers/media/platform/vimc/vimc-scaler.c
>> index b0952ee86296..efb29384197d 100644
>> --- a/drivers/media/platform/vimc/vimc-scaler.c
>> +++ b/drivers/media/platform/vimc/vimc-scaler.c
>> @@ -23,6 +23,7 @@
>> #include <linux/v4l2-mediabus.h>
>> #include <media/v4l2-subdev.h>
>>
>> +#include "vimc-configfs.h"
>> #include "vimc-common.h"
>>
>> #define VIMC_SCA_DRV_NAME "vimc-scaler"
>> @@ -394,8 +395,7 @@ static int vimc_sca_comp_bind(struct device *comp, struct device *master,
>> return -ENOMEM;
>>
>> /* Initialize ved and sd */
>> - ret = vimc_ent_sd_register(&vsca->ved, &vsca->sd, v4l2_dev,
>> - pdata->entity_name,
>> + ret = vimc_ent_sd_register(&vsca->ved, &vsca->sd, v4l2_dev, pdata->name,
>> MEDIA_ENT_F_PROC_VIDEO_SCALER, 2,
>> (const unsigned long[2]) {MEDIA_PAD_FL_SINK,
>> MEDIA_PAD_FL_SOURCE},
>> @@ -448,7 +448,50 @@ static struct platform_driver vimc_sca_pdrv = {
>> },
>> };
>>
>> -module_platform_driver(vimc_sca_pdrv);
>> +static struct config_item_type vimc_sca_cfs_pad_type = {
>> + .ct_owner = THIS_MODULE,
>> +};
>> +
>> +static struct config_group vimc_sca_cfs_sink_pad_group;
>> +static struct config_group vimc_sca_cfs_src_pad_group;
>> +
>> +static void vimc_sca_configfs_cb(struct config_group *group)
>> +{
>> + config_group_init_type_name(&vimc_sca_cfs_sink_pad_group,
>> + VIMC_CFS_SINK_PAD_NAME(0),
>> + &vimc_sca_cfs_pad_type);
>> + configfs_add_default_group(&vimc_sca_cfs_sink_pad_group, group);
>> +
>> + config_group_init_type_name(&vimc_sca_cfs_src_pad_group,
>> + VIMC_CFS_SRC_PAD_NAME(1),
>> + &vimc_sca_cfs_pad_type);
>> + configfs_add_default_group(&vimc_sca_cfs_src_pad_group, group);
>> +}
>> +
>> +struct vimc_cfs_drv vimc_sca_cfs_drv = {
>> + .name = VIMC_SCA_DRV_NAME,
>> + .configfs_cb = vimc_sca_configfs_cb,
>> +};
>> +
>> +static int __init vimc_sca_init(void)
>> +{
>> + int ret = platform_driver_register(&vimc_sca_pdrv);
>> +
>> + if (ret)
>> + return ret;
>> +
>> + vimc_cfs_drv_register(&vimc_sca_cfs_drv);
>> + return 0;
>> +}
>> +
>> +static void __exit vimc_sca_exit(void)
>> +{
>> + platform_driver_unregister(&vimc_sca_pdrv);
>> + vimc_cfs_drv_unregister(&vimc_sca_cfs_drv);
>> +}
>> +
>> +module_init(vimc_sca_init);
>> +module_exit(vimc_sca_exit);
>>
>> MODULE_DEVICE_TABLE(platform, vimc_sca_driver_ids);
>>
>> diff --git a/drivers/media/platform/vimc/vimc-sensor.c b/drivers/media/platform/vimc/vimc-sensor.c
>> index 32ca9c6172b1..37540e72c6bc 100644
>> --- a/drivers/media/platform/vimc/vimc-sensor.c
>> +++ b/drivers/media/platform/vimc/vimc-sensor.c
>> @@ -28,6 +28,7 @@
>> #include <media/v4l2-subdev.h>
>> #include <media/tpg/v4l2-tpg.h>
>>
>> +#include "vimc-configfs.h"
>> #include "vimc-common.h"
>>
>> #define VIMC_SEN_DRV_NAME "vimc-sensor"
>> @@ -405,8 +406,7 @@ static int vimc_sen_comp_bind(struct device *comp, struct device *master,
>> }
>>
>> /* Initialize ved and sd */
>> - ret = vimc_ent_sd_register(&vsen->ved, &vsen->sd, v4l2_dev,
>> - pdata->entity_name,
>> + ret = vimc_ent_sd_register(&vsen->ved, &vsen->sd, v4l2_dev, pdata->name,
>> MEDIA_ENT_F_CAM_SENSOR, 1,
>> (const unsigned long[1]) {MEDIA_PAD_FL_SOURCE},
>> &vimc_sen_ops);
>> @@ -471,7 +471,44 @@ static struct platform_driver vimc_sen_pdrv = {
>> },
>> };
>>
>> -module_platform_driver(vimc_sen_pdrv);
>> +static struct config_item_type vimc_sen_cfs_pad_type = {
>> + .ct_owner = THIS_MODULE,
>> +};
>> +
>> +static struct config_group vimc_sen_cfs_src_pad_group;
>> +
>> +static void vimc_sen_configfs_cb(struct config_group *group)
>> +{
>> + config_group_init_type_name(&vimc_sen_cfs_src_pad_group,
>> + VIMC_CFS_SRC_PAD_NAME(0),
>> + &vimc_sen_cfs_pad_type);
>> + configfs_add_default_group(&vimc_sen_cfs_src_pad_group, group);
>> +}
>> +
>> +struct vimc_cfs_drv vimc_sen_cfs_drv = {
>> + .name = VIMC_SEN_DRV_NAME,
>> + .configfs_cb = vimc_sen_configfs_cb,
>> +};
>> +
>> +static int __init vimc_sen_init(void)
>> +{
>> + int ret = platform_driver_register(&vimc_sen_pdrv);
>> +
>> + if (ret)
>> + return ret;
>> +
>> + vimc_cfs_drv_register(&vimc_sen_cfs_drv);
>> + return 0;
>> +}
>> +
>> +static void __exit vimc_sen_exit(void)
>> +{
>> + platform_driver_unregister(&vimc_sen_pdrv);
>> + vimc_cfs_drv_unregister(&vimc_sen_cfs_drv);
>> +}
>> +
>> +module_init(vimc_sen_init);
>> +module_exit(vimc_sen_exit);
>>
>> MODULE_DEVICE_TABLE(platform, vimc_sen_driver_ids);
>>
>>
>
> Regards,
>
> Hans
>
Thanks for reviewing this
Helen
On 12/10/18 5:14 PM, Helen Koike wrote:
> Hi Hans,
>
> On 12/10/18 9:31 AM, Hans Verkuil wrote:
>> On 12/7/18 7:22 PM, Helen Koike wrote:
<snip>
>
>>
>> The previewer is effectively similar to a debayer block.
>
> You mean the image it outputs?
Yes. It takes a bayer image and outputs a non-bayer format on the omap3.
>
>>
>> AEWB, AF and histogram are for auto-whitebalance, autofocus and histogram statistics.
>> This isn't supported by vimc, and is a 'nice-to-have' for the future.
>
> Right, I need to check how to include those. I am a bit confused as in
> the omap3 topology they are seems to be just configuration points (I
> mean, they are not really part of the image pipeline).
Typically the SoC analyzes the image and produces statistics of various kinds that
are given to userspace via devices like this. It is used as input to auto-whitebalance,
auto-focus and auto-gain algorithms running in userspace that feedback the results to
sensor config changes.
The format is usually very SoC-specific.
>
> I was reading this
> https://linuxtv.org/downloads/v4l-dvb-apis-new/v4l-drivers/omap3isp.html?highlight=histogram#statistic-blocks-ioctls
> It says:
> "The statistics are dequeueable by the user from the statistics subdev
> nodes using private IOCTLs"
>
> I suppose we should emulate those private IOCTLs in vimc? If you could
> provide me some pointers in where I can find docs on these private
> IOCTLs it would be great.
No, just ignore these statistics devices for now. And if we make them, we
can design a vimc-specific format.
>
>>
>> The main missing bits in vimc are a CSI block and a splitter block. It should be simple
>> to add the CSI block since it really doesn't do anything in an emulated environment.
>
> CSI would be just a dummy entity with one sink pad and one source pad right?
Right.
>
>>
>> A splitter might be more complicated, I'm not sure.
>
> splitter shouldn't that complicated in the current state of vimc, but
> when we start optimizing the pipeline then it is going to be more
> complicated.
Right.
Regards,
Hans
Hi,
I will continue working on this patch that Helen started.
Regarding the requirements, if an entity is removed, should all the
links related to it also be removed?
Also, should it be possible to create a link with entities that do not exist?
The reason to keep links between non existing entities is that it
allows to easily unplug an entity for testing,
and the links related to it can be ignored while still be visible
through the configfs.
I have also some inline comments.
On Fri, Dec 7, 2018 at 7:24 PM Helen Koike <[email protected]> wrote:
>
> Add API to allow userspace to create any type of topology in vimc using
> basic system calls such as mkdir/rmdir/read/write.
>
> Signed-off-by: Helen Koike <[email protected]>
>
> ---
> Hi,
>
> This patch introduces the configufs API for configuring the topology in
> vimc while it removes the hardcoded topology, so now, when you load the
> module you need to create a device (no device will appear in your system
> by default) using mkdir/rmdir/write/read.
> Please see documentation in the patch.
> I was thinking in adding a device by default, but if I do it in
> configfs, userspace won't be able to delete the device (which might not
> be a problem), as I need to create it as a "default" group in configfs,
> or I can just not expose the default device in the configfs.
> What do you think?
>
> Thanks
> Helen
>
> Documentation/media/v4l-drivers/vimc.rst | 172 +++++
> drivers/media/platform/vimc/Kconfig | 7 +-
> drivers/media/platform/vimc/Makefile | 7 +-
> drivers/media/platform/vimc/vimc-capture.c | 46 +-
> drivers/media/platform/vimc/vimc-common.h | 58 +-
> drivers/media/platform/vimc/vimc-configfs.c | 665 ++++++++++++++++++++
> drivers/media/platform/vimc/vimc-configfs.h | 30 +
> drivers/media/platform/vimc/vimc-core.c | 283 ++-------
> drivers/media/platform/vimc/vimc-core.h | 17 +
> drivers/media/platform/vimc/vimc-debayer.c | 51 +-
> drivers/media/platform/vimc/vimc-scaler.c | 49 +-
> drivers/media/platform/vimc/vimc-sensor.c | 43 +-
> 12 files changed, 1153 insertions(+), 275 deletions(-)
> create mode 100644 Documentation/media/v4l-drivers/vimc.rst
> create mode 100644 drivers/media/platform/vimc/vimc-configfs.c
> create mode 100644 drivers/media/platform/vimc/vimc-configfs.h
> create mode 100644 drivers/media/platform/vimc/vimc-core.h
>
> diff --git a/Documentation/media/v4l-drivers/vimc.rst b/Documentation/media/v4l-drivers/vimc.rst
> new file mode 100644
> index 000000000000..28d3b02c7d30
> --- /dev/null
> +++ b/Documentation/media/v4l-drivers/vimc.rst
> @@ -0,0 +1,172 @@
> +The Virtual Media Controller Driver (vimc)
> +=========================================
> +
> +This driver emulates video4linux hardware of varios media topologies. It exposes
> +media devices through /dev/mediaX notes, video capture devices through
> +/dev/videoX and sub-devices through /dev/v4l-subdevX.
> +
> +A subdevice can be a sensor, a debayer or a scaler.
> +
> +To configure a media device of a given topology, a ConfigFS API is provided.
> +
> +
> +Configuring the driver through ConfigFS (Experimental)
> +------------------------------------------------------
> +
> +.. note::
> +This API is not finished yet and might change in the future.
> +
> +Mount configfs:
> +::
> + $ mkdir /configfs
> + $ mount -t configfs none /configfs
> +
> +When loading the module, you see a folders name vimc
> +::
> + $ tree /configfs/
> + /configfs/
> + `-- vimc
> +
> +1) Creating a media device
> +~~~~~~~~~~~~~~~~~~~~~~~~~~
> +
> +To create a media device just create a new folder under /configfs/vimc/
> +
> +Example:
> +::
> + $ mkdir /configfs/vimc/mdev
> + $ tree /configfs/vimc/mdev
> + /configfs/vimc/mdev/
> + |-- entities/
> + |-- hotplug
> + `-- links/
> +
> + 2 directories, 1 file
> +
> +2) Creating entities
> +~~~~~~~~~~~~~~~~~~~~
> +
> +To create an entity in the media device's topology, just create a folder under
> +/configfs/vimc/<mdev-name>/entities/ with the following format:
> +
> + <sub-module>:<name>
> +
> +Where <sub-module> is one of the following:
> +::
> + vimc-sensor
> + vimc-scaler
> + vimc-debayer
> + vimc-capture
> +
> +Example:
> +::
> + $ mkdir /configfs/vimc/mdev/entities/vimc-sensor:my-sensor
> + $ mkdir /configfs/vimc/mdev/entities/vimc-capture:my-capture
> + $ tree /configfs/
> + /configfs/
> + `-- vimc/
> + `-- mdev/
> + |-- entities/
> + | |-- vimc-capture:my-capture/
> + | | `-- pad:sink:0/
> + | `-- vimc-sensor:my-sensor/
> + | `-- pad:source:0/
> + |-- hotplug
> + `-- links/
> +
> + 8 directories, 1 file
> +
> +3) Creating links
> +~~~~~~~~~~~~~~~~~
> +
> +To create links between two entities in the topology, just create a folder under
> +/configfs/vimc/<mdev-name>/links/ with the following format:
> +
> + "<entity1-name><pad-source>:<entity2-name><pad-sink>"
> +
> +Example:
> +::
> + $ mkdir "/configfs/vimc/mdev/links/my-sensor:0->my-capture:0"
> + $ tree /configfs
> + /configfs/
> + `-- vimc/
> + `-- mdev/
> + |-- entities/
> + | |-- vimc-capture:my-capture/
> + | | `-- pad:sink:0/
> + | `-- vimc-sensor:my-sensor/
> + | `-- pad:source:0/
> + |-- hotplug
> + `-- links/
> + `-- my-sensor:0->my-capture:0/
> + `-- flags
> +
> + 9 directories, 2 files
> +
> +Change the attributes of the link by writing in the file
> +"/configfs/vimc/<mdev-name>/links/<my-link>/flags"
> +
> +Flag values are defined in :ref:`include/uapi/linux/media.h <media_header>`
> +( seek for ``MEDIA_LNK_FL_*``)
> +
> +1 - Enabled
> + Indicates the link will be enabled when the media device is created.
> +
> +3 - Enabled and Immutable
> + Indicates that the link enabled state can't be modified at runtime.
> +
> +Example:
> +::
> + $ echo 3 > "/configfs/vimc/mdev/links/my-sensor:0->my-capture:0/flags"
> +
> +4) Activating/Deactivating device
> +~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
> +
> +To activate the device, write one of "plugged", "plug" or "1" to file
> +/configfs/vimc/<ndev-name>/hotplug
> +
> +Example:
> +::
> + $ echo 1 > /configfs/vimc/mdev/hotplug
> +
> +You should see a new node /dev/mediaX in your devfs.
> +
> +To deactivate the device, write one of "unplugged", "unplug" or "0" to file
> +/configfs/vimc/<ndev-name>/hotplug
> +
> +Example:
> +::
> + $ echo 0 > /configfs/vimc/mdev/hotplug
> +
> +Subdevices
> +----------
> +
> +Subdevices defines the behavior of an entity in the topology. Depending on the
> +subdevice, the entity can have multiple pads of type source or sink.
> +
> +vimc-sensor:
> + Generates images in several formats using video test pattern generator.
> + Exposes:
> +
> + * 1 Pad source
> +
> +vimc-debayer:
> + Transforms images in bayer format into a non bayer format.
> + Exposes:
> +
> + * 1 Pad sink
> + * 1 Pad source
> +
> +vimc-scaler:
> + Mutiplies the size of the image by 3.
> + Exposes:
> +
> + * 1 Pad sink
> + * 1 Pad source
> +
> +vimc-capture:
> + Exposes node /dev/videoX to allow userspace to capture the stream.
> + Exposes:
> +
> + * 1 Pad sink
> + * 1 Pad source
> diff --git a/drivers/media/platform/vimc/Kconfig b/drivers/media/platform/vimc/Kconfig
> index 71c9fe7d3370..7f1fb550d4c3 100644
> --- a/drivers/media/platform/vimc/Kconfig
> +++ b/drivers/media/platform/vimc/Kconfig
> @@ -1,15 +1,14 @@
> config VIDEO_VIMC
> tristate "Virtual Media Controller Driver (VIMC)"
> - depends on VIDEO_DEV && VIDEO_V4L2 && VIDEO_V4L2_SUBDEV_API
> + depends on VIDEO_DEV && VIDEO_V4L2 && VIDEO_V4L2_SUBDEV_API && CONFIGFS_FS
> select VIDEOBUF2_VMALLOC
> select VIDEO_V4L2_TPG
> default n
> ---help---
> - Skeleton driver for Virtual Media Controller
> + Virtual Media Controller Driver
>
> This driver can be compared to the vivid driver for emulating
> a media node that exposes a complex media topology. The topology
> - is hard coded for now but is meant to be highly configurable in
> - the future.
> + is configurable through configfs API.
>
> When in doubt, say N.
> diff --git a/drivers/media/platform/vimc/Makefile b/drivers/media/platform/vimc/Makefile
> index 4b2e3de7856e..5d926a5ef15c 100644
> --- a/drivers/media/platform/vimc/Makefile
> +++ b/drivers/media/platform/vimc/Makefile
> @@ -1,10 +1,9 @@
> # SPDX-License-Identifier: GPL-2.0
> -vimc-objs := vimc-core.o
> +vimc-objs := vimc-core.o vimc-common.o vimc-configfs.o
> vimc_capture-objs := vimc-capture.o
> -vimc_common-objs := vimc-common.o
> vimc_debayer-objs := vimc-debayer.o
> vimc_scaler-objs := vimc-scaler.o
> vimc_sensor-objs := vimc-sensor.o
>
> -obj-$(CONFIG_VIDEO_VIMC) += vimc.o vimc_capture.o vimc_common.o vimc-debayer.o \
> - vimc_scaler.o vimc_sensor.o
> +obj-$(CONFIG_VIDEO_VIMC) += vimc.o vimc_capture.o vimc-debayer.o vimc_scaler.o \
> + vimc_sensor.o
> diff --git a/drivers/media/platform/vimc/vimc-capture.c b/drivers/media/platform/vimc/vimc-capture.c
> index 3f7e9ed56633..55a5f85b4591 100644
> --- a/drivers/media/platform/vimc/vimc-capture.c
> +++ b/drivers/media/platform/vimc/vimc-capture.c
> @@ -23,6 +23,7 @@
> #include <media/videobuf2-core.h>
> #include <media/videobuf2-vmalloc.h>
>
> +#include "vimc-configfs.h"
> #include "vimc-common.h"
>
> #define VIMC_CAP_DRV_NAME "vimc-capture"
> @@ -418,7 +419,7 @@ static int vimc_cap_comp_bind(struct device *comp, struct device *master,
> }
>
> /* Initialize the media entity */
> - vcap->vdev.entity.name = pdata->entity_name;
> + vcap->vdev.entity.name = pdata->name;
> vcap->vdev.entity.function = MEDIA_ENT_F_IO_V4L;
> ret = media_entity_pads_init(&vcap->vdev.entity,
> 1, vcap->ved.pads);
> @@ -443,7 +444,7 @@ static int vimc_cap_comp_bind(struct device *comp, struct device *master,
> ret = vb2_queue_init(q);
> if (ret) {
> dev_err(comp, "%s: vb2 queue init failed (err=%d)\n",
> - pdata->entity_name, ret);
> + pdata->name, ret);
> goto err_clean_m_ent;
> }
>
> @@ -476,7 +477,7 @@ static int vimc_cap_comp_bind(struct device *comp, struct device *master,
> vdev->queue = q;
> vdev->v4l2_dev = v4l2_dev;
> vdev->vfl_dir = VFL_DIR_RX;
> - strscpy(vdev->name, pdata->entity_name, sizeof(vdev->name));
> + strscpy(vdev->name, pdata->name, sizeof(vdev->name));
> video_set_drvdata(vdev, &vcap->ved);
>
> /* Register the video_device with the v4l2 and the media framework */
> @@ -534,7 +535,44 @@ static struct platform_driver vimc_cap_pdrv = {
> },
> };
>
> -module_platform_driver(vimc_cap_pdrv);
> +static struct config_item_type vimc_cap_cfs_pad_type = {
> + .ct_owner = THIS_MODULE,
> +};
> +
> +static struct config_group vimc_cap_cfs_sink_pad_group;
> +
> +static void vimc_cap_configfs_cb(struct config_group *group)
> +{
> + config_group_init_type_name(&vimc_cap_cfs_sink_pad_group,
> + VIMC_CFS_SINK_PAD_NAME(0),
> + &vimc_cap_cfs_pad_type);
> + configfs_add_default_group(&vimc_cap_cfs_sink_pad_group, group);
> +}
> +
> +struct vimc_cfs_drv vimc_cap_cfs_drv = {
> + .name = VIMC_CAP_DRV_NAME,
> + .configfs_cb = vimc_cap_configfs_cb,
> +};
> +
> +static int __init vimc_cap_init(void)
> +{
> + int ret = platform_driver_register(&vimc_cap_pdrv);
> +
> + if (ret)
> + return ret;
> +
> + vimc_cfs_drv_register(&vimc_cap_cfs_drv);
> + return 0;
> +}
> +
> +static void __exit vimc_cap_exit(void)
> +{
> + platform_driver_unregister(&vimc_cap_pdrv);
> + vimc_cfs_drv_unregister(&vimc_cap_cfs_drv);
> +}
> +
> +module_init(vimc_cap_init);
> +module_exit(vimc_cap_exit);
>
> MODULE_DEVICE_TABLE(platform, vimc_cap_driver_ids);
>
> diff --git a/drivers/media/platform/vimc/vimc-common.h b/drivers/media/platform/vimc/vimc-common.h
> index 2e9981b18166..9a33e7901b72 100644
> --- a/drivers/media/platform/vimc/vimc-common.h
> +++ b/drivers/media/platform/vimc/vimc-common.h
> @@ -22,6 +22,8 @@
> #include <media/media-device.h>
> #include <media/v4l2-device.h>
>
> +#define VIMC_MAX_NAME_LEN 32
> +
> /* VIMC-specific controls */
> #define VIMC_CID_VIMC_BASE (0x00f00000 | 0xf000)
> #define VIMC_CID_VIMC_CLASS (0x00f00000 | 1)
> @@ -63,16 +65,62 @@ do { \
> /**
> * struct vimc_platform_data - platform data to components
> *
> - * @entity_name: The name of the entity to be created
> + * @name: The name of the device
> + * @group: The configfs group the device belongs
> *
> * Board setup code will often provide additional information using the device's
> * platform_data field to hold additional information.
> - * When injecting a new platform_device in the component system the core needs
> - * to provide to the corresponding submodules the name of the entity that should
> - * be used when registering the subdevice in the Media Controller system.
> + * When injecting a new platform_device in the component system, the name of the
> + * device is required to allow the system to register it with a proper name.
> + * Also the configfs group is given to allow the driver to add custom items in
> + * the group.
> + * This struct is used by the entity submodules and the core system to be able
> + * to retrieve the name to register the device in the Media Controller system.
> */
> struct vimc_platform_data {
> - char entity_name[32];
> + char name[VIMC_MAX_NAME_LEN];
> + struct config_group *group;
> +};
> +
> +/**
> + * struct vimc_platform_data_link - platform data to components of type link
> + *
> + * @source: source component of the link
> + * @source_pad: source pad of the link
> + * @sink: sink component of the link
> + * @sink_pad: sink pad of the link
> + * @flags: flags of the link
> + *
> + * Board setup code will often provide additional information using the device's
> + * platform_data field to hold additional information.
> + * When injecting a new platform_device representing a link in the component
> + * system, source and sink information is required to allow the link module to
> + * create the proper link between entities.
> + */
> +struct vimc_platform_data_link {
> + struct platform_device *source;
> + u16 source_pad;
> + struct platform_device *sink;
> + u16 sink_pad;
> + u32 flags;
> + struct list_head list;
> +};
> +
> +/**
> + * struct vimc_platform_data_core - platform data to the core
> + *
> + * @data: see struct vimc_platform_data
> + * @links: list of struct vimc_platform_data_link
> + *
> + * Board setup code will often provide additional information using the device's
> + * platform_data field to hold additional information.
> + * When injecting a new platform_device representing the core component, a list
> + * of struct vimc_platform_data_list is required to allow the core to create
> + * create the proper links between entities.
> + */
> +struct vimc_platform_data_core {
> + struct vimc_platform_data data;
> + struct list_head *links;
> };
>
> /**
> diff --git a/drivers/media/platform/vimc/vimc-configfs.c b/drivers/media/platform/vimc/vimc-configfs.c
> new file mode 100644
> index 000000000000..68e5f1ea736b
> --- /dev/null
> +++ b/drivers/media/platform/vimc/vimc-configfs.c
> @@ -0,0 +1,665 @@
> +// SPDX-License-Identifier: GPL-2.0+
> +/*
> + * vimc-configfs.c Virtual Media Controller Driver
> + *
> + * Copyright (C) 2018 Helen Koike <[email protected]>
> + */
> +
> +#include <linux/component.h>
> +#include <linux/module.h>
> +#include <linux/slab.h>
> +#include <linux/platform_device.h>
> +
> +#include "vimc-common.h"
> +#include "vimc-configfs.h"
> +#include "vimc-core.h"
> +
> +#define CHAR_SEPARATOR ':'
> +#define LINK_SEPARATOR "->"
> +#define CFS_SUBSYS_NAME "vimc"
> +
> +#define ci_err(ci, fmt, ...) \
> + pr_err("vimc: %s: " pr_fmt(fmt), (ci)->ci_name, ##__VA_ARGS__)
> +#define cg_err(cg, ...) ci_err(&(cg)->cg_item, ##__VA_ARGS__)
> +#define ci_warn(ci, fmt, ...) \
> + pr_warn("vimc: %s: " pr_fmt(fmt), (ci)->ci_name, ##__VA_ARGS__)
> +#define cg_warn(cg, ...) ci_warn(&(cg)->cg_item, ##__VA_ARGS__)
> +#define ci_dbg(ci, fmt, ...) \
> + pr_debug("vimc: %s: " pr_fmt(fmt), (ci)->ci_name, ##__VA_ARGS__)
> +#define cg_dbg(cg, ...) ci_dbg(&(cg)->cg_item, ##__VA_ARGS__)
> +
> +#define is_plugged(cfs) (!!(cfs)->pdev)
> +
> +enum vimc_cfs_hotplug_state {
> + VIMC_CFS_HOTPLUG_STATE_UNPLUGGED = 0,
> + VIMC_CFS_HOTPLUG_STATE_PLUGGED = 1,
> +};
> +
> +const static char *vimc_cfs_hotplug_values[2][3] = {
> + [VIMC_CFS_HOTPLUG_STATE_UNPLUGGED] = {"unplugged\n", "unplug\n", "0\n"},
> + [VIMC_CFS_HOTPLUG_STATE_PLUGGED] = {"plugged\n", "plug\n", "1\n"},
> +};
> +
> +/* --------------------------------------------------------------------------
> + * Pipeline structures
> + */
> +
> +static struct vimc_cfs_subsystem {
> + struct configfs_subsystem subsys;
> + struct list_head drvs;
> +} vimc_cfs_subsys;
> +
> +/* Structure which describes the whole topology */
> +struct vimc_cfs_device {
> + struct platform_device *pdev;
> + struct vimc_platform_data_core pdata;
> + struct list_head ents;
> + struct list_head links;
> + struct config_group gdev;
> + struct config_group gents;
> + struct config_group glinks;
> +};
> +
> +/* Structure which describes individual configuration for each entity */
> +struct vimc_cfs_ent {
> + struct platform_device *pdev;
> + struct vimc_platform_data pdata;
> + char drv[VIMC_MAX_NAME_LEN];
> + struct list_head list;
> + struct config_group cg;
> +};
> +
> +/* Structure which describes links between entities */
> +struct vimc_cfs_link {
> + struct vimc_platform_data_link pdata;
> + char source_name[VIMC_MAX_NAME_LEN];
> + char sink_name[VIMC_MAX_NAME_LEN];
> + struct config_item ci;
> +};
> +
> +void vimc_cfs_drv_register(struct vimc_cfs_drv *c_drv)
> +{
> + list_add(&c_drv->list, &vimc_cfs_subsys.drvs);
> +}
> +EXPORT_SYMBOL_GPL(vimc_cfs_drv_register);
> +
> +void vimc_cfs_drv_unregister(struct vimc_cfs_drv *c_drv)
> +{
> + list_del(&c_drv->list);
> +}
> +EXPORT_SYMBOL_GPL(vimc_cfs_drv_unregister);
> +
> +/* --------------------------------------------------------------------------
> + * Platform Device builders
> + */
> +
> +static int vimc_cfs_link_get_entities(const struct vimc_cfs_device *cfs,
> + struct vimc_cfs_link *c_link)
> +{
> + struct vimc_cfs_ent *c_ent;
> +
> + c_link->pdata.source = NULL;
> + c_link->pdata.sink = NULL;
> + list_for_each_entry(c_ent, &cfs->ents, list) {
> + if (!c_link->pdata.source &&
> + !strcmp(c_ent->pdata.name, c_link->source_name))
> + c_link->pdata.source = c_ent->pdev;
> + if (!c_link->pdata.sink &&
> + !strcmp(c_ent->pdata.name, c_link->sink_name))
> + c_link->pdata.sink = c_ent->pdev;
> + if (c_link->pdata.source && c_link->pdata.sink)
> + return 0;
> + }
> + return -EINVAL;
> +}
> +
> +static int vimc_cfs_comp_compare(struct device *comp, void *data)
> +{
> + dev_dbg(comp, "comp compare %p %p", comp, data);
> +
> + return comp == data;
> +}
> +
> +static const struct component_master_ops vimc_cfs_comp_ops = {
> + .bind = vimc_core_comp_bind,
> + .unbind = vimc_core_comp_unbind,
> +};
> +
> +static void vimc_cfs_device_unplug(struct vimc_cfs_device *cfs)
> +{
> + struct vimc_cfs_ent *c_ent;
> +
> + dev_dbg(&cfs->pdev->dev, "Unplugging device");
> +
> + component_master_del(&cfs->pdev->dev, &vimc_cfs_comp_ops);
> + list_for_each_entry(c_ent, &cfs->ents, list) {
> + platform_device_unregister(c_ent->pdev);
> + c_ent->pdev = NULL;
> + }
> + platform_device_unregister(cfs->pdev);
> + cfs->pdev = NULL;
> +}
> +
> +static int vimc_cfs_device_plug(struct vimc_cfs_device *cfs)
> +{
> + struct component_match *match = NULL;
> + struct vimc_cfs_ent *c_ent;
> + struct vimc_cfs_link *c_link;
> + int ret = 0;
> +
> + cg_dbg(&cfs->gdev, "Plugging device");
> +
> + if (list_empty(&cfs->ents)) {
> + /* TODO: add support for a default topology */
> + cg_err(&cfs->gdev,
> + "At least an entity is required to plug the device");
> + return -EINVAL;
> + }
> +
> + cfs->pdev = platform_device_register_data(NULL, VIMC_CORE_PDEV_NAME,
> + PLATFORM_DEVID_AUTO,
> + &cfs->pdata,
> + sizeof(cfs->pdata));
> + if (IS_ERR(cfs->pdev))
> + return PTR_ERR(cfs->pdev);
> +
> + /* Add component_match for inner structure of the pipeline */
> + list_for_each_entry(c_ent, &cfs->ents, list) {
> + cg_dbg(&c_ent->cg, "registering entity %s:%s", c_ent->drv,
> + c_ent->pdata.name);
> + if (c_ent->pdev)
> + cg_err(&c_ent->cg, "pdev is not null");
> + c_ent->pdev = platform_device_register_data(&cfs->pdev->dev,
> + c_ent->drv,
> + PLATFORM_DEVID_AUTO,
> + &c_ent->pdata,
> + sizeof(c_ent->pdata));
> + if (IS_ERR(c_ent->pdev)) {
> + ret = PTR_ERR(c_ent->pdev);
> + goto unregister_ents;
> + }
> + component_match_add(&cfs->pdev->dev, &match,
> + vimc_cfs_comp_compare, &c_ent->pdev->dev);
> + }
> + list_for_each_entry(c_link, cfs->pdata.links, pdata.list) {
> + ret = vimc_cfs_link_get_entities(cfs, c_link);
> + if (ret) {
> + ci_err(&c_link->ci, "could not validate link");
> + goto unregister_ents;
> + }
> + }
> +
> + dev_dbg(&cfs->pdev->dev, "Adding master device");
> + ret = component_master_add_with_match(&cfs->pdev->dev,
> + &vimc_cfs_comp_ops, match);
> + if (ret)
> + goto unregister_ents;
> +
> + return 0;
> +
> +unregister_ents:
> + list_for_each_entry_continue_reverse(c_ent, &cfs->ents, list) {
> + platform_device_unregister(c_ent->pdev);
> + c_ent->pdev = NULL;
> + }
> +
> + platform_device_unregister(cfs->pdev);
> + cfs->pdev = NULL;
> +
> + return ret;
> +}
> +
> +/* --------------------------------------------------------------------------
> + * Links
> + */
> +
> +static ssize_t vimc_cfs_links_attr_flags_show(struct config_item *item,
> + char *buf)
> +{
> + struct vimc_cfs_link *c_link = container_of(item, struct vimc_cfs_link,
> + ci);
> +
> + sprintf(buf, "%d\n", c_link->pdata.flags);
> + return strlen(buf);
> +}
> +
> +static ssize_t vimc_cfs_links_attr_flags_store(struct config_item *item,
> + const char *buf, size_t size)
> +{
> + struct vimc_cfs_link *c_link = container_of(item, struct vimc_cfs_link,
> + ci);
> +
> + if (kstrtou32(buf, 0, &c_link->pdata.flags))
> + return -EINVAL;
> +
> + return size;
> +}
> +
> +CONFIGFS_ATTR(vimc_cfs_links_attr_, flags);
> +
> +static struct configfs_attribute *vimc_cfs_link_attrs[] = {
> + &vimc_cfs_links_attr_attr_flags,
> + NULL,
> +};
> +
> +static void vimc_cfs_link_release(struct config_item *item)
> +{
> + struct vimc_cfs_link *c_link = container_of(item, struct vimc_cfs_link,
> + ci);
> +
> + kfree(c_link);
> +}
> +
> +static struct configfs_item_operations vimc_cfs_link_item_ops = {
> + .release = vimc_cfs_link_release,
> +};
> +
> +static struct config_item_type vimc_cfs_link_type = {
> + .ct_item_ops = &vimc_cfs_link_item_ops,
> + .ct_attrs = vimc_cfs_link_attrs,
> + .ct_owner = THIS_MODULE,
> +};
> +
> +static void vimc_cfs_link_drop_item(struct config_group *group,
> + struct config_item *item)
> +{
> + struct vimc_cfs_link *link = container_of(item,
> + struct vimc_cfs_link, ci);
> + struct vimc_cfs_device *cfs = container_of(group,
> + struct vimc_cfs_device,
> + glinks);
> +
> + if (is_plugged(cfs))
> + vimc_cfs_device_unplug(cfs);
> + list_del(&link->pdata.list);
> +}
> +
> +static struct config_item *vimc_cfs_link_make_item(struct config_group *group,
> + const char *name)
> +{
> + struct vimc_cfs_device *cfs = container_of(group,
> + struct vimc_cfs_device,
> + glinks);
> + size_t src_pad_strlen, sink_pad_strlen, sink_namelen, source_namelen;
> + const char *sep, *src_pad_str, *sink_pad_str, *sink_name,
> + *source_name = name;
> + struct vimc_cfs_link *c_link;
> + u16 source_pad, sink_pad;
> + char tmp[4];
> +
> + cg_dbg(&cfs->gdev, "Creating link %s", name);
> +
> + if (is_plugged(cfs))
> + vimc_cfs_device_unplug(cfs);
> +
> + /* Parse format "source_name:source_pad->sink_name:sink_pad" */
> + sep = strchr(source_name, CHAR_SEPARATOR);
> + if (!sep)
> + goto syntax_error;
> + source_namelen = (size_t)(sep - source_name);
> +
> + src_pad_str = &sep[1];
> + sep = strstr(src_pad_str, LINK_SEPARATOR);
> + if (!sep)
> + goto syntax_error;
> + src_pad_strlen = (size_t)(sep - src_pad_str);
> +
> + sink_name = &sep[strlen(LINK_SEPARATOR)];
> + sep = strchr(sink_name, CHAR_SEPARATOR);
> + if (!sep)
> + goto syntax_error;
> + sink_namelen = (size_t)(sep - sink_name);
> +
> + sink_pad_str = &sep[1];
> + sink_pad_strlen = strlen(sink_pad_str);
> +
> + /* Validate sizes */
> + if (!src_pad_strlen || !sink_pad_strlen ||
> + !sink_namelen || !source_namelen)
> + goto syntax_error;
> +
> + /* we limit the size here so we don't need to allocate another buffer */
> + if (src_pad_strlen >= sizeof(tmp) || sink_pad_strlen >= sizeof(tmp)) {
> + cg_err(&cfs->gdev,
> + "Pad with more then %ld digits is not supported",
> + sizeof(tmp) - 1);
> + goto syntax_error;
> + }
> + strscpy(tmp, src_pad_str, src_pad_strlen + 1);
> + if (kstrtou16(tmp, 0, &source_pad)) {
> + cg_err(&cfs->gdev, "Couldn't convert pad %s to number", tmp);
> + goto syntax_error;
> + }
> + strscpy(tmp, sink_pad_str, sink_pad_strlen + 1);
> + if (kstrtou16(tmp, 0, &sink_pad)) {
> + cg_err(&cfs->gdev, "Couldn't convert pad %s to number", tmp);
> + goto syntax_error;
> + }
> +
> + c_link = kzalloc(sizeof(*c_link), GFP_KERNEL);
> + if (!c_link)
> + return ERR_PTR(-ENOMEM);
> +
> + c_link->pdata.source_pad = source_pad;
> + c_link->pdata.sink_pad = sink_pad;
> + strscpy(c_link->source_name, source_name, source_namelen + 1);
> + strscpy(c_link->sink_name, sink_name, sink_namelen + 1);
> +
> + /* Configure group */
> + list_add(&c_link->pdata.list, cfs->pdata.links);
I am not sure how should the config_item_get/config_item_put should be used
For example a reference to an item is added here to a linked-list. So
does it require a call to config_item_get ?
> + config_item_init_type_name(&c_link->ci, name, &vimc_cfs_link_type);
> +
> + return &c_link->ci;
> +
> +syntax_error:
> + cg_err(&cfs->gdev,
> + "Couldn't create link %s, wrong syntax.", name);
> + return ERR_PTR(-EINVAL);
> +}
> +
> +/* --------------------------------------------------------------------------
> + * Entities
> + */
> +
> +/* *TODO: add support for hotplug in entity level */
> +
> +static int vimc_cfs_drv_cb(const char *drv_name, struct config_group *group)
> +{
> + struct vimc_cfs_drv *c_drv = NULL;
> +
> + list_for_each_entry(c_drv, &vimc_cfs_subsys.drvs, list) {
> + if (!strcmp(drv_name, c_drv->name))
> + break;
> + }
> + if (!c_drv)
> + return -EINVAL;
> +
> + if (c_drv->configfs_cb)
> + c_drv->configfs_cb(group);
> +
> + return 0;
> +}
> +
> +static void vimc_cfs_ent_release(struct config_item *item)
> +{
> + struct vimc_cfs_ent *c_ent = container_of(item, struct vimc_cfs_ent,
> + cg.cg_item);
> +
> + kfree(c_ent);
> +}
> +
> +static struct configfs_item_operations vimc_cfs_ent_item_ops = {
> + .release = vimc_cfs_ent_release,
> +};
> +
> +static struct config_item_type vimc_cfs_ent_type = {
> + .ct_item_ops = &vimc_cfs_ent_item_ops,
> + .ct_owner = THIS_MODULE,
> +};
> +
> +static void vimc_cfs_ent_drop_item(struct config_group *group,
> + struct config_item *item)
> +{
> + struct vimc_cfs_ent *c_ent = container_of(item, struct vimc_cfs_ent,
> + cg.cg_item);
> + struct vimc_cfs_device *cfs = container_of(group,
> + struct vimc_cfs_device,
> + gents);
> +
> + if (is_plugged(cfs))
> + vimc_cfs_device_unplug(cfs);
> + list_del(&c_ent->list);
> +}
> +
> +static struct config_group *vimc_cfs_ent_make_group(struct config_group *group,
> + const char *name)
> +{
> + struct vimc_cfs_device *cfs = container_of(group,
> + struct vimc_cfs_device,
> + gents);
> + const char *drv_name = name;
> + char *ent_name, *sep = strchr(drv_name, CHAR_SEPARATOR);
> + struct vimc_cfs_ent *c_ent;
> + size_t drv_namelen;
> +
> + if (is_plugged(cfs))
> + vimc_cfs_device_unplug(cfs);
> +
> + /* Parse format "drv_name:ent_name" */
> + if (!sep) {
> + cg_err(&cfs->gdev,
> + "Could not find separator '%c'", CHAR_SEPARATOR);
> + goto syntax_error;
> + }
> + drv_namelen = (size_t)(sep - drv_name);
> + ent_name = &sep[1];
> + if (!*ent_name || !drv_namelen) {
> + cg_err(&cfs->gdev,
> + "%s: Driver name and entity name can't be empty.",
> + name);
> + goto syntax_error;
> + }
> + if (drv_namelen >= sizeof(c_ent->drv)) {
> + cg_err(&cfs->gdev,
> + "%s: Driver name length should be less then %ld.",
> + name, sizeof(c_ent->drv));
> + goto syntax_error;
> + }
> +
> + c_ent = kzalloc(sizeof(*c_ent), GFP_KERNEL);
> + if (!c_ent)
> + return ERR_PTR(-ENOMEM);
> +
> + /* Configure platform device */
> + strscpy(c_ent->drv, drv_name, drv_namelen + 1);
> + strscpy(c_ent->pdata.name, ent_name, sizeof(c_ent->pdata.name));
> + c_ent->pdata.group = &c_ent->cg;
> +
> + cg_dbg(&cfs->gdev, "New entity %s:%s", c_ent->drv, c_ent->pdata.name);
> +
> + /* Configure group */
> + config_group_init_type_name(&c_ent->cg, name, &vimc_cfs_ent_type);
> + if (vimc_cfs_drv_cb(c_ent->drv, &c_ent->cg)) {
> + cg_err(&c_ent->cg, "Module %s not found", c_ent->drv);
> + kfree(c_ent);
> + return ERR_PTR(-EINVAL);
> + }
> + list_add(&c_ent->list, &cfs->ents);
Same here, need to call config_item_get ?
Regard,
Dafna
> +
> + return &c_ent->cg;
> +
> +syntax_error:
> + cg_err(&cfs->gdev,
> + "Couldn't create entity %s, wrong syntax.", name);
> + return ERR_PTR(-EINVAL);
> +}
> +
> +/* --------------------------------------------------------------------------
> + * Default group: Links
> + */
> +
> +static struct configfs_group_operations vimc_cfs_dlink_group_ops = {
> + .make_item = vimc_cfs_link_make_item,
> + .drop_item = vimc_cfs_link_drop_item,
> +};
> +
> +static struct config_item_type vimc_cfs_dlink_type = {
> + .ct_group_ops = &vimc_cfs_dlink_group_ops,
> + .ct_owner = THIS_MODULE,
> +};
> +
> +void vimc_cfs_dlink_add_default_group(struct vimc_cfs_device *cfs)
> +{
> + config_group_init_type_name(&cfs->glinks, "links",
> + &vimc_cfs_dlink_type);
> + configfs_add_default_group(&cfs->glinks, &cfs->gdev);
> +}
> +
> +/* --------------------------------------------------------------------------
> + * Default group: Entities
> + */
> +
> +static struct configfs_group_operations vimc_cfs_dent_group_ops = {
> + .make_group = vimc_cfs_ent_make_group,
> + .drop_item = vimc_cfs_ent_drop_item,
> +};
> +
> +static struct config_item_type vimc_cfs_dent_type = {
> + .ct_group_ops = &vimc_cfs_dent_group_ops,
> + .ct_owner = THIS_MODULE,
> +};
> +
> +void vimc_cfs_dent_add_default_group(struct vimc_cfs_device *cfs)
> +{
> + config_group_init_type_name(&cfs->gents, "entities",
> + &vimc_cfs_dent_type);
> + configfs_add_default_group(&cfs->gents, &cfs->gdev);
> +}
> +
> +/* --------------------------------------------------------------------------
> + * Device instance
> + */
> +
> +static int vimc_cfs_decode_state(const char *buf, size_t size)
> +{
> + unsigned int i, j;
> +
> + for (i = 0; i < ARRAY_SIZE(vimc_cfs_hotplug_values); i++) {
> + for (j = 0; j < ARRAY_SIZE(vimc_cfs_hotplug_values[0]); j++) {
> + if (!strncmp(buf, vimc_cfs_hotplug_values[i][j], size))
> + return i;
> + }
> + }
> + return -EINVAL;
> +}
> +
> +static ssize_t vimc_cfs_dev_attr_hotplug_show(struct config_item *item,
> + char *buf)
> +{
> + struct vimc_cfs_device *cfs = container_of(item, struct vimc_cfs_device,
> + gdev.cg_item);
> +
> + strcpy(buf, vimc_cfs_hotplug_values[is_plugged(cfs)][0]);
> + return strlen(buf);
> +}
> +
> +static int vimc_cfs_hotplug_set(struct vimc_cfs_device *cfs,
> + enum vimc_cfs_hotplug_state state)
> +{
> + if (state == is_plugged(cfs)) {
> + return 0;
> + } else if (state == VIMC_CFS_HOTPLUG_STATE_UNPLUGGED) {
> + vimc_cfs_device_unplug(cfs);
> + return 0;
> + } else if (state == VIMC_CFS_HOTPLUG_STATE_PLUGGED) {
> + return vimc_cfs_device_plug(cfs);
> + }
> + return -EINVAL;
> +}
> +
> +static ssize_t vimc_cfs_dev_attr_hotplug_store(struct config_item *item,
> + const char *buf, size_t size)
> +{
> + struct vimc_cfs_device *cfs = container_of(item, struct vimc_cfs_device,
> + gdev.cg_item);
> + int state = vimc_cfs_decode_state(buf, size);
> +
> + if (vimc_cfs_hotplug_set(cfs, state))
> + return -EINVAL;
> + return size;
> +}
> +
> +CONFIGFS_ATTR(vimc_cfs_dev_attr_, hotplug);
> +
> +static struct configfs_attribute *vimc_cfs_dev_attrs[] = {
> + &vimc_cfs_dev_attr_attr_hotplug,
> + NULL,
> +};
> +
> +static void vimc_cfs_dev_release(struct config_item *item)
> +{
> + struct vimc_cfs_device *cfs = container_of(item, struct vimc_cfs_device,
> + gdev.cg_item);
> +
> + kfree(cfs);
> +}
> +
> +static struct configfs_item_operations vimc_cfs_dev_item_ops = {
> + .release = vimc_cfs_dev_release,
> +};
> +
> +static struct config_item_type vimc_cfs_dev_type = {
> + .ct_item_ops = &vimc_cfs_dev_item_ops,
> + .ct_attrs = vimc_cfs_dev_attrs,
> + .ct_owner = THIS_MODULE,
> +};
> +
> +static void vimc_cfs_dev_drop_item(struct config_group *group,
> + struct config_item *item)
> +{
> + struct vimc_cfs_device *cfs = container_of(group,
> + struct vimc_cfs_device,
> + gdev);
> +
> + if (is_plugged(cfs))
> + vimc_cfs_device_unplug(cfs);
> +}
> +
> +static struct config_group *vimc_cfs_dev_make_group(
> + struct config_group *group, const char *name)
> +{
> + struct vimc_cfs_device *cfs = kzalloc(sizeof(*cfs), GFP_KERNEL);
> +
> + if (!cfs)
> + return ERR_PTR(-ENOMEM);
> +
> + /* Configure pipeline */
> + INIT_LIST_HEAD(&cfs->ents);
> + INIT_LIST_HEAD(&cfs->links);
> +
> + /* Configure platform data */
> + strscpy(cfs->pdata.data.name, name, sizeof(cfs->pdata.data.name));
> + cfs->pdata.data.group = &cfs->gdev;
> + cfs->pdata.links = &cfs->links;
> +
> + /* Configure configfs group */
> + config_group_init_type_name(&cfs->gdev, name, &vimc_cfs_dev_type);
> + vimc_cfs_dent_add_default_group(cfs);
> + vimc_cfs_dlink_add_default_group(cfs);
> +
> + return &cfs->gdev;
> +}
> +
> +/* --------------------------------------------------------------------------
> + * Subsystem
> + */
> +
> +static struct configfs_group_operations vimc_cfs_subsys_group_ops = {
> + /* Create vimc devices */
> + .make_group = vimc_cfs_dev_make_group,
> + .drop_item = vimc_cfs_dev_drop_item,
> +};
> +
> +static struct config_item_type vimc_cfs_subsys_type = {
> + .ct_group_ops = &vimc_cfs_subsys_group_ops,
> + .ct_owner = THIS_MODULE,
> +};
> +
> +int vimc_cfs_subsys_register(void)
> +{
> + struct configfs_subsystem *subsys = &vimc_cfs_subsys.subsys;
> + int ret;
> +
> + INIT_LIST_HEAD(&vimc_cfs_subsys.drvs);
> + config_group_init_type_name(&subsys->su_group, CFS_SUBSYS_NAME,
> + &vimc_cfs_subsys_type);
> + mutex_init(&subsys->su_mutex);
> + ret = configfs_register_subsystem(subsys);
> +
> + return ret;
> +}
> +
> +void vimc_cfs_subsys_unregister(void)
> +{
> + configfs_unregister_subsystem(&vimc_cfs_subsys.subsys);
> +}
> diff --git a/drivers/media/platform/vimc/vimc-configfs.h b/drivers/media/platform/vimc/vimc-configfs.h
> new file mode 100644
> index 000000000000..6278b53d11ba
> --- /dev/null
> +++ b/drivers/media/platform/vimc/vimc-configfs.h
> @@ -0,0 +1,30 @@
> +/* SPDX-License-Identifier: GPL-2.0+ */
> +/*
> + * vimc-configfs.h Virtual Media Controller Driver
> + *
> + * Copyright (C) 2018 Helen Koike <[email protected]>
> + */
> +
> +#ifndef _VIMC_CONFIGFS_H_
> +#define _VIMC_CONFIGFS_H_
> +
> +#include <linux/configfs.h>
> +
> +#define VIMC_CFS_SRC_PAD_NAME(n) "pad:source:" #n
> +#define VIMC_CFS_SINK_PAD_NAME(n) "pad:sink:" #n
> +
> +struct vimc_cfs_drv {
> + const char *name;
> + void (*const configfs_cb)(struct config_group *group);
> + struct list_head list;
> +};
> +
> +int vimc_cfs_subsys_register(void);
> +
> +void vimc_cfs_subsys_unregister(void);
> +
> +void vimc_cfs_drv_register(struct vimc_cfs_drv *c_drv);
> +
> +void vimc_cfs_drv_unregister(struct vimc_cfs_drv *c_drv);
> +
> +#endif
> diff --git a/drivers/media/platform/vimc/vimc-core.c b/drivers/media/platform/vimc/vimc-core.c
> index ce809d2e3d53..816015e7c8f6 100644
> --- a/drivers/media/platform/vimc/vimc-core.c
> +++ b/drivers/media/platform/vimc/vimc-core.c
> @@ -23,150 +23,29 @@
> #include <media/v4l2-device.h>
>
> #include "vimc-common.h"
> -
> -#define VIMC_PDEV_NAME "vimc"
> -#define VIMC_MDEV_MODEL_NAME "VIMC MDEV"
> -
> -#define VIMC_ENT_LINK(src, srcpad, sink, sinkpad, link_flags) { \
> - .src_ent = src, \
> - .src_pad = srcpad, \
> - .sink_ent = sink, \
> - .sink_pad = sinkpad, \
> - .flags = link_flags, \
> -}
> +#include "vimc-configfs.h"
>
> struct vimc_device {
> - /* The platform device */
> - struct platform_device pdev;
> -
> - /* The pipeline configuration */
> - const struct vimc_pipeline_config *pipe_cfg;
> -
> /* The Associated media_device parent */
> struct media_device mdev;
>
> /* Internal v4l2 parent device*/
> struct v4l2_device v4l2_dev;
> -
> - /* Subdevices */
> - struct platform_device **subdevs;
> -};
> -
> -/* Structure which describes individual configuration for each entity */
> -struct vimc_ent_config {
> - const char *name;
> - const char *drv;
> -};
> -
> -/* Structure which describes links between entities */
> -struct vimc_ent_link {
> - unsigned int src_ent;
> - u16 src_pad;
> - unsigned int sink_ent;
> - u16 sink_pad;
> - u32 flags;
> -};
> -
> -/* Structure which describes the whole topology */
> -struct vimc_pipeline_config {
> - const struct vimc_ent_config *ents;
> - size_t num_ents;
> - const struct vimc_ent_link *links;
> - size_t num_links;
> -};
> -
> -/* --------------------------------------------------------------------------
> - * Topology Configuration
> - */
> -
> -static const struct vimc_ent_config ent_config[] = {
> - {
> - .name = "Sensor A",
> - .drv = "vimc-sensor",
> - },
> - {
> - .name = "Sensor B",
> - .drv = "vimc-sensor",
> - },
> - {
> - .name = "Debayer A",
> - .drv = "vimc-debayer",
> - },
> - {
> - .name = "Debayer B",
> - .drv = "vimc-debayer",
> - },
> - {
> - .name = "Raw Capture 0",
> - .drv = "vimc-capture",
> - },
> - {
> - .name = "Raw Capture 1",
> - .drv = "vimc-capture",
> - },
> - {
> - .name = "RGB/YUV Input",
> - /* TODO: change this to vimc-input when it is implemented */
> - .drv = "vimc-sensor",
> - },
> - {
> - .name = "Scaler",
> - .drv = "vimc-scaler",
> - },
> - {
> - .name = "RGB/YUV Capture",
> - .drv = "vimc-capture",
> - },
> -};
> -
> -static const struct vimc_ent_link ent_links[] = {
> - /* Link: Sensor A (Pad 0)->(Pad 0) Debayer A */
> - VIMC_ENT_LINK(0, 0, 2, 0, MEDIA_LNK_FL_ENABLED | MEDIA_LNK_FL_IMMUTABLE),
> - /* Link: Sensor A (Pad 0)->(Pad 0) Raw Capture 0 */
> - VIMC_ENT_LINK(0, 0, 4, 0, MEDIA_LNK_FL_ENABLED | MEDIA_LNK_FL_IMMUTABLE),
> - /* Link: Sensor B (Pad 0)->(Pad 0) Debayer B */
> - VIMC_ENT_LINK(1, 0, 3, 0, MEDIA_LNK_FL_ENABLED | MEDIA_LNK_FL_IMMUTABLE),
> - /* Link: Sensor B (Pad 0)->(Pad 0) Raw Capture 1 */
> - VIMC_ENT_LINK(1, 0, 5, 0, MEDIA_LNK_FL_ENABLED | MEDIA_LNK_FL_IMMUTABLE),
> - /* Link: Debayer A (Pad 1)->(Pad 0) Scaler */
> - VIMC_ENT_LINK(2, 1, 7, 0, MEDIA_LNK_FL_ENABLED),
> - /* Link: Debayer B (Pad 1)->(Pad 0) Scaler */
> - VIMC_ENT_LINK(3, 1, 7, 0, 0),
> - /* Link: RGB/YUV Input (Pad 0)->(Pad 0) Scaler */
> - VIMC_ENT_LINK(6, 0, 7, 0, 0),
> - /* Link: Scaler (Pad 1)->(Pad 0) RGB/YUV Capture */
> - VIMC_ENT_LINK(7, 1, 8, 0, MEDIA_LNK_FL_ENABLED | MEDIA_LNK_FL_IMMUTABLE),
> -};
> -
> -static const struct vimc_pipeline_config pipe_cfg = {
> - .ents = ent_config,
> - .num_ents = ARRAY_SIZE(ent_config),
> - .links = ent_links,
> - .num_links = ARRAY_SIZE(ent_links)
> };
>
> -/* -------------------------------------------------------------------------- */
> -
> -static int vimc_create_links(struct vimc_device *vimc)
> +static int vimc_core_links_create(const struct device *master)
> {
> - unsigned int i;
> + struct vimc_platform_data_core *pdata = master->platform_data;
> + struct vimc_ent_device *ved_src, *ved_sink;
> + struct vimc_platform_data_link *plink;
> int ret;
>
> - /* Initialize the links between entities */
> - for (i = 0; i < vimc->pipe_cfg->num_links; i++) {
> - const struct vimc_ent_link *link = &vimc->pipe_cfg->links[i];
> - /*
> - * TODO: Check another way of retrieving ved struct without
> - * relying on platform_get_drvdata
> - */
> - struct vimc_ent_device *ved_src =
> - platform_get_drvdata(vimc->subdevs[link->src_ent]);
> - struct vimc_ent_device *ved_sink =
> - platform_get_drvdata(vimc->subdevs[link->sink_ent]);
> -
> - ret = media_create_pad_link(ved_src->ent, link->src_pad,
> - ved_sink->ent, link->sink_pad,
> - link->flags);
> + list_for_each_entry(plink, pdata->links, list) {
> + ved_src = platform_get_drvdata(plink->source);
> + ved_sink = platform_get_drvdata(plink->sink);
> + ret = media_create_pad_link(ved_src->ent, plink->source_pad,
> + ved_sink->ent, plink->sink_pad,
> + plink->flags);
> if (ret)
> return ret;
> }
> @@ -174,10 +53,10 @@ static int vimc_create_links(struct vimc_device *vimc)
> return 0;
> }
>
> -static int vimc_comp_bind(struct device *master)
> +int vimc_core_comp_bind(struct device *master)
> {
> - struct vimc_device *vimc = container_of(to_platform_device(master),
> - struct vimc_device, pdev);
> + struct vimc_device *vimc =
> + platform_get_drvdata(to_platform_device(master));
> int ret;
>
> dev_dbg(master, "bind");
> @@ -194,9 +73,7 @@ static int vimc_comp_bind(struct device *master)
> ret = component_bind_all(master, &vimc->v4l2_dev);
> if (ret)
> goto err_v4l2_unregister;
> -
> - /* Initialize links */
> - ret = vimc_create_links(vimc);
> + ret = vimc_core_links_create(master);
> if (ret)
> goto err_comp_unbind_all;
>
> @@ -228,11 +105,12 @@ static int vimc_comp_bind(struct device *master)
>
> return ret;
> }
> +EXPORT_SYMBOL_GPL(vimc_core_comp_bind);
>
> -static void vimc_comp_unbind(struct device *master)
> +void vimc_core_comp_unbind(struct device *master)
> {
> - struct vimc_device *vimc = container_of(to_platform_device(master),
> - struct vimc_device, pdev);
> + struct vimc_device *vimc =
> + platform_get_drvdata(to_platform_device(master));
>
> dev_dbg(master, "unbind");
>
> @@ -240,147 +118,56 @@ static void vimc_comp_unbind(struct device *master)
> component_unbind_all(master, NULL);
> v4l2_device_unregister(&vimc->v4l2_dev);
> }
> -
> -static int vimc_comp_compare(struct device *comp, void *data)
> -{
> - const struct platform_device *pdev = to_platform_device(comp);
> - const char *name = data;
> -
> - return !strcmp(pdev->dev.platform_data, name);
> -}
> -
> -static struct component_match *vimc_add_subdevs(struct vimc_device *vimc)
> -{
> - struct component_match *match = NULL;
> - struct vimc_platform_data pdata;
> - int i;
> -
> - for (i = 0; i < vimc->pipe_cfg->num_ents; i++) {
> - dev_dbg(&vimc->pdev.dev, "new pdev for %s\n",
> - vimc->pipe_cfg->ents[i].drv);
> -
> - strscpy(pdata.entity_name, vimc->pipe_cfg->ents[i].name,
> - sizeof(pdata.entity_name));
> -
> - vimc->subdevs[i] = platform_device_register_data(&vimc->pdev.dev,
> - vimc->pipe_cfg->ents[i].drv,
> - PLATFORM_DEVID_AUTO,
> - &pdata,
> - sizeof(pdata));
> - if (IS_ERR(vimc->subdevs[i])) {
> - match = ERR_CAST(vimc->subdevs[i]);
> - while (--i >= 0)
> - platform_device_unregister(vimc->subdevs[i]);
> -
> - return match;
> - }
> -
> - component_match_add(&vimc->pdev.dev, &match, vimc_comp_compare,
> - (void *)vimc->pipe_cfg->ents[i].name);
> - }
> -
> - return match;
> -}
> -
> -static void vimc_rm_subdevs(struct vimc_device *vimc)
> -{
> - unsigned int i;
> -
> - for (i = 0; i < vimc->pipe_cfg->num_ents; i++)
> - platform_device_unregister(vimc->subdevs[i]);
> -}
> -
> -static const struct component_master_ops vimc_comp_ops = {
> - .bind = vimc_comp_bind,
> - .unbind = vimc_comp_unbind,
> -};
> +EXPORT_SYMBOL_GPL(vimc_core_comp_unbind);
>
> static int vimc_probe(struct platform_device *pdev)
> {
> - struct vimc_device *vimc = container_of(pdev, struct vimc_device, pdev);
> - struct component_match *match = NULL;
> - int ret;
> + const struct vimc_platform_data_core *pdata = pdev->dev.platform_data;
> + struct vimc_device *vimc = devm_kzalloc(&pdev->dev, sizeof(*vimc),
> + GFP_KERNEL);
>
> dev_dbg(&pdev->dev, "probe");
>
> - /* Create platform_device for each entity in the topology*/
> - vimc->subdevs = devm_kcalloc(&vimc->pdev.dev, vimc->pipe_cfg->num_ents,
> - sizeof(*vimc->subdevs), GFP_KERNEL);
> - if (!vimc->subdevs)
> - return -ENOMEM;
> -
> - match = vimc_add_subdevs(vimc);
> - if (IS_ERR(match))
> - return PTR_ERR(match);
> -
> - /* Link the media device within the v4l2_device */
> - vimc->v4l2_dev.mdev = &vimc->mdev;
> -
> /* Initialize media device */
> - strscpy(vimc->mdev.model, VIMC_MDEV_MODEL_NAME,
> - sizeof(vimc->mdev.model));
> + strscpy(vimc->mdev.model, pdata->data.name, sizeof(vimc->mdev.model));
> vimc->mdev.dev = &pdev->dev;
> media_device_init(&vimc->mdev);
> + vimc->v4l2_dev.mdev = &vimc->mdev;
>
> - /* Add self to the component system */
> - ret = component_master_add_with_match(&pdev->dev, &vimc_comp_ops,
> - match);
> - if (ret) {
> - media_device_cleanup(&vimc->mdev);
> - vimc_rm_subdevs(vimc);
> - return ret;
> - }
> + platform_set_drvdata(pdev, vimc);
>
> return 0;
> }
>
> static int vimc_remove(struct platform_device *pdev)
> {
> - struct vimc_device *vimc = container_of(pdev, struct vimc_device, pdev);
> + struct vimc_device *vimc = platform_get_drvdata(pdev);
>
> dev_dbg(&pdev->dev, "remove");
>
> - component_master_del(&pdev->dev, &vimc_comp_ops);
> - vimc_rm_subdevs(vimc);
> + media_device_cleanup(&vimc->mdev);
>
> return 0;
> }
>
> -static void vimc_dev_release(struct device *dev)
> -{
> -}
> -
> -static struct vimc_device vimc_dev = {
> - .pipe_cfg = &pipe_cfg,
> - .pdev = {
> - .name = VIMC_PDEV_NAME,
> - .dev.release = vimc_dev_release,
> - }
> -};
> -
> static struct platform_driver vimc_pdrv = {
> .probe = vimc_probe,
> .remove = vimc_remove,
> .driver = {
> - .name = VIMC_PDEV_NAME,
> - },
> + .name = "vimc-core",
> + }
> };
>
> static int __init vimc_init(void)
> {
> int ret;
>
> - ret = platform_device_register(&vimc_dev.pdev);
> - if (ret) {
> - dev_err(&vimc_dev.pdev.dev,
> - "platform device registration failed (err=%d)\n", ret);
> + ret = platform_driver_register(&vimc_pdrv);
> + if (ret)
> return ret;
> - }
>
> - ret = platform_driver_register(&vimc_pdrv);
> + ret = vimc_cfs_subsys_register();
> if (ret) {
> - dev_err(&vimc_dev.pdev.dev,
> - "platform driver registration failed (err=%d)\n", ret);
> platform_driver_unregister(&vimc_pdrv);
> return ret;
> }
> @@ -390,9 +177,9 @@ static int __init vimc_init(void)
>
> static void __exit vimc_exit(void)
> {
> - platform_driver_unregister(&vimc_pdrv);
> + vimc_cfs_subsys_unregister();
>
> - platform_device_unregister(&vimc_dev.pdev);
> + platform_driver_unregister(&vimc_pdrv);
> }
>
> module_init(vimc_init);
> diff --git a/drivers/media/platform/vimc/vimc-core.h b/drivers/media/platform/vimc/vimc-core.h
> new file mode 100644
> index 000000000000..42c8f92354af
> --- /dev/null
> +++ b/drivers/media/platform/vimc/vimc-core.h
> @@ -0,0 +1,17 @@
> +/* SPDX-License-Identifier: GPL-2.0+ */
> +/*
> + * vimc-core.h Virtual Media Controller Driver
> + *
> + * Copyright (C) 2018 Helen Koike <[email protected]>
> + */
> +
> +#ifndef _VIMC_CORE_H_
> +#define _VIMC_CORE_H_
> +
> +#define VIMC_CORE_PDEV_NAME "vimc-core"
> +
> +int vimc_core_comp_bind(struct device *master);
> +
> +void vimc_core_comp_unbind(struct device *master);
> +
> +#endif
> diff --git a/drivers/media/platform/vimc/vimc-debayer.c b/drivers/media/platform/vimc/vimc-debayer.c
> index 77887f66f323..fa326dbb7562 100644
> --- a/drivers/media/platform/vimc/vimc-debayer.c
> +++ b/drivers/media/platform/vimc/vimc-debayer.c
> @@ -23,6 +23,7 @@
> #include <linux/v4l2-mediabus.h>
> #include <media/v4l2-subdev.h>
>
> +#include "vimc-configfs.h"
> #include "vimc-common.h"
>
> #define VIMC_DEB_DRV_NAME "vimc-debayer"
> @@ -522,7 +523,7 @@ static int vimc_deb_comp_bind(struct device *comp, struct device *master,
> void *master_data)
> {
> struct v4l2_device *v4l2_dev = master_data;
> - struct vimc_platform_data *pdata = comp->platform_data;
> + struct vimc_platform_data *pdata = dev_get_platdata(comp);
> struct vimc_deb_device *vdeb;
> int ret;
>
> @@ -532,8 +533,7 @@ static int vimc_deb_comp_bind(struct device *comp, struct device *master,
> return -ENOMEM;
>
> /* Initialize ved and sd */
> - ret = vimc_ent_sd_register(&vdeb->ved, &vdeb->sd, v4l2_dev,
> - pdata->entity_name,
> + ret = vimc_ent_sd_register(&vdeb->ved, &vdeb->sd, v4l2_dev, pdata->name,
> MEDIA_ENT_F_PROC_VIDEO_PIXEL_ENC_CONV, 2,
> (const unsigned long[2]) {MEDIA_PAD_FL_SINK,
> MEDIA_PAD_FL_SOURCE},
> @@ -594,7 +594,50 @@ static struct platform_driver vimc_deb_pdrv = {
> },
> };
>
> -module_platform_driver(vimc_deb_pdrv);
> +static struct config_item_type vimc_deb_cfs_pad_type = {
> + .ct_owner = THIS_MODULE,
> +};
> +
> +static struct config_group vimc_deb_cfs_sink_pad_group;
> +static struct config_group vimc_deb_cfs_src_pad_group;
> +
> +static void vimc_deb_configfs_cb(struct config_group *group)
> +{
> + config_group_init_type_name(&vimc_deb_cfs_sink_pad_group,
> + VIMC_CFS_SINK_PAD_NAME(0),
> + &vimc_deb_cfs_pad_type);
> + configfs_add_default_group(&vimc_deb_cfs_sink_pad_group, group);
> +
> + config_group_init_type_name(&vimc_deb_cfs_src_pad_group,
> + VIMC_CFS_SRC_PAD_NAME(1),
> + &vimc_deb_cfs_pad_type);
> + configfs_add_default_group(&vimc_deb_cfs_src_pad_group, group);
> +}
> +
> +struct vimc_cfs_drv vimc_deb_cfs_drv = {
> + .name = VIMC_DEB_DRV_NAME,
> + .configfs_cb = vimc_deb_configfs_cb,
> +};
> +
> +static int __init vimc_deb_init(void)
> +{
> + int ret = platform_driver_register(&vimc_deb_pdrv);
> +
> + if (ret)
> + return ret;
> +
> + vimc_cfs_drv_register(&vimc_deb_cfs_drv);
> + return 0;
> +}
> +
> +static void __exit vimc_deb_exit(void)
> +{
> + platform_driver_unregister(&vimc_deb_pdrv);
> + vimc_cfs_drv_unregister(&vimc_deb_cfs_drv);
> +}
> +
> +module_init(vimc_deb_init);
> +module_exit(vimc_deb_exit);
>
> MODULE_DEVICE_TABLE(platform, vimc_deb_driver_ids);
>
> diff --git a/drivers/media/platform/vimc/vimc-scaler.c b/drivers/media/platform/vimc/vimc-scaler.c
> index b0952ee86296..efb29384197d 100644
> --- a/drivers/media/platform/vimc/vimc-scaler.c
> +++ b/drivers/media/platform/vimc/vimc-scaler.c
> @@ -23,6 +23,7 @@
> #include <linux/v4l2-mediabus.h>
> #include <media/v4l2-subdev.h>
>
> +#include "vimc-configfs.h"
> #include "vimc-common.h"
>
> #define VIMC_SCA_DRV_NAME "vimc-scaler"
> @@ -394,8 +395,7 @@ static int vimc_sca_comp_bind(struct device *comp, struct device *master,
> return -ENOMEM;
>
> /* Initialize ved and sd */
> - ret = vimc_ent_sd_register(&vsca->ved, &vsca->sd, v4l2_dev,
> - pdata->entity_name,
> + ret = vimc_ent_sd_register(&vsca->ved, &vsca->sd, v4l2_dev, pdata->name,
> MEDIA_ENT_F_PROC_VIDEO_SCALER, 2,
> (const unsigned long[2]) {MEDIA_PAD_FL_SINK,
> MEDIA_PAD_FL_SOURCE},
> @@ -448,7 +448,50 @@ static struct platform_driver vimc_sca_pdrv = {
> },
> };
>
> -module_platform_driver(vimc_sca_pdrv);
> +static struct config_item_type vimc_sca_cfs_pad_type = {
> + .ct_owner = THIS_MODULE,
> +};
> +
> +static struct config_group vimc_sca_cfs_sink_pad_group;
> +static struct config_group vimc_sca_cfs_src_pad_group;
> +
> +static void vimc_sca_configfs_cb(struct config_group *group)
> +{
> + config_group_init_type_name(&vimc_sca_cfs_sink_pad_group,
> + VIMC_CFS_SINK_PAD_NAME(0),
> + &vimc_sca_cfs_pad_type);
> + configfs_add_default_group(&vimc_sca_cfs_sink_pad_group, group);
> +
> + config_group_init_type_name(&vimc_sca_cfs_src_pad_group,
> + VIMC_CFS_SRC_PAD_NAME(1),
> + &vimc_sca_cfs_pad_type);
> + configfs_add_default_group(&vimc_sca_cfs_src_pad_group, group);
> +}
> +
> +struct vimc_cfs_drv vimc_sca_cfs_drv = {
> + .name = VIMC_SCA_DRV_NAME,
> + .configfs_cb = vimc_sca_configfs_cb,
> +};
> +
> +static int __init vimc_sca_init(void)
> +{
> + int ret = platform_driver_register(&vimc_sca_pdrv);
> +
> + if (ret)
> + return ret;
> +
> + vimc_cfs_drv_register(&vimc_sca_cfs_drv);
> + return 0;
> +}
> +
> +static void __exit vimc_sca_exit(void)
> +{
> + platform_driver_unregister(&vimc_sca_pdrv);
> + vimc_cfs_drv_unregister(&vimc_sca_cfs_drv);
> +}
> +
> +module_init(vimc_sca_init);
> +module_exit(vimc_sca_exit);
>
> MODULE_DEVICE_TABLE(platform, vimc_sca_driver_ids);
>
> diff --git a/drivers/media/platform/vimc/vimc-sensor.c b/drivers/media/platform/vimc/vimc-sensor.c
> index 32ca9c6172b1..37540e72c6bc 100644
> --- a/drivers/media/platform/vimc/vimc-sensor.c
> +++ b/drivers/media/platform/vimc/vimc-sensor.c
> @@ -28,6 +28,7 @@
> #include <media/v4l2-subdev.h>
> #include <media/tpg/v4l2-tpg.h>
>
> +#include "vimc-configfs.h"
> #include "vimc-common.h"
>
> #define VIMC_SEN_DRV_NAME "vimc-sensor"
> @@ -405,8 +406,7 @@ static int vimc_sen_comp_bind(struct device *comp, struct device *master,
> }
>
> /* Initialize ved and sd */
> - ret = vimc_ent_sd_register(&vsen->ved, &vsen->sd, v4l2_dev,
> - pdata->entity_name,
> + ret = vimc_ent_sd_register(&vsen->ved, &vsen->sd, v4l2_dev, pdata->name,
> MEDIA_ENT_F_CAM_SENSOR, 1,
> (const unsigned long[1]) {MEDIA_PAD_FL_SOURCE},
> &vimc_sen_ops);
> @@ -471,7 +471,44 @@ static struct platform_driver vimc_sen_pdrv = {
> },
> };
>
> -module_platform_driver(vimc_sen_pdrv);
> +static struct config_item_type vimc_sen_cfs_pad_type = {
> + .ct_owner = THIS_MODULE,
> +};
> +
> +static struct config_group vimc_sen_cfs_src_pad_group;
> +
> +static void vimc_sen_configfs_cb(struct config_group *group)
> +{
> + config_group_init_type_name(&vimc_sen_cfs_src_pad_group,
> + VIMC_CFS_SRC_PAD_NAME(0),
> + &vimc_sen_cfs_pad_type);
> + configfs_add_default_group(&vimc_sen_cfs_src_pad_group, group);
> +}
> +
> +struct vimc_cfs_drv vimc_sen_cfs_drv = {
> + .name = VIMC_SEN_DRV_NAME,
> + .configfs_cb = vimc_sen_configfs_cb,
> +};
> +
> +static int __init vimc_sen_init(void)
> +{
> + int ret = platform_driver_register(&vimc_sen_pdrv);
> +
> + if (ret)
> + return ret;
> +
> + vimc_cfs_drv_register(&vimc_sen_cfs_drv);
> + return 0;
> +}
> +
> +static void __exit vimc_sen_exit(void)
> +{
> + platform_driver_unregister(&vimc_sen_pdrv);
> + vimc_cfs_drv_unregister(&vimc_sen_cfs_drv);
> +}
> +
> +module_init(vimc_sen_init);
> +module_exit(vimc_sen_exit);
>
> MODULE_DEVICE_TABLE(platform, vimc_sen_driver_ids);
>
> --
> 2.19.1
>
Hi Dafna,
On 8/10/19 4:40 AM, Dafna Hirschfeld wrote:
> Hi,
> I will continue working on this patch that Helen started.
Thank you for doing this.
> Regarding the requirements, if an entity is removed, should all the
> links related to it also be removed?
I'm not sure if the configfs framework allows this easily.
> Also, should it be possible to create a link with entities that do not exist?
iirc, rmdir can't fail.
So, lets say that you create two entities, ent1 and ent2 with mkdir, then
you create a link between the two with mkdir, then you remove ent1 with rmdir.
As rmdir can't fail, or you remove the links related to ent1 (which I don't
think is easy with configfs framework from what I recall, unless you launch
the rmdir syscall from the kernel code), or you will have a link with entities
that don't exist.
What I suggest for now is to allow creating links with entities that do not
exist, and when someone tries to "plug" the device by writing to the hotplug
file, you fail and print a message that the configfs tree is inconsistent (or just
ignore the falty links and print a message that they couldn't be created on "plug").
What do you think?
Please see the answer to your inline comments below.
> The reason to keep links between non existing entities is that it
> allows to easily unplug an entity for testing,
> and the links related to it can be ignored while still be visible
> through the configfs.
>
> I have also some inline comments.
>
> On Fri, Dec 7, 2018 at 7:24 PM Helen Koike <[email protected]> wrote:
>>
>> Add API to allow userspace to create any type of topology in vimc using
>> basic system calls such as mkdir/rmdir/read/write.
>>
>> Signed-off-by: Helen Koike <[email protected]>
>>
>> ---
>> Hi,
>>
>> This patch introduces the configufs API for configuring the topology in
>> vimc while it removes the hardcoded topology, so now, when you load the
>> module you need to create a device (no device will appear in your system
>> by default) using mkdir/rmdir/write/read.
>> Please see documentation in the patch.
>> I was thinking in adding a device by default, but if I do it in
>> configfs, userspace won't be able to delete the device (which might not
>> be a problem), as I need to create it as a "default" group in configfs,
>> or I can just not expose the default device in the configfs.
>> What do you think?
>>
>> Thanks
>> Helen
>>
>> Documentation/media/v4l-drivers/vimc.rst | 172 +++++
>> drivers/media/platform/vimc/Kconfig | 7 +-
>> drivers/media/platform/vimc/Makefile | 7 +-
>> drivers/media/platform/vimc/vimc-capture.c | 46 +-
>> drivers/media/platform/vimc/vimc-common.h | 58 +-
>> drivers/media/platform/vimc/vimc-configfs.c | 665 ++++++++++++++++++++
>> drivers/media/platform/vimc/vimc-configfs.h | 30 +
>> drivers/media/platform/vimc/vimc-core.c | 283 ++-------
>> drivers/media/platform/vimc/vimc-core.h | 17 +
>> drivers/media/platform/vimc/vimc-debayer.c | 51 +-
>> drivers/media/platform/vimc/vimc-scaler.c | 49 +-
>> drivers/media/platform/vimc/vimc-sensor.c | 43 +-
>> 12 files changed, 1153 insertions(+), 275 deletions(-)
>> create mode 100644 Documentation/media/v4l-drivers/vimc.rst
>> create mode 100644 drivers/media/platform/vimc/vimc-configfs.c
>> create mode 100644 drivers/media/platform/vimc/vimc-configfs.h
>> create mode 100644 drivers/media/platform/vimc/vimc-core.h
>>
>> diff --git a/Documentation/media/v4l-drivers/vimc.rst b/Documentation/media/v4l-drivers/vimc.rst
>> new file mode 100644
>> index 000000000000..28d3b02c7d30
>> --- /dev/null
>> +++ b/Documentation/media/v4l-drivers/vimc.rst
>> @@ -0,0 +1,172 @@
>> +The Virtual Media Controller Driver (vimc)
>> +=========================================
>> +
>> +This driver emulates video4linux hardware of varios media topologies. It exposes
>> +media devices through /dev/mediaX notes, video capture devices through
>> +/dev/videoX and sub-devices through /dev/v4l-subdevX.
>> +
>> +A subdevice can be a sensor, a debayer or a scaler.
>> +
>> +To configure a media device of a given topology, a ConfigFS API is provided.
>> +
>> +
>> +Configuring the driver through ConfigFS (Experimental)
>> +------------------------------------------------------
>> +
>> +.. note::
>> +This API is not finished yet and might change in the future.
>> +
>> +Mount configfs:
>> +::
>> + $ mkdir /configfs
>> + $ mount -t configfs none /configfs
>> +
>> +When loading the module, you see a folders name vimc
>> +::
>> + $ tree /configfs/
>> + /configfs/
>> + `-- vimc
>> +
>> +1) Creating a media device
>> +~~~~~~~~~~~~~~~~~~~~~~~~~~
>> +
>> +To create a media device just create a new folder under /configfs/vimc/
>> +
>> +Example:
>> +::
>> + $ mkdir /configfs/vimc/mdev
>> + $ tree /configfs/vimc/mdev
>> + /configfs/vimc/mdev/
>> + |-- entities/
>> + |-- hotplug
>> + `-- links/
>> +
>> + 2 directories, 1 file
>> +
>> +2) Creating entities
>> +~~~~~~~~~~~~~~~~~~~~
>> +
>> +To create an entity in the media device's topology, just create a folder under
>> +/configfs/vimc/<mdev-name>/entities/ with the following format:
>> +
>> + <sub-module>:<name>
>> +
>> +Where <sub-module> is one of the following:
>> +::
>> + vimc-sensor
>> + vimc-scaler
>> + vimc-debayer
>> + vimc-capture
>> +
>> +Example:
>> +::
>> + $ mkdir /configfs/vimc/mdev/entities/vimc-sensor:my-sensor
>> + $ mkdir /configfs/vimc/mdev/entities/vimc-capture:my-capture
>> + $ tree /configfs/
>> + /configfs/
>> + `-- vimc/
>> + `-- mdev/
>> + |-- entities/
>> + | |-- vimc-capture:my-capture/
>> + | | `-- pad:sink:0/
>> + | `-- vimc-sensor:my-sensor/
>> + | `-- pad:source:0/
>> + |-- hotplug
>> + `-- links/
>> +
>> + 8 directories, 1 file
>> +
>> +3) Creating links
>> +~~~~~~~~~~~~~~~~~
>> +
>> +To create links between two entities in the topology, just create a folder under
>> +/configfs/vimc/<mdev-name>/links/ with the following format:
>> +
>> + "<entity1-name><pad-source>:<entity2-name><pad-sink>"
>> +
>> +Example:
>> +::
>> + $ mkdir "/configfs/vimc/mdev/links/my-sensor:0->my-capture:0"
>> + $ tree /configfs
>> + /configfs/
>> + `-- vimc/
>> + `-- mdev/
>> + |-- entities/
>> + | |-- vimc-capture:my-capture/
>> + | | `-- pad:sink:0/
>> + | `-- vimc-sensor:my-sensor/
>> + | `-- pad:source:0/
>> + |-- hotplug
>> + `-- links/
>> + `-- my-sensor:0->my-capture:0/
>> + `-- flags
>> +
>> + 9 directories, 2 files
>> +
>> +Change the attributes of the link by writing in the file
>> +"/configfs/vimc/<mdev-name>/links/<my-link>/flags"
>> +
>> +Flag values are defined in :ref:`include/uapi/linux/media.h <media_header>`
>> +( seek for ``MEDIA_LNK_FL_*``)
>> +
>> +1 - Enabled
>> + Indicates the link will be enabled when the media device is created.
>> +
>> +3 - Enabled and Immutable
>> + Indicates that the link enabled state can't be modified at runtime.
>> +
>> +Example:
>> +::
>> + $ echo 3 > "/configfs/vimc/mdev/links/my-sensor:0->my-capture:0/flags"
>> +
>> +4) Activating/Deactivating device
>> +~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
>> +
>> +To activate the device, write one of "plugged", "plug" or "1" to file
>> +/configfs/vimc/<ndev-name>/hotplug
>> +
>> +Example:
>> +::
>> + $ echo 1 > /configfs/vimc/mdev/hotplug
>> +
>> +You should see a new node /dev/mediaX in your devfs.
>> +
>> +To deactivate the device, write one of "unplugged", "unplug" or "0" to file
>> +/configfs/vimc/<ndev-name>/hotplug
>> +
>> +Example:
>> +::
>> + $ echo 0 > /configfs/vimc/mdev/hotplug
>> +
>> +Subdevices
>> +----------
>> +
>> +Subdevices defines the behavior of an entity in the topology. Depending on the
>> +subdevice, the entity can have multiple pads of type source or sink.
>> +
>> +vimc-sensor:
>> + Generates images in several formats using video test pattern generator.
>> + Exposes:
>> +
>> + * 1 Pad source
>> +
>> +vimc-debayer:
>> + Transforms images in bayer format into a non bayer format.
>> + Exposes:
>> +
>> + * 1 Pad sink
>> + * 1 Pad source
>> +
>> +vimc-scaler:
>> + Mutiplies the size of the image by 3.
>> + Exposes:
>> +
>> + * 1 Pad sink
>> + * 1 Pad source
>> +
>> +vimc-capture:
>> + Exposes node /dev/videoX to allow userspace to capture the stream.
>> + Exposes:
>> +
>> + * 1 Pad sink
>> + * 1 Pad source
>> diff --git a/drivers/media/platform/vimc/Kconfig b/drivers/media/platform/vimc/Kconfig
>> index 71c9fe7d3370..7f1fb550d4c3 100644
>> --- a/drivers/media/platform/vimc/Kconfig
>> +++ b/drivers/media/platform/vimc/Kconfig
>> @@ -1,15 +1,14 @@
>> config VIDEO_VIMC
>> tristate "Virtual Media Controller Driver (VIMC)"
>> - depends on VIDEO_DEV && VIDEO_V4L2 && VIDEO_V4L2_SUBDEV_API
>> + depends on VIDEO_DEV && VIDEO_V4L2 && VIDEO_V4L2_SUBDEV_API && CONFIGFS_FS
>> select VIDEOBUF2_VMALLOC
>> select VIDEO_V4L2_TPG
>> default n
>> ---help---
>> - Skeleton driver for Virtual Media Controller
>> + Virtual Media Controller Driver
>>
>> This driver can be compared to the vivid driver for emulating
>> a media node that exposes a complex media topology. The topology
>> - is hard coded for now but is meant to be highly configurable in
>> - the future.
>> + is configurable through configfs API.
>>
>> When in doubt, say N.
>> diff --git a/drivers/media/platform/vimc/Makefile b/drivers/media/platform/vimc/Makefile
>> index 4b2e3de7856e..5d926a5ef15c 100644
>> --- a/drivers/media/platform/vimc/Makefile
>> +++ b/drivers/media/platform/vimc/Makefile
>> @@ -1,10 +1,9 @@
>> # SPDX-License-Identifier: GPL-2.0
>> -vimc-objs := vimc-core.o
>> +vimc-objs := vimc-core.o vimc-common.o vimc-configfs.o
>> vimc_capture-objs := vimc-capture.o
>> -vimc_common-objs := vimc-common.o
>> vimc_debayer-objs := vimc-debayer.o
>> vimc_scaler-objs := vimc-scaler.o
>> vimc_sensor-objs := vimc-sensor.o
>>
>> -obj-$(CONFIG_VIDEO_VIMC) += vimc.o vimc_capture.o vimc_common.o vimc-debayer.o \
>> - vimc_scaler.o vimc_sensor.o
>> +obj-$(CONFIG_VIDEO_VIMC) += vimc.o vimc_capture.o vimc-debayer.o vimc_scaler.o \
>> + vimc_sensor.o
>> diff --git a/drivers/media/platform/vimc/vimc-capture.c b/drivers/media/platform/vimc/vimc-capture.c
>> index 3f7e9ed56633..55a5f85b4591 100644
>> --- a/drivers/media/platform/vimc/vimc-capture.c
>> +++ b/drivers/media/platform/vimc/vimc-capture.c
>> @@ -23,6 +23,7 @@
>> #include <media/videobuf2-core.h>
>> #include <media/videobuf2-vmalloc.h>
>>
>> +#include "vimc-configfs.h"
>> #include "vimc-common.h"
>>
>> #define VIMC_CAP_DRV_NAME "vimc-capture"
>> @@ -418,7 +419,7 @@ static int vimc_cap_comp_bind(struct device *comp, struct device *master,
>> }
>>
>> /* Initialize the media entity */
>> - vcap->vdev.entity.name = pdata->entity_name;
>> + vcap->vdev.entity.name = pdata->name;
>> vcap->vdev.entity.function = MEDIA_ENT_F_IO_V4L;
>> ret = media_entity_pads_init(&vcap->vdev.entity,
>> 1, vcap->ved.pads);
>> @@ -443,7 +444,7 @@ static int vimc_cap_comp_bind(struct device *comp, struct device *master,
>> ret = vb2_queue_init(q);
>> if (ret) {
>> dev_err(comp, "%s: vb2 queue init failed (err=%d)\n",
>> - pdata->entity_name, ret);
>> + pdata->name, ret);
>> goto err_clean_m_ent;
>> }
>>
>> @@ -476,7 +477,7 @@ static int vimc_cap_comp_bind(struct device *comp, struct device *master,
>> vdev->queue = q;
>> vdev->v4l2_dev = v4l2_dev;
>> vdev->vfl_dir = VFL_DIR_RX;
>> - strscpy(vdev->name, pdata->entity_name, sizeof(vdev->name));
>> + strscpy(vdev->name, pdata->name, sizeof(vdev->name));
>> video_set_drvdata(vdev, &vcap->ved);
>>
>> /* Register the video_device with the v4l2 and the media framework */
>> @@ -534,7 +535,44 @@ static struct platform_driver vimc_cap_pdrv = {
>> },
>> };
>>
>> -module_platform_driver(vimc_cap_pdrv);
>> +static struct config_item_type vimc_cap_cfs_pad_type = {
>> + .ct_owner = THIS_MODULE,
>> +};
>> +
>> +static struct config_group vimc_cap_cfs_sink_pad_group;
>> +
>> +static void vimc_cap_configfs_cb(struct config_group *group)
>> +{
>> + config_group_init_type_name(&vimc_cap_cfs_sink_pad_group,
>> + VIMC_CFS_SINK_PAD_NAME(0),
>> + &vimc_cap_cfs_pad_type);
>> + configfs_add_default_group(&vimc_cap_cfs_sink_pad_group, group);
>> +}
>> +
>> +struct vimc_cfs_drv vimc_cap_cfs_drv = {
>> + .name = VIMC_CAP_DRV_NAME,
>> + .configfs_cb = vimc_cap_configfs_cb,
>> +};
>> +
>> +static int __init vimc_cap_init(void)
>> +{
>> + int ret = platform_driver_register(&vimc_cap_pdrv);
>> +
>> + if (ret)
>> + return ret;
>> +
>> + vimc_cfs_drv_register(&vimc_cap_cfs_drv);
>> + return 0;
>> +}
>> +
>> +static void __exit vimc_cap_exit(void)
>> +{
>> + platform_driver_unregister(&vimc_cap_pdrv);
>> + vimc_cfs_drv_unregister(&vimc_cap_cfs_drv);
>> +}
>> +
>> +module_init(vimc_cap_init);
>> +module_exit(vimc_cap_exit);
>>
>> MODULE_DEVICE_TABLE(platform, vimc_cap_driver_ids);
>>
>> diff --git a/drivers/media/platform/vimc/vimc-common.h b/drivers/media/platform/vimc/vimc-common.h
>> index 2e9981b18166..9a33e7901b72 100644
>> --- a/drivers/media/platform/vimc/vimc-common.h
>> +++ b/drivers/media/platform/vimc/vimc-common.h
>> @@ -22,6 +22,8 @@
>> #include <media/media-device.h>
>> #include <media/v4l2-device.h>
>>
>> +#define VIMC_MAX_NAME_LEN 32
>> +
>> /* VIMC-specific controls */
>> #define VIMC_CID_VIMC_BASE (0x00f00000 | 0xf000)
>> #define VIMC_CID_VIMC_CLASS (0x00f00000 | 1)
>> @@ -63,16 +65,62 @@ do { \
>> /**
>> * struct vimc_platform_data - platform data to components
>> *
>> - * @entity_name: The name of the entity to be created
>> + * @name: The name of the device
>> + * @group: The configfs group the device belongs
>> *
>> * Board setup code will often provide additional information using the device's
>> * platform_data field to hold additional information.
>> - * When injecting a new platform_device in the component system the core needs
>> - * to provide to the corresponding submodules the name of the entity that should
>> - * be used when registering the subdevice in the Media Controller system.
>> + * When injecting a new platform_device in the component system, the name of the
>> + * device is required to allow the system to register it with a proper name.
>> + * Also the configfs group is given to allow the driver to add custom items in
>> + * the group.
>> + * This struct is used by the entity submodules and the core system to be able
>> + * to retrieve the name to register the device in the Media Controller system.
>> */
>> struct vimc_platform_data {
>> - char entity_name[32];
>> + char name[VIMC_MAX_NAME_LEN];
>> + struct config_group *group;
>> +};
>> +
>> +/**
>> + * struct vimc_platform_data_link - platform data to components of type link
>> + *
>> + * @source: source component of the link
>> + * @source_pad: source pad of the link
>> + * @sink: sink component of the link
>> + * @sink_pad: sink pad of the link
>> + * @flags: flags of the link
>> + *
>> + * Board setup code will often provide additional information using the device's
>> + * platform_data field to hold additional information.
>> + * When injecting a new platform_device representing a link in the component
>> + * system, source and sink information is required to allow the link module to
>> + * create the proper link between entities.
>> + */
>> +struct vimc_platform_data_link {
>> + struct platform_device *source;
>> + u16 source_pad;
>> + struct platform_device *sink;
>> + u16 sink_pad;
>> + u32 flags;
>> + struct list_head list;
>> +};
>> +
>> +/**
>> + * struct vimc_platform_data_core - platform data to the core
>> + *
>> + * @data: see struct vimc_platform_data
>> + * @links: list of struct vimc_platform_data_link
>> + *
>> + * Board setup code will often provide additional information using the device's
>> + * platform_data field to hold additional information.
>> + * When injecting a new platform_device representing the core component, a list
>> + * of struct vimc_platform_data_list is required to allow the core to create
>> + * create the proper links between entities.
>> + */
>> +struct vimc_platform_data_core {
>> + struct vimc_platform_data data;
>> + struct list_head *links;
>> };
>>
>> /**
>> diff --git a/drivers/media/platform/vimc/vimc-configfs.c b/drivers/media/platform/vimc/vimc-configfs.c
>> new file mode 100644
>> index 000000000000..68e5f1ea736b
>> --- /dev/null
>> +++ b/drivers/media/platform/vimc/vimc-configfs.c
>> @@ -0,0 +1,665 @@
>> +// SPDX-License-Identifier: GPL-2.0+
>> +/*
>> + * vimc-configfs.c Virtual Media Controller Driver
>> + *
>> + * Copyright (C) 2018 Helen Koike <[email protected]>
>> + */
>> +
>> +#include <linux/component.h>
>> +#include <linux/module.h>
>> +#include <linux/slab.h>
>> +#include <linux/platform_device.h>
>> +
>> +#include "vimc-common.h"
>> +#include "vimc-configfs.h"
>> +#include "vimc-core.h"
>> +
>> +#define CHAR_SEPARATOR ':'
>> +#define LINK_SEPARATOR "->"
>> +#define CFS_SUBSYS_NAME "vimc"
>> +
>> +#define ci_err(ci, fmt, ...) \
>> + pr_err("vimc: %s: " pr_fmt(fmt), (ci)->ci_name, ##__VA_ARGS__)
>> +#define cg_err(cg, ...) ci_err(&(cg)->cg_item, ##__VA_ARGS__)
>> +#define ci_warn(ci, fmt, ...) \
>> + pr_warn("vimc: %s: " pr_fmt(fmt), (ci)->ci_name, ##__VA_ARGS__)
>> +#define cg_warn(cg, ...) ci_warn(&(cg)->cg_item, ##__VA_ARGS__)
>> +#define ci_dbg(ci, fmt, ...) \
>> + pr_debug("vimc: %s: " pr_fmt(fmt), (ci)->ci_name, ##__VA_ARGS__)
>> +#define cg_dbg(cg, ...) ci_dbg(&(cg)->cg_item, ##__VA_ARGS__)
>> +
>> +#define is_plugged(cfs) (!!(cfs)->pdev)
>> +
>> +enum vimc_cfs_hotplug_state {
>> + VIMC_CFS_HOTPLUG_STATE_UNPLUGGED = 0,
>> + VIMC_CFS_HOTPLUG_STATE_PLUGGED = 1,
>> +};
>> +
>> +const static char *vimc_cfs_hotplug_values[2][3] = {
>> + [VIMC_CFS_HOTPLUG_STATE_UNPLUGGED] = {"unplugged\n", "unplug\n", "0\n"},
>> + [VIMC_CFS_HOTPLUG_STATE_PLUGGED] = {"plugged\n", "plug\n", "1\n"},
>> +};
>> +
>> +/* --------------------------------------------------------------------------
>> + * Pipeline structures
>> + */
>> +
>> +static struct vimc_cfs_subsystem {
>> + struct configfs_subsystem subsys;
>> + struct list_head drvs;
>> +} vimc_cfs_subsys;
>> +
>> +/* Structure which describes the whole topology */
>> +struct vimc_cfs_device {
>> + struct platform_device *pdev;
>> + struct vimc_platform_data_core pdata;
>> + struct list_head ents;
>> + struct list_head links;
>> + struct config_group gdev;
>> + struct config_group gents;
>> + struct config_group glinks;
>> +};
>> +
>> +/* Structure which describes individual configuration for each entity */
>> +struct vimc_cfs_ent {
>> + struct platform_device *pdev;
>> + struct vimc_platform_data pdata;
>> + char drv[VIMC_MAX_NAME_LEN];
>> + struct list_head list;
>> + struct config_group cg;
>> +};
>> +
>> +/* Structure which describes links between entities */
>> +struct vimc_cfs_link {
>> + struct vimc_platform_data_link pdata;
>> + char source_name[VIMC_MAX_NAME_LEN];
>> + char sink_name[VIMC_MAX_NAME_LEN];
>> + struct config_item ci;
>> +};
>> +
>> +void vimc_cfs_drv_register(struct vimc_cfs_drv *c_drv)
>> +{
>> + list_add(&c_drv->list, &vimc_cfs_subsys.drvs);
>> +}
>> +EXPORT_SYMBOL_GPL(vimc_cfs_drv_register);
>> +
>> +void vimc_cfs_drv_unregister(struct vimc_cfs_drv *c_drv)
>> +{
>> + list_del(&c_drv->list);
>> +}
>> +EXPORT_SYMBOL_GPL(vimc_cfs_drv_unregister);
>> +
>> +/* --------------------------------------------------------------------------
>> + * Platform Device builders
>> + */
>> +
>> +static int vimc_cfs_link_get_entities(const struct vimc_cfs_device *cfs,
>> + struct vimc_cfs_link *c_link)
>> +{
>> + struct vimc_cfs_ent *c_ent;
>> +
>> + c_link->pdata.source = NULL;
>> + c_link->pdata.sink = NULL;
>> + list_for_each_entry(c_ent, &cfs->ents, list) {
>> + if (!c_link->pdata.source &&
>> + !strcmp(c_ent->pdata.name, c_link->source_name))
>> + c_link->pdata.source = c_ent->pdev;
>> + if (!c_link->pdata.sink &&
>> + !strcmp(c_ent->pdata.name, c_link->sink_name))
>> + c_link->pdata.sink = c_ent->pdev;
>> + if (c_link->pdata.source && c_link->pdata.sink)
>> + return 0;
>> + }
>> + return -EINVAL;
>> +}
>> +
>> +static int vimc_cfs_comp_compare(struct device *comp, void *data)
>> +{
>> + dev_dbg(comp, "comp compare %p %p", comp, data);
>> +
>> + return comp == data;
>> +}
>> +
>> +static const struct component_master_ops vimc_cfs_comp_ops = {
>> + .bind = vimc_core_comp_bind,
>> + .unbind = vimc_core_comp_unbind,
>> +};
>> +
>> +static void vimc_cfs_device_unplug(struct vimc_cfs_device *cfs)
>> +{
>> + struct vimc_cfs_ent *c_ent;
>> +
>> + dev_dbg(&cfs->pdev->dev, "Unplugging device");
>> +
>> + component_master_del(&cfs->pdev->dev, &vimc_cfs_comp_ops);
>> + list_for_each_entry(c_ent, &cfs->ents, list) {
>> + platform_device_unregister(c_ent->pdev);
>> + c_ent->pdev = NULL;
>> + }
>> + platform_device_unregister(cfs->pdev);
>> + cfs->pdev = NULL;
>> +}
>> +
>> +static int vimc_cfs_device_plug(struct vimc_cfs_device *cfs)
>> +{
>> + struct component_match *match = NULL;
>> + struct vimc_cfs_ent *c_ent;
>> + struct vimc_cfs_link *c_link;
>> + int ret = 0;
>> +
>> + cg_dbg(&cfs->gdev, "Plugging device");
>> +
>> + if (list_empty(&cfs->ents)) {
>> + /* TODO: add support for a default topology */
>> + cg_err(&cfs->gdev,
>> + "At least an entity is required to plug the device");
>> + return -EINVAL;
>> + }
>> +
>> + cfs->pdev = platform_device_register_data(NULL, VIMC_CORE_PDEV_NAME,
>> + PLATFORM_DEVID_AUTO,
>> + &cfs->pdata,
>> + sizeof(cfs->pdata));
>> + if (IS_ERR(cfs->pdev))
>> + return PTR_ERR(cfs->pdev);
>> +
>> + /* Add component_match for inner structure of the pipeline */
>> + list_for_each_entry(c_ent, &cfs->ents, list) {
>> + cg_dbg(&c_ent->cg, "registering entity %s:%s", c_ent->drv,
>> + c_ent->pdata.name);
>> + if (c_ent->pdev)
>> + cg_err(&c_ent->cg, "pdev is not null");
>> + c_ent->pdev = platform_device_register_data(&cfs->pdev->dev,
>> + c_ent->drv,
>> + PLATFORM_DEVID_AUTO,
>> + &c_ent->pdata,
>> + sizeof(c_ent->pdata));
>> + if (IS_ERR(c_ent->pdev)) {
>> + ret = PTR_ERR(c_ent->pdev);
>> + goto unregister_ents;
>> + }
>> + component_match_add(&cfs->pdev->dev, &match,
>> + vimc_cfs_comp_compare, &c_ent->pdev->dev);
>> + }
>> + list_for_each_entry(c_link, cfs->pdata.links, pdata.list) {
>> + ret = vimc_cfs_link_get_entities(cfs, c_link);
>> + if (ret) {
>> + ci_err(&c_link->ci, "could not validate link");
>> + goto unregister_ents;
>> + }
>> + }
>> +
>> + dev_dbg(&cfs->pdev->dev, "Adding master device");
>> + ret = component_master_add_with_match(&cfs->pdev->dev,
>> + &vimc_cfs_comp_ops, match);
>> + if (ret)
>> + goto unregister_ents;
>> +
>> + return 0;
>> +
>> +unregister_ents:
>> + list_for_each_entry_continue_reverse(c_ent, &cfs->ents, list) {
>> + platform_device_unregister(c_ent->pdev);
>> + c_ent->pdev = NULL;
>> + }
>> +
>> + platform_device_unregister(cfs->pdev);
>> + cfs->pdev = NULL;
>> +
>> + return ret;
>> +}
>> +
>> +/* --------------------------------------------------------------------------
>> + * Links
>> + */
>> +
>> +static ssize_t vimc_cfs_links_attr_flags_show(struct config_item *item,
>> + char *buf)
>> +{
>> + struct vimc_cfs_link *c_link = container_of(item, struct vimc_cfs_link,
>> + ci);
>> +
>> + sprintf(buf, "%d\n", c_link->pdata.flags);
>> + return strlen(buf);
>> +}
>> +
>> +static ssize_t vimc_cfs_links_attr_flags_store(struct config_item *item,
>> + const char *buf, size_t size)
>> +{
>> + struct vimc_cfs_link *c_link = container_of(item, struct vimc_cfs_link,
>> + ci);
>> +
>> + if (kstrtou32(buf, 0, &c_link->pdata.flags))
>> + return -EINVAL;
>> +
>> + return size;
>> +}
>> +
>> +CONFIGFS_ATTR(vimc_cfs_links_attr_, flags);
>> +
>> +static struct configfs_attribute *vimc_cfs_link_attrs[] = {
>> + &vimc_cfs_links_attr_attr_flags,
>> + NULL,
>> +};
>> +
>> +static void vimc_cfs_link_release(struct config_item *item)
>> +{
>> + struct vimc_cfs_link *c_link = container_of(item, struct vimc_cfs_link,
>> + ci);
>> +
>> + kfree(c_link);
>> +}
>> +
>> +static struct configfs_item_operations vimc_cfs_link_item_ops = {
>> + .release = vimc_cfs_link_release,
>> +};
>> +
>> +static struct config_item_type vimc_cfs_link_type = {
>> + .ct_item_ops = &vimc_cfs_link_item_ops,
>> + .ct_attrs = vimc_cfs_link_attrs,
>> + .ct_owner = THIS_MODULE,
>> +};
>> +
>> +static void vimc_cfs_link_drop_item(struct config_group *group,
>> + struct config_item *item)
>> +{
>> + struct vimc_cfs_link *link = container_of(item,
>> + struct vimc_cfs_link, ci);
>> + struct vimc_cfs_device *cfs = container_of(group,
>> + struct vimc_cfs_device,
>> + glinks);
>> +
>> + if (is_plugged(cfs))
>> + vimc_cfs_device_unplug(cfs);
>> + list_del(&link->pdata.list);
>> +}
>> +
>> +static struct config_item *vimc_cfs_link_make_item(struct config_group *group,
>> + const char *name)
>> +{
>> + struct vimc_cfs_device *cfs = container_of(group,
>> + struct vimc_cfs_device,
>> + glinks);
>> + size_t src_pad_strlen, sink_pad_strlen, sink_namelen, source_namelen;
>> + const char *sep, *src_pad_str, *sink_pad_str, *sink_name,
>> + *source_name = name;
>> + struct vimc_cfs_link *c_link;
>> + u16 source_pad, sink_pad;
>> + char tmp[4];
>> +
>> + cg_dbg(&cfs->gdev, "Creating link %s", name);
>> +
>> + if (is_plugged(cfs))
>> + vimc_cfs_device_unplug(cfs);
>> +
>> + /* Parse format "source_name:source_pad->sink_name:sink_pad" */
>> + sep = strchr(source_name, CHAR_SEPARATOR);
>> + if (!sep)
>> + goto syntax_error;
>> + source_namelen = (size_t)(sep - source_name);
>> +
>> + src_pad_str = &sep[1];
>> + sep = strstr(src_pad_str, LINK_SEPARATOR);
>> + if (!sep)
>> + goto syntax_error;
>> + src_pad_strlen = (size_t)(sep - src_pad_str);
>> +
>> + sink_name = &sep[strlen(LINK_SEPARATOR)];
>> + sep = strchr(sink_name, CHAR_SEPARATOR);
>> + if (!sep)
>> + goto syntax_error;
>> + sink_namelen = (size_t)(sep - sink_name);
>> +
>> + sink_pad_str = &sep[1];
>> + sink_pad_strlen = strlen(sink_pad_str);
>> +
>> + /* Validate sizes */
>> + if (!src_pad_strlen || !sink_pad_strlen ||
>> + !sink_namelen || !source_namelen)
>> + goto syntax_error;
>> +
>> + /* we limit the size here so we don't need to allocate another buffer */
>> + if (src_pad_strlen >= sizeof(tmp) || sink_pad_strlen >= sizeof(tmp)) {
>> + cg_err(&cfs->gdev,
>> + "Pad with more then %ld digits is not supported",
>> + sizeof(tmp) - 1);
>> + goto syntax_error;
>> + }
>> + strscpy(tmp, src_pad_str, src_pad_strlen + 1);
>> + if (kstrtou16(tmp, 0, &source_pad)) {
>> + cg_err(&cfs->gdev, "Couldn't convert pad %s to number", tmp);
>> + goto syntax_error;
>> + }
>> + strscpy(tmp, sink_pad_str, sink_pad_strlen + 1);
>> + if (kstrtou16(tmp, 0, &sink_pad)) {
>> + cg_err(&cfs->gdev, "Couldn't convert pad %s to number", tmp);
>> + goto syntax_error;
>> + }
>> +
>> + c_link = kzalloc(sizeof(*c_link), GFP_KERNEL);
>> + if (!c_link)
>> + return ERR_PTR(-ENOMEM);
>> +
>> + c_link->pdata.source_pad = source_pad;
>> + c_link->pdata.sink_pad = sink_pad;
>> + strscpy(c_link->source_name, source_name, source_namelen + 1);
>> + strscpy(c_link->sink_name, sink_name, sink_namelen + 1);
>> +
>> + /* Configure group */
>> + list_add(&c_link->pdata.list, cfs->pdata.links);
> I am not sure how should the config_item_get/config_item_put should be used
> For example a reference to an item is added here to a linked-list. So
> does it require a call to config_item_get ?
config_item_get/config_item_put are used to coordinate when the release function
should be called.
As adding to the list and removing from it is synchronized with make_item/drop_item,
I don't think you need an extra reference besides the initial reference that
configfs_mkdir() code from the configfs framekwork sets.
In the other hand, looking at client_drop_item() function from configfs framework:
/*
* If ->drop_item() exists, it is responsible for the
* config_item_put().
*/
if (type->ct_group_ops && type->ct_group_ops->drop_item)
type->ct_group_ops->drop_item(to_config_group(parent_item),
item);
else
config_item_put(item);
We need to call config_item_put in the ->drop_item() functions, which is missing
from the original patch (thanks for checking this).
>
>> + config_item_init_type_name(&c_link->ci, name, &vimc_cfs_link_type);
>> +
>> + return &c_link->ci;
>> +
>> +syntax_error:
>> + cg_err(&cfs->gdev,
>> + "Couldn't create link %s, wrong syntax.", name);
>> + return ERR_PTR(-EINVAL);
>> +}
>> +
>> +/* --------------------------------------------------------------------------
>> + * Entities
>> + */
>> +
>> +/* *TODO: add support for hotplug in entity level */
>> +
>> +static int vimc_cfs_drv_cb(const char *drv_name, struct config_group *group)
>> +{
>> + struct vimc_cfs_drv *c_drv = NULL;
>> +
>> + list_for_each_entry(c_drv, &vimc_cfs_subsys.drvs, list) {
>> + if (!strcmp(drv_name, c_drv->name))
>> + break;
>> + }
>> + if (!c_drv)
>> + return -EINVAL;
>> +
>> + if (c_drv->configfs_cb)
>> + c_drv->configfs_cb(group);
>> +
>> + return 0;
>> +}
>> +
>> +static void vimc_cfs_ent_release(struct config_item *item)
>> +{
>> + struct vimc_cfs_ent *c_ent = container_of(item, struct vimc_cfs_ent,
>> + cg.cg_item);
>> +
>> + kfree(c_ent);
>> +}
>> +
>> +static struct configfs_item_operations vimc_cfs_ent_item_ops = {
>> + .release = vimc_cfs_ent_release,
>> +};
>> +
>> +static struct config_item_type vimc_cfs_ent_type = {
>> + .ct_item_ops = &vimc_cfs_ent_item_ops,
>> + .ct_owner = THIS_MODULE,
>> +};
>> +
>> +static void vimc_cfs_ent_drop_item(struct config_group *group,
>> + struct config_item *item)
>> +{
>> + struct vimc_cfs_ent *c_ent = container_of(item, struct vimc_cfs_ent,
>> + cg.cg_item);
>> + struct vimc_cfs_device *cfs = container_of(group,
>> + struct vimc_cfs_device,
>> + gents);
>> +
>> + if (is_plugged(cfs))
>> + vimc_cfs_device_unplug(cfs);
>> + list_del(&c_ent->list);
>> +}
>> +
>> +static struct config_group *vimc_cfs_ent_make_group(struct config_group *group,
>> + const char *name)
>> +{
>> + struct vimc_cfs_device *cfs = container_of(group,
>> + struct vimc_cfs_device,
>> + gents);
>> + const char *drv_name = name;
>> + char *ent_name, *sep = strchr(drv_name, CHAR_SEPARATOR);
>> + struct vimc_cfs_ent *c_ent;
>> + size_t drv_namelen;
>> +
>> + if (is_plugged(cfs))
>> + vimc_cfs_device_unplug(cfs);
>> +
>> + /* Parse format "drv_name:ent_name" */
>> + if (!sep) {
>> + cg_err(&cfs->gdev,
>> + "Could not find separator '%c'", CHAR_SEPARATOR);
>> + goto syntax_error;
>> + }
>> + drv_namelen = (size_t)(sep - drv_name);
>> + ent_name = &sep[1];
>> + if (!*ent_name || !drv_namelen) {
>> + cg_err(&cfs->gdev,
>> + "%s: Driver name and entity name can't be empty.",
>> + name);
>> + goto syntax_error;
>> + }
>> + if (drv_namelen >= sizeof(c_ent->drv)) {
>> + cg_err(&cfs->gdev,
>> + "%s: Driver name length should be less then %ld.",
>> + name, sizeof(c_ent->drv));
>> + goto syntax_error;
>> + }
>> +
>> + c_ent = kzalloc(sizeof(*c_ent), GFP_KERNEL);
>> + if (!c_ent)
>> + return ERR_PTR(-ENOMEM);
>> +
>> + /* Configure platform device */
>> + strscpy(c_ent->drv, drv_name, drv_namelen + 1);
>> + strscpy(c_ent->pdata.name, ent_name, sizeof(c_ent->pdata.name));
>> + c_ent->pdata.group = &c_ent->cg;
>> +
>> + cg_dbg(&cfs->gdev, "New entity %s:%s", c_ent->drv, c_ent->pdata.name);
>> +
>> + /* Configure group */
>> + config_group_init_type_name(&c_ent->cg, name, &vimc_cfs_ent_type);
>> + if (vimc_cfs_drv_cb(c_ent->drv, &c_ent->cg)) {
>> + cg_err(&c_ent->cg, "Module %s not found", c_ent->drv);
>> + kfree(c_ent);
>> + return ERR_PTR(-EINVAL);
>> + }
>> + list_add(&c_ent->list, &cfs->ents);
> Same here, need to call config_item_get ?
Same answer from above.
Thanks,
Helen
>
> Regard,
> Dafna
>
>> +
>> + return &c_ent->cg;
>> +
>> +syntax_error:
>> + cg_err(&cfs->gdev,
>> + "Couldn't create entity %s, wrong syntax.", name);
>> + return ERR_PTR(-EINVAL);
>> +}
>> +
>> +/* --------------------------------------------------------------------------
>> + * Default group: Links
>> + */
>> +
>> +static struct configfs_group_operations vimc_cfs_dlink_group_ops = {
>> + .make_item = vimc_cfs_link_make_item,
>> + .drop_item = vimc_cfs_link_drop_item,
>> +};
>> +
>> +static struct config_item_type vimc_cfs_dlink_type = {
>> + .ct_group_ops = &vimc_cfs_dlink_group_ops,
>> + .ct_owner = THIS_MODULE,
>> +};
>> +
>> +void vimc_cfs_dlink_add_default_group(struct vimc_cfs_device *cfs)
>> +{
>> + config_group_init_type_name(&cfs->glinks, "links",
>> + &vimc_cfs_dlink_type);
>> + configfs_add_default_group(&cfs->glinks, &cfs->gdev);
>> +}
>> +
>> +/* --------------------------------------------------------------------------
>> + * Default group: Entities
>> + */
>> +
>> +static struct configfs_group_operations vimc_cfs_dent_group_ops = {
>> + .make_group = vimc_cfs_ent_make_group,
>> + .drop_item = vimc_cfs_ent_drop_item,
>> +};
>> +
>> +static struct config_item_type vimc_cfs_dent_type = {
>> + .ct_group_ops = &vimc_cfs_dent_group_ops,
>> + .ct_owner = THIS_MODULE,
>> +};
>> +
>> +void vimc_cfs_dent_add_default_group(struct vimc_cfs_device *cfs)
>> +{
>> + config_group_init_type_name(&cfs->gents, "entities",
>> + &vimc_cfs_dent_type);
>> + configfs_add_default_group(&cfs->gents, &cfs->gdev);
>> +}
>> +
>> +/* --------------------------------------------------------------------------
>> + * Device instance
>> + */
>> +
>> +static int vimc_cfs_decode_state(const char *buf, size_t size)
>> +{
>> + unsigned int i, j;
>> +
>> + for (i = 0; i < ARRAY_SIZE(vimc_cfs_hotplug_values); i++) {
>> + for (j = 0; j < ARRAY_SIZE(vimc_cfs_hotplug_values[0]); j++) {
>> + if (!strncmp(buf, vimc_cfs_hotplug_values[i][j], size))
>> + return i;
>> + }
>> + }
>> + return -EINVAL;
>> +}
>> +
>> +static ssize_t vimc_cfs_dev_attr_hotplug_show(struct config_item *item,
>> + char *buf)
>> +{
>> + struct vimc_cfs_device *cfs = container_of(item, struct vimc_cfs_device,
>> + gdev.cg_item);
>> +
>> + strcpy(buf, vimc_cfs_hotplug_values[is_plugged(cfs)][0]);
>> + return strlen(buf);
>> +}
>> +
>> +static int vimc_cfs_hotplug_set(struct vimc_cfs_device *cfs,
>> + enum vimc_cfs_hotplug_state state)
>> +{
>> + if (state == is_plugged(cfs)) {
>> + return 0;
>> + } else if (state == VIMC_CFS_HOTPLUG_STATE_UNPLUGGED) {
>> + vimc_cfs_device_unplug(cfs);
>> + return 0;
>> + } else if (state == VIMC_CFS_HOTPLUG_STATE_PLUGGED) {
>> + return vimc_cfs_device_plug(cfs);
>> + }
>> + return -EINVAL;
>> +}
>> +
>> +static ssize_t vimc_cfs_dev_attr_hotplug_store(struct config_item *item,
>> + const char *buf, size_t size)
>> +{
>> + struct vimc_cfs_device *cfs = container_of(item, struct vimc_cfs_device,
>> + gdev.cg_item);
>> + int state = vimc_cfs_decode_state(buf, size);
>> +
>> + if (vimc_cfs_hotplug_set(cfs, state))
>> + return -EINVAL;
>> + return size;
>> +}
>> +
>> +CONFIGFS_ATTR(vimc_cfs_dev_attr_, hotplug);
>> +
>> +static struct configfs_attribute *vimc_cfs_dev_attrs[] = {
>> + &vimc_cfs_dev_attr_attr_hotplug,
>> + NULL,
>> +};
>> +
>> +static void vimc_cfs_dev_release(struct config_item *item)
>> +{
>> + struct vimc_cfs_device *cfs = container_of(item, struct vimc_cfs_device,
>> + gdev.cg_item);
>> +
>> + kfree(cfs);
>> +}
>> +
>> +static struct configfs_item_operations vimc_cfs_dev_item_ops = {
>> + .release = vimc_cfs_dev_release,
>> +};
>> +
>> +static struct config_item_type vimc_cfs_dev_type = {
>> + .ct_item_ops = &vimc_cfs_dev_item_ops,
>> + .ct_attrs = vimc_cfs_dev_attrs,
>> + .ct_owner = THIS_MODULE,
>> +};
>> +
>> +static void vimc_cfs_dev_drop_item(struct config_group *group,
>> + struct config_item *item)
>> +{
>> + struct vimc_cfs_device *cfs = container_of(group,
>> + struct vimc_cfs_device,
>> + gdev);
>> +
>> + if (is_plugged(cfs))
>> + vimc_cfs_device_unplug(cfs);
>> +}
>> +
>> +static struct config_group *vimc_cfs_dev_make_group(
>> + struct config_group *group, const char *name)
>> +{
>> + struct vimc_cfs_device *cfs = kzalloc(sizeof(*cfs), GFP_KERNEL);
>> +
>> + if (!cfs)
>> + return ERR_PTR(-ENOMEM);
>> +
>> + /* Configure pipeline */
>> + INIT_LIST_HEAD(&cfs->ents);
>> + INIT_LIST_HEAD(&cfs->links);
>> +
>> + /* Configure platform data */
>> + strscpy(cfs->pdata.data.name, name, sizeof(cfs->pdata.data.name));
>> + cfs->pdata.data.group = &cfs->gdev;
>> + cfs->pdata.links = &cfs->links;
>> +
>> + /* Configure configfs group */
>> + config_group_init_type_name(&cfs->gdev, name, &vimc_cfs_dev_type);
>> + vimc_cfs_dent_add_default_group(cfs);
>> + vimc_cfs_dlink_add_default_group(cfs);
>> +
>> + return &cfs->gdev;
>> +}
>> +
>> +/* --------------------------------------------------------------------------
>> + * Subsystem
>> + */
>> +
>> +static struct configfs_group_operations vimc_cfs_subsys_group_ops = {
>> + /* Create vimc devices */
>> + .make_group = vimc_cfs_dev_make_group,
>> + .drop_item = vimc_cfs_dev_drop_item,
>> +};
>> +
>> +static struct config_item_type vimc_cfs_subsys_type = {
>> + .ct_group_ops = &vimc_cfs_subsys_group_ops,
>> + .ct_owner = THIS_MODULE,
>> +};
>> +
>> +int vimc_cfs_subsys_register(void)
>> +{
>> + struct configfs_subsystem *subsys = &vimc_cfs_subsys.subsys;
>> + int ret;
>> +
>> + INIT_LIST_HEAD(&vimc_cfs_subsys.drvs);
>> + config_group_init_type_name(&subsys->su_group, CFS_SUBSYS_NAME,
>> + &vimc_cfs_subsys_type);
>> + mutex_init(&subsys->su_mutex);
>> + ret = configfs_register_subsystem(subsys);
>> +
>> + return ret;
>> +}
>> +
>> +void vimc_cfs_subsys_unregister(void)
>> +{
>> + configfs_unregister_subsystem(&vimc_cfs_subsys.subsys);
>> +}
>> diff --git a/drivers/media/platform/vimc/vimc-configfs.h b/drivers/media/platform/vimc/vimc-configfs.h
>> new file mode 100644
>> index 000000000000..6278b53d11ba
>> --- /dev/null
>> +++ b/drivers/media/platform/vimc/vimc-configfs.h
>> @@ -0,0 +1,30 @@
>> +/* SPDX-License-Identifier: GPL-2.0+ */
>> +/*
>> + * vimc-configfs.h Virtual Media Controller Driver
>> + *
>> + * Copyright (C) 2018 Helen Koike <[email protected]>
>> + */
>> +
>> +#ifndef _VIMC_CONFIGFS_H_
>> +#define _VIMC_CONFIGFS_H_
>> +
>> +#include <linux/configfs.h>
>> +
>> +#define VIMC_CFS_SRC_PAD_NAME(n) "pad:source:" #n
>> +#define VIMC_CFS_SINK_PAD_NAME(n) "pad:sink:" #n
>> +
>> +struct vimc_cfs_drv {
>> + const char *name;
>> + void (*const configfs_cb)(struct config_group *group);
>> + struct list_head list;
>> +};
>> +
>> +int vimc_cfs_subsys_register(void);
>> +
>> +void vimc_cfs_subsys_unregister(void);
>> +
>> +void vimc_cfs_drv_register(struct vimc_cfs_drv *c_drv);
>> +
>> +void vimc_cfs_drv_unregister(struct vimc_cfs_drv *c_drv);
>> +
>> +#endif
>> diff --git a/drivers/media/platform/vimc/vimc-core.c b/drivers/media/platform/vimc/vimc-core.c
>> index ce809d2e3d53..816015e7c8f6 100644
>> --- a/drivers/media/platform/vimc/vimc-core.c
>> +++ b/drivers/media/platform/vimc/vimc-core.c
>> @@ -23,150 +23,29 @@
>> #include <media/v4l2-device.h>
>>
>> #include "vimc-common.h"
>> -
>> -#define VIMC_PDEV_NAME "vimc"
>> -#define VIMC_MDEV_MODEL_NAME "VIMC MDEV"
>> -
>> -#define VIMC_ENT_LINK(src, srcpad, sink, sinkpad, link_flags) { \
>> - .src_ent = src, \
>> - .src_pad = srcpad, \
>> - .sink_ent = sink, \
>> - .sink_pad = sinkpad, \
>> - .flags = link_flags, \
>> -}
>> +#include "vimc-configfs.h"
>>
>> struct vimc_device {
>> - /* The platform device */
>> - struct platform_device pdev;
>> -
>> - /* The pipeline configuration */
>> - const struct vimc_pipeline_config *pipe_cfg;
>> -
>> /* The Associated media_device parent */
>> struct media_device mdev;
>>
>> /* Internal v4l2 parent device*/
>> struct v4l2_device v4l2_dev;
>> -
>> - /* Subdevices */
>> - struct platform_device **subdevs;
>> -};
>> -
>> -/* Structure which describes individual configuration for each entity */
>> -struct vimc_ent_config {
>> - const char *name;
>> - const char *drv;
>> -};
>> -
>> -/* Structure which describes links between entities */
>> -struct vimc_ent_link {
>> - unsigned int src_ent;
>> - u16 src_pad;
>> - unsigned int sink_ent;
>> - u16 sink_pad;
>> - u32 flags;
>> -};
>> -
>> -/* Structure which describes the whole topology */
>> -struct vimc_pipeline_config {
>> - const struct vimc_ent_config *ents;
>> - size_t num_ents;
>> - const struct vimc_ent_link *links;
>> - size_t num_links;
>> -};
>> -
>> -/* --------------------------------------------------------------------------
>> - * Topology Configuration
>> - */
>> -
>> -static const struct vimc_ent_config ent_config[] = {
>> - {
>> - .name = "Sensor A",
>> - .drv = "vimc-sensor",
>> - },
>> - {
>> - .name = "Sensor B",
>> - .drv = "vimc-sensor",
>> - },
>> - {
>> - .name = "Debayer A",
>> - .drv = "vimc-debayer",
>> - },
>> - {
>> - .name = "Debayer B",
>> - .drv = "vimc-debayer",
>> - },
>> - {
>> - .name = "Raw Capture 0",
>> - .drv = "vimc-capture",
>> - },
>> - {
>> - .name = "Raw Capture 1",
>> - .drv = "vimc-capture",
>> - },
>> - {
>> - .name = "RGB/YUV Input",
>> - /* TODO: change this to vimc-input when it is implemented */
>> - .drv = "vimc-sensor",
>> - },
>> - {
>> - .name = "Scaler",
>> - .drv = "vimc-scaler",
>> - },
>> - {
>> - .name = "RGB/YUV Capture",
>> - .drv = "vimc-capture",
>> - },
>> -};
>> -
>> -static const struct vimc_ent_link ent_links[] = {
>> - /* Link: Sensor A (Pad 0)->(Pad 0) Debayer A */
>> - VIMC_ENT_LINK(0, 0, 2, 0, MEDIA_LNK_FL_ENABLED | MEDIA_LNK_FL_IMMUTABLE),
>> - /* Link: Sensor A (Pad 0)->(Pad 0) Raw Capture 0 */
>> - VIMC_ENT_LINK(0, 0, 4, 0, MEDIA_LNK_FL_ENABLED | MEDIA_LNK_FL_IMMUTABLE),
>> - /* Link: Sensor B (Pad 0)->(Pad 0) Debayer B */
>> - VIMC_ENT_LINK(1, 0, 3, 0, MEDIA_LNK_FL_ENABLED | MEDIA_LNK_FL_IMMUTABLE),
>> - /* Link: Sensor B (Pad 0)->(Pad 0) Raw Capture 1 */
>> - VIMC_ENT_LINK(1, 0, 5, 0, MEDIA_LNK_FL_ENABLED | MEDIA_LNK_FL_IMMUTABLE),
>> - /* Link: Debayer A (Pad 1)->(Pad 0) Scaler */
>> - VIMC_ENT_LINK(2, 1, 7, 0, MEDIA_LNK_FL_ENABLED),
>> - /* Link: Debayer B (Pad 1)->(Pad 0) Scaler */
>> - VIMC_ENT_LINK(3, 1, 7, 0, 0),
>> - /* Link: RGB/YUV Input (Pad 0)->(Pad 0) Scaler */
>> - VIMC_ENT_LINK(6, 0, 7, 0, 0),
>> - /* Link: Scaler (Pad 1)->(Pad 0) RGB/YUV Capture */
>> - VIMC_ENT_LINK(7, 1, 8, 0, MEDIA_LNK_FL_ENABLED | MEDIA_LNK_FL_IMMUTABLE),
>> -};
>> -
>> -static const struct vimc_pipeline_config pipe_cfg = {
>> - .ents = ent_config,
>> - .num_ents = ARRAY_SIZE(ent_config),
>> - .links = ent_links,
>> - .num_links = ARRAY_SIZE(ent_links)
>> };
>>
>> -/* -------------------------------------------------------------------------- */
>> -
>> -static int vimc_create_links(struct vimc_device *vimc)
>> +static int vimc_core_links_create(const struct device *master)
>> {
>> - unsigned int i;
>> + struct vimc_platform_data_core *pdata = master->platform_data;
>> + struct vimc_ent_device *ved_src, *ved_sink;
>> + struct vimc_platform_data_link *plink;
>> int ret;
>>
>> - /* Initialize the links between entities */
>> - for (i = 0; i < vimc->pipe_cfg->num_links; i++) {
>> - const struct vimc_ent_link *link = &vimc->pipe_cfg->links[i];
>> - /*
>> - * TODO: Check another way of retrieving ved struct without
>> - * relying on platform_get_drvdata
>> - */
>> - struct vimc_ent_device *ved_src =
>> - platform_get_drvdata(vimc->subdevs[link->src_ent]);
>> - struct vimc_ent_device *ved_sink =
>> - platform_get_drvdata(vimc->subdevs[link->sink_ent]);
>> -
>> - ret = media_create_pad_link(ved_src->ent, link->src_pad,
>> - ved_sink->ent, link->sink_pad,
>> - link->flags);
>> + list_for_each_entry(plink, pdata->links, list) {
>> + ved_src = platform_get_drvdata(plink->source);
>> + ved_sink = platform_get_drvdata(plink->sink);
>> + ret = media_create_pad_link(ved_src->ent, plink->source_pad,
>> + ved_sink->ent, plink->sink_pad,
>> + plink->flags);
>> if (ret)
>> return ret;
>> }
>> @@ -174,10 +53,10 @@ static int vimc_create_links(struct vimc_device *vimc)
>> return 0;
>> }
>>
>> -static int vimc_comp_bind(struct device *master)
>> +int vimc_core_comp_bind(struct device *master)
>> {
>> - struct vimc_device *vimc = container_of(to_platform_device(master),
>> - struct vimc_device, pdev);
>> + struct vimc_device *vimc =
>> + platform_get_drvdata(to_platform_device(master));
>> int ret;
>>
>> dev_dbg(master, "bind");
>> @@ -194,9 +73,7 @@ static int vimc_comp_bind(struct device *master)
>> ret = component_bind_all(master, &vimc->v4l2_dev);
>> if (ret)
>> goto err_v4l2_unregister;
>> -
>> - /* Initialize links */
>> - ret = vimc_create_links(vimc);
>> + ret = vimc_core_links_create(master);
>> if (ret)
>> goto err_comp_unbind_all;
>>
>> @@ -228,11 +105,12 @@ static int vimc_comp_bind(struct device *master)
>>
>> return ret;
>> }
>> +EXPORT_SYMBOL_GPL(vimc_core_comp_bind);
>>
>> -static void vimc_comp_unbind(struct device *master)
>> +void vimc_core_comp_unbind(struct device *master)
>> {
>> - struct vimc_device *vimc = container_of(to_platform_device(master),
>> - struct vimc_device, pdev);
>> + struct vimc_device *vimc =
>> + platform_get_drvdata(to_platform_device(master));
>>
>> dev_dbg(master, "unbind");
>>
>> @@ -240,147 +118,56 @@ static void vimc_comp_unbind(struct device *master)
>> component_unbind_all(master, NULL);
>> v4l2_device_unregister(&vimc->v4l2_dev);
>> }
>> -
>> -static int vimc_comp_compare(struct device *comp, void *data)
>> -{
>> - const struct platform_device *pdev = to_platform_device(comp);
>> - const char *name = data;
>> -
>> - return !strcmp(pdev->dev.platform_data, name);
>> -}
>> -
>> -static struct component_match *vimc_add_subdevs(struct vimc_device *vimc)
>> -{
>> - struct component_match *match = NULL;
>> - struct vimc_platform_data pdata;
>> - int i;
>> -
>> - for (i = 0; i < vimc->pipe_cfg->num_ents; i++) {
>> - dev_dbg(&vimc->pdev.dev, "new pdev for %s\n",
>> - vimc->pipe_cfg->ents[i].drv);
>> -
>> - strscpy(pdata.entity_name, vimc->pipe_cfg->ents[i].name,
>> - sizeof(pdata.entity_name));
>> -
>> - vimc->subdevs[i] = platform_device_register_data(&vimc->pdev.dev,
>> - vimc->pipe_cfg->ents[i].drv,
>> - PLATFORM_DEVID_AUTO,
>> - &pdata,
>> - sizeof(pdata));
>> - if (IS_ERR(vimc->subdevs[i])) {
>> - match = ERR_CAST(vimc->subdevs[i]);
>> - while (--i >= 0)
>> - platform_device_unregister(vimc->subdevs[i]);
>> -
>> - return match;
>> - }
>> -
>> - component_match_add(&vimc->pdev.dev, &match, vimc_comp_compare,
>> - (void *)vimc->pipe_cfg->ents[i].name);
>> - }
>> -
>> - return match;
>> -}
>> -
>> -static void vimc_rm_subdevs(struct vimc_device *vimc)
>> -{
>> - unsigned int i;
>> -
>> - for (i = 0; i < vimc->pipe_cfg->num_ents; i++)
>> - platform_device_unregister(vimc->subdevs[i]);
>> -}
>> -
>> -static const struct component_master_ops vimc_comp_ops = {
>> - .bind = vimc_comp_bind,
>> - .unbind = vimc_comp_unbind,
>> -};
>> +EXPORT_SYMBOL_GPL(vimc_core_comp_unbind);
>>
>> static int vimc_probe(struct platform_device *pdev)
>> {
>> - struct vimc_device *vimc = container_of(pdev, struct vimc_device, pdev);
>> - struct component_match *match = NULL;
>> - int ret;
>> + const struct vimc_platform_data_core *pdata = pdev->dev.platform_data;
>> + struct vimc_device *vimc = devm_kzalloc(&pdev->dev, sizeof(*vimc),
>> + GFP_KERNEL);
>>
>> dev_dbg(&pdev->dev, "probe");
>>
>> - /* Create platform_device for each entity in the topology*/
>> - vimc->subdevs = devm_kcalloc(&vimc->pdev.dev, vimc->pipe_cfg->num_ents,
>> - sizeof(*vimc->subdevs), GFP_KERNEL);
>> - if (!vimc->subdevs)
>> - return -ENOMEM;
>> -
>> - match = vimc_add_subdevs(vimc);
>> - if (IS_ERR(match))
>> - return PTR_ERR(match);
>> -
>> - /* Link the media device within the v4l2_device */
>> - vimc->v4l2_dev.mdev = &vimc->mdev;
>> -
>> /* Initialize media device */
>> - strscpy(vimc->mdev.model, VIMC_MDEV_MODEL_NAME,
>> - sizeof(vimc->mdev.model));
>> + strscpy(vimc->mdev.model, pdata->data.name, sizeof(vimc->mdev.model));
>> vimc->mdev.dev = &pdev->dev;
>> media_device_init(&vimc->mdev);
>> + vimc->v4l2_dev.mdev = &vimc->mdev;
>>
>> - /* Add self to the component system */
>> - ret = component_master_add_with_match(&pdev->dev, &vimc_comp_ops,
>> - match);
>> - if (ret) {
>> - media_device_cleanup(&vimc->mdev);
>> - vimc_rm_subdevs(vimc);
>> - return ret;
>> - }
>> + platform_set_drvdata(pdev, vimc);
>>
>> return 0;
>> }
>>
>> static int vimc_remove(struct platform_device *pdev)
>> {
>> - struct vimc_device *vimc = container_of(pdev, struct vimc_device, pdev);
>> + struct vimc_device *vimc = platform_get_drvdata(pdev);
>>
>> dev_dbg(&pdev->dev, "remove");
>>
>> - component_master_del(&pdev->dev, &vimc_comp_ops);
>> - vimc_rm_subdevs(vimc);
>> + media_device_cleanup(&vimc->mdev);
>>
>> return 0;
>> }
>>
>> -static void vimc_dev_release(struct device *dev)
>> -{
>> -}
>> -
>> -static struct vimc_device vimc_dev = {
>> - .pipe_cfg = &pipe_cfg,
>> - .pdev = {
>> - .name = VIMC_PDEV_NAME,
>> - .dev.release = vimc_dev_release,
>> - }
>> -};
>> -
>> static struct platform_driver vimc_pdrv = {
>> .probe = vimc_probe,
>> .remove = vimc_remove,
>> .driver = {
>> - .name = VIMC_PDEV_NAME,
>> - },
>> + .name = "vimc-core",
>> + }
>> };
>>
>> static int __init vimc_init(void)
>> {
>> int ret;
>>
>> - ret = platform_device_register(&vimc_dev.pdev);
>> - if (ret) {
>> - dev_err(&vimc_dev.pdev.dev,
>> - "platform device registration failed (err=%d)\n", ret);
>> + ret = platform_driver_register(&vimc_pdrv);
>> + if (ret)
>> return ret;
>> - }
>>
>> - ret = platform_driver_register(&vimc_pdrv);
>> + ret = vimc_cfs_subsys_register();
>> if (ret) {
>> - dev_err(&vimc_dev.pdev.dev,
>> - "platform driver registration failed (err=%d)\n", ret);
>> platform_driver_unregister(&vimc_pdrv);
>> return ret;
>> }
>> @@ -390,9 +177,9 @@ static int __init vimc_init(void)
>>
>> static void __exit vimc_exit(void)
>> {
>> - platform_driver_unregister(&vimc_pdrv);
>> + vimc_cfs_subsys_unregister();
>>
>> - platform_device_unregister(&vimc_dev.pdev);
>> + platform_driver_unregister(&vimc_pdrv);
>> }
>>
>> module_init(vimc_init);
>> diff --git a/drivers/media/platform/vimc/vimc-core.h b/drivers/media/platform/vimc/vimc-core.h
>> new file mode 100644
>> index 000000000000..42c8f92354af
>> --- /dev/null
>> +++ b/drivers/media/platform/vimc/vimc-core.h
>> @@ -0,0 +1,17 @@
>> +/* SPDX-License-Identifier: GPL-2.0+ */
>> +/*
>> + * vimc-core.h Virtual Media Controller Driver
>> + *
>> + * Copyright (C) 2018 Helen Koike <[email protected]>
>> + */
>> +
>> +#ifndef _VIMC_CORE_H_
>> +#define _VIMC_CORE_H_
>> +
>> +#define VIMC_CORE_PDEV_NAME "vimc-core"
>> +
>> +int vimc_core_comp_bind(struct device *master);
>> +
>> +void vimc_core_comp_unbind(struct device *master);
>> +
>> +#endif
>> diff --git a/drivers/media/platform/vimc/vimc-debayer.c b/drivers/media/platform/vimc/vimc-debayer.c
>> index 77887f66f323..fa326dbb7562 100644
>> --- a/drivers/media/platform/vimc/vimc-debayer.c
>> +++ b/drivers/media/platform/vimc/vimc-debayer.c
>> @@ -23,6 +23,7 @@
>> #include <linux/v4l2-mediabus.h>
>> #include <media/v4l2-subdev.h>
>>
>> +#include "vimc-configfs.h"
>> #include "vimc-common.h"
>>
>> #define VIMC_DEB_DRV_NAME "vimc-debayer"
>> @@ -522,7 +523,7 @@ static int vimc_deb_comp_bind(struct device *comp, struct device *master,
>> void *master_data)
>> {
>> struct v4l2_device *v4l2_dev = master_data;
>> - struct vimc_platform_data *pdata = comp->platform_data;
>> + struct vimc_platform_data *pdata = dev_get_platdata(comp);
>> struct vimc_deb_device *vdeb;
>> int ret;
>>
>> @@ -532,8 +533,7 @@ static int vimc_deb_comp_bind(struct device *comp, struct device *master,
>> return -ENOMEM;
>>
>> /* Initialize ved and sd */
>> - ret = vimc_ent_sd_register(&vdeb->ved, &vdeb->sd, v4l2_dev,
>> - pdata->entity_name,
>> + ret = vimc_ent_sd_register(&vdeb->ved, &vdeb->sd, v4l2_dev, pdata->name,
>> MEDIA_ENT_F_PROC_VIDEO_PIXEL_ENC_CONV, 2,
>> (const unsigned long[2]) {MEDIA_PAD_FL_SINK,
>> MEDIA_PAD_FL_SOURCE},
>> @@ -594,7 +594,50 @@ static struct platform_driver vimc_deb_pdrv = {
>> },
>> };
>>
>> -module_platform_driver(vimc_deb_pdrv);
>> +static struct config_item_type vimc_deb_cfs_pad_type = {
>> + .ct_owner = THIS_MODULE,
>> +};
>> +
>> +static struct config_group vimc_deb_cfs_sink_pad_group;
>> +static struct config_group vimc_deb_cfs_src_pad_group;
>> +
>> +static void vimc_deb_configfs_cb(struct config_group *group)
>> +{
>> + config_group_init_type_name(&vimc_deb_cfs_sink_pad_group,
>> + VIMC_CFS_SINK_PAD_NAME(0),
>> + &vimc_deb_cfs_pad_type);
>> + configfs_add_default_group(&vimc_deb_cfs_sink_pad_group, group);
>> +
>> + config_group_init_type_name(&vimc_deb_cfs_src_pad_group,
>> + VIMC_CFS_SRC_PAD_NAME(1),
>> + &vimc_deb_cfs_pad_type);
>> + configfs_add_default_group(&vimc_deb_cfs_src_pad_group, group);
>> +}
>> +
>> +struct vimc_cfs_drv vimc_deb_cfs_drv = {
>> + .name = VIMC_DEB_DRV_NAME,
>> + .configfs_cb = vimc_deb_configfs_cb,
>> +};
>> +
>> +static int __init vimc_deb_init(void)
>> +{
>> + int ret = platform_driver_register(&vimc_deb_pdrv);
>> +
>> + if (ret)
>> + return ret;
>> +
>> + vimc_cfs_drv_register(&vimc_deb_cfs_drv);
>> + return 0;
>> +}
>> +
>> +static void __exit vimc_deb_exit(void)
>> +{
>> + platform_driver_unregister(&vimc_deb_pdrv);
>> + vimc_cfs_drv_unregister(&vimc_deb_cfs_drv);
>> +}
>> +
>> +module_init(vimc_deb_init);
>> +module_exit(vimc_deb_exit);
>>
>> MODULE_DEVICE_TABLE(platform, vimc_deb_driver_ids);
>>
>> diff --git a/drivers/media/platform/vimc/vimc-scaler.c b/drivers/media/platform/vimc/vimc-scaler.c
>> index b0952ee86296..efb29384197d 100644
>> --- a/drivers/media/platform/vimc/vimc-scaler.c
>> +++ b/drivers/media/platform/vimc/vimc-scaler.c
>> @@ -23,6 +23,7 @@
>> #include <linux/v4l2-mediabus.h>
>> #include <media/v4l2-subdev.h>
>>
>> +#include "vimc-configfs.h"
>> #include "vimc-common.h"
>>
>> #define VIMC_SCA_DRV_NAME "vimc-scaler"
>> @@ -394,8 +395,7 @@ static int vimc_sca_comp_bind(struct device *comp, struct device *master,
>> return -ENOMEM;
>>
>> /* Initialize ved and sd */
>> - ret = vimc_ent_sd_register(&vsca->ved, &vsca->sd, v4l2_dev,
>> - pdata->entity_name,
>> + ret = vimc_ent_sd_register(&vsca->ved, &vsca->sd, v4l2_dev, pdata->name,
>> MEDIA_ENT_F_PROC_VIDEO_SCALER, 2,
>> (const unsigned long[2]) {MEDIA_PAD_FL_SINK,
>> MEDIA_PAD_FL_SOURCE},
>> @@ -448,7 +448,50 @@ static struct platform_driver vimc_sca_pdrv = {
>> },
>> };
>>
>> -module_platform_driver(vimc_sca_pdrv);
>> +static struct config_item_type vimc_sca_cfs_pad_type = {
>> + .ct_owner = THIS_MODULE,
>> +};
>> +
>> +static struct config_group vimc_sca_cfs_sink_pad_group;
>> +static struct config_group vimc_sca_cfs_src_pad_group;
>> +
>> +static void vimc_sca_configfs_cb(struct config_group *group)
>> +{
>> + config_group_init_type_name(&vimc_sca_cfs_sink_pad_group,
>> + VIMC_CFS_SINK_PAD_NAME(0),
>> + &vimc_sca_cfs_pad_type);
>> + configfs_add_default_group(&vimc_sca_cfs_sink_pad_group, group);
>> +
>> + config_group_init_type_name(&vimc_sca_cfs_src_pad_group,
>> + VIMC_CFS_SRC_PAD_NAME(1),
>> + &vimc_sca_cfs_pad_type);
>> + configfs_add_default_group(&vimc_sca_cfs_src_pad_group, group);
>> +}
>> +
>> +struct vimc_cfs_drv vimc_sca_cfs_drv = {
>> + .name = VIMC_SCA_DRV_NAME,
>> + .configfs_cb = vimc_sca_configfs_cb,
>> +};
>> +
>> +static int __init vimc_sca_init(void)
>> +{
>> + int ret = platform_driver_register(&vimc_sca_pdrv);
>> +
>> + if (ret)
>> + return ret;
>> +
>> + vimc_cfs_drv_register(&vimc_sca_cfs_drv);
>> + return 0;
>> +}
>> +
>> +static void __exit vimc_sca_exit(void)
>> +{
>> + platform_driver_unregister(&vimc_sca_pdrv);
>> + vimc_cfs_drv_unregister(&vimc_sca_cfs_drv);
>> +}
>> +
>> +module_init(vimc_sca_init);
>> +module_exit(vimc_sca_exit);
>>
>> MODULE_DEVICE_TABLE(platform, vimc_sca_driver_ids);
>>
>> diff --git a/drivers/media/platform/vimc/vimc-sensor.c b/drivers/media/platform/vimc/vimc-sensor.c
>> index 32ca9c6172b1..37540e72c6bc 100644
>> --- a/drivers/media/platform/vimc/vimc-sensor.c
>> +++ b/drivers/media/platform/vimc/vimc-sensor.c
>> @@ -28,6 +28,7 @@
>> #include <media/v4l2-subdev.h>
>> #include <media/tpg/v4l2-tpg.h>
>>
>> +#include "vimc-configfs.h"
>> #include "vimc-common.h"
>>
>> #define VIMC_SEN_DRV_NAME "vimc-sensor"
>> @@ -405,8 +406,7 @@ static int vimc_sen_comp_bind(struct device *comp, struct device *master,
>> }
>>
>> /* Initialize ved and sd */
>> - ret = vimc_ent_sd_register(&vsen->ved, &vsen->sd, v4l2_dev,
>> - pdata->entity_name,
>> + ret = vimc_ent_sd_register(&vsen->ved, &vsen->sd, v4l2_dev, pdata->name,
>> MEDIA_ENT_F_CAM_SENSOR, 1,
>> (const unsigned long[1]) {MEDIA_PAD_FL_SOURCE},
>> &vimc_sen_ops);
>> @@ -471,7 +471,44 @@ static struct platform_driver vimc_sen_pdrv = {
>> },
>> };
>>
>> -module_platform_driver(vimc_sen_pdrv);
>> +static struct config_item_type vimc_sen_cfs_pad_type = {
>> + .ct_owner = THIS_MODULE,
>> +};
>> +
>> +static struct config_group vimc_sen_cfs_src_pad_group;
>> +
>> +static void vimc_sen_configfs_cb(struct config_group *group)
>> +{
>> + config_group_init_type_name(&vimc_sen_cfs_src_pad_group,
>> + VIMC_CFS_SRC_PAD_NAME(0),
>> + &vimc_sen_cfs_pad_type);
>> + configfs_add_default_group(&vimc_sen_cfs_src_pad_group, group);
>> +}
>> +
>> +struct vimc_cfs_drv vimc_sen_cfs_drv = {
>> + .name = VIMC_SEN_DRV_NAME,
>> + .configfs_cb = vimc_sen_configfs_cb,
>> +};
>> +
>> +static int __init vimc_sen_init(void)
>> +{
>> + int ret = platform_driver_register(&vimc_sen_pdrv);
>> +
>> + if (ret)
>> + return ret;
>> +
>> + vimc_cfs_drv_register(&vimc_sen_cfs_drv);
>> + return 0;
>> +}
>> +
>> +static void __exit vimc_sen_exit(void)
>> +{
>> + platform_driver_unregister(&vimc_sen_pdrv);
>> + vimc_cfs_drv_unregister(&vimc_sen_cfs_drv);
>> +}
>> +
>> +module_init(vimc_sen_init);
>> +module_exit(vimc_sen_exit);
>>
>> MODULE_DEVICE_TABLE(platform, vimc_sen_driver_ids);
>>
>> --
>> 2.19.1
>>
