From: Michael Riesch <michael.riesch@collabora.com>
The Synopsys DesignWare MIPI CSI-2 Receiver is a CSI-2 bridge with
one input port and one output port. It receives the data with the
help of an external MIPI PHY (C-PHY or D-PHY) and passes it to e.g.,
the Rockchip Video Capture (VICAP) block on recent Rockchip SoCs.
Add a V4L2 subdevice driver for this unit.
Signed-off-by: Michael Riesch <michael.riesch@wolfvision.net>
Reviewed-by: Bryan O'Donoghue <bryan.odonoghue@linaro.org>
Reviewed-by: Mehdi Djait <mehdi.djait@linux.intel.com>
Signed-off-by: Michael Riesch <michael.riesch@collabora.com>
---
MAINTAINERS | 1 +
drivers/media/platform/synopsys/Kconfig | 1 +
drivers/media/platform/synopsys/Makefile | 1 +
.../media/platform/synopsys/dw-mipi-csi2/Kconfig | 17 +
.../media/platform/synopsys/dw-mipi-csi2/Makefile | 2 +
.../platform/synopsys/dw-mipi-csi2/dw-mipi-csi2.c | 735 +++++++++++++++++++++
6 files changed, 757 insertions(+)
diff --git a/MAINTAINERS b/MAINTAINERS
index 965132e0933a..42a739417a10 100644
--- a/MAINTAINERS
+++ b/MAINTAINERS
@@ -25369,6 +25369,7 @@ M: Michael Riesch <michael.riesch@collabora.com>
L: linux-media@vger.kernel.org
S: Maintained
F: Documentation/devicetree/bindings/media/rockchip,rk3568-mipi-csi2.yaml
+F: drivers/media/platform/synopsys/dw-mipi-csi2/
SYNOPSYS DESIGNWARE MMC/SD/SDIO DRIVER
M: Jaehoon Chung <jh80.chung@samsung.com>
diff --git a/drivers/media/platform/synopsys/Kconfig b/drivers/media/platform/synopsys/Kconfig
index 4fd521f78425..7dbe5cbdd2cf 100644
--- a/drivers/media/platform/synopsys/Kconfig
+++ b/drivers/media/platform/synopsys/Kconfig
@@ -1,3 +1,4 @@
# SPDX-License-Identifier: GPL-2.0-only
+source "drivers/media/platform/synopsys/dw-mipi-csi2/Kconfig"
source "drivers/media/platform/synopsys/hdmirx/Kconfig"
diff --git a/drivers/media/platform/synopsys/Makefile b/drivers/media/platform/synopsys/Makefile
index 3b12c574dd67..30951176b029 100644
--- a/drivers/media/platform/synopsys/Makefile
+++ b/drivers/media/platform/synopsys/Makefile
@@ -1,2 +1,3 @@
# SPDX-License-Identifier: GPL-2.0-only
+obj-y += dw-mipi-csi2/
obj-y += hdmirx/
diff --git a/drivers/media/platform/synopsys/dw-mipi-csi2/Kconfig b/drivers/media/platform/synopsys/dw-mipi-csi2/Kconfig
new file mode 100644
index 000000000000..d5d56a1fc491
--- /dev/null
+++ b/drivers/media/platform/synopsys/dw-mipi-csi2/Kconfig
@@ -0,0 +1,17 @@
+config VIDEO_DW_MIPI_CSI2
+ tristate "Synopsys DesignWare MIPI CSI-2 Receiver"
+ depends on VIDEO_DEV
+ depends on V4L_PLATFORM_DRIVERS
+ depends on PM && COMMON_CLK
+ select MEDIA_CONTROLLER
+ select V4L2_FWNODE
+ select VIDEO_V4L2_SUBDEV_API
+ help
+ The Synopsys DesignWare MIPI CSI-2 Receiver is a CSI-2 bridge with
+ one input port and one output port. It receives the data with the
+ help of an external MIPI PHY (C-PHY or D-PHY) and passes it to e.g.,
+ the Rockchip Video Capture (VICAP) block on recent Rockchip SoCs.
+ This is a driver for this unit.
+
+ To compile this driver as a module, choose M here: the module
+ will be called dw-mipi-csi2.
diff --git a/drivers/media/platform/synopsys/dw-mipi-csi2/Makefile b/drivers/media/platform/synopsys/dw-mipi-csi2/Makefile
new file mode 100644
index 000000000000..e49a125c531e
--- /dev/null
+++ b/drivers/media/platform/synopsys/dw-mipi-csi2/Makefile
@@ -0,0 +1,2 @@
+# SPDX-License-Identifier: GPL-2.0
+obj-$(CONFIG_VIDEO_DW_MIPI_CSI2) += dw-mipi-csi2.o
diff --git a/drivers/media/platform/synopsys/dw-mipi-csi2/dw-mipi-csi2.c b/drivers/media/platform/synopsys/dw-mipi-csi2/dw-mipi-csi2.c
new file mode 100644
index 000000000000..a7bd76afe2ee
--- /dev/null
+++ b/drivers/media/platform/synopsys/dw-mipi-csi2/dw-mipi-csi2.c
@@ -0,0 +1,735 @@
+// SPDX-License-Identifier: GPL-2.0
+/*
+ * Synopsys DesignWare MIPI CSI-2 Receiver Driver
+ *
+ * Copyright (C) 2019 Rockchip Electronics Co., Ltd.
+ * Copyright (C) 2025 Michael Riesch <michael.riesch@wolfvision.net>
+ * Copyright (C) 2026 Collabora, Ltd.
+ */
+
+#include <linux/clk.h>
+#include <linux/delay.h>
+#include <linux/io.h>
+#include <linux/module.h>
+#include <linux/of.h>
+#include <linux/phy/phy.h>
+#include <linux/platform_device.h>
+#include <linux/pm_runtime.h>
+#include <linux/property.h>
+#include <linux/reset.h>
+
+#include <media/mipi-csi2.h>
+#include <media/v4l2-ctrls.h>
+#include <media/v4l2-fwnode.h>
+#include <media/v4l2-mc.h>
+#include <media/v4l2-subdev.h>
+
+#define DW_MIPI_CSI2_N_LANES 0x04
+#define DW_MIPI_CSI2_RESETN 0x10
+#define DW_MIPI_CSI2_PHY_STATE 0x14
+#define DW_MIPI_CSI2_ERR1 0x20
+#define DW_MIPI_CSI2_ERR2 0x24
+#define DW_MIPI_CSI2_MSK1 0x28
+#define DW_MIPI_CSI2_MSK2 0x2c
+#define DW_MIPI_CSI2_CONTROL 0x40
+
+#define SW_CPHY_EN(x) ((x) << 0)
+#define SW_DSI_EN(x) ((x) << 4)
+#define SW_DATATYPE_FS(x) ((x) << 8)
+#define SW_DATATYPE_FE(x) ((x) << 14)
+#define SW_DATATYPE_LS(x) ((x) << 20)
+#define SW_DATATYPE_LE(x) ((x) << 26)
+
+#define DW_MIPI_CSI2_CLKS_MAX 1
+
+enum {
+ DW_MIPI_CSI2_PAD_SINK,
+ DW_MIPI_CSI2_PAD_SRC,
+ DW_MIPI_CSI2_PAD_MAX,
+};
+
+struct dw_mipi_csi2_format {
+ u32 code;
+ u8 depth;
+ u8 csi_dt;
+};
+
+struct dw_mipi_csi2_device {
+ struct device *dev;
+
+ void __iomem *base_addr;
+ struct clk_bulk_data *clks;
+ unsigned int clks_num;
+ struct phy *phy;
+ struct reset_control *reset;
+
+ const struct dw_mipi_csi2_format *formats;
+ unsigned int formats_num;
+
+ struct media_pad pads[DW_MIPI_CSI2_PAD_MAX];
+ struct v4l2_async_notifier notifier;
+ struct v4l2_subdev sd;
+
+ enum v4l2_mbus_type bus_type;
+ u32 lanes_num;
+};
+
+static const struct v4l2_mbus_framefmt default_format = {
+ .width = 3840,
+ .height = 2160,
+ .code = MEDIA_BUS_FMT_SRGGB10_1X10,
+ .field = V4L2_FIELD_NONE,
+ .colorspace = V4L2_COLORSPACE_RAW,
+ .ycbcr_enc = V4L2_YCBCR_ENC_601,
+ .quantization = V4L2_QUANTIZATION_FULL_RANGE,
+ .xfer_func = V4L2_XFER_FUNC_NONE,
+};
+
+static const struct dw_mipi_csi2_format formats[] = {
+ /* YUV formats */
+ {
+ .code = MEDIA_BUS_FMT_YUYV8_1X16,
+ .depth = 16,
+ .csi_dt = MIPI_CSI2_DT_YUV422_8B,
+ },
+ {
+ .code = MEDIA_BUS_FMT_UYVY8_1X16,
+ .depth = 16,
+ .csi_dt = MIPI_CSI2_DT_YUV422_8B,
+ },
+ {
+ .code = MEDIA_BUS_FMT_YVYU8_1X16,
+ .depth = 16,
+ .csi_dt = MIPI_CSI2_DT_YUV422_8B,
+ },
+ {
+ .code = MEDIA_BUS_FMT_VYUY8_1X16,
+ .depth = 16,
+ .csi_dt = MIPI_CSI2_DT_YUV422_8B,
+ },
+ /* RGB formats */
+ {
+ .code = MEDIA_BUS_FMT_RGB888_1X24,
+ .depth = 24,
+ .csi_dt = MIPI_CSI2_DT_RGB888,
+ },
+ {
+ .code = MEDIA_BUS_FMT_BGR888_1X24,
+ .depth = 24,
+ .csi_dt = MIPI_CSI2_DT_RGB888,
+ },
+ /* Bayer formats */
+ {
+ .code = MEDIA_BUS_FMT_SBGGR8_1X8,
+ .depth = 8,
+ .csi_dt = MIPI_CSI2_DT_RAW8,
+ },
+ {
+ .code = MEDIA_BUS_FMT_SGBRG8_1X8,
+ .depth = 8,
+ .csi_dt = MIPI_CSI2_DT_RAW8,
+ },
+ {
+ .code = MEDIA_BUS_FMT_SGRBG8_1X8,
+ .depth = 8,
+ .csi_dt = MIPI_CSI2_DT_RAW8,
+ },
+ {
+ .code = MEDIA_BUS_FMT_SRGGB8_1X8,
+ .depth = 8,
+ .csi_dt = MIPI_CSI2_DT_RAW8,
+ },
+ {
+ .code = MEDIA_BUS_FMT_SBGGR10_1X10,
+ .depth = 10,
+ .csi_dt = MIPI_CSI2_DT_RAW10,
+ },
+ {
+ .code = MEDIA_BUS_FMT_SGBRG10_1X10,
+ .depth = 10,
+ .csi_dt = MIPI_CSI2_DT_RAW10,
+ },
+ {
+ .code = MEDIA_BUS_FMT_SGRBG10_1X10,
+ .depth = 10,
+ .csi_dt = MIPI_CSI2_DT_RAW10,
+ },
+ {
+ .code = MEDIA_BUS_FMT_SRGGB10_1X10,
+ .depth = 10,
+ .csi_dt = MIPI_CSI2_DT_RAW10,
+ },
+ {
+ .code = MEDIA_BUS_FMT_SBGGR12_1X12,
+ .depth = 12,
+ .csi_dt = MIPI_CSI2_DT_RAW12,
+ },
+ {
+ .code = MEDIA_BUS_FMT_SGBRG12_1X12,
+ .depth = 12,
+ .csi_dt = MIPI_CSI2_DT_RAW12,
+ },
+ {
+ .code = MEDIA_BUS_FMT_SGRBG12_1X12,
+ .depth = 12,
+ .csi_dt = MIPI_CSI2_DT_RAW12,
+ },
+ {
+ .code = MEDIA_BUS_FMT_SRGGB12_1X12,
+ .depth = 12,
+ .csi_dt = MIPI_CSI2_DT_RAW12,
+ },
+};
+
+static inline struct dw_mipi_csi2_device *to_csi2(struct v4l2_subdev *sd)
+{
+ return container_of(sd, struct dw_mipi_csi2_device, sd);
+}
+
+static inline __maybe_unused void
+dw_mipi_csi2_write(struct dw_mipi_csi2_device *csi2, unsigned int addr, u32 val)
+{
+ writel(val, csi2->base_addr + addr);
+}
+
+static inline __maybe_unused u32
+dw_mipi_csi2_read(struct dw_mipi_csi2_device *csi2, unsigned int addr)
+{
+ return readl(csi2->base_addr + addr);
+}
+
+static const struct dw_mipi_csi2_format *
+dw_mipi_csi2_find_format(struct dw_mipi_csi2_device *csi2, u32 mbus_code)
+{
+ WARN_ON(csi2->formats_num == 0);
+
+ for (unsigned int i = 0; i < csi2->formats_num; i++) {
+ const struct dw_mipi_csi2_format *format = &csi2->formats[i];
+
+ if (format->code == mbus_code)
+ return format;
+ }
+
+ return NULL;
+}
+
+static int dw_mipi_csi2_start(struct dw_mipi_csi2_device *csi2)
+{
+ struct media_pad *source_pad;
+ union phy_configure_opts opts;
+ s64 link_freq;
+ u32 control = 0;
+ u32 lanes = csi2->lanes_num;
+ int ret;
+
+ if (lanes < 1 || lanes > 4)
+ return -EINVAL;
+
+ source_pad =
+ media_pad_remote_pad_unique(&csi2->pads[DW_MIPI_CSI2_PAD_SINK]);
+ if (IS_ERR(source_pad))
+ return PTR_ERR(source_pad);
+
+ /* set mult and div to 0, thus completely rely on V4L2_CID_LINK_FREQ */
+ link_freq = v4l2_get_link_freq(source_pad, 0, 0);
+ if (link_freq <= 0)
+ return link_freq ?: -EINVAL;
+
+ switch (csi2->bus_type) {
+ case V4L2_MBUS_CSI2_DPHY:
+ struct phy_configure_opts_mipi_dphy *cfg = &opts.mipi_dphy;
+
+ ret = phy_mipi_dphy_get_default_config_for_hsclk(link_freq * 2,
+ lanes, cfg);
+ if (ret)
+ return ret;
+
+ ret = phy_set_mode(csi2->phy, PHY_MODE_MIPI_DPHY);
+ if (ret)
+ return ret;
+
+ ret = phy_configure(csi2->phy, &opts);
+ if (ret)
+ return ret;
+
+ control |= SW_CPHY_EN(0);
+ break;
+
+ case V4L2_MBUS_CSI2_CPHY:
+ /* TODO: implement CPHY configuration */
+ return -EOPNOTSUPP;
+ default:
+ return -EINVAL;
+ }
+
+ control |= SW_DATATYPE_FS(0x00) | SW_DATATYPE_FE(0x01) |
+ SW_DATATYPE_LS(0x02) | SW_DATATYPE_LE(0x03);
+
+ dw_mipi_csi2_write(csi2, DW_MIPI_CSI2_N_LANES, lanes - 1);
+ dw_mipi_csi2_write(csi2, DW_MIPI_CSI2_CONTROL, control);
+ dw_mipi_csi2_write(csi2, DW_MIPI_CSI2_RESETN, 1);
+
+ return phy_power_on(csi2->phy);
+}
+
+static void dw_mipi_csi2_stop(struct dw_mipi_csi2_device *csi2)
+{
+ phy_power_off(csi2->phy);
+
+ dw_mipi_csi2_write(csi2, DW_MIPI_CSI2_RESETN, 0);
+ dw_mipi_csi2_write(csi2, DW_MIPI_CSI2_MSK1, ~0);
+ dw_mipi_csi2_write(csi2, DW_MIPI_CSI2_MSK2, ~0);
+}
+
+static const struct media_entity_operations dw_mipi_csi2_media_ops = {
+ .link_validate = v4l2_subdev_link_validate,
+};
+
+static int dw_mipi_csi2_enum_mbus_code(struct v4l2_subdev *sd,
+ struct v4l2_subdev_state *sd_state,
+ struct v4l2_subdev_mbus_code_enum *code)
+{
+ struct dw_mipi_csi2_device *csi2 = to_csi2(sd);
+
+ switch (code->pad) {
+ case DW_MIPI_CSI2_PAD_SRC:
+ const struct v4l2_mbus_framefmt *sink_fmt;
+
+ if (code->index)
+ return -EINVAL;
+
+ sink_fmt = v4l2_subdev_state_get_format(sd_state,
+ DW_MIPI_CSI2_PAD_SINK);
+ code->code = sink_fmt->code;
+
+ return 0;
+ case DW_MIPI_CSI2_PAD_SINK:
+ if (code->index > csi2->formats_num)
+ return -EINVAL;
+
+ code->code = csi2->formats[code->index].code;
+ return 0;
+ default:
+ return -EINVAL;
+ }
+}
+
+static int dw_mipi_csi2_set_fmt(struct v4l2_subdev *sd,
+ struct v4l2_subdev_state *state,
+ struct v4l2_subdev_format *format)
+{
+ struct dw_mipi_csi2_device *csi2 = to_csi2(sd);
+ const struct dw_mipi_csi2_format *fmt;
+ struct v4l2_mbus_framefmt *sink, *src;
+
+ /* the format on the source pad always matches the sink pad */
+ if (format->pad == DW_MIPI_CSI2_PAD_SRC)
+ return v4l2_subdev_get_fmt(sd, state, format);
+
+ sink = v4l2_subdev_state_get_format(state, format->pad, format->stream);
+ if (!sink)
+ return -EINVAL;
+
+ fmt = dw_mipi_csi2_find_format(csi2, format->format.code);
+ if (!fmt)
+ format->format = default_format;
+
+ *sink = format->format;
+
+ /* propagate the format to the source pad */
+ src = v4l2_subdev_state_get_opposite_stream_format(state, format->pad,
+ format->stream);
+ if (!src)
+ return -EINVAL;
+
+ *src = *sink;
+
+ return 0;
+}
+
+static int dw_mipi_csi2_set_routing(struct v4l2_subdev *sd,
+ struct v4l2_subdev_state *state,
+ enum v4l2_subdev_format_whence which,
+ struct v4l2_subdev_krouting *routing)
+{
+ int ret;
+
+ ret = v4l2_subdev_routing_validate(sd, routing,
+ V4L2_SUBDEV_ROUTING_ONLY_1_TO_1);
+ if (ret)
+ return ret;
+
+ return v4l2_subdev_set_routing_with_fmt(sd, state, routing,
+ &default_format);
+}
+
+static int dw_mipi_csi2_enable_streams(struct v4l2_subdev *sd,
+ struct v4l2_subdev_state *state, u32 pad,
+ u64 streams_mask)
+{
+ struct dw_mipi_csi2_device *csi2 = to_csi2(sd);
+ struct v4l2_subdev *remote_sd;
+ struct media_pad *sink_pad, *remote_pad;
+ struct device *dev = csi2->dev;
+ u64 mask;
+ int ret;
+
+ sink_pad = &sd->entity.pads[DW_MIPI_CSI2_PAD_SINK];
+ remote_pad = media_pad_remote_pad_first(sink_pad);
+ remote_sd = media_entity_to_v4l2_subdev(remote_pad->entity);
+
+ mask = v4l2_subdev_state_xlate_streams(state, DW_MIPI_CSI2_PAD_SINK,
+ DW_MIPI_CSI2_PAD_SRC,
+ &streams_mask);
+
+ ret = pm_runtime_resume_and_get(dev);
+ if (ret)
+ goto err;
+
+ ret = dw_mipi_csi2_start(csi2);
+ if (ret) {
+ dev_err(dev, "failed to enable CSI hardware\n");
+ goto err_pm_runtime_put;
+ }
+
+ ret = v4l2_subdev_enable_streams(remote_sd, remote_pad->index, mask);
+ if (ret)
+ goto err_csi_stop;
+
+ return 0;
+
+err_csi_stop:
+ dw_mipi_csi2_stop(csi2);
+err_pm_runtime_put:
+ pm_runtime_put(dev);
+err:
+ return ret;
+}
+
+static int dw_mipi_csi2_disable_streams(struct v4l2_subdev *sd,
+ struct v4l2_subdev_state *state,
+ u32 pad, u64 streams_mask)
+{
+ struct dw_mipi_csi2_device *csi2 = to_csi2(sd);
+ struct v4l2_subdev *remote_sd;
+ struct media_pad *sink_pad, *remote_pad;
+ struct device *dev = csi2->dev;
+ u64 mask;
+ int ret;
+
+ sink_pad = &sd->entity.pads[DW_MIPI_CSI2_PAD_SINK];
+ remote_pad = media_pad_remote_pad_first(sink_pad);
+ remote_sd = media_entity_to_v4l2_subdev(remote_pad->entity);
+
+ mask = v4l2_subdev_state_xlate_streams(state, DW_MIPI_CSI2_PAD_SINK,
+ DW_MIPI_CSI2_PAD_SRC,
+ &streams_mask);
+
+ ret = v4l2_subdev_disable_streams(remote_sd, remote_pad->index, mask);
+
+ dw_mipi_csi2_stop(csi2);
+
+ pm_runtime_put(dev);
+
+ return ret;
+}
+
+static const struct v4l2_subdev_pad_ops dw_mipi_csi2_pad_ops = {
+ .enum_mbus_code = dw_mipi_csi2_enum_mbus_code,
+ .get_fmt = v4l2_subdev_get_fmt,
+ .set_fmt = dw_mipi_csi2_set_fmt,
+ .set_routing = dw_mipi_csi2_set_routing,
+ .enable_streams = dw_mipi_csi2_enable_streams,
+ .disable_streams = dw_mipi_csi2_disable_streams,
+};
+
+static const struct v4l2_subdev_ops dw_mipi_csi2_ops = {
+ .pad = &dw_mipi_csi2_pad_ops,
+};
+
+static int dw_mipi_csi2_init_state(struct v4l2_subdev *sd,
+ struct v4l2_subdev_state *state)
+{
+ struct v4l2_subdev_route routes[] = {
+ {
+ .sink_pad = DW_MIPI_CSI2_PAD_SINK,
+ .sink_stream = 0,
+ .source_pad = DW_MIPI_CSI2_PAD_SRC,
+ .source_stream = 0,
+ .flags = V4L2_SUBDEV_ROUTE_FL_ACTIVE,
+ },
+ };
+ struct v4l2_subdev_krouting routing = {
+ .len_routes = ARRAY_SIZE(routes),
+ .num_routes = ARRAY_SIZE(routes),
+ .routes = routes,
+ };
+
+ return v4l2_subdev_set_routing_with_fmt(sd, state, &routing,
+ &default_format);
+}
+
+static const struct v4l2_subdev_internal_ops dw_mipi_csi2_internal_ops = {
+ .init_state = dw_mipi_csi2_init_state,
+};
+
+static int dw_mipi_csi2_notifier_bound(struct v4l2_async_notifier *notifier,
+ struct v4l2_subdev *sd,
+ struct v4l2_async_connection *asd)
+{
+ struct dw_mipi_csi2_device *csi2 =
+ container_of(notifier, struct dw_mipi_csi2_device, notifier);
+ struct media_pad *sink_pad = &csi2->pads[DW_MIPI_CSI2_PAD_SINK];
+ int ret;
+
+ ret = v4l2_create_fwnode_links_to_pad(sd, sink_pad,
+ MEDIA_LNK_FL_ENABLED);
+ if (ret) {
+ dev_err(csi2->dev, "failed to link source pad of %s\n",
+ sd->name);
+ return ret;
+ }
+
+ return 0;
+}
+
+static const struct v4l2_async_notifier_operations dw_mipi_csi2_notifier_ops = {
+ .bound = dw_mipi_csi2_notifier_bound,
+};
+
+static int dw_mipi_csi2_register_notifier(struct dw_mipi_csi2_device *csi2)
+{
+ struct v4l2_async_connection *asd;
+ struct v4l2_async_notifier *ntf = &csi2->notifier;
+ struct v4l2_fwnode_endpoint vep;
+ struct v4l2_subdev *sd = &csi2->sd;
+ struct device *dev = csi2->dev;
+ struct fwnode_handle *ep;
+ int ret;
+
+ ep = fwnode_graph_get_endpoint_by_id(dev_fwnode(dev), 0, 0, 0);
+ if (!ep)
+ return dev_err_probe(dev, -ENODEV, "failed to get endpoint\n");
+
+ vep.bus_type = V4L2_MBUS_UNKNOWN;
+ ret = v4l2_fwnode_endpoint_parse(ep, &vep);
+ if (ret) {
+ ret = dev_err_probe(dev, ret, "failed to parse endpoint\n");
+ goto out;
+ }
+
+ if (vep.bus_type != V4L2_MBUS_CSI2_DPHY &&
+ vep.bus_type != V4L2_MBUS_CSI2_CPHY) {
+ ret = dev_err_probe(dev, -EINVAL,
+ "invalid bus type of endpoint\n");
+ goto out;
+ }
+
+ csi2->bus_type = vep.bus_type;
+ csi2->lanes_num = vep.bus.mipi_csi2.num_data_lanes;
+
+ v4l2_async_subdev_nf_init(ntf, sd);
+ ntf->ops = &dw_mipi_csi2_notifier_ops;
+
+ asd = v4l2_async_nf_add_fwnode_remote(ntf, ep,
+ struct v4l2_async_connection);
+ if (IS_ERR(asd)) {
+ ret = PTR_ERR(asd);
+ goto err_nf_cleanup;
+ }
+
+ ret = v4l2_async_nf_register(ntf);
+ if (ret) {
+ ret = dev_err_probe(dev, ret, "failed to register notifier\n");
+ goto err_nf_cleanup;
+ }
+
+ goto out;
+
+err_nf_cleanup:
+ v4l2_async_nf_cleanup(ntf);
+out:
+ fwnode_handle_put(ep);
+ return ret;
+}
+
+static int dw_mipi_csi2_register(struct dw_mipi_csi2_device *csi2)
+{
+ struct media_pad *pads = csi2->pads;
+ struct v4l2_subdev *sd = &csi2->sd;
+ int ret;
+
+ ret = dw_mipi_csi2_register_notifier(csi2);
+ if (ret)
+ goto err;
+
+ v4l2_subdev_init(sd, &dw_mipi_csi2_ops);
+ sd->dev = csi2->dev;
+ sd->entity.ops = &dw_mipi_csi2_media_ops;
+ sd->entity.function = MEDIA_ENT_F_VID_IF_BRIDGE;
+ sd->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE | V4L2_SUBDEV_FL_STREAMS;
+ sd->internal_ops = &dw_mipi_csi2_internal_ops;
+ sd->owner = THIS_MODULE;
+ snprintf(sd->name, sizeof(sd->name), "dw-mipi-csi2 %s",
+ dev_name(csi2->dev));
+
+ pads[DW_MIPI_CSI2_PAD_SINK].flags = MEDIA_PAD_FL_SINK |
+ MEDIA_PAD_FL_MUST_CONNECT;
+ pads[DW_MIPI_CSI2_PAD_SRC].flags = MEDIA_PAD_FL_SOURCE;
+ ret = media_entity_pads_init(&sd->entity, DW_MIPI_CSI2_PAD_MAX, pads);
+ if (ret)
+ goto err_notifier_unregister;
+
+ ret = v4l2_subdev_init_finalize(sd);
+ if (ret)
+ goto err_entity_cleanup;
+
+ ret = v4l2_async_register_subdev(sd);
+ if (ret) {
+ dev_err(sd->dev, "failed to register CSI-2 subdev\n");
+ goto err_subdev_cleanup;
+ }
+
+ return 0;
+
+err_subdev_cleanup:
+ v4l2_subdev_cleanup(sd);
+err_entity_cleanup:
+ media_entity_cleanup(&sd->entity);
+err_notifier_unregister:
+ v4l2_async_nf_unregister(&csi2->notifier);
+ v4l2_async_nf_cleanup(&csi2->notifier);
+err:
+ return ret;
+}
+
+static void dw_mipi_csi2_unregister(struct dw_mipi_csi2_device *csi2)
+{
+ struct v4l2_subdev *sd = &csi2->sd;
+
+ v4l2_async_unregister_subdev(sd);
+ v4l2_subdev_cleanup(sd);
+ media_entity_cleanup(&sd->entity);
+ v4l2_async_nf_unregister(&csi2->notifier);
+ v4l2_async_nf_cleanup(&csi2->notifier);
+}
+
+static const struct of_device_id dw_mipi_csi2_of_match[] = {
+ {
+ .compatible = "rockchip,rk3568-mipi-csi2",
+ },
+ {}
+};
+MODULE_DEVICE_TABLE(of, dw_mipi_csi2_of_match);
+
+static int dw_mipi_csi2_probe(struct platform_device *pdev)
+{
+ struct device *dev = &pdev->dev;
+ struct dw_mipi_csi2_device *csi2;
+ int ret;
+
+ csi2 = devm_kzalloc(dev, sizeof(*csi2), GFP_KERNEL);
+ if (!csi2)
+ return -ENOMEM;
+ csi2->dev = dev;
+ dev_set_drvdata(dev, csi2);
+
+ csi2->base_addr = devm_platform_ioremap_resource(pdev, 0);
+ if (IS_ERR(csi2->base_addr))
+ return PTR_ERR(csi2->base_addr);
+
+ ret = devm_clk_bulk_get_all(dev, &csi2->clks);
+ if (ret != DW_MIPI_CSI2_CLKS_MAX)
+ return dev_err_probe(dev, -ENODEV, "failed to get clocks\n");
+ csi2->clks_num = ret;
+
+ csi2->phy = devm_phy_get(dev, NULL);
+ if (IS_ERR(csi2->phy))
+ return dev_err_probe(dev, PTR_ERR(csi2->phy),
+ "failed to get MIPI CSI-2 PHY\n");
+
+ csi2->reset = devm_reset_control_get_exclusive(dev, NULL);
+ if (IS_ERR(csi2->reset))
+ return dev_err_probe(dev, PTR_ERR(csi2->reset),
+ "failed to get reset\n");
+
+ csi2->formats = formats;
+ csi2->formats_num = ARRAY_SIZE(formats);
+
+ pm_runtime_enable(dev);
+
+ ret = phy_init(csi2->phy);
+ if (ret) {
+ ret = dev_err_probe(dev, ret,
+ "failed to initialize MIPI CSI-2 PHY\n");
+ goto err_pm_runtime_disable;
+ }
+
+ ret = dw_mipi_csi2_register(csi2);
+ if (ret)
+ goto err_phy_exit;
+
+ return 0;
+
+err_phy_exit:
+ phy_exit(csi2->phy);
+err_pm_runtime_disable:
+ pm_runtime_disable(dev);
+
+ return ret;
+}
+
+static void dw_mipi_csi2_remove(struct platform_device *pdev)
+{
+ struct dw_mipi_csi2_device *csi2 = platform_get_drvdata(pdev);
+ struct device *dev = &pdev->dev;
+
+ dw_mipi_csi2_unregister(csi2);
+ phy_exit(csi2->phy);
+ pm_runtime_disable(dev);
+}
+
+static int dw_mipi_csi2_runtime_suspend(struct device *dev)
+{
+ struct dw_mipi_csi2_device *csi2 = dev_get_drvdata(dev);
+
+ clk_bulk_disable_unprepare(csi2->clks_num, csi2->clks);
+
+ return 0;
+}
+
+static int dw_mipi_csi2_runtime_resume(struct device *dev)
+{
+ struct dw_mipi_csi2_device *csi2 = dev_get_drvdata(dev);
+ int ret;
+
+ reset_control_assert(csi2->reset);
+ udelay(5);
+ reset_control_deassert(csi2->reset);
+
+ ret = clk_bulk_prepare_enable(csi2->clks_num, csi2->clks);
+ if (ret) {
+ dev_err(dev, "failed to enable clocks\n");
+ return ret;
+ }
+
+ return 0;
+}
+
+static DEFINE_RUNTIME_DEV_PM_OPS(dw_mipi_csi2_pm_ops,
+ dw_mipi_csi2_runtime_suspend,
+ dw_mipi_csi2_runtime_resume, NULL);
+
+static struct platform_driver dw_mipi_csi2_drv = {
+ .driver = {
+ .name = "dw-mipi-csi2",
+ .of_match_table = dw_mipi_csi2_of_match,
+ .pm = &dw_mipi_csi2_pm_ops,
+ },
+ .probe = dw_mipi_csi2_probe,
+ .remove = dw_mipi_csi2_remove,
+};
+module_platform_driver(dw_mipi_csi2_drv);
+
+MODULE_DESCRIPTION("Synopsys DesignWare MIPI CSI-2 Receiver platform driver");
+MODULE_LICENSE("GPL");
--
2.39.5
On Fri, Jan 16, 2026 at 02:02:47PM +0100, Michael Riesch wrote:
> The Synopsys DesignWare MIPI CSI-2 Receiver is a CSI-2 bridge with
> one input port and one output port. It receives the data with the
> help of an external MIPI PHY (C-PHY or D-PHY) and passes it to e.g.,
> the Rockchip Video Capture (VICAP) block on recent Rockchip SoCs.
>
> Add a V4L2 subdevice driver for this unit.
>
> Signed-off-by: Michael Riesch <michael.riesch@wolfvision.net>
> Reviewed-by: Bryan O'Donoghue <bryan.odonoghue@linaro.org>
> Reviewed-by: Mehdi Djait <mehdi.djait@linux.intel.com>
> Signed-off-by: Michael Riesch <michael.riesch@collabora.com>
> ---
...
> +
> +static inline struct dw_mipi_csi2_device *to_csi2(struct v4l2_subdev *sd)
> +{
> + return container_of(sd, struct dw_mipi_csi2_device, sd);
> +}
> +
> +static inline __maybe_unused void
why need '__maybe_unused', needn't inline. compiler can auto decide and
report unused function if no 'inline'.
> +dw_mipi_csi2_write(struct dw_mipi_csi2_device *csi2, unsigned int addr, u32 val)
> +{
> + writel(val, csi2->base_addr + addr);
> +}
> +
> +static inline __maybe_unused u32
> +dw_mipi_csi2_read(struct dw_mipi_csi2_device *csi2, unsigned int addr)
> +{
> + return readl(csi2->base_addr + addr);
> +}
> +
> +static const struct dw_mipi_csi2_format *
> +dw_mipi_csi2_find_format(struct dw_mipi_csi2_device *csi2, u32 mbus_code)
> +{
> + WARN_ON(csi2->formats_num == 0);
> +
> + for (unsigned int i = 0; i < csi2->formats_num; i++) {
> + const struct dw_mipi_csi2_format *format = &csi2->formats[i];
> +
> + if (format->code == mbus_code)
> + return format;
> + }
> +
> + return NULL;
> +}
> +
> +static int dw_mipi_csi2_start(struct dw_mipi_csi2_device *csi2)
> +{
> + struct media_pad *source_pad;
> + union phy_configure_opts opts;
> + s64 link_freq;
> + u32 control = 0;
> + u32 lanes = csi2->lanes_num;
> + int ret;
try keep reverise christmas tree order.
> +
> + if (lanes < 1 || lanes > 4)
> + return -EINVAL;
> +
...
> +
> +static int dw_mipi_csi2_register_notifier(struct dw_mipi_csi2_device *csi2)
> +{
> + struct v4l2_async_connection *asd;
> + struct v4l2_async_notifier *ntf = &csi2->notifier;
> + struct v4l2_fwnode_endpoint vep;
> + struct v4l2_subdev *sd = &csi2->sd;
> + struct device *dev = csi2->dev;
> + struct fwnode_handle *ep;
> + int ret;
> +
> + ep = fwnode_graph_get_endpoint_by_id(dev_fwnode(dev), 0, 0, 0);
use struct fwnode_handle *ep __free(fwnode_handle) can simplify err
handler.
> + if (!ep)
> + return dev_err_probe(dev, -ENODEV, "failed to get endpoint\n");
> +
...
> +{
> + struct media_pad *pads = csi2->pads;
> + struct v4l2_subdev *sd = &csi2->sd;
> + int ret;
> +
> + ret = dw_mipi_csi2_register_notifier(csi2);
> + if (ret)
> + goto err;
> +
> + v4l2_subdev_init(sd, &dw_mipi_csi2_ops);
> + sd->dev = csi2->dev;
> + sd->entity.ops = &dw_mipi_csi2_media_ops;
> + sd->entity.function = MEDIA_ENT_F_VID_IF_BRIDGE;
> + sd->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE | V4L2_SUBDEV_FL_STREAMS;
> + sd->internal_ops = &dw_mipi_csi2_internal_ops;
> + sd->owner = THIS_MODULE;
I remeber needn't set owner, v4l2_async_register_subdev() do it for you.
> + snprintf(sd->name, sizeof(sd->name), "dw-mipi-csi2 %s",
> + dev_name(csi2->dev));
> +
...
> +
> +static int dw_mipi_csi2_probe(struct platform_device *pdev)
> +{
> + struct device *dev = &pdev->dev;
> + struct dw_mipi_csi2_device *csi2;
> + int ret;
> +
> + csi2 = devm_kzalloc(dev, sizeof(*csi2), GFP_KERNEL);
> + if (!csi2)
> + return -ENOMEM;
> + csi2->dev = dev;
> + dev_set_drvdata(dev, csi2);
> +
> + csi2->base_addr = devm_platform_ioremap_resource(pdev, 0);
> + if (IS_ERR(csi2->base_addr))
> + return PTR_ERR(csi2->base_addr);
> +
> + ret = devm_clk_bulk_get_all(dev, &csi2->clks);
> + if (ret != DW_MIPI_CSI2_CLKS_MAX)
> + return dev_err_probe(dev, -ENODEV, "failed to get clocks\n");
> + csi2->clks_num = ret;
> +
> + csi2->phy = devm_phy_get(dev, NULL);
> + if (IS_ERR(csi2->phy))
> + return dev_err_probe(dev, PTR_ERR(csi2->phy),
> + "failed to get MIPI CSI-2 PHY\n");
> +
> + csi2->reset = devm_reset_control_get_exclusive(dev, NULL);
> + if (IS_ERR(csi2->reset))
> + return dev_err_probe(dev, PTR_ERR(csi2->reset),
> + "failed to get reset\n");
> +
> + csi2->formats = formats;
> + csi2->formats_num = ARRAY_SIZE(formats);
> +
> + pm_runtime_enable(dev);
devm_pm_runtime_enable() will simple error handle.
> +
> + ret = phy_init(csi2->phy);
> + if (ret) {
> + ret = dev_err_probe(dev, ret,
> + "failed to initialize MIPI CSI-2 PHY\n");
> + goto err_pm_runtime_disable;
> + }
> +
...
> +
> +static int dw_mipi_csi2_runtime_resume(struct device *dev)
> +{
> + struct dw_mipi_csi2_device *csi2 = dev_get_drvdata(dev);
> + int ret;
> +
> + reset_control_assert(csi2->reset);
> + udelay(5);
Now prefer use fsleep(), which auto choose difference sleep function
according to delay number.
> + reset_control_deassert(csi2->reset);
> +
> + ret = clk_bulk_prepare_enable(csi2->clks_num, csi2->clks);
> + if (ret) {
> + dev_err(dev, "failed to enable clocks\n");
> + return ret;
> + }
> +
> + return 0;
> +}
> +
> +static DEFINE_RUNTIME_DEV_PM_OPS(dw_mipi_csi2_pm_ops,
> + dw_mipi_csi2_runtime_suspend,
> + dw_mipi_csi2_runtime_resume, NULL);
> +
> +static struct platform_driver dw_mipi_csi2_drv = {
> + .driver = {
> + .name = "dw-mipi-csi2",
> + .of_match_table = dw_mipi_csi2_of_match,
> + .pm = &dw_mipi_csi2_pm_ops,
pm_ptr( &dw_mipi_csi2_pm_ops)
Frank
> + },
> + .probe = dw_mipi_csi2_probe,
> + .remove = dw_mipi_csi2_remove,
> +};
> +module_platform_driver(dw_mipi_csi2_drv);
> +
> +MODULE_DESCRIPTION("Synopsys DesignWare MIPI CSI-2 Receiver platform driver");
> +MODULE_LICENSE("GPL");
>
> --
> 2.39.5
>
Hi Frank,
Thanks for your review.
On 1/16/26 17:08, Frank Li wrote:
> On Fri, Jan 16, 2026 at 02:02:47PM +0100, Michael Riesch wrote:
>> The Synopsys DesignWare MIPI CSI-2 Receiver is a CSI-2 bridge with
>> one input port and one output port. It receives the data with the
>> help of an external MIPI PHY (C-PHY or D-PHY) and passes it to e.g.,
>> the Rockchip Video Capture (VICAP) block on recent Rockchip SoCs.
>>
>> Add a V4L2 subdevice driver for this unit.
>>
>> Signed-off-by: Michael Riesch <michael.riesch@wolfvision.net>
>> Reviewed-by: Bryan O'Donoghue <bryan.odonoghue@linaro.org>
>> Reviewed-by: Mehdi Djait <mehdi.djait@linux.intel.com>
>> Signed-off-by: Michael Riesch <michael.riesch@collabora.com>
>> ---
> ...
>> +
>> +static inline struct dw_mipi_csi2_device *to_csi2(struct v4l2_subdev *sd)
>> +{
>> + return container_of(sd, struct dw_mipi_csi2_device, sd);
>> +}
>> +
>> +static inline __maybe_unused void
>
> why need '__maybe_unused', needn't inline. compiler can auto decide and
> report unused function if no 'inline'.
The __maybe_unused was helpful during development and is not really
required now. It doesn't hurt either, so I left it in. I can remove it
if you wish.
>
>> +dw_mipi_csi2_write(struct dw_mipi_csi2_device *csi2, unsigned int addr, u32 val)
>> +{
>> + writel(val, csi2->base_addr + addr);
>> +}
>> +
>> +static inline __maybe_unused u32
>> +dw_mipi_csi2_read(struct dw_mipi_csi2_device *csi2, unsigned int addr)
>> +{
>> + return readl(csi2->base_addr + addr);
>> +}
>> +
>> +static const struct dw_mipi_csi2_format *
>> +dw_mipi_csi2_find_format(struct dw_mipi_csi2_device *csi2, u32 mbus_code)
>> +{
>> + WARN_ON(csi2->formats_num == 0);
>> +
>> + for (unsigned int i = 0; i < csi2->formats_num; i++) {
>> + const struct dw_mipi_csi2_format *format = &csi2->formats[i];
>> +
>> + if (format->code == mbus_code)
>> + return format;
>> + }
>> +
>> + return NULL;
>> +}
>> +
>> +static int dw_mipi_csi2_start(struct dw_mipi_csi2_device *csi2)
>> +{
>> + struct media_pad *source_pad;
>> + union phy_configure_opts opts;
>> + s64 link_freq;
>> + u32 control = 0;
>> + u32 lanes = csi2->lanes_num;
>> + int ret;
>
> try keep reverise christmas tree order.
Ack.
>
>> +
>> + if (lanes < 1 || lanes > 4)
>> + return -EINVAL;
>> +
> ...
>> +
>> +static int dw_mipi_csi2_register_notifier(struct dw_mipi_csi2_device *csi2)
>> +{
>> + struct v4l2_async_connection *asd;
>> + struct v4l2_async_notifier *ntf = &csi2->notifier;
>> + struct v4l2_fwnode_endpoint vep;
>> + struct v4l2_subdev *sd = &csi2->sd;
>> + struct device *dev = csi2->dev;
>> + struct fwnode_handle *ep;
>> + int ret;
>> +
>> + ep = fwnode_graph_get_endpoint_by_id(dev_fwnode(dev), 0, 0, 0);
>
> use struct fwnode_handle *ep __free(fwnode_handle) can simplify err
> handler.
Sorry, I don't see the benefit of that.
>
>> + if (!ep)
>> + return dev_err_probe(dev, -ENODEV, "failed to get endpoint\n");
>> +
> ...
>> +{
>> + struct media_pad *pads = csi2->pads;
>> + struct v4l2_subdev *sd = &csi2->sd;
>> + int ret;
>> +
>> + ret = dw_mipi_csi2_register_notifier(csi2);
>> + if (ret)
>> + goto err;
>> +
>> + v4l2_subdev_init(sd, &dw_mipi_csi2_ops);
>> + sd->dev = csi2->dev;
>> + sd->entity.ops = &dw_mipi_csi2_media_ops;
>> + sd->entity.function = MEDIA_ENT_F_VID_IF_BRIDGE;
>> + sd->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE | V4L2_SUBDEV_FL_STREAMS;
>> + sd->internal_ops = &dw_mipi_csi2_internal_ops;
>> + sd->owner = THIS_MODULE;
>
> I remeber needn't set owner, v4l2_async_register_subdev() do it for you.
Indeed, nice catch.
>
>> + snprintf(sd->name, sizeof(sd->name), "dw-mipi-csi2 %s",
>> + dev_name(csi2->dev));
>> +
> ...
>> +
>> +static int dw_mipi_csi2_probe(struct platform_device *pdev)
>> +{
>> + struct device *dev = &pdev->dev;
>> + struct dw_mipi_csi2_device *csi2;
>> + int ret;
>> +
>> + csi2 = devm_kzalloc(dev, sizeof(*csi2), GFP_KERNEL);
>> + if (!csi2)
>> + return -ENOMEM;
>> + csi2->dev = dev;
>> + dev_set_drvdata(dev, csi2);
>> +
>> + csi2->base_addr = devm_platform_ioremap_resource(pdev, 0);
>> + if (IS_ERR(csi2->base_addr))
>> + return PTR_ERR(csi2->base_addr);
>> +
>> + ret = devm_clk_bulk_get_all(dev, &csi2->clks);
>> + if (ret != DW_MIPI_CSI2_CLKS_MAX)
>> + return dev_err_probe(dev, -ENODEV, "failed to get clocks\n");
>> + csi2->clks_num = ret;
>> +
>> + csi2->phy = devm_phy_get(dev, NULL);
>> + if (IS_ERR(csi2->phy))
>> + return dev_err_probe(dev, PTR_ERR(csi2->phy),
>> + "failed to get MIPI CSI-2 PHY\n");
>> +
>> + csi2->reset = devm_reset_control_get_exclusive(dev, NULL);
>> + if (IS_ERR(csi2->reset))
>> + return dev_err_probe(dev, PTR_ERR(csi2->reset),
>> + "failed to get reset\n");
>> +
>> + csi2->formats = formats;
>> + csi2->formats_num = ARRAY_SIZE(formats);
>> +
>> + pm_runtime_enable(dev);
>
> devm_pm_runtime_enable() will simple error handle.
Ack.
>
>> +
>> + ret = phy_init(csi2->phy);
>> + if (ret) {
>> + ret = dev_err_probe(dev, ret,
>> + "failed to initialize MIPI CSI-2 PHY\n");
>> + goto err_pm_runtime_disable;
>> + }
>> +
> ...
>> +
>> +static int dw_mipi_csi2_runtime_resume(struct device *dev)
>> +{
>> + struct dw_mipi_csi2_device *csi2 = dev_get_drvdata(dev);
>> + int ret;
>> +
>> + reset_control_assert(csi2->reset);
>> + udelay(5);
>
> Now prefer use fsleep(), which auto choose difference sleep function
> according to delay number.
I'll keep that in mind, but here the first thing that fsleep does is to
check whether the parameter is <= 10 and (since this is true) call
udelay. So here I don't see the point really.
>
>> + reset_control_deassert(csi2->reset);
>> +
>> + ret = clk_bulk_prepare_enable(csi2->clks_num, csi2->clks);
>> + if (ret) {
>> + dev_err(dev, "failed to enable clocks\n");
>> + return ret;
>> + }
>> +
>> + return 0;
>> +}
>> +
>> +static DEFINE_RUNTIME_DEV_PM_OPS(dw_mipi_csi2_pm_ops,
>> + dw_mipi_csi2_runtime_suspend,
>> + dw_mipi_csi2_runtime_resume, NULL);
>> +
>> +static struct platform_driver dw_mipi_csi2_drv = {
>> + .driver = {
>> + .name = "dw-mipi-csi2",
>> + .of_match_table = dw_mipi_csi2_of_match,
>> + .pm = &dw_mipi_csi2_pm_ops,
>
> pm_ptr( &dw_mipi_csi2_pm_ops)
Shouldn't make a difference here since this driver depends on CONFIG_PM.
Best regards,
Michael
>
> Frank
>> + },
>> + .probe = dw_mipi_csi2_probe,
>> + .remove = dw_mipi_csi2_remove,
>> +};
>> +module_platform_driver(dw_mipi_csi2_drv);
>> +
>> +MODULE_DESCRIPTION("Synopsys DesignWare MIPI CSI-2 Receiver platform driver");
>> +MODULE_LICENSE("GPL");
>>
>> --
>> 2.39.5
>>
On Mon, Jan 19, 2026 at 10:49:20AM +0100, Michael Riesch wrote:
> Hi Frank,
>
> Thanks for your review.
>
> On 1/16/26 17:08, Frank Li wrote:
> > On Fri, Jan 16, 2026 at 02:02:47PM +0100, Michael Riesch wrote:
> >> The Synopsys DesignWare MIPI CSI-2 Receiver is a CSI-2 bridge with
> >> one input port and one output port. It receives the data with the
> >> help of an external MIPI PHY (C-PHY or D-PHY) and passes it to e.g.,
> >> the Rockchip Video Capture (VICAP) block on recent Rockchip SoCs.
> >>
> >> Add a V4L2 subdevice driver for this unit.
> >>
> >> Signed-off-by: Michael Riesch <michael.riesch@wolfvision.net>
> >> Reviewed-by: Bryan O'Donoghue <bryan.odonoghue@linaro.org>
> >> Reviewed-by: Mehdi Djait <mehdi.djait@linux.intel.com>
> >> Signed-off-by: Michael Riesch <michael.riesch@collabora.com>
> >> ---
> > ...
> >> +
> >> +static inline struct dw_mipi_csi2_device *to_csi2(struct v4l2_subdev *sd)
> >> +{
> >> + return container_of(sd, struct dw_mipi_csi2_device, sd);
> >> +}
> >> +
> >> +static inline __maybe_unused void
> >
> > why need '__maybe_unused', needn't inline. compiler can auto decide and
> > report unused function if no 'inline'.
>
> The __maybe_unused was helpful during development and is not really
> required now. It doesn't hurt either, so I left it in. I can remove it
> if you wish.
>
> >
> >> +
> >> + ep = fwnode_graph_get_endpoint_by_id(dev_fwnode(dev), 0, 0, 0);
> >
> > use struct fwnode_handle *ep __free(fwnode_handle) can simplify err
> > handler.
>
> Sorry, I don't see the benefit of that.
>
I remember reduce one goto
> >
> >> + if (!ep)
> >> + return dev_err_probe(dev, -ENODEV, "failed to get endpoint\n");
> >> +
> > ...
> >> +{
> >> + struct media_pad *pads = csi2->pads;
> >> + struct v4l2_subdev *sd = &csi2->sd;
> >> + int ret;
> >> +
> >> + ret = dw_mipi_csi2_register_notifier(csi2);
> >> + if (ret)
> >> + goto err;
> >> +
> >> + v4l2_subdev_init(sd, &dw_mipi_csi2_ops);
> >> + sd->dev = csi2->dev;
> >> + sd->entity.ops = &dw_mipi_csi2_media_ops;
> >> + sd->entity.function = MEDIA_ENT_F_VID_IF_BRIDGE;
> >> + sd->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE | V4L2_SUBDEV_FL_STREAMS;
> >> +
> >> +static int dw_mipi_csi2_runtime_resume(struct device *dev)
> >> +{
> >> + struct dw_mipi_csi2_device *csi2 = dev_get_drvdata(dev);
> >> + int ret;
> >> +
> >> + reset_control_assert(csi2->reset);
> >> + udelay(5);
> >
> > Now prefer use fsleep(), which auto choose difference sleep function
> > according to delay number.
>
> I'll keep that in mind, but here the first thing that fsleep does is to
> check whether the parameter is <= 10 and (since this is true) call
> udelay. So here I don't see the point really.
Thank.
>
> >
> >> + reset_control_deassert(csi2->reset);
> >> +
> >> + ret = clk_bulk_prepare_enable(csi2->clks_num, csi2->clks);
> >> + if (ret) {
> >> + dev_err(dev, "failed to enable clocks\n");
> >> + return ret;
> >> + }
> >> +
> >> + return 0;
> >> +}
> >> +
> >> +static DEFINE_RUNTIME_DEV_PM_OPS(dw_mipi_csi2_pm_ops,
> >> + dw_mipi_csi2_runtime_suspend,
> >> + dw_mipi_csi2_runtime_resume, NULL);
> >> +
> >> +static struct platform_driver dw_mipi_csi2_drv = {
> >> + .driver = {
> >> + .name = "dw-mipi-csi2",
> >> + .of_match_table = dw_mipi_csi2_of_match,
> >> + .pm = &dw_mipi_csi2_pm_ops,
> >
> > pm_ptr( &dw_mipi_csi2_pm_ops)
>
> Shouldn't make a difference here since this driver depends on CONFIG_PM.
>
Avoid some static scan tools to report the problem, no harmful to add
pm_ptr().
Frank
> Best regards,
> Michael
>
> >
> > Frank
> >> + },
> >> + .probe = dw_mipi_csi2_probe,
> >> + .remove = dw_mipi_csi2_remove,
> >> +};
> >> +module_platform_driver(dw_mipi_csi2_drv);
> >> +
> >> +MODULE_DESCRIPTION("Synopsys DesignWare MIPI CSI-2 Receiver platform driver");
> >> +MODULE_LICENSE("GPL");
> >>
> >> --
> >> 2.39.5
> >>
>
Hi Frank,
On 1/19/26 16:35, Frank Li wrote:
> On Mon, Jan 19, 2026 at 10:49:20AM +0100, Michael Riesch wrote:
>> Hi Frank,
>>
>> Thanks for your review.
>>
>> On 1/16/26 17:08, Frank Li wrote:
>>> On Fri, Jan 16, 2026 at 02:02:47PM +0100, Michael Riesch wrote:
>>>> The Synopsys DesignWare MIPI CSI-2 Receiver is a CSI-2 bridge with
>>>> one input port and one output port. It receives the data with the
>>>> help of an external MIPI PHY (C-PHY or D-PHY) and passes it to e.g.,
>>>> the Rockchip Video Capture (VICAP) block on recent Rockchip SoCs.
>>>>
>>>> Add a V4L2 subdevice driver for this unit.
>>>>
>>>> Signed-off-by: Michael Riesch <michael.riesch@wolfvision.net>
>>>> Reviewed-by: Bryan O'Donoghue <bryan.odonoghue@linaro.org>
>>>> Reviewed-by: Mehdi Djait <mehdi.djait@linux.intel.com>
>>>> Signed-off-by: Michael Riesch <michael.riesch@collabora.com>
>>>> ---
>>> ...
>>>> +
>>>> +static inline struct dw_mipi_csi2_device *to_csi2(struct v4l2_subdev *sd)
>>>> +{
>>>> + return container_of(sd, struct dw_mipi_csi2_device, sd);
>>>> +}
>>>> +
>>>> +static inline __maybe_unused void
>>>
>>> why need '__maybe_unused', needn't inline. compiler can auto decide and
>>> report unused function if no 'inline'.
>>
>> The __maybe_unused was helpful during development and is not really
>> required now. It doesn't hurt either, so I left it in. I can remove it
>> if you wish.
>>
>>>
>>>> +
>>>> + ep = fwnode_graph_get_endpoint_by_id(dev_fwnode(dev), 0, 0, 0);
>>>
>>> use struct fwnode_handle *ep __free(fwnode_handle) can simplify err
>>> handler.
>>
>> Sorry, I don't see the benefit of that.
>>
>
> I remember reduce one goto
Since Sakari requested this variant as well, I changed it to as you
suggested in v7.
>
>>>
>>>> + if (!ep)
>>>> + return dev_err_probe(dev, -ENODEV, "failed to get endpoint\n");
>>>> +
>>> ...
>>>> +{
>>>> + struct media_pad *pads = csi2->pads;
>>>> + struct v4l2_subdev *sd = &csi2->sd;
>>>> + int ret;
>>>> +
>>>> + ret = dw_mipi_csi2_register_notifier(csi2);
>>>> + if (ret)
>>>> + goto err;
>>>> +
>>>> + v4l2_subdev_init(sd, &dw_mipi_csi2_ops);
>>>> + sd->dev = csi2->dev;
>>>> + sd->entity.ops = &dw_mipi_csi2_media_ops;
>>>> + sd->entity.function = MEDIA_ENT_F_VID_IF_BRIDGE;
>>>> + sd->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE | V4L2_SUBDEV_FL_STREAMS;
>>>> +
>>>> +static int dw_mipi_csi2_runtime_resume(struct device *dev)
>>>> +{
>>>> + struct dw_mipi_csi2_device *csi2 = dev_get_drvdata(dev);
>>>> + int ret;
>>>> +
>>>> + reset_control_assert(csi2->reset);
>>>> + udelay(5);
>>>
>>> Now prefer use fsleep(), which auto choose difference sleep function
>>> according to delay number.
>>
>> I'll keep that in mind, but here the first thing that fsleep does is to
>> check whether the parameter is <= 10 and (since this is true) call
>> udelay. So here I don't see the point really.
>
> Thank.
>
>>
>>>
>>>> + reset_control_deassert(csi2->reset);
>>>> +
>>>> + ret = clk_bulk_prepare_enable(csi2->clks_num, csi2->clks);
>>>> + if (ret) {
>>>> + dev_err(dev, "failed to enable clocks\n");
>>>> + return ret;
>>>> + }
>>>> +
>>>> + return 0;
>>>> +}
>>>> +
>>>> +static DEFINE_RUNTIME_DEV_PM_OPS(dw_mipi_csi2_pm_ops,
>>>> + dw_mipi_csi2_runtime_suspend,
>>>> + dw_mipi_csi2_runtime_resume, NULL);
>>>> +
>>>> +static struct platform_driver dw_mipi_csi2_drv = {
>>>> + .driver = {
>>>> + .name = "dw-mipi-csi2",
>>>> + .of_match_table = dw_mipi_csi2_of_match,
>>>> + .pm = &dw_mipi_csi2_pm_ops,
>>>
>>> pm_ptr( &dw_mipi_csi2_pm_ops)
>>
>> Shouldn't make a difference here since this driver depends on CONFIG_PM.
>>
>
> Avoid some static scan tools to report the problem, no harmful to add
> pm_ptr().
Interesting. Which tools to you use?
I hope v7 is accepted as sent earlier today, and this should not be a
blocker. We can add pm_ptr() easily in a follow-up patch.
Thanks and regards,
Michael
>
> Frank
>
>> Best regards,
>> Michael
>>
>>>
>>> Frank
>>>> + },
>>>> + .probe = dw_mipi_csi2_probe,
>>>> + .remove = dw_mipi_csi2_remove,
>>>> +};
>>>> +module_platform_driver(dw_mipi_csi2_drv);
>>>> +
>>>> +MODULE_DESCRIPTION("Synopsys DesignWare MIPI CSI-2 Receiver platform driver");
>>>> +MODULE_LICENSE("GPL");
>>>>
>>>> --
>>>> 2.39.5
>>>>
>>
On Mon, Jan 19, 2026 at 10:49:20AM +0100, Michael Riesch wrote:
> Hi Frank,
>
> Thanks for your review.
>
> On 1/16/26 17:08, Frank Li wrote:
> > On Fri, Jan 16, 2026 at 02:02:47PM +0100, Michael Riesch wrote:
> >> The Synopsys DesignWare MIPI CSI-2 Receiver is a CSI-2 bridge with
> >> one input port and one output port. It receives the data with the
> >> help of an external MIPI PHY (C-PHY or D-PHY) and passes it to e.g.,
> >> the Rockchip Video Capture (VICAP) block on recent Rockchip SoCs.
> >>
> >> Add a V4L2 subdevice driver for this unit.
> >>
> >> Signed-off-by: Michael Riesch <michael.riesch@wolfvision.net>
> >> Reviewed-by: Bryan O'Donoghue <bryan.odonoghue@linaro.org>
> >> Reviewed-by: Mehdi Djait <mehdi.djait@linux.intel.com>
> >> Signed-off-by: Michael Riesch <michael.riesch@collabora.com>
> >> ---
> > ...
> >> +
> >> +static inline struct dw_mipi_csi2_device *to_csi2(struct v4l2_subdev *sd)
> >> +{
> >> + return container_of(sd, struct dw_mipi_csi2_device, sd);
> >> +}
> >> +
> >> +static inline __maybe_unused void
> >
> > why need '__maybe_unused', needn't inline. compiler can auto decide and
> > report unused function if no 'inline'.
>
> The __maybe_unused was helpful during development and is not really
> required now. It doesn't hurt either, so I left it in. I can remove it
> if you wish.
>
> >> +dw_mipi_csi2_write(struct dw_mipi_csi2_device *csi2, unsigned int addr, u32 val)
> >> +{
> >> + writel(val, csi2->base_addr + addr);
> >> +}
> >> +
> >> +static inline __maybe_unused u32
> >> +dw_mipi_csi2_read(struct dw_mipi_csi2_device *csi2, unsigned int addr)
> >> +{
> >> + return readl(csi2->base_addr + addr);
> >> +}
> >> +
> >> +static const struct dw_mipi_csi2_format *
> >> +dw_mipi_csi2_find_format(struct dw_mipi_csi2_device *csi2, u32 mbus_code)
> >> +{
> >> + WARN_ON(csi2->formats_num == 0);
> >> +
> >> + for (unsigned int i = 0; i < csi2->formats_num; i++) {
> >> + const struct dw_mipi_csi2_format *format = &csi2->formats[i];
> >> +
> >> + if (format->code == mbus_code)
> >> + return format;
> >> + }
> >> +
> >> + return NULL;
> >> +}
> >> +
> >> +static int dw_mipi_csi2_start(struct dw_mipi_csi2_device *csi2)
> >> +{
> >> + struct media_pad *source_pad;
> >> + union phy_configure_opts opts;
> >> + s64 link_freq;
> >> + u32 control = 0;
> >> + u32 lanes = csi2->lanes_num;
> >> + int ret;
> >
> > try keep reverise christmas tree order.
>
> Ack.
>
> >> +
> >> + if (lanes < 1 || lanes > 4)
> >> + return -EINVAL;
> >> +
> > ...
> >> +
> >> +static int dw_mipi_csi2_register_notifier(struct dw_mipi_csi2_device *csi2)
> >> +{
> >> + struct v4l2_async_connection *asd;
> >> + struct v4l2_async_notifier *ntf = &csi2->notifier;
> >> + struct v4l2_fwnode_endpoint vep;
> >> + struct v4l2_subdev *sd = &csi2->sd;
> >> + struct device *dev = csi2->dev;
> >> + struct fwnode_handle *ep;
> >> + int ret;
> >> +
> >> + ep = fwnode_graph_get_endpoint_by_id(dev_fwnode(dev), 0, 0, 0);
> >
> > use struct fwnode_handle *ep __free(fwnode_handle) can simplify err
> > handler.
>
> Sorry, I don't see the benefit of that.
>
> >> + if (!ep)
> >> + return dev_err_probe(dev, -ENODEV, "failed to get endpoint\n");
> >> +
> > ...
> >> +{
> >> + struct media_pad *pads = csi2->pads;
> >> + struct v4l2_subdev *sd = &csi2->sd;
> >> + int ret;
> >> +
> >> + ret = dw_mipi_csi2_register_notifier(csi2);
> >> + if (ret)
> >> + goto err;
> >> +
> >> + v4l2_subdev_init(sd, &dw_mipi_csi2_ops);
> >> + sd->dev = csi2->dev;
> >> + sd->entity.ops = &dw_mipi_csi2_media_ops;
> >> + sd->entity.function = MEDIA_ENT_F_VID_IF_BRIDGE;
> >> + sd->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE | V4L2_SUBDEV_FL_STREAMS;
> >> + sd->internal_ops = &dw_mipi_csi2_internal_ops;
> >> + sd->owner = THIS_MODULE;
> >
> > I remeber needn't set owner, v4l2_async_register_subdev() do it for you.
>
> Indeed, nice catch.
>
> >> + snprintf(sd->name, sizeof(sd->name), "dw-mipi-csi2 %s",
> >> + dev_name(csi2->dev));
> >> +
> > ...
> >> +
> >> +static int dw_mipi_csi2_probe(struct platform_device *pdev)
> >> +{
> >> + struct device *dev = &pdev->dev;
> >> + struct dw_mipi_csi2_device *csi2;
> >> + int ret;
> >> +
> >> + csi2 = devm_kzalloc(dev, sizeof(*csi2), GFP_KERNEL);
> >> + if (!csi2)
> >> + return -ENOMEM;
> >> + csi2->dev = dev;
> >> + dev_set_drvdata(dev, csi2);
> >> +
> >> + csi2->base_addr = devm_platform_ioremap_resource(pdev, 0);
> >> + if (IS_ERR(csi2->base_addr))
> >> + return PTR_ERR(csi2->base_addr);
> >> +
> >> + ret = devm_clk_bulk_get_all(dev, &csi2->clks);
> >> + if (ret != DW_MIPI_CSI2_CLKS_MAX)
> >> + return dev_err_probe(dev, -ENODEV, "failed to get clocks\n");
> >> + csi2->clks_num = ret;
> >> +
> >> + csi2->phy = devm_phy_get(dev, NULL);
> >> + if (IS_ERR(csi2->phy))
> >> + return dev_err_probe(dev, PTR_ERR(csi2->phy),
> >> + "failed to get MIPI CSI-2 PHY\n");
> >> +
> >> + csi2->reset = devm_reset_control_get_exclusive(dev, NULL);
> >> + if (IS_ERR(csi2->reset))
> >> + return dev_err_probe(dev, PTR_ERR(csi2->reset),
> >> + "failed to get reset\n");
> >> +
> >> + csi2->formats = formats;
> >> + csi2->formats_num = ARRAY_SIZE(formats);
> >> +
> >> + pm_runtime_enable(dev);
> >
> > devm_pm_runtime_enable() will simple error handle.
>
> Ack.
>
> >> +
> >> + ret = phy_init(csi2->phy);
> >> + if (ret) {
> >> + ret = dev_err_probe(dev, ret,
> >> + "failed to initialize MIPI CSI-2 PHY\n");
> >> + goto err_pm_runtime_disable;
> >> + }
> >> +
> > ...
> >> +
> >> +static int dw_mipi_csi2_runtime_resume(struct device *dev)
> >> +{
> >> + struct dw_mipi_csi2_device *csi2 = dev_get_drvdata(dev);
> >> + int ret;
> >> +
> >> + reset_control_assert(csi2->reset);
> >> + udelay(5);
> >
> > Now prefer use fsleep(), which auto choose difference sleep function
> > according to delay number.
>
> I'll keep that in mind, but here the first thing that fsleep does is to
> check whether the parameter is <= 10 and (since this is true) call
> udelay. So here I don't see the point really.
Using fsleep() by default, unless there's a specific need to use
udelay() or msleep(), is usually preferred. It "does the right thing"
(TM) automatically, freeing developers and reviewers from having to
think about it.
> >> + reset_control_deassert(csi2->reset);
> >> +
> >> + ret = clk_bulk_prepare_enable(csi2->clks_num, csi2->clks);
> >> + if (ret) {
> >> + dev_err(dev, "failed to enable clocks\n");
> >> + return ret;
> >> + }
> >> +
> >> + return 0;
> >> +}
> >> +
> >> +static DEFINE_RUNTIME_DEV_PM_OPS(dw_mipi_csi2_pm_ops,
> >> + dw_mipi_csi2_runtime_suspend,
> >> + dw_mipi_csi2_runtime_resume, NULL);
> >> +
> >> +static struct platform_driver dw_mipi_csi2_drv = {
> >> + .driver = {
> >> + .name = "dw-mipi-csi2",
> >> + .of_match_table = dw_mipi_csi2_of_match,
> >> + .pm = &dw_mipi_csi2_pm_ops,
> >
> > pm_ptr( &dw_mipi_csi2_pm_ops)
>
> Shouldn't make a difference here since this driver depends on CONFIG_PM.
>
> >> + },
> >> + .probe = dw_mipi_csi2_probe,
> >> + .remove = dw_mipi_csi2_remove,
> >> +};
> >> +module_platform_driver(dw_mipi_csi2_drv);
> >> +
> >> +MODULE_DESCRIPTION("Synopsys DesignWare MIPI CSI-2 Receiver platform driver");
> >> +MODULE_LICENSE("GPL");
--
Regards,
Laurent Pinchart
Hi Michael,
On Mon, Jan 19, 2026 at 10:49:20AM +0100, Michael Riesch wrote:
> Hi Frank,
>
> Thanks for your review.
>
> On 1/16/26 17:08, Frank Li wrote:
> > On Fri, Jan 16, 2026 at 02:02:47PM +0100, Michael Riesch wrote:
> >> The Synopsys DesignWare MIPI CSI-2 Receiver is a CSI-2 bridge with
> >> one input port and one output port. It receives the data with the
> >> help of an external MIPI PHY (C-PHY or D-PHY) and passes it to e.g.,
> >> the Rockchip Video Capture (VICAP) block on recent Rockchip SoCs.
> >>
> >> Add a V4L2 subdevice driver for this unit.
> >>
> >> Signed-off-by: Michael Riesch <michael.riesch@wolfvision.net>
> >> Reviewed-by: Bryan O'Donoghue <bryan.odonoghue@linaro.org>
> >> Reviewed-by: Mehdi Djait <mehdi.djait@linux.intel.com>
> >> Signed-off-by: Michael Riesch <michael.riesch@collabora.com>
> >> ---
> > ...
> >> +
> >> +static inline struct dw_mipi_csi2_device *to_csi2(struct v4l2_subdev *sd)
> >> +{
> >> + return container_of(sd, struct dw_mipi_csi2_device, sd);
> >> +}
> >> +
> >> +static inline __maybe_unused void
> >
> > why need '__maybe_unused', needn't inline. compiler can auto decide and
> > report unused function if no 'inline'.
>
> The __maybe_unused was helpful during development and is not really
> required now. It doesn't hurt either, so I left it in. I can remove it
> if you wish.
Please. :-)
> >> +static int dw_mipi_csi2_register_notifier(struct dw_mipi_csi2_device *csi2)
> >> +{
> >> + struct v4l2_async_connection *asd;
> >> + struct v4l2_async_notifier *ntf = &csi2->notifier;
> >> + struct v4l2_fwnode_endpoint vep;
> >> + struct v4l2_subdev *sd = &csi2->sd;
> >> + struct device *dev = csi2->dev;
> >> + struct fwnode_handle *ep;
> >> + int ret;
> >> +
> >> + ep = fwnode_graph_get_endpoint_by_id(dev_fwnode(dev), 0, 0, 0);
> >
> > use struct fwnode_handle *ep __free(fwnode_handle) can simplify err
> > handler.
>
> Sorry, I don't see the benefit of that.
I'd prefer this, too, when you unconditionally need to release or put
something. It'll make error handling simpler, too.
--
Kind regards,
Sakari Ailus
© 2016 - 2026 Red Hat, Inc.