diff mbox series

[v2] media: rcar-isp: Add Renesas R-Car Image Signal Processor driver

Message ID 20210512081912.3976565-1-niklas.soderlund+renesas@ragnatech.se
State Superseded
Headers show
Series [v2] media: rcar-isp: Add Renesas R-Car Image Signal Processor driver | expand

Commit Message

Niklas Söderlund May 12, 2021, 8:19 a.m. UTC
Add a V4L2 driver for Renesas R-Car Image Signal Processor. The driver
supports the R-Car V3U SoC where the ISP IP sits between the R-Car CSI-2
receiver and VIN and filters the CSI-2 data based on VC/DT and directs
the video stream to different VIN IPs.

Signed-off-by: Niklas Söderlund <niklas.soderlund+renesas@ragnatech.se>
---
 MAINTAINERS                       |   1 +
 drivers/media/platform/Kconfig    |  16 +
 drivers/media/platform/Makefile   |   1 +
 drivers/media/platform/rcar-isp.c | 500 ++++++++++++++++++++++++++++++
 4 files changed, 518 insertions(+)
 create mode 100644 drivers/media/platform/rcar-isp.c

Comments

Hans Verkuil June 14, 2021, 12:29 p.m. UTC | #1
On 12/05/2021 10:19, Niklas Söderlund wrote:
> Add a V4L2 driver for Renesas R-Car Image Signal Processor. The driver

> supports the R-Car V3U SoC where the ISP IP sits between the R-Car CSI-2

> receiver and VIN and filters the CSI-2 data based on VC/DT and directs

> the video stream to different VIN IPs.


Is ISP the right name for this? Based on the description above, it is not
really what I would consider an ISP.

> 

> Signed-off-by: Niklas Söderlund <niklas.soderlund+renesas@ragnatech.se>

> ---

>  MAINTAINERS                       |   1 +

>  drivers/media/platform/Kconfig    |  16 +

>  drivers/media/platform/Makefile   |   1 +

>  drivers/media/platform/rcar-isp.c | 500 ++++++++++++++++++++++++++++++

>  4 files changed, 518 insertions(+)

>  create mode 100644 drivers/media/platform/rcar-isp.c

> 

> diff --git a/MAINTAINERS b/MAINTAINERS

> index c35a9c93da84f4f7..03f3d52e03596f66 100644

> --- a/MAINTAINERS

> +++ b/MAINTAINERS

> @@ -11400,6 +11400,7 @@ T:	git git://linuxtv.org/media_tree.git

>  F:	Documentation/devicetree/bindings/media/renesas,csi2.yaml

>  F:	Documentation/devicetree/bindings/media/renesas,isp.yaml

>  F:	Documentation/devicetree/bindings/media/renesas,vin.yaml

> +F:	drivers/media/platform/rcar-isp.c

>  F:	drivers/media/platform/rcar-vin/

>  

>  MEDIA DRIVERS FOR RENESAS - VSP1

> diff --git a/drivers/media/platform/Kconfig b/drivers/media/platform/Kconfig

> index 157c924686e4b61b..a8777d5dd6bc3ec1 100644

> --- a/drivers/media/platform/Kconfig

> +++ b/drivers/media/platform/Kconfig

> @@ -200,6 +200,22 @@ config VIDEO_TI_CAL_MC

>  

>  endif # VIDEO_TI_CAL

>  

> +config VIDEO_RCAR_ISP

> +	tristate "R-Car Image Signal Processor (ISP)"

> +	depends on VIDEO_V4L2 && OF

> +	depends on ARCH_RENESAS || COMPILE_TEST

> +	select MEDIA_CONTROLLER

> +	select VIDEO_V4L2_SUBDEV_API

> +	select RESET_CONTROLLER

> +	select V4L2_FWNODE

> +	help

> +	  Support for Renesas R-Car Image Signal Processor (ISP).

> +	  Enable this to support the Renesas R-Car Image Signal

> +	  Processor (ISP).

> +

> +	  To compile this driver as a module, choose M here: the

> +	  module will be called rcar-isp.

> +

>  endif # V4L_PLATFORM_DRIVERS

>  

>  menuconfig V4L_MEM2MEM_DRIVERS

> diff --git a/drivers/media/platform/Makefile b/drivers/media/platform/Makefile

> index eedc14aafb32c2fa..8ae543f6ef764c48 100644

> --- a/drivers/media/platform/Makefile

> +++ b/drivers/media/platform/Makefile

> @@ -63,6 +63,7 @@ obj-$(CONFIG_VIDEO_AM437X_VPFE)		+= am437x/

>  

>  obj-$(CONFIG_VIDEO_XILINX)		+= xilinx/

>  

> +obj-$(CONFIG_VIDEO_RCAR_ISP)		+= rcar-isp.o

>  obj-$(CONFIG_VIDEO_RCAR_VIN)		+= rcar-vin/

>  

>  obj-$(CONFIG_VIDEO_ATMEL_ISC)		+= atmel/

> diff --git a/drivers/media/platform/rcar-isp.c b/drivers/media/platform/rcar-isp.c

> new file mode 100644

> index 0000000000000000..bf6a376354ece89d

> --- /dev/null

> +++ b/drivers/media/platform/rcar-isp.c

> @@ -0,0 +1,500 @@

> +// SPDX-License-Identifier: GPL-2.0

> +/*

> + * Driver for Renesas R-Car ISP Channel Selector

> + *

> + * Copyright (C) 2021 Renesas Electronics Corp.

> + */

> +

> +#include <linux/module.h>

> +#include <linux/mutex.h>

> +#include <linux/of_device.h>

> +#include <linux/platform_device.h>

> +#include <linux/pm_runtime.h>

> +#include <linux/reset.h>

> +

> +#include <media/v4l2-subdev.h>

> +

> +#define ISPINPUTSEL0_REG				0x0008

> +#define ISPINPUTSEL0_SEL_CSI0				BIT(31)

> +

> +#define ISPSTART_REG					0x0014

> +#define ISPSTART_START					0xffff

> +#define ISPSTART_STOP					0x0000

> +

> +#define ISPPROCMODE_DT_REG(n)				(0x1100 + (0x4 * n))

> +#define ISPPROCMODE_DT_PROC_MODE_VC3(pm)		(((pm) & 0x3f) << 24)

> +#define ISPPROCMODE_DT_PROC_MODE_VC2(pm)		(((pm) & 0x3f) << 16)

> +#define ISPPROCMODE_DT_PROC_MODE_VC1(pm)		(((pm) & 0x3f) << 8)

> +#define ISPPROCMODE_DT_PROC_MODE_VC0(pm)		((pm) & 0x3f)

> +

> +#define ISPCS_FILTER_ID_CH_REG(n)			(0x3000 + (0x0100 * n))

> +

> +#define ISPCS_DT_CODE03_CH_REG(n)			(0x3008 + (0x100 * n))

> +#define ISPCS_DT_CODE03_EN3				BIT(31)

> +#define ISPCS_DT_CODE03_DT3(dt)				(((dt) & 0x3f) << 24)

> +#define ISPCS_DT_CODE03_EN2				BIT(23)

> +#define ISPCS_DT_CODE03_DT2(dt)				(((dt) & 0x3f) << 16)

> +#define ISPCS_DT_CODE03_EN1				BIT(15)

> +#define ISPCS_DT_CODE03_DT1(dt)				(((dt) & 0x3f) << 8)

> +#define ISPCS_DT_CODE03_EN0				BIT(7)

> +#define ISPCS_DT_CODE03_DT0(dt)				((dt) & 0x3f)

> +

> +struct rcar_isp_format {

> +	u32 code;

> +	unsigned int datatype;

> +	unsigned int procmode;

> +};

> +

> +static const struct rcar_isp_format rcar_isp_formats[] = {

> +	{ .code = MEDIA_BUS_FMT_RGB888_1X24,	.datatype = 0x24, .procmode = 0x15 },

> +	{ .code = MEDIA_BUS_FMT_Y10_1X10,	.datatype = 0x2b, .procmode = 0x10 },

> +	{ .code = MEDIA_BUS_FMT_UYVY8_1X16,	.datatype = 0x1e, .procmode = 0x0c },

> +	{ .code = MEDIA_BUS_FMT_YUYV8_1X16,	.datatype = 0x1e, .procmode = 0x0c },

> +	{ .code = MEDIA_BUS_FMT_UYVY8_2X8,	.datatype = 0x1e, .procmode = 0x0c },

> +	{ .code = MEDIA_BUS_FMT_YUYV10_2X10,	.datatype = 0x1e, .procmode = 0x0c },

> +};

> +

> +static const struct rcar_isp_format *risp_code_to_fmt(unsigned int code)

> +{

> +	unsigned int i;

> +

> +	for (i = 0; i < ARRAY_SIZE(rcar_isp_formats); i++)

> +		if (rcar_isp_formats[i].code == code)

> +			return &rcar_isp_formats[i];

> +

> +	return NULL;

> +}

> +

> +enum rcar_isp_input {

> +	RISP_CSI_INPUT0,

> +	RISP_CSI_INPUT1,

> +};

> +

> +enum rcar_isp_pads {

> +	RCAR_ISP_SINK,

> +	RCAR_ISP_PORT0,

> +	RCAR_ISP_PORT1,

> +	RCAR_ISP_PORT2,

> +	RCAR_ISP_PORT3,

> +	RCAR_ISP_PORT4,

> +	RCAR_ISP_PORT5,

> +	RCAR_ISP_PORT6,

> +	RCAR_ISP_PORT7,

> +	RCAR_ISP_MAX_PAD,

> +};

> +

> +struct rcar_isp {

> +	struct device *dev;

> +	void __iomem *base;

> +	struct reset_control *rstc;

> +

> +	enum rcar_isp_input csi_input;

> +

> +	struct v4l2_subdev subdev;

> +	struct media_pad pads[RCAR_ISP_MAX_PAD];

> +

> +	struct v4l2_async_notifier notifier;

> +	struct v4l2_subdev *remote;

> +	unsigned int remote_pad;

> +

> +	struct v4l2_mbus_framefmt mf;

> +

> +	struct mutex lock;

> +	int stream_count;

> +};

> +

> +static inline struct rcar_isp *sd_to_isp(struct v4l2_subdev *sd)

> +{

> +	return container_of(sd, struct rcar_isp, subdev);

> +}

> +

> +static inline struct rcar_isp *notifier_to_isp(struct v4l2_async_notifier *n)

> +{

> +	return container_of(n, struct rcar_isp, notifier);

> +}

> +

> +static void risp_write(struct rcar_isp *isp, u32 offset, u32 value)

> +{

> +	iowrite32(value, isp->base + offset);

> +}

> +

> +static u32 risp_read(struct rcar_isp *isp, u32 offset)

> +{

> +	return ioread32(isp->base + offset);

> +}

> +

> +static int risp_s_power(struct v4l2_subdev *sd, int on)

> +{

> +	struct rcar_isp *isp = sd_to_isp(sd);

> +	int ret;

> +

> +	if (on) {

> +		ret = pm_runtime_get_sync(isp->dev);

> +		if (ret < 0)

> +			return ret;

> +

> +		ret = reset_control_deassert(isp->rstc);

> +		if (ret < 0)

> +			return ret;

> +	} else {

> +		reset_control_assert(isp->rstc);

> +		pm_runtime_put(isp->dev);

> +	}

> +

> +	return 0;

> +}

> +

> +static const struct v4l2_subdev_core_ops risp_core_ops = {

> +	.s_power = risp_s_power,

> +};

> +

> +static int risp_remote_code(struct rcar_isp *isp)

> +{

> +	struct v4l2_subdev_format fmt = {

> +		.which = V4L2_SUBDEV_FORMAT_ACTIVE,

> +	};

> +

> +	fmt.pad = isp->remote_pad;

> +	if (v4l2_subdev_call(isp->remote, pad, get_fmt, NULL, &fmt))

> +		return -EPIPE;

> +

> +	return fmt.format.code;

> +}

> +

> +static int risp_start(struct rcar_isp *isp)

> +{

> +	const struct rcar_isp_format *format;

> +	unsigned int vc;

> +	u32 sel_csi = 0;

> +

> +	format = risp_code_to_fmt(risp_remote_code(isp));

> +	if (!format) {

> +		dev_err(isp->dev, "Unsupported bus format\n");

> +		return -EINVAL;

> +	}

> +

> +	/* Select CSI-2 input source. */

> +	if (isp->csi_input == RISP_CSI_INPUT1)

> +		sel_csi = ISPINPUTSEL0_SEL_CSI0;

> +

> +	risp_write(isp, ISPINPUTSEL0_REG,

> +		   risp_read(isp, ISPINPUTSEL0_REG) | sel_csi);

> +

> +	/* Configure Channel Selector. */

> +	for (vc = 0; vc < 4; vc++) {

> +		u8 ch = vc + 4;

> +		u8 dt = format->datatype;

> +

> +		risp_write(isp, ISPCS_FILTER_ID_CH_REG(ch), BIT(vc));

> +		risp_write(isp, ISPCS_DT_CODE03_CH_REG(ch),

> +			   ISPCS_DT_CODE03_EN3 | ISPCS_DT_CODE03_DT3(dt) |

> +			   ISPCS_DT_CODE03_EN2 | ISPCS_DT_CODE03_DT2(dt) |

> +			   ISPCS_DT_CODE03_EN1 | ISPCS_DT_CODE03_DT1(dt) |

> +			   ISPCS_DT_CODE03_EN0 | ISPCS_DT_CODE03_DT0(dt));

> +	}

> +

> +	/* Setup processing method. */

> +	risp_write(isp, ISPPROCMODE_DT_REG(format->datatype),

> +		   ISPPROCMODE_DT_PROC_MODE_VC3(format->procmode) |

> +		   ISPPROCMODE_DT_PROC_MODE_VC2(format->procmode) |

> +		   ISPPROCMODE_DT_PROC_MODE_VC1(format->procmode) |

> +		   ISPPROCMODE_DT_PROC_MODE_VC0(format->procmode));

> +

> +	/* Start ISP. */

> +	risp_write(isp, ISPSTART_REG, ISPSTART_START);

> +

> +	return v4l2_subdev_call(isp->remote, video, s_stream, 1);

> +}

> +

> +static void risp_stop(struct rcar_isp *isp)

> +{

> +	v4l2_subdev_call(isp->remote, video, s_stream, 0);

> +

> +	/* Stop ISP. */

> +	risp_write(isp, ISPSTART_REG, ISPSTART_STOP);

> +}

> +

> +static int risp_s_stream(struct v4l2_subdev *sd, int enable)

> +{

> +	struct rcar_isp *isp = sd_to_isp(sd);

> +	int ret = 0;

> +

> +	mutex_lock(&isp->lock);

> +

> +	if (!isp->remote) {

> +		ret = -ENODEV;

> +		goto out;

> +	}

> +

> +	if (enable && isp->stream_count == 0) {

> +		ret = risp_start(isp);

> +		if (ret)

> +			goto out;

> +	} else if (!enable && isp->stream_count == 1) {

> +		risp_stop(isp);

> +	}

> +

> +	isp->stream_count += enable ? 1 : -1;

> +out:

> +	mutex_unlock(&isp->lock);https://qa-deploy.rd.cisco.com/gates/7/results/86270

> +

> +	return ret;

> +}

> +

> +static const struct v4l2_subdev_video_ops risp_video_ops = {

> +	.s_stream = risp_s_stream,

> +};

> +

> +static int risp_set_pad_format(struct v4l2_subdev *sd,

> +			       struct v4l2_subdev_pad_config *cfg,

> +			       struct v4l2_subdev_format *format)


This prototype will change very soon (I hope) as soon as

https://patchwork.linuxtv.org/project/linux-media/cover/20210610145606.3468235-1-tomi.valkeinen@ideasonboard.com/

is merged (PR is outstanding).

Once that is merged, this patch will have to be rebased and a v3 posted.

> +{

> +	struct rcar_isp *isp = sd_to_isp(sd);

> +	struct v4l2_mbus_framefmt *framefmt;

> +

> +	if (!risp_code_to_fmt(format->format.code))

> +		format->format.code = rcar_isp_formats[0].code;

> +

> +	if (format->which == V4L2_SUBDEV_FORMAT_ACTIVE) {

> +		isp->mf = format->format;

> +	} else {

> +		framefmt = v4l2_subdev_get_try_format(sd, cfg, 0);

> +		*framefmt = format->format;

> +	}

> +

> +	return 0;

> +}

> +

> +static int risp_get_pad_format(struct v4l2_subdev *sd,

> +			       struct v4l2_subdev_pad_config *cfg,

> +			       struct v4l2_subdev_format *format)

> +{

> +	struct rcar_isp *isp = sd_to_isp(sd);

> +

> +	if (format->which == V4L2_SUBDEV_FORMAT_ACTIVE)

> +		format->format = isp->mf;

> +	else

> +		format->format = *v4l2_subdev_get_try_format(sd, cfg, 0);

> +

> +	return 0;

> +}

> +

> +static const struct v4l2_subdev_pad_ops risp_pad_ops = {

> +	.set_fmt = risp_set_pad_format,

> +	.get_fmt = risp_get_pad_format,

> +};

> +

> +static const struct v4l2_subdev_ops rcar_isp_subdev_ops = {

> +	.core	= &risp_core_ops,

> +	.video	= &risp_video_ops,

> +	.pad	= &risp_pad_ops,

> +};

> +

> +/* -----------------------------------------------------------------------------

> + * Async handling and registration of subdevices and links

> + */

> +

> +static int risp_notify_bound(struct v4l2_async_notifier *notifier,

> +			     struct v4l2_subdev *subdev,

> +			     struct v4l2_async_subdev *asd)

> +{

> +	struct rcar_isp *isp = notifier_to_isp(notifier);

> +	int pad;

> +

> +	pad = media_entity_get_fwnode_pad(&subdev->entity, asd->match.fwnode,

> +					  MEDIA_PAD_FL_SOURCE);

> +	if (pad < 0) {

> +		dev_err(isp->dev, "Failed to find pad for %s\n", subdev->name);

> +		return pad;

> +	}

> +

> +	isp->remote = subdev;

> +	isp->remote_pad = pad;

> +

> +	dev_dbg(isp->dev, "Bound %s pad: %d\n", subdev->name, pad);

> +

> +	return media_create_pad_link(&subdev->entity, pad,

> +				     &isp->subdev.entity, 0,

> +				     MEDIA_LNK_FL_ENABLED |

> +				     MEDIA_LNK_FL_IMMUTABLE);

> +}

> +

> +static void risp_notify_unbind(struct v4l2_async_notifier *notifier,

> +			       struct v4l2_subdev *subdev,

> +			       struct v4l2_async_subdev *asd)

> +{

> +	struct rcar_isp *isp = notifier_to_isp(notifier);

> +

> +	isp->remote = NULL;

> +

> +	dev_dbg(isp->dev, "Unbind %s\n", subdev->name);

> +}

> +

> +static const struct v4l2_async_notifier_operations risp_notify_ops = {

> +	.bound = risp_notify_bound,

> +	.unbind = risp_notify_unbind,

> +};

> +

> +static int risp_parse_dt(struct rcar_isp *isp)

> +{

> +	struct v4l2_async_subdev *asd;

> +	struct fwnode_handle *fwnode;

> +	struct fwnode_handle *ep;

> +	unsigned int id;

> +	int ret;

> +

> +	for (id = 0; id < 2; id++) {

> +		ep = fwnode_graph_get_endpoint_by_id(dev_fwnode(isp->dev),

> +						     0, id, 0);

> +		if (ep)

> +			break;

> +	}

> +

> +	if (!ep) {

> +		dev_err(isp->dev, "Not connected to subdevice\n");

> +		return -EINVAL;

> +	}

> +

> +	if (id == 1)

> +		isp->csi_input = RISP_CSI_INPUT1;

> +

> +	fwnode = fwnode_graph_get_remote_endpoint(ep);

> +	fwnode_handle_put(ep);

> +

> +	dev_dbg(isp->dev, "Found '%pOF'\n", to_of_node(fwnode));

> +

> +	v4l2_async_notifier_init(&isp->notifier);

> +	isp->notifier.ops = &risp_notify_ops;

> +

> +	asd = v4l2_async_notifier_add_fwnode_subdev(&isp->notifier, fwnode,

> +						    struct v4l2_async_subdev);

> +	fwnode_handle_put(fwnode);

> +	if (IS_ERR(asd))

> +		return PTR_ERR(asd);

> +

> +	ret = v4l2_async_subdev_notifier_register(&isp->subdev, &isp->notifier);

> +	if (ret)

> +		v4l2_async_notifier_cleanup(&isp->notifier);

> +

> +	return ret;

> +}

> +

> +/* -----------------------------------------------------------------------------

> + * Platform Device Driver

> + */

> +

> +static const struct media_entity_operations risp_entity_ops = {

> +	.link_validate = v4l2_subdev_link_validate,

> +};

> +

> +static int risp_probe_resources(struct rcar_isp *isp,

> +				struct platform_device *pdev)

> +{

> +	struct resource *res;

> +

> +	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);

> +	isp->base = devm_ioremap_resource(&pdev->dev, res);

> +	if (IS_ERR(isp->base))

> +		return PTR_ERR(isp->base);

> +

> +	isp->rstc = devm_reset_control_get(&pdev->dev, NULL);

> +

> +	return PTR_ERR_OR_ZERO(isp->rstc);

> +}

> +

> +static const struct of_device_id risp_of_id_table[] = {

> +	{ .compatible = "renesas,r8a779a0-isp" },

> +	{ /* sentinel */ },

> +};

> +MODULE_DEVICE_TABLE(of, risp_of_id_table);

> +

> +static int risp_probe(struct platform_device *pdev)

> +{

> +	struct rcar_isp *isp;

> +	unsigned int i;

> +	int ret;

> +

> +	isp = devm_kzalloc(&pdev->dev, sizeof(*isp), GFP_KERNEL);

> +	if (!isp)

> +		return -ENOMEM;

> +

> +	isp->dev = &pdev->dev;

> +

> +	mutex_init(&isp->lock);

> +	isp->stream_count = 0;

> +

> +	ret = risp_probe_resources(isp, pdev);

> +	if (ret) {

> +		dev_err(isp->dev, "Failed to get resources\n");

> +		return ret;

> +	}

> +

> +	platform_set_drvdata(pdev, isp);

> +

> +	ret = risp_parse_dt(isp);

> +	if (ret)

> +		return ret;

> +

> +	isp->subdev.owner = THIS_MODULE;

> +	isp->subdev.dev = &pdev->dev;

> +	v4l2_subdev_init(&isp->subdev, &rcar_isp_subdev_ops);

> +	v4l2_set_subdevdata(&isp->subdev, &pdev->dev);

> +	snprintf(isp->subdev.name, V4L2_SUBDEV_NAME_SIZE, "%s %s",

> +		 KBUILD_MODNAME, dev_name(&pdev->dev));

> +	isp->subdev.flags = V4L2_SUBDEV_FL_HAS_DEVNODE;

> +

> +	isp->subdev.entity.function = MEDIA_ENT_F_PROC_VIDEO_PIXEL_FORMATTER;


Similar question to the one at the top: is this really a pixel formatter?

It really feels more like a routing device.

I wonder if this series isn't relevant for this driver:

https://patchwork.linuxtv.org/project/linux-media/cover/20210524104408.599645-1-tomi.valkeinen@ideasonboard.com/

Regards,

	Hans

> +	isp->subdev.entity.ops = &risp_entity_ops;

> +

> +	isp->pads[RCAR_ISP_SINK].flags = MEDIA_PAD_FL_SINK;

> +	for (i = RCAR_ISP_PORT0; i < RCAR_ISP_MAX_PAD; i++)

> +		isp->pads[i].flags = MEDIA_PAD_FL_SOURCE;

> +

> +	ret = media_entity_pads_init(&isp->subdev.entity, RCAR_ISP_MAX_PAD,

> +				     isp->pads);

> +	if (ret)

> +		goto error;

> +

> +	pm_runtime_enable(&pdev->dev);

> +

> +	ret = v4l2_async_register_subdev(&isp->subdev);

> +	if (ret < 0)

> +		goto error;

> +

> +	dev_info(isp->dev, "Using CSI-2 input: %u\n", isp->csi_input);

> +

> +	return 0;

> +error:

> +	v4l2_async_notifier_unregister(&isp->notifier);

> +	v4l2_async_notifier_cleanup(&isp->notifier);

> +

> +	return ret;

> +}

> +

> +static int risp_remove(struct platform_device *pdev)

> +{

> +	struct rcar_isp *isp = platform_get_drvdata(pdev);

> +

> +	v4l2_async_notifier_unregister(&isp->notifier);

> +	v4l2_async_notifier_cleanup(&isp->notifier);

> +	v4l2_async_unregister_subdev(&isp->subdev);

> +

> +	pm_runtime_disable(&pdev->dev);

> +

> +	return 0;

> +}

> +

> +static struct platform_driver rcar_isp_driver = {

> +	.driver = {

> +		.name = "rcar-isp",

> +		.of_match_table = risp_of_id_table,

> +	},

> +	.probe = risp_probe,

> +	.remove = risp_remove,

> +};

> +

> +module_platform_driver(rcar_isp_driver);

> +

> +MODULE_AUTHOR("Niklas Söderlund <niklas.soderlund@ragnatech.se>");

> +MODULE_DESCRIPTION("Renesas R-Car ISP Channel Selector driver");

> +MODULE_LICENSE("GPL");

>
Niklas Söderlund June 14, 2021, 12:50 p.m. UTC | #2
Hi Hans,

Thanks for your feedback.

On 2021-06-14 14:29:32 +0200, Hans Verkuil wrote:
> On 12/05/2021 10:19, Niklas Söderlund wrote:

> > Add a V4L2 driver for Renesas R-Car Image Signal Processor. The driver

> > supports the R-Car V3U SoC where the ISP IP sits between the R-Car CSI-2

> > receiver and VIN and filters the CSI-2 data based on VC/DT and directs

> > the video stream to different VIN IPs.

> 

> Is ISP the right name for this? Based on the description above, it is not

> really what I would consider an ISP.


Yes this models an ISP so the name is correct. But your observation is 
correct it does not (yet) expose any real ISP functionality. I only have 
documentation for the features exposed in this patch and unfortunately 
the ISP is needed on some SoCs to enable video capture. Maybe in the 
future more features can be added.

> 

> > 

> > Signed-off-by: Niklas Söderlund <niklas.soderlund+renesas@ragnatech.se>

> > ---

> >  MAINTAINERS                       |   1 +

> >  drivers/media/platform/Kconfig    |  16 +

> >  drivers/media/platform/Makefile   |   1 +

> >  drivers/media/platform/rcar-isp.c | 500 ++++++++++++++++++++++++++++++

> >  4 files changed, 518 insertions(+)

> >  create mode 100644 drivers/media/platform/rcar-isp.c

> > 

> > diff --git a/MAINTAINERS b/MAINTAINERS

> > index c35a9c93da84f4f7..03f3d52e03596f66 100644

> > --- a/MAINTAINERS

> > +++ b/MAINTAINERS

> > @@ -11400,6 +11400,7 @@ T:	git git://linuxtv.org/media_tree.git

> >  F:	Documentation/devicetree/bindings/media/renesas,csi2.yaml

> >  F:	Documentation/devicetree/bindings/media/renesas,isp.yaml

> >  F:	Documentation/devicetree/bindings/media/renesas,vin.yaml

> > +F:	drivers/media/platform/rcar-isp.c

> >  F:	drivers/media/platform/rcar-vin/

> >  

> >  MEDIA DRIVERS FOR RENESAS - VSP1

> > diff --git a/drivers/media/platform/Kconfig b/drivers/media/platform/Kconfig

> > index 157c924686e4b61b..a8777d5dd6bc3ec1 100644

> > --- a/drivers/media/platform/Kconfig

> > +++ b/drivers/media/platform/Kconfig

> > @@ -200,6 +200,22 @@ config VIDEO_TI_CAL_MC

> >  

> >  endif # VIDEO_TI_CAL

> >  

> > +config VIDEO_RCAR_ISP

> > +	tristate "R-Car Image Signal Processor (ISP)"

> > +	depends on VIDEO_V4L2 && OF

> > +	depends on ARCH_RENESAS || COMPILE_TEST

> > +	select MEDIA_CONTROLLER

> > +	select VIDEO_V4L2_SUBDEV_API

> > +	select RESET_CONTROLLER

> > +	select V4L2_FWNODE

> > +	help

> > +	  Support for Renesas R-Car Image Signal Processor (ISP).

> > +	  Enable this to support the Renesas R-Car Image Signal

> > +	  Processor (ISP).

> > +

> > +	  To compile this driver as a module, choose M here: the

> > +	  module will be called rcar-isp.

> > +

> >  endif # V4L_PLATFORM_DRIVERS

> >  

> >  menuconfig V4L_MEM2MEM_DRIVERS

> > diff --git a/drivers/media/platform/Makefile b/drivers/media/platform/Makefile

> > index eedc14aafb32c2fa..8ae543f6ef764c48 100644

> > --- a/drivers/media/platform/Makefile

> > +++ b/drivers/media/platform/Makefile

> > @@ -63,6 +63,7 @@ obj-$(CONFIG_VIDEO_AM437X_VPFE)		+= am437x/

> >  

> >  obj-$(CONFIG_VIDEO_XILINX)		+= xilinx/

> >  

> > +obj-$(CONFIG_VIDEO_RCAR_ISP)		+= rcar-isp.o

> >  obj-$(CONFIG_VIDEO_RCAR_VIN)		+= rcar-vin/

> >  

> >  obj-$(CONFIG_VIDEO_ATMEL_ISC)		+= atmel/

> > diff --git a/drivers/media/platform/rcar-isp.c b/drivers/media/platform/rcar-isp.c

> > new file mode 100644

> > index 0000000000000000..bf6a376354ece89d

> > --- /dev/null

> > +++ b/drivers/media/platform/rcar-isp.c

> > @@ -0,0 +1,500 @@

> > +// SPDX-License-Identifier: GPL-2.0

> > +/*

> > + * Driver for Renesas R-Car ISP Channel Selector

> > + *

> > + * Copyright (C) 2021 Renesas Electronics Corp.

> > + */

> > +

> > +#include <linux/module.h>

> > +#include <linux/mutex.h>

> > +#include <linux/of_device.h>

> > +#include <linux/platform_device.h>

> > +#include <linux/pm_runtime.h>

> > +#include <linux/reset.h>

> > +

> > +#include <media/v4l2-subdev.h>

> > +

> > +#define ISPINPUTSEL0_REG				0x0008

> > +#define ISPINPUTSEL0_SEL_CSI0				BIT(31)

> > +

> > +#define ISPSTART_REG					0x0014

> > +#define ISPSTART_START					0xffff

> > +#define ISPSTART_STOP					0x0000

> > +

> > +#define ISPPROCMODE_DT_REG(n)				(0x1100 + (0x4 * n))

> > +#define ISPPROCMODE_DT_PROC_MODE_VC3(pm)		(((pm) & 0x3f) << 24)

> > +#define ISPPROCMODE_DT_PROC_MODE_VC2(pm)		(((pm) & 0x3f) << 16)

> > +#define ISPPROCMODE_DT_PROC_MODE_VC1(pm)		(((pm) & 0x3f) << 8)

> > +#define ISPPROCMODE_DT_PROC_MODE_VC0(pm)		((pm) & 0x3f)

> > +

> > +#define ISPCS_FILTER_ID_CH_REG(n)			(0x3000 + (0x0100 * n))

> > +

> > +#define ISPCS_DT_CODE03_CH_REG(n)			(0x3008 + (0x100 * n))

> > +#define ISPCS_DT_CODE03_EN3				BIT(31)

> > +#define ISPCS_DT_CODE03_DT3(dt)				(((dt) & 0x3f) << 24)

> > +#define ISPCS_DT_CODE03_EN2				BIT(23)

> > +#define ISPCS_DT_CODE03_DT2(dt)				(((dt) & 0x3f) << 16)

> > +#define ISPCS_DT_CODE03_EN1				BIT(15)

> > +#define ISPCS_DT_CODE03_DT1(dt)				(((dt) & 0x3f) << 8)

> > +#define ISPCS_DT_CODE03_EN0				BIT(7)

> > +#define ISPCS_DT_CODE03_DT0(dt)				((dt) & 0x3f)

> > +

> > +struct rcar_isp_format {

> > +	u32 code;

> > +	unsigned int datatype;

> > +	unsigned int procmode;

> > +};

> > +

> > +static const struct rcar_isp_format rcar_isp_formats[] = {

> > +	{ .code = MEDIA_BUS_FMT_RGB888_1X24,	.datatype = 0x24, .procmode = 0x15 },

> > +	{ .code = MEDIA_BUS_FMT_Y10_1X10,	.datatype = 0x2b, .procmode = 0x10 },

> > +	{ .code = MEDIA_BUS_FMT_UYVY8_1X16,	.datatype = 0x1e, .procmode = 0x0c },

> > +	{ .code = MEDIA_BUS_FMT_YUYV8_1X16,	.datatype = 0x1e, .procmode = 0x0c },

> > +	{ .code = MEDIA_BUS_FMT_UYVY8_2X8,	.datatype = 0x1e, .procmode = 0x0c },

> > +	{ .code = MEDIA_BUS_FMT_YUYV10_2X10,	.datatype = 0x1e, .procmode = 0x0c },

> > +};

> > +

> > +static const struct rcar_isp_format *risp_code_to_fmt(unsigned int code)

> > +{

> > +	unsigned int i;

> > +

> > +	for (i = 0; i < ARRAY_SIZE(rcar_isp_formats); i++)

> > +		if (rcar_isp_formats[i].code == code)

> > +			return &rcar_isp_formats[i];

> > +

> > +	return NULL;

> > +}

> > +

> > +enum rcar_isp_input {

> > +	RISP_CSI_INPUT0,

> > +	RISP_CSI_INPUT1,

> > +};

> > +

> > +enum rcar_isp_pads {

> > +	RCAR_ISP_SINK,

> > +	RCAR_ISP_PORT0,

> > +	RCAR_ISP_PORT1,

> > +	RCAR_ISP_PORT2,

> > +	RCAR_ISP_PORT3,

> > +	RCAR_ISP_PORT4,

> > +	RCAR_ISP_PORT5,

> > +	RCAR_ISP_PORT6,

> > +	RCAR_ISP_PORT7,

> > +	RCAR_ISP_MAX_PAD,

> > +};

> > +

> > +struct rcar_isp {

> > +	struct device *dev;

> > +	void __iomem *base;

> > +	struct reset_control *rstc;

> > +

> > +	enum rcar_isp_input csi_input;

> > +

> > +	struct v4l2_subdev subdev;

> > +	struct media_pad pads[RCAR_ISP_MAX_PAD];

> > +

> > +	struct v4l2_async_notifier notifier;

> > +	struct v4l2_subdev *remote;

> > +	unsigned int remote_pad;

> > +

> > +	struct v4l2_mbus_framefmt mf;

> > +

> > +	struct mutex lock;

> > +	int stream_count;

> > +};

> > +

> > +static inline struct rcar_isp *sd_to_isp(struct v4l2_subdev *sd)

> > +{

> > +	return container_of(sd, struct rcar_isp, subdev);

> > +}

> > +

> > +static inline struct rcar_isp *notifier_to_isp(struct v4l2_async_notifier *n)

> > +{

> > +	return container_of(n, struct rcar_isp, notifier);

> > +}

> > +

> > +static void risp_write(struct rcar_isp *isp, u32 offset, u32 value)

> > +{

> > +	iowrite32(value, isp->base + offset);

> > +}

> > +

> > +static u32 risp_read(struct rcar_isp *isp, u32 offset)

> > +{

> > +	return ioread32(isp->base + offset);

> > +}

> > +

> > +static int risp_s_power(struct v4l2_subdev *sd, int on)

> > +{

> > +	struct rcar_isp *isp = sd_to_isp(sd);

> > +	int ret;

> > +

> > +	if (on) {

> > +		ret = pm_runtime_get_sync(isp->dev);

> > +		if (ret < 0)

> > +			return ret;

> > +

> > +		ret = reset_control_deassert(isp->rstc);

> > +		if (ret < 0)

> > +			return ret;

> > +	} else {

> > +		reset_control_assert(isp->rstc);

> > +		pm_runtime_put(isp->dev);

> > +	}

> > +

> > +	return 0;

> > +}

> > +

> > +static const struct v4l2_subdev_core_ops risp_core_ops = {

> > +	.s_power = risp_s_power,

> > +};

> > +

> > +static int risp_remote_code(struct rcar_isp *isp)

> > +{

> > +	struct v4l2_subdev_format fmt = {

> > +		.which = V4L2_SUBDEV_FORMAT_ACTIVE,

> > +	};

> > +

> > +	fmt.pad = isp->remote_pad;

> > +	if (v4l2_subdev_call(isp->remote, pad, get_fmt, NULL, &fmt))

> > +		return -EPIPE;

> > +

> > +	return fmt.format.code;

> > +}

> > +

> > +static int risp_start(struct rcar_isp *isp)

> > +{

> > +	const struct rcar_isp_format *format;

> > +	unsigned int vc;

> > +	u32 sel_csi = 0;

> > +

> > +	format = risp_code_to_fmt(risp_remote_code(isp));

> > +	if (!format) {

> > +		dev_err(isp->dev, "Unsupported bus format\n");

> > +		return -EINVAL;

> > +	}

> > +

> > +	/* Select CSI-2 input source. */

> > +	if (isp->csi_input == RISP_CSI_INPUT1)

> > +		sel_csi = ISPINPUTSEL0_SEL_CSI0;

> > +

> > +	risp_write(isp, ISPINPUTSEL0_REG,

> > +		   risp_read(isp, ISPINPUTSEL0_REG) | sel_csi);

> > +

> > +	/* Configure Channel Selector. */

> > +	for (vc = 0; vc < 4; vc++) {

> > +		u8 ch = vc + 4;

> > +		u8 dt = format->datatype;

> > +

> > +		risp_write(isp, ISPCS_FILTER_ID_CH_REG(ch), BIT(vc));

> > +		risp_write(isp, ISPCS_DT_CODE03_CH_REG(ch),

> > +			   ISPCS_DT_CODE03_EN3 | ISPCS_DT_CODE03_DT3(dt) |

> > +			   ISPCS_DT_CODE03_EN2 | ISPCS_DT_CODE03_DT2(dt) |

> > +			   ISPCS_DT_CODE03_EN1 | ISPCS_DT_CODE03_DT1(dt) |

> > +			   ISPCS_DT_CODE03_EN0 | ISPCS_DT_CODE03_DT0(dt));

> > +	}

> > +

> > +	/* Setup processing method. */

> > +	risp_write(isp, ISPPROCMODE_DT_REG(format->datatype),

> > +		   ISPPROCMODE_DT_PROC_MODE_VC3(format->procmode) |

> > +		   ISPPROCMODE_DT_PROC_MODE_VC2(format->procmode) |

> > +		   ISPPROCMODE_DT_PROC_MODE_VC1(format->procmode) |

> > +		   ISPPROCMODE_DT_PROC_MODE_VC0(format->procmode));

> > +

> > +	/* Start ISP. */

> > +	risp_write(isp, ISPSTART_REG, ISPSTART_START);

> > +

> > +	return v4l2_subdev_call(isp->remote, video, s_stream, 1);

> > +}

> > +

> > +static void risp_stop(struct rcar_isp *isp)

> > +{

> > +	v4l2_subdev_call(isp->remote, video, s_stream, 0);

> > +

> > +	/* Stop ISP. */

> > +	risp_write(isp, ISPSTART_REG, ISPSTART_STOP);

> > +}

> > +

> > +static int risp_s_stream(struct v4l2_subdev *sd, int enable)

> > +{

> > +	struct rcar_isp *isp = sd_to_isp(sd);

> > +	int ret = 0;

> > +

> > +	mutex_lock(&isp->lock);

> > +

> > +	if (!isp->remote) {

> > +		ret = -ENODEV;

> > +		goto out;

> > +	}

> > +

> > +	if (enable && isp->stream_count == 0) {

> > +		ret = risp_start(isp);

> > +		if (ret)

> > +			goto out;

> > +	} else if (!enable && isp->stream_count == 1) {

> > +		risp_stop(isp);

> > +	}

> > +

> > +	isp->stream_count += enable ? 1 : -1;

> > +out:

> > +	mutex_unlock(&isp->lock);https://qa-deploy.rd.cisco.com/gates/7/results/86270

> > +

> > +	return ret;

> > +}

> > +

> > +static const struct v4l2_subdev_video_ops risp_video_ops = {

> > +	.s_stream = risp_s_stream,

> > +};

> > +

> > +static int risp_set_pad_format(struct v4l2_subdev *sd,

> > +			       struct v4l2_subdev_pad_config *cfg,

> > +			       struct v4l2_subdev_format *format)

> 

> This prototype will change very soon (I hope) as soon as

> 

> https://patchwork.linuxtv.org/project/linux-media/cover/20210610145606.3468235-1-tomi.valkeinen@ideasonboard.com/

> 

> is merged (PR is outstanding).

> 

> Once that is merged, this patch will have to be rebased and a v3 posted.


Thanks for the heads-up, I will rebase and resend once it's merged.

> 

> > +{

> > +	struct rcar_isp *isp = sd_to_isp(sd);

> > +	struct v4l2_mbus_framefmt *framefmt;

> > +

> > +	if (!risp_code_to_fmt(format->format.code))

> > +		format->format.code = rcar_isp_formats[0].code;

> > +

> > +	if (format->which == V4L2_SUBDEV_FORMAT_ACTIVE) {

> > +		isp->mf = format->format;

> > +	} else {

> > +		framefmt = v4l2_subdev_get_try_format(sd, cfg, 0);

> > +		*framefmt = format->format;

> > +	}

> > +

> > +	return 0;

> > +}

> > +

> > +static int risp_get_pad_format(struct v4l2_subdev *sd,

> > +			       struct v4l2_subdev_pad_config *cfg,

> > +			       struct v4l2_subdev_format *format)

> > +{

> > +	struct rcar_isp *isp = sd_to_isp(sd);

> > +

> > +	if (format->which == V4L2_SUBDEV_FORMAT_ACTIVE)

> > +		format->format = isp->mf;

> > +	else

> > +		format->format = *v4l2_subdev_get_try_format(sd, cfg, 0);

> > +

> > +	return 0;

> > +}

> > +

> > +static const struct v4l2_subdev_pad_ops risp_pad_ops = {

> > +	.set_fmt = risp_set_pad_format,

> > +	.get_fmt = risp_get_pad_format,

> > +};

> > +

> > +static const struct v4l2_subdev_ops rcar_isp_subdev_ops = {

> > +	.core	= &risp_core_ops,

> > +	.video	= &risp_video_ops,

> > +	.pad	= &risp_pad_ops,

> > +};

> > +

> > +/* -----------------------------------------------------------------------------

> > + * Async handling and registration of subdevices and links

> > + */

> > +

> > +static int risp_notify_bound(struct v4l2_async_notifier *notifier,

> > +			     struct v4l2_subdev *subdev,

> > +			     struct v4l2_async_subdev *asd)

> > +{

> > +	struct rcar_isp *isp = notifier_to_isp(notifier);

> > +	int pad;

> > +

> > +	pad = media_entity_get_fwnode_pad(&subdev->entity, asd->match.fwnode,

> > +					  MEDIA_PAD_FL_SOURCE);

> > +	if (pad < 0) {

> > +		dev_err(isp->dev, "Failed to find pad for %s\n", subdev->name);

> > +		return pad;

> > +	}

> > +

> > +	isp->remote = subdev;

> > +	isp->remote_pad = pad;

> > +

> > +	dev_dbg(isp->dev, "Bound %s pad: %d\n", subdev->name, pad);

> > +

> > +	return media_create_pad_link(&subdev->entity, pad,

> > +				     &isp->subdev.entity, 0,

> > +				     MEDIA_LNK_FL_ENABLED |

> > +				     MEDIA_LNK_FL_IMMUTABLE);

> > +}

> > +

> > +static void risp_notify_unbind(struct v4l2_async_notifier *notifier,

> > +			       struct v4l2_subdev *subdev,

> > +			       struct v4l2_async_subdev *asd)

> > +{

> > +	struct rcar_isp *isp = notifier_to_isp(notifier);

> > +

> > +	isp->remote = NULL;

> > +

> > +	dev_dbg(isp->dev, "Unbind %s\n", subdev->name);

> > +}

> > +

> > +static const struct v4l2_async_notifier_operations risp_notify_ops = {

> > +	.bound = risp_notify_bound,

> > +	.unbind = risp_notify_unbind,

> > +};

> > +

> > +static int risp_parse_dt(struct rcar_isp *isp)

> > +{

> > +	struct v4l2_async_subdev *asd;

> > +	struct fwnode_handle *fwnode;

> > +	struct fwnode_handle *ep;

> > +	unsigned int id;

> > +	int ret;

> > +

> > +	for (id = 0; id < 2; id++) {

> > +		ep = fwnode_graph_get_endpoint_by_id(dev_fwnode(isp->dev),

> > +						     0, id, 0);

> > +		if (ep)

> > +			break;

> > +	}

> > +

> > +	if (!ep) {

> > +		dev_err(isp->dev, "Not connected to subdevice\n");

> > +		return -EINVAL;

> > +	}

> > +

> > +	if (id == 1)

> > +		isp->csi_input = RISP_CSI_INPUT1;

> > +

> > +	fwnode = fwnode_graph_get_remote_endpoint(ep);

> > +	fwnode_handle_put(ep);

> > +

> > +	dev_dbg(isp->dev, "Found '%pOF'\n", to_of_node(fwnode));

> > +

> > +	v4l2_async_notifier_init(&isp->notifier);

> > +	isp->notifier.ops = &risp_notify_ops;

> > +

> > +	asd = v4l2_async_notifier_add_fwnode_subdev(&isp->notifier, fwnode,

> > +						    struct v4l2_async_subdev);

> > +	fwnode_handle_put(fwnode);

> > +	if (IS_ERR(asd))

> > +		return PTR_ERR(asd);

> > +

> > +	ret = v4l2_async_subdev_notifier_register(&isp->subdev, &isp->notifier);

> > +	if (ret)

> > +		v4l2_async_notifier_cleanup(&isp->notifier);

> > +

> > +	return ret;

> > +}

> > +

> > +/* -----------------------------------------------------------------------------

> > + * Platform Device Driver

> > + */

> > +

> > +static const struct media_entity_operations risp_entity_ops = {

> > +	.link_validate = v4l2_subdev_link_validate,

> > +};

> > +

> > +static int risp_probe_resources(struct rcar_isp *isp,

> > +				struct platform_device *pdev)

> > +{

> > +	struct resource *res;

> > +

> > +	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);

> > +	isp->base = devm_ioremap_resource(&pdev->dev, res);

> > +	if (IS_ERR(isp->base))

> > +		return PTR_ERR(isp->base);

> > +

> > +	isp->rstc = devm_reset_control_get(&pdev->dev, NULL);

> > +

> > +	return PTR_ERR_OR_ZERO(isp->rstc);

> > +}

> > +

> > +static const struct of_device_id risp_of_id_table[] = {

> > +	{ .compatible = "renesas,r8a779a0-isp" },

> > +	{ /* sentinel */ },

> > +};

> > +MODULE_DEVICE_TABLE(of, risp_of_id_table);

> > +

> > +static int risp_probe(struct platform_device *pdev)

> > +{

> > +	struct rcar_isp *isp;

> > +	unsigned int i;

> > +	int ret;

> > +

> > +	isp = devm_kzalloc(&pdev->dev, sizeof(*isp), GFP_KERNEL);

> > +	if (!isp)

> > +		return -ENOMEM;

> > +

> > +	isp->dev = &pdev->dev;

> > +

> > +	mutex_init(&isp->lock);

> > +	isp->stream_count = 0;

> > +

> > +	ret = risp_probe_resources(isp, pdev);

> > +	if (ret) {

> > +		dev_err(isp->dev, "Failed to get resources\n");

> > +		return ret;

> > +	}

> > +

> > +	platform_set_drvdata(pdev, isp);

> > +

> > +	ret = risp_parse_dt(isp);

> > +	if (ret)

> > +		return ret;

> > +

> > +	isp->subdev.owner = THIS_MODULE;

> > +	isp->subdev.dev = &pdev->dev;

> > +	v4l2_subdev_init(&isp->subdev, &rcar_isp_subdev_ops);

> > +	v4l2_set_subdevdata(&isp->subdev, &pdev->dev);

> > +	snprintf(isp->subdev.name, V4L2_SUBDEV_NAME_SIZE, "%s %s",

> > +		 KBUILD_MODNAME, dev_name(&pdev->dev));

> > +	isp->subdev.flags = V4L2_SUBDEV_FL_HAS_DEVNODE;

> > +

> > +	isp->subdev.entity.function = MEDIA_ENT_F_PROC_VIDEO_PIXEL_FORMATTER;

> 

> Similar question to the one at the top: is this really a pixel formatter?

> 

> It really feels more like a routing device.


It can be a pixel formatter.

> 

> I wonder if this series isn't relevant for this driver:

> 

> https://patchwork.linuxtv.org/project/linux-media/cover/20210524104408.599645-1-tomi.valkeinen@ideasonboard.com/


Maybe, all the internal routes are static so there is no need to expose 
an API to modify the routing. But as any device that deals with 
multiplexed links it will benefit once Tomi's work is in in as the 
formats between all the devices in the media graph can be validated.

Given that the internal routing series have been on the list for years I 
rather not wait for it and I would prefers to as I add support for the 
new API once it's done. I will need to add support for the R-Car CSI-2 
receiver as well for this new API once its merged.

> 

> Regards,

> 

> 	Hans

> 

> > +	isp->subdev.entity.ops = &risp_entity_ops;

> > +

> > +	isp->pads[RCAR_ISP_SINK].flags = MEDIA_PAD_FL_SINK;

> > +	for (i = RCAR_ISP_PORT0; i < RCAR_ISP_MAX_PAD; i++)

> > +		isp->pads[i].flags = MEDIA_PAD_FL_SOURCE;

> > +

> > +	ret = media_entity_pads_init(&isp->subdev.entity, RCAR_ISP_MAX_PAD,

> > +				     isp->pads);

> > +	if (ret)

> > +		goto error;

> > +

> > +	pm_runtime_enable(&pdev->dev);

> > +

> > +	ret = v4l2_async_register_subdev(&isp->subdev);

> > +	if (ret < 0)

> > +		goto error;

> > +

> > +	dev_info(isp->dev, "Using CSI-2 input: %u\n", isp->csi_input);

> > +

> > +	return 0;

> > +error:

> > +	v4l2_async_notifier_unregister(&isp->notifier);

> > +	v4l2_async_notifier_cleanup(&isp->notifier);

> > +

> > +	return ret;

> > +}

> > +

> > +static int risp_remove(struct platform_device *pdev)

> > +{

> > +	struct rcar_isp *isp = platform_get_drvdata(pdev);

> > +

> > +	v4l2_async_notifier_unregister(&isp->notifier);

> > +	v4l2_async_notifier_cleanup(&isp->notifier);

> > +	v4l2_async_unregister_subdev(&isp->subdev);

> > +

> > +	pm_runtime_disable(&pdev->dev);

> > +

> > +	return 0;

> > +}

> > +

> > +static struct platform_driver rcar_isp_driver = {

> > +	.driver = {

> > +		.name = "rcar-isp",

> > +		.of_match_table = risp_of_id_table,

> > +	},

> > +	.probe = risp_probe,

> > +	.remove = risp_remove,

> > +};

> > +

> > +module_platform_driver(rcar_isp_driver);

> > +

> > +MODULE_AUTHOR("Niklas Söderlund <niklas.soderlund@ragnatech.se>");

> > +MODULE_DESCRIPTION("Renesas R-Car ISP Channel Selector driver");

> > +MODULE_LICENSE("GPL");

> > 

> 


-- 
Regards,
Niklas Söderlund
Hans Verkuil June 14, 2021, 1:12 p.m. UTC | #3
(Added CC to Tomi)

On 14/06/2021 14:50, Niklas Söderlund wrote:
> Hi Hans,

> 

> Thanks for your feedback.

> 

> On 2021-06-14 14:29:32 +0200, Hans Verkuil wrote:

>> On 12/05/2021 10:19, Niklas Söderlund wrote:

>>> Add a V4L2 driver for Renesas R-Car Image Signal Processor. The driver

>>> supports the R-Car V3U SoC where the ISP IP sits between the R-Car CSI-2

>>> receiver and VIN and filters the CSI-2 data based on VC/DT and directs

>>> the video stream to different VIN IPs.

>>

>> Is ISP the right name for this? Based on the description above, it is not

>> really what I would consider an ISP.

> 

> Yes this models an ISP so the name is correct. But your observation is 

> correct it does not (yet) expose any real ISP functionality. I only have 

> documentation for the features exposed in this patch and unfortunately 

> the ISP is needed on some SoCs to enable video capture. Maybe in the 

> future more features can be added.


This needs to be documented in the driver, since right now this is not at all
clear. Perhaps list some/all of the features that the HW can do, then say
what it currently supports (very little :-) ).

Regards,

	Hans

> 

>>

>>>

>>> Signed-off-by: Niklas Söderlund <niklas.soderlund+renesas@ragnatech.se>

>>> ---

>>>  MAINTAINERS                       |   1 +

>>>  drivers/media/platform/Kconfig    |  16 +

>>>  drivers/media/platform/Makefile   |   1 +

>>>  drivers/media/platform/rcar-isp.c | 500 ++++++++++++++++++++++++++++++

>>>  4 files changed, 518 insertions(+)

>>>  create mode 100644 drivers/media/platform/rcar-isp.c

>>>

>>> diff --git a/MAINTAINERS b/MAINTAINERS

>>> index c35a9c93da84f4f7..03f3d52e03596f66 100644

>>> --- a/MAINTAINERS

>>> +++ b/MAINTAINERS

>>> @@ -11400,6 +11400,7 @@ T:	git git://linuxtv.org/media_tree.git

>>>  F:	Documentation/devicetree/bindings/media/renesas,csi2.yaml

>>>  F:	Documentation/devicetree/bindings/media/renesas,isp.yaml

>>>  F:	Documentation/devicetree/bindings/media/renesas,vin.yaml

>>> +F:	drivers/media/platform/rcar-isp.c

>>>  F:	drivers/media/platform/rcar-vin/

>>>  

>>>  MEDIA DRIVERS FOR RENESAS - VSP1

>>> diff --git a/drivers/media/platform/Kconfig b/drivers/media/platform/Kconfig

>>> index 157c924686e4b61b..a8777d5dd6bc3ec1 100644

>>> --- a/drivers/media/platform/Kconfig

>>> +++ b/drivers/media/platform/Kconfig

>>> @@ -200,6 +200,22 @@ config VIDEO_TI_CAL_MC

>>>  

>>>  endif # VIDEO_TI_CAL

>>>  

>>> +config VIDEO_RCAR_ISP

>>> +	tristate "R-Car Image Signal Processor (ISP)"

>>> +	depends on VIDEO_V4L2 && OF

>>> +	depends on ARCH_RENESAS || COMPILE_TEST

>>> +	select MEDIA_CONTROLLER

>>> +	select VIDEO_V4L2_SUBDEV_API

>>> +	select RESET_CONTROLLER

>>> +	select V4L2_FWNODE

>>> +	help

>>> +	  Support for Renesas R-Car Image Signal Processor (ISP).

>>> +	  Enable this to support the Renesas R-Car Image Signal

>>> +	  Processor (ISP).

>>> +

>>> +	  To compile this driver as a module, choose M here: the

>>> +	  module will be called rcar-isp.

>>> +

>>>  endif # V4L_PLATFORM_DRIVERS

>>>  

>>>  menuconfig V4L_MEM2MEM_DRIVERS

>>> diff --git a/drivers/media/platform/Makefile b/drivers/media/platform/Makefile

>>> index eedc14aafb32c2fa..8ae543f6ef764c48 100644

>>> --- a/drivers/media/platform/Makefile

>>> +++ b/drivers/media/platform/Makefile

>>> @@ -63,6 +63,7 @@ obj-$(CONFIG_VIDEO_AM437X_VPFE)		+= am437x/

>>>  

>>>  obj-$(CONFIG_VIDEO_XILINX)		+= xilinx/

>>>  

>>> +obj-$(CONFIG_VIDEO_RCAR_ISP)		+= rcar-isp.o

>>>  obj-$(CONFIG_VIDEO_RCAR_VIN)		+= rcar-vin/

>>>  

>>>  obj-$(CONFIG_VIDEO_ATMEL_ISC)		+= atmel/

>>> diff --git a/drivers/media/platform/rcar-isp.c b/drivers/media/platform/rcar-isp.c

>>> new file mode 100644

>>> index 0000000000000000..bf6a376354ece89d

>>> --- /dev/null

>>> +++ b/drivers/media/platform/rcar-isp.c

>>> @@ -0,0 +1,500 @@

>>> +// SPDX-License-Identifier: GPL-2.0

>>> +/*

>>> + * Driver for Renesas R-Car ISP Channel Selector

>>> + *

>>> + * Copyright (C) 2021 Renesas Electronics Corp.

>>> + */

>>> +

>>> +#include <linux/module.h>

>>> +#include <linux/mutex.h>

>>> +#include <linux/of_device.h>

>>> +#include <linux/platform_device.h>

>>> +#include <linux/pm_runtime.h>

>>> +#include <linux/reset.h>

>>> +

>>> +#include <media/v4l2-subdev.h>

>>> +

>>> +#define ISPINPUTSEL0_REG				0x0008

>>> +#define ISPINPUTSEL0_SEL_CSI0				BIT(31)

>>> +

>>> +#define ISPSTART_REG					0x0014

>>> +#define ISPSTART_START					0xffff

>>> +#define ISPSTART_STOP					0x0000

>>> +

>>> +#define ISPPROCMODE_DT_REG(n)				(0x1100 + (0x4 * n))

>>> +#define ISPPROCMODE_DT_PROC_MODE_VC3(pm)		(((pm) & 0x3f) << 24)

>>> +#define ISPPROCMODE_DT_PROC_MODE_VC2(pm)		(((pm) & 0x3f) << 16)

>>> +#define ISPPROCMODE_DT_PROC_MODE_VC1(pm)		(((pm) & 0x3f) << 8)

>>> +#define ISPPROCMODE_DT_PROC_MODE_VC0(pm)		((pm) & 0x3f)

>>> +

>>> +#define ISPCS_FILTER_ID_CH_REG(n)			(0x3000 + (0x0100 * n))

>>> +

>>> +#define ISPCS_DT_CODE03_CH_REG(n)			(0x3008 + (0x100 * n))

>>> +#define ISPCS_DT_CODE03_EN3				BIT(31)

>>> +#define ISPCS_DT_CODE03_DT3(dt)				(((dt) & 0x3f) << 24)

>>> +#define ISPCS_DT_CODE03_EN2				BIT(23)

>>> +#define ISPCS_DT_CODE03_DT2(dt)				(((dt) & 0x3f) << 16)

>>> +#define ISPCS_DT_CODE03_EN1				BIT(15)

>>> +#define ISPCS_DT_CODE03_DT1(dt)				(((dt) & 0x3f) << 8)

>>> +#define ISPCS_DT_CODE03_EN0				BIT(7)

>>> +#define ISPCS_DT_CODE03_DT0(dt)				((dt) & 0x3f)

>>> +

>>> +struct rcar_isp_format {

>>> +	u32 code;

>>> +	unsigned int datatype;

>>> +	unsigned int procmode;

>>> +};

>>> +

>>> +static const struct rcar_isp_format rcar_isp_formats[] = {

>>> +	{ .code = MEDIA_BUS_FMT_RGB888_1X24,	.datatype = 0x24, .procmode = 0x15 },

>>> +	{ .code = MEDIA_BUS_FMT_Y10_1X10,	.datatype = 0x2b, .procmode = 0x10 },

>>> +	{ .code = MEDIA_BUS_FMT_UYVY8_1X16,	.datatype = 0x1e, .procmode = 0x0c },

>>> +	{ .code = MEDIA_BUS_FMT_YUYV8_1X16,	.datatype = 0x1e, .procmode = 0x0c },

>>> +	{ .code = MEDIA_BUS_FMT_UYVY8_2X8,	.datatype = 0x1e, .procmode = 0x0c },

>>> +	{ .code = MEDIA_BUS_FMT_YUYV10_2X10,	.datatype = 0x1e, .procmode = 0x0c },

>>> +};

>>> +

>>> +static const struct rcar_isp_format *risp_code_to_fmt(unsigned int code)

>>> +{

>>> +	unsigned int i;

>>> +

>>> +	for (i = 0; i < ARRAY_SIZE(rcar_isp_formats); i++)

>>> +		if (rcar_isp_formats[i].code == code)

>>> +			return &rcar_isp_formats[i];

>>> +

>>> +	return NULL;

>>> +}

>>> +

>>> +enum rcar_isp_input {

>>> +	RISP_CSI_INPUT0,

>>> +	RISP_CSI_INPUT1,

>>> +};

>>> +

>>> +enum rcar_isp_pads {

>>> +	RCAR_ISP_SINK,

>>> +	RCAR_ISP_PORT0,

>>> +	RCAR_ISP_PORT1,

>>> +	RCAR_ISP_PORT2,

>>> +	RCAR_ISP_PORT3,

>>> +	RCAR_ISP_PORT4,

>>> +	RCAR_ISP_PORT5,

>>> +	RCAR_ISP_PORT6,

>>> +	RCAR_ISP_PORT7,

>>> +	RCAR_ISP_MAX_PAD,

>>> +};

>>> +

>>> +struct rcar_isp {

>>> +	struct device *dev;

>>> +	void __iomem *base;

>>> +	struct reset_control *rstc;

>>> +

>>> +	enum rcar_isp_input csi_input;

>>> +

>>> +	struct v4l2_subdev subdev;

>>> +	struct media_pad pads[RCAR_ISP_MAX_PAD];

>>> +

>>> +	struct v4l2_async_notifier notifier;

>>> +	struct v4l2_subdev *remote;

>>> +	unsigned int remote_pad;

>>> +

>>> +	struct v4l2_mbus_framefmt mf;

>>> +

>>> +	struct mutex lock;

>>> +	int stream_count;

>>> +};

>>> +

>>> +static inline struct rcar_isp *sd_to_isp(struct v4l2_subdev *sd)

>>> +{

>>> +	return container_of(sd, struct rcar_isp, subdev);

>>> +}

>>> +

>>> +static inline struct rcar_isp *notifier_to_isp(struct v4l2_async_notifier *n)

>>> +{

>>> +	return container_of(n, struct rcar_isp, notifier);

>>> +}

>>> +

>>> +static void risp_write(struct rcar_isp *isp, u32 offset, u32 value)

>>> +{

>>> +	iowrite32(value, isp->base + offset);

>>> +}

>>> +

>>> +static u32 risp_read(struct rcar_isp *isp, u32 offset)

>>> +{

>>> +	return ioread32(isp->base + offset);

>>> +}

>>> +

>>> +static int risp_s_power(struct v4l2_subdev *sd, int on)

>>> +{

>>> +	struct rcar_isp *isp = sd_to_isp(sd);

>>> +	int ret;

>>> +

>>> +	if (on) {

>>> +		ret = pm_runtime_get_sync(isp->dev);

>>> +		if (ret < 0)

>>> +			return ret;

>>> +

>>> +		ret = reset_control_deassert(isp->rstc);

>>> +		if (ret < 0)

>>> +			return ret;

>>> +	} else {

>>> +		reset_control_assert(isp->rstc);

>>> +		pm_runtime_put(isp->dev);

>>> +	}

>>> +

>>> +	return 0;

>>> +}

>>> +

>>> +static const struct v4l2_subdev_core_ops risp_core_ops = {

>>> +	.s_power = risp_s_power,

>>> +};

>>> +

>>> +static int risp_remote_code(struct rcar_isp *isp)

>>> +{

>>> +	struct v4l2_subdev_format fmt = {

>>> +		.which = V4L2_SUBDEV_FORMAT_ACTIVE,

>>> +	};

>>> +

>>> +	fmt.pad = isp->remote_pad;

>>> +	if (v4l2_subdev_call(isp->remote, pad, get_fmt, NULL, &fmt))

>>> +		return -EPIPE;

>>> +

>>> +	return fmt.format.code;

>>> +}

>>> +

>>> +static int risp_start(struct rcar_isp *isp)

>>> +{

>>> +	const struct rcar_isp_format *format;

>>> +	unsigned int vc;

>>> +	u32 sel_csi = 0;

>>> +

>>> +	format = risp_code_to_fmt(risp_remote_code(isp));

>>> +	if (!format) {

>>> +		dev_err(isp->dev, "Unsupported bus format\n");

>>> +		return -EINVAL;

>>> +	}

>>> +

>>> +	/* Select CSI-2 input source. */

>>> +	if (isp->csi_input == RISP_CSI_INPUT1)

>>> +		sel_csi = ISPINPUTSEL0_SEL_CSI0;

>>> +

>>> +	risp_write(isp, ISPINPUTSEL0_REG,

>>> +		   risp_read(isp, ISPINPUTSEL0_REG) | sel_csi);

>>> +

>>> +	/* Configure Channel Selector. */

>>> +	for (vc = 0; vc < 4; vc++) {

>>> +		u8 ch = vc + 4;

>>> +		u8 dt = format->datatype;

>>> +

>>> +		risp_write(isp, ISPCS_FILTER_ID_CH_REG(ch), BIT(vc));

>>> +		risp_write(isp, ISPCS_DT_CODE03_CH_REG(ch),

>>> +			   ISPCS_DT_CODE03_EN3 | ISPCS_DT_CODE03_DT3(dt) |

>>> +			   ISPCS_DT_CODE03_EN2 | ISPCS_DT_CODE03_DT2(dt) |

>>> +			   ISPCS_DT_CODE03_EN1 | ISPCS_DT_CODE03_DT1(dt) |

>>> +			   ISPCS_DT_CODE03_EN0 | ISPCS_DT_CODE03_DT0(dt));

>>> +	}

>>> +

>>> +	/* Setup processing method. */

>>> +	risp_write(isp, ISPPROCMODE_DT_REG(format->datatype),

>>> +		   ISPPROCMODE_DT_PROC_MODE_VC3(format->procmode) |

>>> +		   ISPPROCMODE_DT_PROC_MODE_VC2(format->procmode) |

>>> +		   ISPPROCMODE_DT_PROC_MODE_VC1(format->procmode) |

>>> +		   ISPPROCMODE_DT_PROC_MODE_VC0(format->procmode));

>>> +

>>> +	/* Start ISP. */

>>> +	risp_write(isp, ISPSTART_REG, ISPSTART_START);

>>> +

>>> +	return v4l2_subdev_call(isp->remote, video, s_stream, 1);

>>> +}

>>> +

>>> +static void risp_stop(struct rcar_isp *isp)

>>> +{

>>> +	v4l2_subdev_call(isp->remote, video, s_stream, 0);

>>> +

>>> +	/* Stop ISP. */

>>> +	risp_write(isp, ISPSTART_REG, ISPSTART_STOP);

>>> +}

>>> +

>>> +static int risp_s_stream(struct v4l2_subdev *sd, int enable)

>>> +{

>>> +	struct rcar_isp *isp = sd_to_isp(sd);

>>> +	int ret = 0;

>>> +

>>> +	mutex_lock(&isp->lock);

>>> +

>>> +	if (!isp->remote) {

>>> +		ret = -ENODEV;

>>> +		goto out;

>>> +	}

>>> +

>>> +	if (enable && isp->stream_count == 0) {

>>> +		ret = risp_start(isp);

>>> +		if (ret)

>>> +			goto out;

>>> +	} else if (!enable && isp->stream_count == 1) {

>>> +		risp_stop(isp);

>>> +	}

>>> +

>>> +	isp->stream_count += enable ? 1 : -1;

>>> +out:

>>> +	mutex_unlock(&isp->lock);https://qa-deploy.rd.cisco.com/gates/7/results/86270

>>> +

>>> +	return ret;

>>> +}

>>> +

>>> +static const struct v4l2_subdev_video_ops risp_video_ops = {

>>> +	.s_stream = risp_s_stream,

>>> +};

>>> +

>>> +static int risp_set_pad_format(struct v4l2_subdev *sd,

>>> +			       struct v4l2_subdev_pad_config *cfg,

>>> +			       struct v4l2_subdev_format *format)

>>

>> This prototype will change very soon (I hope) as soon as

>>

>> https://patchwork.linuxtv.org/project/linux-media/cover/20210610145606.3468235-1-tomi.valkeinen@ideasonboard.com/

>>

>> is merged (PR is outstanding).

>>

>> Once that is merged, this patch will have to be rebased and a v3 posted.

> 

> Thanks for the heads-up, I will rebase and resend once it's merged.

> 

>>

>>> +{

>>> +	struct rcar_isp *isp = sd_to_isp(sd);

>>> +	struct v4l2_mbus_framefmt *framefmt;

>>> +

>>> +	if (!risp_code_to_fmt(format->format.code))

>>> +		format->format.code = rcar_isp_formats[0].code;

>>> +

>>> +	if (format->which == V4L2_SUBDEV_FORMAT_ACTIVE) {

>>> +		isp->mf = format->format;

>>> +	} else {

>>> +		framefmt = v4l2_subdev_get_try_format(sd, cfg, 0);

>>> +		*framefmt = format->format;

>>> +	}

>>> +

>>> +	return 0;

>>> +}

>>> +

>>> +static int risp_get_pad_format(struct v4l2_subdev *sd,

>>> +			       struct v4l2_subdev_pad_config *cfg,

>>> +			       struct v4l2_subdev_format *format)

>>> +{

>>> +	struct rcar_isp *isp = sd_to_isp(sd);

>>> +

>>> +	if (format->which == V4L2_SUBDEV_FORMAT_ACTIVE)

>>> +		format->format = isp->mf;

>>> +	else

>>> +		format->format = *v4l2_subdev_get_try_format(sd, cfg, 0);

>>> +

>>> +	return 0;

>>> +}

>>> +

>>> +static const struct v4l2_subdev_pad_ops risp_pad_ops = {

>>> +	.set_fmt = risp_set_pad_format,

>>> +	.get_fmt = risp_get_pad_format,

>>> +};

>>> +

>>> +static const struct v4l2_subdev_ops rcar_isp_subdev_ops = {

>>> +	.core	= &risp_core_ops,

>>> +	.video	= &risp_video_ops,

>>> +	.pad	= &risp_pad_ops,

>>> +};

>>> +

>>> +/* -----------------------------------------------------------------------------

>>> + * Async handling and registration of subdevices and links

>>> + */

>>> +

>>> +static int risp_notify_bound(struct v4l2_async_notifier *notifier,

>>> +			     struct v4l2_subdev *subdev,

>>> +			     struct v4l2_async_subdev *asd)

>>> +{

>>> +	struct rcar_isp *isp = notifier_to_isp(notifier);

>>> +	int pad;

>>> +

>>> +	pad = media_entity_get_fwnode_pad(&subdev->entity, asd->match.fwnode,

>>> +					  MEDIA_PAD_FL_SOURCE);

>>> +	if (pad < 0) {

>>> +		dev_err(isp->dev, "Failed to find pad for %s\n", subdev->name);

>>> +		return pad;

>>> +	}

>>> +

>>> +	isp->remote = subdev;

>>> +	isp->remote_pad = pad;

>>> +

>>> +	dev_dbg(isp->dev, "Bound %s pad: %d\n", subdev->name, pad);

>>> +

>>> +	return media_create_pad_link(&subdev->entity, pad,

>>> +				     &isp->subdev.entity, 0,

>>> +				     MEDIA_LNK_FL_ENABLED |

>>> +				     MEDIA_LNK_FL_IMMUTABLE);

>>> +}

>>> +

>>> +static void risp_notify_unbind(struct v4l2_async_notifier *notifier,

>>> +			       struct v4l2_subdev *subdev,

>>> +			       struct v4l2_async_subdev *asd)

>>> +{

>>> +	struct rcar_isp *isp = notifier_to_isp(notifier);

>>> +

>>> +	isp->remote = NULL;

>>> +

>>> +	dev_dbg(isp->dev, "Unbind %s\n", subdev->name);

>>> +}

>>> +

>>> +static const struct v4l2_async_notifier_operations risp_notify_ops = {

>>> +	.bound = risp_notify_bound,

>>> +	.unbind = risp_notify_unbind,

>>> +};

>>> +

>>> +static int risp_parse_dt(struct rcar_isp *isp)

>>> +{

>>> +	struct v4l2_async_subdev *asd;

>>> +	struct fwnode_handle *fwnode;

>>> +	struct fwnode_handle *ep;

>>> +	unsigned int id;

>>> +	int ret;

>>> +

>>> +	for (id = 0; id < 2; id++) {

>>> +		ep = fwnode_graph_get_endpoint_by_id(dev_fwnode(isp->dev),

>>> +						     0, id, 0);

>>> +		if (ep)

>>> +			break;

>>> +	}

>>> +

>>> +	if (!ep) {

>>> +		dev_err(isp->dev, "Not connected to subdevice\n");

>>> +		return -EINVAL;

>>> +	}

>>> +

>>> +	if (id == 1)

>>> +		isp->csi_input = RISP_CSI_INPUT1;

>>> +

>>> +	fwnode = fwnode_graph_get_remote_endpoint(ep);

>>> +	fwnode_handle_put(ep);

>>> +

>>> +	dev_dbg(isp->dev, "Found '%pOF'\n", to_of_node(fwnode));

>>> +

>>> +	v4l2_async_notifier_init(&isp->notifier);

>>> +	isp->notifier.ops = &risp_notify_ops;

>>> +

>>> +	asd = v4l2_async_notifier_add_fwnode_subdev(&isp->notifier, fwnode,

>>> +						    struct v4l2_async_subdev);

>>> +	fwnode_handle_put(fwnode);

>>> +	if (IS_ERR(asd))

>>> +		return PTR_ERR(asd);

>>> +

>>> +	ret = v4l2_async_subdev_notifier_register(&isp->subdev, &isp->notifier);

>>> +	if (ret)

>>> +		v4l2_async_notifier_cleanup(&isp->notifier);

>>> +

>>> +	return ret;

>>> +}

>>> +

>>> +/* -----------------------------------------------------------------------------

>>> + * Platform Device Driver

>>> + */

>>> +

>>> +static const struct media_entity_operations risp_entity_ops = {

>>> +	.link_validate = v4l2_subdev_link_validate,

>>> +};

>>> +

>>> +static int risp_probe_resources(struct rcar_isp *isp,

>>> +				struct platform_device *pdev)

>>> +{

>>> +	struct resource *res;

>>> +

>>> +	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);

>>> +	isp->base = devm_ioremap_resource(&pdev->dev, res);

>>> +	if (IS_ERR(isp->base))

>>> +		return PTR_ERR(isp->base);

>>> +

>>> +	isp->rstc = devm_reset_control_get(&pdev->dev, NULL);

>>> +

>>> +	return PTR_ERR_OR_ZERO(isp->rstc);

>>> +}

>>> +

>>> +static const struct of_device_id risp_of_id_table[] = {

>>> +	{ .compatible = "renesas,r8a779a0-isp" },

>>> +	{ /* sentinel */ },

>>> +};

>>> +MODULE_DEVICE_TABLE(of, risp_of_id_table);

>>> +

>>> +static int risp_probe(struct platform_device *pdev)

>>> +{

>>> +	struct rcar_isp *isp;

>>> +	unsigned int i;

>>> +	int ret;

>>> +

>>> +	isp = devm_kzalloc(&pdev->dev, sizeof(*isp), GFP_KERNEL);

>>> +	if (!isp)

>>> +		return -ENOMEM;

>>> +

>>> +	isp->dev = &pdev->dev;

>>> +

>>> +	mutex_init(&isp->lock);

>>> +	isp->stream_count = 0;

>>> +

>>> +	ret = risp_probe_resources(isp, pdev);

>>> +	if (ret) {

>>> +		dev_err(isp->dev, "Failed to get resources\n");

>>> +		return ret;

>>> +	}

>>> +

>>> +	platform_set_drvdata(pdev, isp);

>>> +

>>> +	ret = risp_parse_dt(isp);

>>> +	if (ret)

>>> +		return ret;

>>> +

>>> +	isp->subdev.owner = THIS_MODULE;

>>> +	isp->subdev.dev = &pdev->dev;

>>> +	v4l2_subdev_init(&isp->subdev, &rcar_isp_subdev_ops);

>>> +	v4l2_set_subdevdata(&isp->subdev, &pdev->dev);

>>> +	snprintf(isp->subdev.name, V4L2_SUBDEV_NAME_SIZE, "%s %s",

>>> +		 KBUILD_MODNAME, dev_name(&pdev->dev));

>>> +	isp->subdev.flags = V4L2_SUBDEV_FL_HAS_DEVNODE;

>>> +

>>> +	isp->subdev.entity.function = MEDIA_ENT_F_PROC_VIDEO_PIXEL_FORMATTER;

>>

>> Similar question to the one at the top: is this really a pixel formatter?

>>

>> It really feels more like a routing device.

> 

> It can be a pixel formatter.

> 

>>

>> I wonder if this series isn't relevant for this driver:

>>

>> https://patchwork.linuxtv.org/project/linux-media/cover/20210524104408.599645-1-tomi.valkeinen@ideasonboard.com/

> 

> Maybe, all the internal routes are static so there is no need to expose 

> an API to modify the routing. But as any device that deals with 

> multiplexed links it will benefit once Tomi's work is in in as the 

> formats between all the devices in the media graph can be validated.

> 

> Given that the internal routing series have been on the list for years I 

> rather not wait for it and I would prefers to as I add support for the 

> new API once it's done. I will need to add support for the R-Car CSI-2 

> receiver as well for this new API once its merged.

> 

>>

>> Regards,

>>

>> 	Hans

>>

>>> +	isp->subdev.entity.ops = &risp_entity_ops;

>>> +

>>> +	isp->pads[RCAR_ISP_SINK].flags = MEDIA_PAD_FL_SINK;

>>> +	for (i = RCAR_ISP_PORT0; i < RCAR_ISP_MAX_PAD; i++)

>>> +		isp->pads[i].flags = MEDIA_PAD_FL_SOURCE;

>>> +

>>> +	ret = media_entity_pads_init(&isp->subdev.entity, RCAR_ISP_MAX_PAD,

>>> +				     isp->pads);

>>> +	if (ret)

>>> +		goto error;

>>> +

>>> +	pm_runtime_enable(&pdev->dev);

>>> +

>>> +	ret = v4l2_async_register_subdev(&isp->subdev);

>>> +	if (ret < 0)

>>> +		goto error;

>>> +

>>> +	dev_info(isp->dev, "Using CSI-2 input: %u\n", isp->csi_input);

>>> +

>>> +	return 0;

>>> +error:

>>> +	v4l2_async_notifier_unregister(&isp->notifier);

>>> +	v4l2_async_notifier_cleanup(&isp->notifier);

>>> +

>>> +	return ret;

>>> +}

>>> +

>>> +static int risp_remove(struct platform_device *pdev)

>>> +{

>>> +	struct rcar_isp *isp = platform_get_drvdata(pdev);

>>> +

>>> +	v4l2_async_notifier_unregister(&isp->notifier);

>>> +	v4l2_async_notifier_cleanup(&isp->notifier);

>>> +	v4l2_async_unregister_subdev(&isp->subdev);

>>> +

>>> +	pm_runtime_disable(&pdev->dev);

>>> +

>>> +	return 0;

>>> +}

>>> +

>>> +static struct platform_driver rcar_isp_driver = {

>>> +	.driver = {

>>> +		.name = "rcar-isp",

>>> +		.of_match_table = risp_of_id_table,

>>> +	},

>>> +	.probe = risp_probe,

>>> +	.remove = risp_remove,

>>> +};

>>> +

>>> +module_platform_driver(rcar_isp_driver);

>>> +

>>> +MODULE_AUTHOR("Niklas Söderlund <niklas.soderlund@ragnatech.se>");

>>> +MODULE_DESCRIPTION("Renesas R-Car ISP Channel Selector driver");

>>> +MODULE_LICENSE("GPL");

>>>

>>

>
Jacopo Mondi June 16, 2021, 3:12 p.m. UTC | #4
Hi Niklas,

On Wed, May 12, 2021 at 10:19:12AM +0200, Niklas Söderlund wrote:
> Add a V4L2 driver for Renesas R-Car Image Signal Processor. The driver

> supports the R-Car V3U SoC where the ISP IP sits between the R-Car CSI-2

> receiver and VIN and filters the CSI-2 data based on VC/DT and directs

> the video stream to different VIN IPs.

>

> Signed-off-by: Niklas Söderlund <niklas.soderlund+renesas@ragnatech.se>

> ---

>  MAINTAINERS                       |   1 +

>  drivers/media/platform/Kconfig    |  16 +

>  drivers/media/platform/Makefile   |   1 +

>  drivers/media/platform/rcar-isp.c | 500 ++++++++++++++++++++++++++++++


Have you considered adding the driver to platform/rcar-vin where the
VIN/CSI-2 drivers live already ?

>  4 files changed, 518 insertions(+)

>  create mode 100644 drivers/media/platform/rcar-isp.c

>

> diff --git a/MAINTAINERS b/MAINTAINERS

> index c35a9c93da84f4f7..03f3d52e03596f66 100644

> --- a/MAINTAINERS

> +++ b/MAINTAINERS

> @@ -11400,6 +11400,7 @@ T:	git git://linuxtv.org/media_tree.git

>  F:	Documentation/devicetree/bindings/media/renesas,csi2.yaml

>  F:	Documentation/devicetree/bindings/media/renesas,isp.yaml

>  F:	Documentation/devicetree/bindings/media/renesas,vin.yaml

> +F:	drivers/media/platform/rcar-isp.c

>  F:	drivers/media/platform/rcar-vin/

>

>  MEDIA DRIVERS FOR RENESAS - VSP1

> diff --git a/drivers/media/platform/Kconfig b/drivers/media/platform/Kconfig

> index 157c924686e4b61b..a8777d5dd6bc3ec1 100644

> --- a/drivers/media/platform/Kconfig

> +++ b/drivers/media/platform/Kconfig

> @@ -200,6 +200,22 @@ config VIDEO_TI_CAL_MC

>

>  endif # VIDEO_TI_CAL

>

> +config VIDEO_RCAR_ISP

> +	tristate "R-Car Image Signal Processor (ISP)"

> +	depends on VIDEO_V4L2 && OF

> +	depends on ARCH_RENESAS || COMPILE_TEST

> +	select MEDIA_CONTROLLER

> +	select VIDEO_V4L2_SUBDEV_API

> +	select RESET_CONTROLLER

> +	select V4L2_FWNODE

> +	help

> +	  Support for Renesas R-Car Image Signal Processor (ISP).

> +	  Enable this to support the Renesas R-Car Image Signal

> +	  Processor (ISP).

> +

> +	  To compile this driver as a module, choose M here: the

> +	  module will be called rcar-isp.

> +

>  endif # V4L_PLATFORM_DRIVERS

>

>  menuconfig V4L_MEM2MEM_DRIVERS

> diff --git a/drivers/media/platform/Makefile b/drivers/media/platform/Makefile

> index eedc14aafb32c2fa..8ae543f6ef764c48 100644

> --- a/drivers/media/platform/Makefile

> +++ b/drivers/media/platform/Makefile

> @@ -63,6 +63,7 @@ obj-$(CONFIG_VIDEO_AM437X_VPFE)		+= am437x/

>

>  obj-$(CONFIG_VIDEO_XILINX)		+= xilinx/

>

> +obj-$(CONFIG_VIDEO_RCAR_ISP)		+= rcar-isp.o

>  obj-$(CONFIG_VIDEO_RCAR_VIN)		+= rcar-vin/

>

>  obj-$(CONFIG_VIDEO_ATMEL_ISC)		+= atmel/

> diff --git a/drivers/media/platform/rcar-isp.c b/drivers/media/platform/rcar-isp.c

> new file mode 100644

> index 0000000000000000..bf6a376354ece89d

> --- /dev/null

> +++ b/drivers/media/platform/rcar-isp.c

> @@ -0,0 +1,500 @@

> +// SPDX-License-Identifier: GPL-2.0

> +/*

> + * Driver for Renesas R-Car ISP Channel Selector

> + *

> + * Copyright (C) 2021 Renesas Electronics Corp.

> + */

> +

> +#include <linux/module.h>

> +#include <linux/mutex.h>

> +#include <linux/of_device.h>

> +#include <linux/platform_device.h>

> +#include <linux/pm_runtime.h>

> +#include <linux/reset.h>

> +

> +#include <media/v4l2-subdev.h>

> +

> +#define ISPINPUTSEL0_REG				0x0008

> +#define ISPINPUTSEL0_SEL_CSI0				BIT(31)

> +

> +#define ISPSTART_REG					0x0014

> +#define ISPSTART_START					0xffff

> +#define ISPSTART_STOP					0x0000

> +

> +#define ISPPROCMODE_DT_REG(n)			(0x1100 + (0x4 * n))

> +#define ISPPROCMODE_DT_PROC_MODE_VC3(pm)		(((pm) & 0x3f) << 24)

> +#define ISPPROCMODE_DT_PROC_MODE_VC2(pm)		(((pm) & 0x3f) << 16)

> +#define ISPPROCMODE_DT_PROC_MODE_VC1(pm)		(((pm) & 0x3f) << 8)

> +#define ISPPROCMODE_DT_PROC_MODE_VC0(pm)		((pm) & 0x3f)

> +

> +#define ISPCS_FILTER_ID_CH_REG(n)			(0x3000 + (0x0100 * n))

> +

> +#define ISPCS_DT_CODE03_CH_REG(n)			(0x3008 + (0x100 * n))

> +#define ISPCS_DT_CODE03_EN3				BIT(31)

> +#define ISPCS_DT_CODE03_DT3(dt)				(((dt) & 0x3f) << 24)

> +#define ISPCS_DT_CODE03_EN2				BIT(23)

> +#define ISPCS_DT_CODE03_DT2(dt)				(((dt) & 0x3f) << 16)

> +#define ISPCS_DT_CODE03_EN1				BIT(15)

> +#define ISPCS_DT_CODE03_DT1(dt)				(((dt) & 0x3f) << 8)

> +#define ISPCS_DT_CODE03_EN0				BIT(7)

> +#define ISPCS_DT_CODE03_DT0(dt)				((dt) & 0x3f)

> +

> +struct rcar_isp_format {

> +	u32 code;

> +	unsigned int datatype;

> +	unsigned int procmode;

> +};

> +

> +static const struct rcar_isp_format rcar_isp_formats[] = {

> +	{ .code = MEDIA_BUS_FMT_RGB888_1X24,	.datatype = 0x24, .procmode = 0x15 },

> +	{ .code = MEDIA_BUS_FMT_Y10_1X10,	.datatype = 0x2b, .procmode = 0x10 },

> +	{ .code = MEDIA_BUS_FMT_UYVY8_1X16,	.datatype = 0x1e, .procmode = 0x0c },

> +	{ .code = MEDIA_BUS_FMT_YUYV8_1X16,	.datatype = 0x1e, .procmode = 0x0c },

> +	{ .code = MEDIA_BUS_FMT_UYVY8_2X8,	.datatype = 0x1e, .procmode = 0x0c },

> +	{ .code = MEDIA_BUS_FMT_YUYV10_2X10,	.datatype = 0x1e, .procmode = 0x0c },

> +};

> +

> +static const struct rcar_isp_format *risp_code_to_fmt(unsigned int code)

> +{

> +	unsigned int i;

> +

> +	for (i = 0; i < ARRAY_SIZE(rcar_isp_formats); i++)

> +		if (rcar_isp_formats[i].code == code)

> +			return &rcar_isp_formats[i];


Shouldn't the for loop be enclosed in { }  ?

> +

> +	return NULL;

> +}

> +

> +enum rcar_isp_input {

> +	RISP_CSI_INPUT0,

> +	RISP_CSI_INPUT1,

> +};

> +

> +enum rcar_isp_pads {

> +	RCAR_ISP_SINK,

> +	RCAR_ISP_PORT0,

> +	RCAR_ISP_PORT1,

> +	RCAR_ISP_PORT2,

> +	RCAR_ISP_PORT3,

> +	RCAR_ISP_PORT4,

> +	RCAR_ISP_PORT5,

> +	RCAR_ISP_PORT6,

> +	RCAR_ISP_PORT7,

> +	RCAR_ISP_MAX_PAD,

> +};

> +

> +struct rcar_isp {

> +	struct device *dev;

> +	void __iomem *base;

> +	struct reset_control *rstc;

> +

> +	enum rcar_isp_input csi_input;

> +

> +	struct v4l2_subdev subdev;

> +	struct media_pad pads[RCAR_ISP_MAX_PAD];

> +

> +	struct v4l2_async_notifier notifier;

> +	struct v4l2_subdev *remote;

> +	unsigned int remote_pad;

> +

> +	struct v4l2_mbus_framefmt mf;

> +

> +	struct mutex lock;

> +	int stream_count;

> +};

> +

> +static inline struct rcar_isp *sd_to_isp(struct v4l2_subdev *sd)

> +{

> +	return container_of(sd, struct rcar_isp, subdev);

> +}

> +

> +static inline struct rcar_isp *notifier_to_isp(struct v4l2_async_notifier *n)

> +{

> +	return container_of(n, struct rcar_isp, notifier);

> +}

> +

> +static void risp_write(struct rcar_isp *isp, u32 offset, u32 value)

> +{

> +	iowrite32(value, isp->base + offset);

> +}

> +

> +static u32 risp_read(struct rcar_isp *isp, u32 offset)

> +{

> +	return ioread32(isp->base + offset);

> +}

> +

> +static int risp_s_power(struct v4l2_subdev *sd, int on)

> +{

> +	struct rcar_isp *isp = sd_to_isp(sd);

> +	int ret;

> +

> +	if (on) {

> +		ret = pm_runtime_get_sync(isp->dev);


pm_runtime_get_sync() increases the power usage count even it fails,
so it should be put in case of error.

Or better, you can use pm_runtime_resume_and_get() towards which the
media subsystem is moving to. See
dd8088d5a896 ("PM: runtime: Add pm_runtime_resume_and_get to deal with usage counter")

> +		if (ret < 0)

> +			return ret;

> +

> +		ret = reset_control_deassert(isp->rstc);

> +		if (ret < 0)

> +			return ret;


Where are the pm ops defined ? Shouldn't you define a pm suspend a
and a pm resume ops that assert/deassert the reset controller ?

> +	} else {

> +		reset_control_assert(isp->rstc);

> +		pm_runtime_put(isp->dev);

> +	}


This could be simplified as

        if (!on) {
		reset_control_assert(isp->rstc);
                pm_runtime_put(isp->dev);

                return 0;
        }

        ...

But it's mostly a matter of tastes

> +

> +	return 0;

> +}

> +

> +static const struct v4l2_subdev_core_ops risp_core_ops = {

> +	.s_power = risp_s_power,

> +};

> +

> +static int risp_remote_code(struct rcar_isp *isp)

> +{

> +	struct v4l2_subdev_format fmt = {

> +		.which = V4L2_SUBDEV_FORMAT_ACTIVE,

> +	};

> +

> +	fmt.pad = isp->remote_pad;

> +	if (v4l2_subdev_call(isp->remote, pad, get_fmt, NULL, &fmt))

> +		return -EPIPE;

> +

> +	return fmt.format.code;

> +}

> +

> +static int risp_start(struct rcar_isp *isp)

> +{

> +	const struct rcar_isp_format *format;

> +	unsigned int vc;

> +	u32 sel_csi = 0;

> +

> +	format = risp_code_to_fmt(risp_remote_code(isp));


Why are you quering the remote side format ? In a fully-mc driver
shouldn't the format on the active source pad be used ?

> +	if (!format) {

> +		dev_err(isp->dev, "Unsupported bus format\n");

> +		return -EINVAL;

> +	}

> +

> +	/* Select CSI-2 input source. */

> +	if (isp->csi_input == RISP_CSI_INPUT1)

> +		sel_csi = ISPINPUTSEL0_SEL_CSI0;


Depending on my question below on how many endpoint we can have,
shouldn't the channel selection depend on the active media link ?

> +

> +	risp_write(isp, ISPINPUTSEL0_REG,

> +		   risp_read(isp, ISPINPUTSEL0_REG) | sel_csi);

> +

> +	/* Configure Channel Selector. */

> +	for (vc = 0; vc < 4; vc++) {

> +		u8 ch = vc + 4;

> +		u8 dt = format->datatype;

> +

> +		risp_write(isp, ISPCS_FILTER_ID_CH_REG(ch), BIT(vc));

> +		risp_write(isp, ISPCS_DT_CODE03_CH_REG(ch),

> +			   ISPCS_DT_CODE03_EN3 | ISPCS_DT_CODE03_DT3(dt) |

> +			   ISPCS_DT_CODE03_EN2 | ISPCS_DT_CODE03_DT2(dt) |

> +			   ISPCS_DT_CODE03_EN1 | ISPCS_DT_CODE03_DT1(dt) |

> +			   ISPCS_DT_CODE03_EN0 | ISPCS_DT_CODE03_DT0(dt));

> +	}

> +

> +	/* Setup processing method. */

> +	risp_write(isp, ISPPROCMODE_DT_REG(format->datatype),

> +		   ISPPROCMODE_DT_PROC_MODE_VC3(format->procmode) |

> +		   ISPPROCMODE_DT_PROC_MODE_VC2(format->procmode) |

> +		   ISPPROCMODE_DT_PROC_MODE_VC1(format->procmode) |

> +		   ISPPROCMODE_DT_PROC_MODE_VC0(format->procmode));

> +

> +	/* Start ISP. */

> +	risp_write(isp, ISPSTART_REG, ISPSTART_START);

> +

> +	return v4l2_subdev_call(isp->remote, video, s_stream, 1);

> +}

> +

> +static void risp_stop(struct rcar_isp *isp)

> +{

> +	v4l2_subdev_call(isp->remote, video, s_stream, 0);

> +

> +	/* Stop ISP. */

> +	risp_write(isp, ISPSTART_REG, ISPSTART_STOP);

> +}

> +

> +static int risp_s_stream(struct v4l2_subdev *sd, int enable)

> +{

> +	struct rcar_isp *isp = sd_to_isp(sd);

> +	int ret = 0;

> +

> +	mutex_lock(&isp->lock);

> +

> +	if (!isp->remote) {


If we don't have a remote the media graph is not completed, hence can
we ever get here ?

Also, does this need to be checked while holding the mutex ?

> +		ret = -ENODEV;

> +		goto out;

> +	}

> +

> +	if (enable && isp->stream_count == 0) {

> +		ret = risp_start(isp);

> +		if (ret)

> +			goto out;

> +	} else if (!enable && isp->stream_count == 1) {

> +		risp_stop(isp);

> +	}

> +

> +	isp->stream_count += enable ? 1 : -1;

> +out:

> +	mutex_unlock(&isp->lock);

> +

> +	return ret;

> +}

> +

> +static const struct v4l2_subdev_video_ops risp_video_ops = {

> +	.s_stream = risp_s_stream,

> +};

> +

> +static int risp_set_pad_format(struct v4l2_subdev *sd,

> +			       struct v4l2_subdev_pad_config *cfg,

> +			       struct v4l2_subdev_format *format)

> +{

> +	struct rcar_isp *isp = sd_to_isp(sd);

> +	struct v4l2_mbus_framefmt *framefmt;

> +

> +	if (!risp_code_to_fmt(format->format.code))

> +		format->format.code = rcar_isp_formats[0].code;


Doesn't this mean the format is not supported ?

> +

> +	if (format->which == V4L2_SUBDEV_FORMAT_ACTIVE) {

> +		isp->mf = format->format;

> +	} else {

> +		framefmt = v4l2_subdev_get_try_format(sd, cfg, 0);

> +		*framefmt = format->format;

> +	}

> +

> +	return 0;

> +}

> +

> +static int risp_get_pad_format(struct v4l2_subdev *sd,

> +			       struct v4l2_subdev_pad_config *cfg,

> +			       struct v4l2_subdev_format *format)

> +{

> +	struct rcar_isp *isp = sd_to_isp(sd);

> +

> +	if (format->which == V4L2_SUBDEV_FORMAT_ACTIVE)

> +		format->format = isp->mf;

> +	else

> +		format->format = *v4l2_subdev_get_try_format(sd, cfg, 0);

> +

> +	return 0;

> +}

> +

> +static const struct v4l2_subdev_pad_ops risp_pad_ops = {

> +	.set_fmt = risp_set_pad_format,

> +	.get_fmt = risp_get_pad_format,

> +};

> +

> +static const struct v4l2_subdev_ops rcar_isp_subdev_ops = {

> +	.core	= &risp_core_ops,

> +	.video	= &risp_video_ops,

> +	.pad	= &risp_pad_ops,

> +};

> +

> +/* -----------------------------------------------------------------------------

> + * Async handling and registration of subdevices and links

> + */

> +

> +static int risp_notify_bound(struct v4l2_async_notifier *notifier,

> +			     struct v4l2_subdev *subdev,

> +			     struct v4l2_async_subdev *asd)

> +{

> +	struct rcar_isp *isp = notifier_to_isp(notifier);

> +	int pad;

> +

> +	pad = media_entity_get_fwnode_pad(&subdev->entity, asd->match.fwnode,

> +					  MEDIA_PAD_FL_SOURCE);

> +	if (pad < 0) {

> +		dev_err(isp->dev, "Failed to find pad for %s\n", subdev->name);

> +		return pad;

> +	}

> +

> +	isp->remote = subdev;

> +	isp->remote_pad = pad;

> +

> +	dev_dbg(isp->dev, "Bound %s pad: %d\n", subdev->name, pad);

> +

> +	return media_create_pad_link(&subdev->entity, pad,

> +				     &isp->subdev.entity, 0,

> +				     MEDIA_LNK_FL_ENABLED |

> +				     MEDIA_LNK_FL_IMMUTABLE);


Depending on the answer to my question below about endpoints, should
the links be created for all connected entities and isp->remote
assigned at link enablement time ?

> +}

> +

> +static void risp_notify_unbind(struct v4l2_async_notifier *notifier,

> +			       struct v4l2_subdev *subdev,

> +			       struct v4l2_async_subdev *asd)

> +{

> +	struct rcar_isp *isp = notifier_to_isp(notifier);

> +

> +	isp->remote = NULL;

> +

> +	dev_dbg(isp->dev, "Unbind %s\n", subdev->name);

> +}

> +

> +static const struct v4l2_async_notifier_operations risp_notify_ops = {

> +	.bound = risp_notify_bound,

> +	.unbind = risp_notify_unbind,

> +};

> +

> +static int risp_parse_dt(struct rcar_isp *isp)

> +{

> +	struct v4l2_async_subdev *asd;

> +	struct fwnode_handle *fwnode;

> +	struct fwnode_handle *ep;

> +	unsigned int id;

> +	int ret;

> +

> +	for (id = 0; id < 2; id++) {

> +		ep = fwnode_graph_get_endpoint_by_id(dev_fwnode(isp->dev),

> +						     0, id, 0);

> +		if (ep)

> +			break;

> +	}

> +

> +	if (!ep) {

> +		dev_err(isp->dev, "Not connected to subdevice\n");

> +		return -EINVAL;

> +	}

> +

> +	if (id == 1)

> +		isp->csi_input = RISP_CSI_INPUT1;


This seems to check which endpoints are specified on the local port
node. Am I wrong or this implies that only one endpoint at the time
should be specified ?

Shouldn't we have both endpoints in the local node but only have one
media link active at the time ?

> +

> +	fwnode = fwnode_graph_get_remote_endpoint(ep);

> +	fwnode_handle_put(ep);

> +

> +	dev_dbg(isp->dev, "Found '%pOF'\n", to_of_node(fwnode));

> +

> +	v4l2_async_notifier_init(&isp->notifier);

> +	isp->notifier.ops = &risp_notify_ops;

> +

> +	asd = v4l2_async_notifier_add_fwnode_subdev(&isp->notifier, fwnode,

> +						    struct v4l2_async_subdev);

> +	fwnode_handle_put(fwnode);

> +	if (IS_ERR(asd))

> +		return PTR_ERR(asd);

> +

> +	ret = v4l2_async_subdev_notifier_register(&isp->subdev, &isp->notifier);

> +	if (ret)

> +		v4l2_async_notifier_cleanup(&isp->notifier);

> +

> +	return ret;

> +}

> +

> +/* -----------------------------------------------------------------------------

> + * Platform Device Driver

> + */

> +

> +static const struct media_entity_operations risp_entity_ops = {

> +	.link_validate = v4l2_subdev_link_validate,

> +};

> +

> +static int risp_probe_resources(struct rcar_isp *isp,

> +				struct platform_device *pdev)

> +{

> +	struct resource *res;

> +

> +	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);

> +	isp->base = devm_ioremap_resource(&pdev->dev, res);

> +	if (IS_ERR(isp->base))

> +		return PTR_ERR(isp->base);

> +

> +	isp->rstc = devm_reset_control_get(&pdev->dev, NULL);

> +

> +	return PTR_ERR_OR_ZERO(isp->rstc);

> +}

> +

> +static const struct of_device_id risp_of_id_table[] = {

> +	{ .compatible = "renesas,r8a779a0-isp" },

> +	{ /* sentinel */ },

> +};

> +MODULE_DEVICE_TABLE(of, risp_of_id_table);


Can this block be moved after _remove() ?

> +

> +static int risp_probe(struct platform_device *pdev)

> +{

> +	struct rcar_isp *isp;

> +	unsigned int i;

> +	int ret;

> +

> +	isp = devm_kzalloc(&pdev->dev, sizeof(*isp), GFP_KERNEL);

> +	if (!isp)

> +		return -ENOMEM;

> +

> +	isp->dev = &pdev->dev;

> +

> +	mutex_init(&isp->lock);

> +	isp->stream_count = 0;


isp is kzalloc-ed, is this required ?

> +

> +	ret = risp_probe_resources(isp, pdev);

> +	if (ret) {

> +		dev_err(isp->dev, "Failed to get resources\n");

> +		return ret;

> +	}

> +

> +	platform_set_drvdata(pdev, isp);

> +

> +	ret = risp_parse_dt(isp);

> +	if (ret)

> +		return ret;

> +

> +	isp->subdev.owner = THIS_MODULE;

> +	isp->subdev.dev = &pdev->dev;

> +	v4l2_subdev_init(&isp->subdev, &rcar_isp_subdev_ops);

> +	v4l2_set_subdevdata(&isp->subdev, &pdev->dev);

> +	snprintf(isp->subdev.name, V4L2_SUBDEV_NAME_SIZE, "%s %s",

> +		 KBUILD_MODNAME, dev_name(&pdev->dev));

> +	isp->subdev.flags = V4L2_SUBDEV_FL_HAS_DEVNODE;

> +

> +	isp->subdev.entity.function = MEDIA_ENT_F_PROC_VIDEO_PIXEL_FORMATTER;

> +	isp->subdev.entity.ops = &risp_entity_ops;

> +

> +	isp->pads[RCAR_ISP_SINK].flags = MEDIA_PAD_FL_SINK;

> +	for (i = RCAR_ISP_PORT0; i < RCAR_ISP_MAX_PAD; i++)

> +		isp->pads[i].flags = MEDIA_PAD_FL_SOURCE;

> +

> +	ret = media_entity_pads_init(&isp->subdev.entity, RCAR_ISP_MAX_PAD,

> +				     isp->pads);

> +	if (ret)

> +		goto error;

> +

> +	pm_runtime_enable(&pdev->dev);

> +

> +	ret = v4l2_async_register_subdev(&isp->subdev);

> +	if (ret < 0)

> +		goto error;

> +

> +	dev_info(isp->dev, "Using CSI-2 input: %u\n", isp->csi_input);

> +

> +	return 0;

> +error:

> +	v4l2_async_notifier_unregister(&isp->notifier);

> +	v4l2_async_notifier_cleanup(&isp->notifier);

> +

> +	return ret;

> +}

> +

> +static int risp_remove(struct platform_device *pdev)

> +{

> +	struct rcar_isp *isp = platform_get_drvdata(pdev);

> +

> +	v4l2_async_notifier_unregister(&isp->notifier);

> +	v4l2_async_notifier_cleanup(&isp->notifier);

> +	v4l2_async_unregister_subdev(&isp->subdev);

> +

> +	pm_runtime_disable(&pdev->dev);


Isn't it better to turn power off first, then unregister the subdev ?

Also, I wonder if we can enforce the reset sequence as specified in
"25B.6.3.1 Boot up sequence type 1" which implies the VIN and ISP
resets should be ordered.

Thanks
   j

> +

> +	return 0;

> +}

> +

> +static struct platform_driver rcar_isp_driver = {

> +	.driver = {

> +		.name = "rcar-isp",

> +		.of_match_table = risp_of_id_table,

> +	},

> +	.probe = risp_probe,

> +	.remove = risp_remove,

> +};

> +

> +module_platform_driver(rcar_isp_driver);

> +

> +MODULE_AUTHOR("Niklas Söderlund <niklas.soderlund@ragnatech.se>");

> +MODULE_DESCRIPTION("Renesas R-Car ISP Channel Selector driver");

> +MODULE_LICENSE("GPL");

> --

> 2.31.1

>
Niklas Söderlund June 30, 2021, 1:40 p.m. UTC | #5
Hi Jacopo,

Thanks for your feedback.

On 2021-06-16 17:12:55 +0200, Jacopo Mondi wrote:
> Hi Niklas,

> 

> On Wed, May 12, 2021 at 10:19:12AM +0200, Niklas Söderlund wrote:

> > Add a V4L2 driver for Renesas R-Car Image Signal Processor. The driver

> > supports the R-Car V3U SoC where the ISP IP sits between the R-Car CSI-2

> > receiver and VIN and filters the CSI-2 data based on VC/DT and directs

> > the video stream to different VIN IPs.

> >

> > Signed-off-by: Niklas Söderlund <niklas.soderlund+renesas@ragnatech.se>

> > ---

> >  MAINTAINERS                       |   1 +

> >  drivers/media/platform/Kconfig    |  16 +

> >  drivers/media/platform/Makefile   |   1 +

> >  drivers/media/platform/rcar-isp.c | 500 ++++++++++++++++++++++++++++++

> 

> Have you considered adding the driver to platform/rcar-vin where the

> VIN/CSI-2 drivers live already ?


Yes I did, but I opted to go the other way around and will move the 
rcar-csi2.c out of the rcar-vin directory. The VIN + CSI-2 is a legacy 
pre media graph times (was never part of an upstream kernel) and really 
makes no sens now.

> 

> >  4 files changed, 518 insertions(+)

> >  create mode 100644 drivers/media/platform/rcar-isp.c

> >

> > diff --git a/MAINTAINERS b/MAINTAINERS

> > index c35a9c93da84f4f7..03f3d52e03596f66 100644

> > --- a/MAINTAINERS

> > +++ b/MAINTAINERS

> > @@ -11400,6 +11400,7 @@ T:	git git://linuxtv.org/media_tree.git

> >  F:	Documentation/devicetree/bindings/media/renesas,csi2.yaml

> >  F:	Documentation/devicetree/bindings/media/renesas,isp.yaml

> >  F:	Documentation/devicetree/bindings/media/renesas,vin.yaml

> > +F:	drivers/media/platform/rcar-isp.c

> >  F:	drivers/media/platform/rcar-vin/

> >

> >  MEDIA DRIVERS FOR RENESAS - VSP1

> > diff --git a/drivers/media/platform/Kconfig b/drivers/media/platform/Kconfig

> > index 157c924686e4b61b..a8777d5dd6bc3ec1 100644

> > --- a/drivers/media/platform/Kconfig

> > +++ b/drivers/media/platform/Kconfig

> > @@ -200,6 +200,22 @@ config VIDEO_TI_CAL_MC

> >

> >  endif # VIDEO_TI_CAL

> >

> > +config VIDEO_RCAR_ISP

> > +	tristate "R-Car Image Signal Processor (ISP)"

> > +	depends on VIDEO_V4L2 && OF

> > +	depends on ARCH_RENESAS || COMPILE_TEST

> > +	select MEDIA_CONTROLLER

> > +	select VIDEO_V4L2_SUBDEV_API

> > +	select RESET_CONTROLLER

> > +	select V4L2_FWNODE

> > +	help

> > +	  Support for Renesas R-Car Image Signal Processor (ISP).

> > +	  Enable this to support the Renesas R-Car Image Signal

> > +	  Processor (ISP).

> > +

> > +	  To compile this driver as a module, choose M here: the

> > +	  module will be called rcar-isp.

> > +

> >  endif # V4L_PLATFORM_DRIVERS

> >

> >  menuconfig V4L_MEM2MEM_DRIVERS

> > diff --git a/drivers/media/platform/Makefile b/drivers/media/platform/Makefile

> > index eedc14aafb32c2fa..8ae543f6ef764c48 100644

> > --- a/drivers/media/platform/Makefile

> > +++ b/drivers/media/platform/Makefile

> > @@ -63,6 +63,7 @@ obj-$(CONFIG_VIDEO_AM437X_VPFE)		+= am437x/

> >

> >  obj-$(CONFIG_VIDEO_XILINX)		+= xilinx/

> >

> > +obj-$(CONFIG_VIDEO_RCAR_ISP)		+= rcar-isp.o

> >  obj-$(CONFIG_VIDEO_RCAR_VIN)		+= rcar-vin/

> >

> >  obj-$(CONFIG_VIDEO_ATMEL_ISC)		+= atmel/

> > diff --git a/drivers/media/platform/rcar-isp.c b/drivers/media/platform/rcar-isp.c

> > new file mode 100644

> > index 0000000000000000..bf6a376354ece89d

> > --- /dev/null

> > +++ b/drivers/media/platform/rcar-isp.c

> > @@ -0,0 +1,500 @@

> > +// SPDX-License-Identifier: GPL-2.0

> > +/*

> > + * Driver for Renesas R-Car ISP Channel Selector

> > + *

> > + * Copyright (C) 2021 Renesas Electronics Corp.

> > + */

> > +

> > +#include <linux/module.h>

> > +#include <linux/mutex.h>

> > +#include <linux/of_device.h>

> > +#include <linux/platform_device.h>

> > +#include <linux/pm_runtime.h>

> > +#include <linux/reset.h>

> > +

> > +#include <media/v4l2-subdev.h>

> > +

> > +#define ISPINPUTSEL0_REG				0x0008

> > +#define ISPINPUTSEL0_SEL_CSI0				BIT(31)

> > +

> > +#define ISPSTART_REG					0x0014

> > +#define ISPSTART_START					0xffff

> > +#define ISPSTART_STOP					0x0000

> > +

> > +#define ISPPROCMODE_DT_REG(n)			(0x1100 + (0x4 * n))

> > +#define ISPPROCMODE_DT_PROC_MODE_VC3(pm)		(((pm) & 0x3f) << 24)

> > +#define ISPPROCMODE_DT_PROC_MODE_VC2(pm)		(((pm) & 0x3f) << 16)

> > +#define ISPPROCMODE_DT_PROC_MODE_VC1(pm)		(((pm) & 0x3f) << 8)

> > +#define ISPPROCMODE_DT_PROC_MODE_VC0(pm)		((pm) & 0x3f)

> > +

> > +#define ISPCS_FILTER_ID_CH_REG(n)			(0x3000 + (0x0100 * n))

> > +

> > +#define ISPCS_DT_CODE03_CH_REG(n)			(0x3008 + (0x100 * n))

> > +#define ISPCS_DT_CODE03_EN3				BIT(31)

> > +#define ISPCS_DT_CODE03_DT3(dt)				(((dt) & 0x3f) << 24)

> > +#define ISPCS_DT_CODE03_EN2				BIT(23)

> > +#define ISPCS_DT_CODE03_DT2(dt)				(((dt) & 0x3f) << 16)

> > +#define ISPCS_DT_CODE03_EN1				BIT(15)

> > +#define ISPCS_DT_CODE03_DT1(dt)				(((dt) & 0x3f) << 8)

> > +#define ISPCS_DT_CODE03_EN0				BIT(7)

> > +#define ISPCS_DT_CODE03_DT0(dt)				((dt) & 0x3f)

> > +

> > +struct rcar_isp_format {

> > +	u32 code;

> > +	unsigned int datatype;

> > +	unsigned int procmode;

> > +};

> > +

> > +static const struct rcar_isp_format rcar_isp_formats[] = {

> > +	{ .code = MEDIA_BUS_FMT_RGB888_1X24,	.datatype = 0x24, .procmode = 0x15 },

> > +	{ .code = MEDIA_BUS_FMT_Y10_1X10,	.datatype = 0x2b, .procmode = 0x10 },

> > +	{ .code = MEDIA_BUS_FMT_UYVY8_1X16,	.datatype = 0x1e, .procmode = 0x0c },

> > +	{ .code = MEDIA_BUS_FMT_YUYV8_1X16,	.datatype = 0x1e, .procmode = 0x0c },

> > +	{ .code = MEDIA_BUS_FMT_UYVY8_2X8,	.datatype = 0x1e, .procmode = 0x0c },

> > +	{ .code = MEDIA_BUS_FMT_YUYV10_2X10,	.datatype = 0x1e, .procmode = 0x0c },

> > +};

> > +

> > +static const struct rcar_isp_format *risp_code_to_fmt(unsigned int code)

> > +{

> > +	unsigned int i;

> > +

> > +	for (i = 0; i < ARRAY_SIZE(rcar_isp_formats); i++)

> > +		if (rcar_isp_formats[i].code == code)

> > +			return &rcar_isp_formats[i];

> 

> Shouldn't the for loop be enclosed in { }  ?


No, why? Maybe it's a matter of taste but it will not effect the code 
and IMHO adding { } here would just make it harder to read.

> 

> > +

> > +	return NULL;

> > +}

> > +

> > +enum rcar_isp_input {

> > +	RISP_CSI_INPUT0,

> > +	RISP_CSI_INPUT1,

> > +};

> > +

> > +enum rcar_isp_pads {

> > +	RCAR_ISP_SINK,

> > +	RCAR_ISP_PORT0,

> > +	RCAR_ISP_PORT1,

> > +	RCAR_ISP_PORT2,

> > +	RCAR_ISP_PORT3,

> > +	RCAR_ISP_PORT4,

> > +	RCAR_ISP_PORT5,

> > +	RCAR_ISP_PORT6,

> > +	RCAR_ISP_PORT7,

> > +	RCAR_ISP_MAX_PAD,

> > +};

> > +

> > +struct rcar_isp {

> > +	struct device *dev;

> > +	void __iomem *base;

> > +	struct reset_control *rstc;

> > +

> > +	enum rcar_isp_input csi_input;

> > +

> > +	struct v4l2_subdev subdev;

> > +	struct media_pad pads[RCAR_ISP_MAX_PAD];

> > +

> > +	struct v4l2_async_notifier notifier;

> > +	struct v4l2_subdev *remote;

> > +	unsigned int remote_pad;

> > +

> > +	struct v4l2_mbus_framefmt mf;

> > +

> > +	struct mutex lock;

> > +	int stream_count;

> > +};

> > +

> > +static inline struct rcar_isp *sd_to_isp(struct v4l2_subdev *sd)

> > +{

> > +	return container_of(sd, struct rcar_isp, subdev);

> > +}

> > +

> > +static inline struct rcar_isp *notifier_to_isp(struct v4l2_async_notifier *n)

> > +{

> > +	return container_of(n, struct rcar_isp, notifier);

> > +}

> > +

> > +static void risp_write(struct rcar_isp *isp, u32 offset, u32 value)

> > +{

> > +	iowrite32(value, isp->base + offset);

> > +}

> > +

> > +static u32 risp_read(struct rcar_isp *isp, u32 offset)

> > +{

> > +	return ioread32(isp->base + offset);

> > +}

> > +

> > +static int risp_s_power(struct v4l2_subdev *sd, int on)

> > +{

> > +	struct rcar_isp *isp = sd_to_isp(sd);

> > +	int ret;

> > +

> > +	if (on) {

> > +		ret = pm_runtime_get_sync(isp->dev);

> 

> pm_runtime_get_sync() increases the power usage count even it fails,

> so it should be put in case of error.

> 

> Or better, you can use pm_runtime_resume_and_get() towards which the

> media subsystem is moving to. See

> dd8088d5a896 ("PM: runtime: Add pm_runtime_resume_and_get to deal with usage counter")


Good idea.

> 

> > +		if (ret < 0)

> > +			return ret;

> > +

> > +		ret = reset_control_deassert(isp->rstc);

> > +		if (ret < 0)

> > +			return ret;

> 

> Where are the pm ops defined ? Shouldn't you define a pm suspend a

> and a pm resume ops that assert/deassert the reset controller ?


No that would be trick to get resume to work if a capture was going on 
at suspend time. Instead the suspend/resume for the capture chain is 
controlled from the R-Car VIN driver that stops/starts capture in it's 
suspend/resume handlers if capture is running. If no capture is running 
the device is already powered off.

> 

> > +	} else {

> > +		reset_control_assert(isp->rstc);

> > +		pm_runtime_put(isp->dev);

> > +	}

> 

> This could be simplified as

> 

>         if (!on) {

> 		reset_control_assert(isp->rstc);

>                 pm_runtime_put(isp->dev);

> 

>                 return 0;

>         }

> 

>         ...

> 

> But it's mostly a matter of tastes


:-)

> 

> > +

> > +	return 0;

> > +}

> > +

> > +static const struct v4l2_subdev_core_ops risp_core_ops = {

> > +	.s_power = risp_s_power,

> > +};

> > +

> > +static int risp_remote_code(struct rcar_isp *isp)

> > +{

> > +	struct v4l2_subdev_format fmt = {

> > +		.which = V4L2_SUBDEV_FORMAT_ACTIVE,

> > +	};

> > +

> > +	fmt.pad = isp->remote_pad;

> > +	if (v4l2_subdev_call(isp->remote, pad, get_fmt, NULL, &fmt))

> > +		return -EPIPE;

> > +

> > +	return fmt.format.code;

> > +}

> > +

> > +static int risp_start(struct rcar_isp *isp)

> > +{

> > +	const struct rcar_isp_format *format;

> > +	unsigned int vc;

> > +	u32 sel_csi = 0;

> > +

> > +	format = risp_code_to_fmt(risp_remote_code(isp));

> 

> Why are you quering the remote side format ? In a fully-mc driver

> shouldn't the format on the active source pad be used ?


In a perfect world yes. But until we have the media graph format 
validation introduced in different form from the multiplexed stream 
series the pad format validation in the core is broken. So I can either 
get the remote format here and compare it and fail capture start if they 
differ or I can just fetch it and use it.

As both methods are "wrong" as we can't describe multiple formats for 
multiple streams on a CSI-2 link I choose to align this with how things 
are done in the R-Car CSI-2 driver which also is involved in the same 
capture chain. At least we are consistency "wrong" ;-)

> 

> > +	if (!format) {

> > +		dev_err(isp->dev, "Unsupported bus format\n");

> > +		return -EINVAL;

> > +	}

> > +

> > +	/* Select CSI-2 input source. */

> > +	if (isp->csi_input == RISP_CSI_INPUT1)

> > +		sel_csi = ISPINPUTSEL0_SEL_CSI0;

> 

> Depending on my question below on how many endpoint we can have,

> shouldn't the channel selection depend on the active media link ?


We should indeed do that. The schematics are a bit unclear on how this 
is wired up on the V3U and I have been able to create the DT description 
used to test this driver by trail and error. So for now I have opted to 
keep the driver to only support a single endpoint. The blocker is not 
that it's hard to do but rather I can't test it.

The bindings description takes this into account and allows for the two 
possible endpoints to be described correctly. But currently as you 
noticed the driver will fail to probe if two endpoints are described.  

> 

> > +

> > +	risp_write(isp, ISPINPUTSEL0_REG,

> > +		   risp_read(isp, ISPINPUTSEL0_REG) | sel_csi);

> > +

> > +	/* Configure Channel Selector. */

> > +	for (vc = 0; vc < 4; vc++) {

> > +		u8 ch = vc + 4;

> > +		u8 dt = format->datatype;

> > +

> > +		risp_write(isp, ISPCS_FILTER_ID_CH_REG(ch), BIT(vc));

> > +		risp_write(isp, ISPCS_DT_CODE03_CH_REG(ch),

> > +			   ISPCS_DT_CODE03_EN3 | ISPCS_DT_CODE03_DT3(dt) |

> > +			   ISPCS_DT_CODE03_EN2 | ISPCS_DT_CODE03_DT2(dt) |

> > +			   ISPCS_DT_CODE03_EN1 | ISPCS_DT_CODE03_DT1(dt) |

> > +			   ISPCS_DT_CODE03_EN0 | ISPCS_DT_CODE03_DT0(dt));

> > +	}

> > +

> > +	/* Setup processing method. */

> > +	risp_write(isp, ISPPROCMODE_DT_REG(format->datatype),

> > +		   ISPPROCMODE_DT_PROC_MODE_VC3(format->procmode) |

> > +		   ISPPROCMODE_DT_PROC_MODE_VC2(format->procmode) |

> > +		   ISPPROCMODE_DT_PROC_MODE_VC1(format->procmode) |

> > +		   ISPPROCMODE_DT_PROC_MODE_VC0(format->procmode));

> > +

> > +	/* Start ISP. */

> > +	risp_write(isp, ISPSTART_REG, ISPSTART_START);

> > +

> > +	return v4l2_subdev_call(isp->remote, video, s_stream, 1);

> > +}

> > +

> > +static void risp_stop(struct rcar_isp *isp)

> > +{

> > +	v4l2_subdev_call(isp->remote, video, s_stream, 0);

> > +

> > +	/* Stop ISP. */

> > +	risp_write(isp, ISPSTART_REG, ISPSTART_STOP);

> > +}

> > +

> > +static int risp_s_stream(struct v4l2_subdev *sd, int enable)

> > +{

> > +	struct rcar_isp *isp = sd_to_isp(sd);

> > +	int ret = 0;

> > +

> > +	mutex_lock(&isp->lock);

> > +

> > +	if (!isp->remote) {

> 

> If we don't have a remote the media graph is not completed, hence can

> we ever get here ?

> 

> Also, does this need to be checked while holding the mutex ?


This goes a bit hand in hand with your question above. For a single 
endpoint with an immutable media link we can't get here. But as soon as 
we allow for the link selection in the graph we could get here if both 
links are disabled.

> 

> > +		ret = -ENODEV;

> > +		goto out;

> > +	}

> > +

> > +	if (enable && isp->stream_count == 0) {

> > +		ret = risp_start(isp);

> > +		if (ret)

> > +			goto out;

> > +	} else if (!enable && isp->stream_count == 1) {

> > +		risp_stop(isp);

> > +	}

> > +

> > +	isp->stream_count += enable ? 1 : -1;

> > +out:

> > +	mutex_unlock(&isp->lock);

> > +

> > +	return ret;

> > +}

> > +

> > +static const struct v4l2_subdev_video_ops risp_video_ops = {

> > +	.s_stream = risp_s_stream,

> > +};

> > +

> > +static int risp_set_pad_format(struct v4l2_subdev *sd,

> > +			       struct v4l2_subdev_pad_config *cfg,

> > +			       struct v4l2_subdev_format *format)

> > +{

> > +	struct rcar_isp *isp = sd_to_isp(sd);

> > +	struct v4l2_mbus_framefmt *framefmt;

> > +

> > +	if (!risp_code_to_fmt(format->format.code))

> > +		format->format.code = rcar_isp_formats[0].code;

> 

> Doesn't this mean the format is not supported ?


Yes, and then we need to set it to something that is.

> 

> > +

> > +	if (format->which == V4L2_SUBDEV_FORMAT_ACTIVE) {

> > +		isp->mf = format->format;

> > +	} else {

> > +		framefmt = v4l2_subdev_get_try_format(sd, cfg, 0);

> > +		*framefmt = format->format;

> > +	}

> > +

> > +	return 0;

> > +}

> > +

> > +static int risp_get_pad_format(struct v4l2_subdev *sd,

> > +			       struct v4l2_subdev_pad_config *cfg,

> > +			       struct v4l2_subdev_format *format)

> > +{

> > +	struct rcar_isp *isp = sd_to_isp(sd);

> > +

> > +	if (format->which == V4L2_SUBDEV_FORMAT_ACTIVE)

> > +		format->format = isp->mf;

> > +	else

> > +		format->format = *v4l2_subdev_get_try_format(sd, cfg, 0);

> > +

> > +	return 0;

> > +}

> > +

> > +static const struct v4l2_subdev_pad_ops risp_pad_ops = {

> > +	.set_fmt = risp_set_pad_format,

> > +	.get_fmt = risp_get_pad_format,

> > +};

> > +

> > +static const struct v4l2_subdev_ops rcar_isp_subdev_ops = {

> > +	.core	= &risp_core_ops,

> > +	.video	= &risp_video_ops,

> > +	.pad	= &risp_pad_ops,

> > +};

> > +

> > +/* -----------------------------------------------------------------------------

> > + * Async handling and registration of subdevices and links

> > + */

> > +

> > +static int risp_notify_bound(struct v4l2_async_notifier *notifier,

> > +			     struct v4l2_subdev *subdev,

> > +			     struct v4l2_async_subdev *asd)

> > +{

> > +	struct rcar_isp *isp = notifier_to_isp(notifier);

> > +	int pad;

> > +

> > +	pad = media_entity_get_fwnode_pad(&subdev->entity, asd->match.fwnode,

> > +					  MEDIA_PAD_FL_SOURCE);

> > +	if (pad < 0) {

> > +		dev_err(isp->dev, "Failed to find pad for %s\n", subdev->name);

> > +		return pad;

> > +	}

> > +

> > +	isp->remote = subdev;

> > +	isp->remote_pad = pad;

> > +

> > +	dev_dbg(isp->dev, "Bound %s pad: %d\n", subdev->name, pad);

> > +

> > +	return media_create_pad_link(&subdev->entity, pad,

> > +				     &isp->subdev.entity, 0,

> > +				     MEDIA_LNK_FL_ENABLED |

> > +				     MEDIA_LNK_FL_IMMUTABLE);

> 

> Depending on the answer to my question below about endpoints, should

> the links be created for all connected entities and isp->remote

> assigned at link enablement time ?


As state above yes, once we can test it.

> 

> > +}

> > +

> > +static void risp_notify_unbind(struct v4l2_async_notifier *notifier,

> > +			       struct v4l2_subdev *subdev,

> > +			       struct v4l2_async_subdev *asd)

> > +{

> > +	struct rcar_isp *isp = notifier_to_isp(notifier);

> > +

> > +	isp->remote = NULL;

> > +

> > +	dev_dbg(isp->dev, "Unbind %s\n", subdev->name);

> > +}

> > +

> > +static const struct v4l2_async_notifier_operations risp_notify_ops = {

> > +	.bound = risp_notify_bound,

> > +	.unbind = risp_notify_unbind,

> > +};

> > +

> > +static int risp_parse_dt(struct rcar_isp *isp)

> > +{

> > +	struct v4l2_async_subdev *asd;

> > +	struct fwnode_handle *fwnode;

> > +	struct fwnode_handle *ep;

> > +	unsigned int id;

> > +	int ret;

> > +

> > +	for (id = 0; id < 2; id++) {

> > +		ep = fwnode_graph_get_endpoint_by_id(dev_fwnode(isp->dev),

> > +						     0, id, 0);

> > +		if (ep)

> > +			break;

> > +	}

> > +

> > +	if (!ep) {

> > +		dev_err(isp->dev, "Not connected to subdevice\n");

> > +		return -EINVAL;

> > +	}

> > +

> > +	if (id == 1)

> > +		isp->csi_input = RISP_CSI_INPUT1;

> 

> This seems to check which endpoints are specified on the local port

> node. Am I wrong or this implies that only one endpoint at the time

> should be specified ?

> 

> Shouldn't we have both endpoints in the local node but only have one

> media link active at the time ?


Yes :-)

> 

> > +

> > +	fwnode = fwnode_graph_get_remote_endpoint(ep);

> > +	fwnode_handle_put(ep);

> > +

> > +	dev_dbg(isp->dev, "Found '%pOF'\n", to_of_node(fwnode));

> > +

> > +	v4l2_async_notifier_init(&isp->notifier);

> > +	isp->notifier.ops = &risp_notify_ops;

> > +

> > +	asd = v4l2_async_notifier_add_fwnode_subdev(&isp->notifier, fwnode,

> > +						    struct v4l2_async_subdev);

> > +	fwnode_handle_put(fwnode);

> > +	if (IS_ERR(asd))

> > +		return PTR_ERR(asd);

> > +

> > +	ret = v4l2_async_subdev_notifier_register(&isp->subdev, &isp->notifier);

> > +	if (ret)

> > +		v4l2_async_notifier_cleanup(&isp->notifier);

> > +

> > +	return ret;

> > +}

> > +

> > +/* -----------------------------------------------------------------------------

> > + * Platform Device Driver

> > + */

> > +

> > +static const struct media_entity_operations risp_entity_ops = {

> > +	.link_validate = v4l2_subdev_link_validate,

> > +};

> > +

> > +static int risp_probe_resources(struct rcar_isp *isp,

> > +				struct platform_device *pdev)

> > +{

> > +	struct resource *res;

> > +

> > +	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);

> > +	isp->base = devm_ioremap_resource(&pdev->dev, res);

> > +	if (IS_ERR(isp->base))

> > +		return PTR_ERR(isp->base);

> > +

> > +	isp->rstc = devm_reset_control_get(&pdev->dev, NULL);

> > +

> > +	return PTR_ERR_OR_ZERO(isp->rstc);

> > +}

> > +

> > +static const struct of_device_id risp_of_id_table[] = {

> > +	{ .compatible = "renesas,r8a779a0-isp" },

> > +	{ /* sentinel */ },

> > +};

> > +MODULE_DEVICE_TABLE(of, risp_of_id_table);

> 

> Can this block be moved after _remove() ?


I'm sure it could. But this is the style used in rcar-vin and rcar-csi2 
and I like to be consistent.

> 

> > +

> > +static int risp_probe(struct platform_device *pdev)

> > +{

> > +	struct rcar_isp *isp;

> > +	unsigned int i;

> > +	int ret;

> > +

> > +	isp = devm_kzalloc(&pdev->dev, sizeof(*isp), GFP_KERNEL);

> > +	if (!isp)

> > +		return -ENOMEM;

> > +

> > +	isp->dev = &pdev->dev;

> > +

> > +	mutex_init(&isp->lock);

> > +	isp->stream_count = 0;

> 

> isp is kzalloc-ed, is this required ?


Good point, no.

> 

> > +

> > +	ret = risp_probe_resources(isp, pdev);

> > +	if (ret) {

> > +		dev_err(isp->dev, "Failed to get resources\n");

> > +		return ret;

> > +	}

> > +

> > +	platform_set_drvdata(pdev, isp);

> > +

> > +	ret = risp_parse_dt(isp);

> > +	if (ret)

> > +		return ret;

> > +

> > +	isp->subdev.owner = THIS_MODULE;

> > +	isp->subdev.dev = &pdev->dev;

> > +	v4l2_subdev_init(&isp->subdev, &rcar_isp_subdev_ops);

> > +	v4l2_set_subdevdata(&isp->subdev, &pdev->dev);

> > +	snprintf(isp->subdev.name, V4L2_SUBDEV_NAME_SIZE, "%s %s",

> > +		 KBUILD_MODNAME, dev_name(&pdev->dev));

> > +	isp->subdev.flags = V4L2_SUBDEV_FL_HAS_DEVNODE;

> > +

> > +	isp->subdev.entity.function = MEDIA_ENT_F_PROC_VIDEO_PIXEL_FORMATTER;

> > +	isp->subdev.entity.ops = &risp_entity_ops;

> > +

> > +	isp->pads[RCAR_ISP_SINK].flags = MEDIA_PAD_FL_SINK;

> > +	for (i = RCAR_ISP_PORT0; i < RCAR_ISP_MAX_PAD; i++)

> > +		isp->pads[i].flags = MEDIA_PAD_FL_SOURCE;

> > +

> > +	ret = media_entity_pads_init(&isp->subdev.entity, RCAR_ISP_MAX_PAD,

> > +				     isp->pads);

> > +	if (ret)

> > +		goto error;

> > +

> > +	pm_runtime_enable(&pdev->dev);

> > +

> > +	ret = v4l2_async_register_subdev(&isp->subdev);

> > +	if (ret < 0)

> > +		goto error;

> > +

> > +	dev_info(isp->dev, "Using CSI-2 input: %u\n", isp->csi_input);

> > +

> > +	return 0;

> > +error:

> > +	v4l2_async_notifier_unregister(&isp->notifier);

> > +	v4l2_async_notifier_cleanup(&isp->notifier);

> > +

> > +	return ret;

> > +}

> > +

> > +static int risp_remove(struct platform_device *pdev)

> > +{

> > +	struct rcar_isp *isp = platform_get_drvdata(pdev);

> > +

> > +	v4l2_async_notifier_unregister(&isp->notifier);

> > +	v4l2_async_notifier_cleanup(&isp->notifier);

> > +	v4l2_async_unregister_subdev(&isp->subdev);

> > +

> > +	pm_runtime_disable(&pdev->dev);

> 

> Isn't it better to turn power off first, then unregister the subdev ?


Why? I like that remove is done in reverse order from probe. Is there a 
down side I'm missing?

> 

> Also, I wonder if we can enforce the reset sequence as specified in

> "25B.6.3.1 Boot up sequence type 1" which implies the VIN and ISP

> resets should be ordered.


I don't think so, it has to be enforced from user-space by the order of 
unbinding of the devices, no?

On the same note I'm toying with the idea of setting suppress_bind_attrs 
for all drivers involved as unbinding and then rebinding things using 
v4l-async is horribly broken anyhow ;-)

> 

> Thanks

>    j

> 

> > +

> > +	return 0;

> > +}

> > +

> > +static struct platform_driver rcar_isp_driver = {

> > +	.driver = {

> > +		.name = "rcar-isp",

> > +		.of_match_table = risp_of_id_table,

> > +	},

> > +	.probe = risp_probe,

> > +	.remove = risp_remove,

> > +};

> > +

> > +module_platform_driver(rcar_isp_driver);

> > +

> > +MODULE_AUTHOR("Niklas Söderlund <niklas.soderlund@ragnatech.se>");

> > +MODULE_DESCRIPTION("Renesas R-Car ISP Channel Selector driver");

> > +MODULE_LICENSE("GPL");

> > --

> > 2.31.1

> >


-- 
Regards,
Niklas Söderlund
Jacopo Mondi July 6, 2021, 2:23 p.m. UTC | #6
Hi Niklas,
 A few more comments

On Wed, Jun 30, 2021 at 03:40:42PM +0200, Niklas Söderlund wrote:
> Hi Jacopo,

>

> Thanks for your feedback.

>

> On 2021-06-16 17:12:55 +0200, Jacopo Mondi wrote:

> > Hi Niklas,

> >

> > On Wed, May 12, 2021 at 10:19:12AM +0200, Niklas Söderlund wrote:

> > > Add a V4L2 driver for Renesas R-Car Image Signal Processor. The driver

> > > supports the R-Car V3U SoC where the ISP IP sits between the R-Car CSI-2

> > > receiver and VIN and filters the CSI-2 data based on VC/DT and directs

> > > the video stream to different VIN IPs.

> > >

> > > Signed-off-by: Niklas Söderlund <niklas.soderlund+renesas@ragnatech.se>

> > > ---

> > >  MAINTAINERS                       |   1 +

> > >  drivers/media/platform/Kconfig    |  16 +

> > >  drivers/media/platform/Makefile   |   1 +

> > >  drivers/media/platform/rcar-isp.c | 500 ++++++++++++++++++++++++++++++

> >

> > Have you considered adding the driver to platform/rcar-vin where the

> > VIN/CSI-2 drivers live already ?

>

> Yes I did, but I opted to go the other way around and will move the

> rcar-csi2.c out of the rcar-vin directory. The VIN + CSI-2 is a legacy

> pre media graph times (was never part of an upstream kernel) and really

> makes no sens now.


Can I suggest already a drivers/media/platform/renesas subdir not to
flood the main drivers/media/platform/ ?

>

> >

> > >  4 files changed, 518 insertions(+)

> > >  create mode 100644 drivers/media/platform/rcar-isp.c

> > >

> > > diff --git a/MAINTAINERS b/MAINTAINERS

> > > index c35a9c93da84f4f7..03f3d52e03596f66 100644

> > > --- a/MAINTAINERS

> > > +++ b/MAINTAINERS

> > > @@ -11400,6 +11400,7 @@ T:	git git://linuxtv.org/media_tree.git

> > >  F:	Documentation/devicetree/bindings/media/renesas,csi2.yaml

> > >  F:	Documentation/devicetree/bindings/media/renesas,isp.yaml

> > >  F:	Documentation/devicetree/bindings/media/renesas,vin.yaml

> > > +F:	drivers/media/platform/rcar-isp.c

> > >  F:	drivers/media/platform/rcar-vin/

> > >

> > >  MEDIA DRIVERS FOR RENESAS - VSP1

> > > diff --git a/drivers/media/platform/Kconfig b/drivers/media/platform/Kconfig

> > > index 157c924686e4b61b..a8777d5dd6bc3ec1 100644

> > > --- a/drivers/media/platform/Kconfig

> > > +++ b/drivers/media/platform/Kconfig

> > > @@ -200,6 +200,22 @@ config VIDEO_TI_CAL_MC

> > >

> > >  endif # VIDEO_TI_CAL

> > >

> > > +config VIDEO_RCAR_ISP

> > > +	tristate "R-Car Image Signal Processor (ISP)"

> > > +	depends on VIDEO_V4L2 && OF

> > > +	depends on ARCH_RENESAS || COMPILE_TEST

> > > +	select MEDIA_CONTROLLER

> > > +	select VIDEO_V4L2_SUBDEV_API

> > > +	select RESET_CONTROLLER

> > > +	select V4L2_FWNODE

> > > +	help

> > > +	  Support for Renesas R-Car Image Signal Processor (ISP).

> > > +	  Enable this to support the Renesas R-Car Image Signal

> > > +	  Processor (ISP).

> > > +

> > > +	  To compile this driver as a module, choose M here: the

> > > +	  module will be called rcar-isp.

> > > +

> > >  endif # V4L_PLATFORM_DRIVERS

> > >

> > >  menuconfig V4L_MEM2MEM_DRIVERS

> > > diff --git a/drivers/media/platform/Makefile b/drivers/media/platform/Makefile

> > > index eedc14aafb32c2fa..8ae543f6ef764c48 100644

> > > --- a/drivers/media/platform/Makefile

> > > +++ b/drivers/media/platform/Makefile

> > > @@ -63,6 +63,7 @@ obj-$(CONFIG_VIDEO_AM437X_VPFE)		+= am437x/

> > >

> > >  obj-$(CONFIG_VIDEO_XILINX)		+= xilinx/

> > >

> > > +obj-$(CONFIG_VIDEO_RCAR_ISP)		+= rcar-isp.o

> > >  obj-$(CONFIG_VIDEO_RCAR_VIN)		+= rcar-vin/

> > >

> > >  obj-$(CONFIG_VIDEO_ATMEL_ISC)		+= atmel/

> > > diff --git a/drivers/media/platform/rcar-isp.c b/drivers/media/platform/rcar-isp.c

> > > new file mode 100644

> > > index 0000000000000000..bf6a376354ece89d

> > > --- /dev/null

> > > +++ b/drivers/media/platform/rcar-isp.c

> > > @@ -0,0 +1,500 @@

> > > +// SPDX-License-Identifier: GPL-2.0

> > > +/*

> > > + * Driver for Renesas R-Car ISP Channel Selector

> > > + *

> > > + * Copyright (C) 2021 Renesas Electronics Corp.

> > > + */

> > > +

> > > +#include <linux/module.h>

> > > +#include <linux/mutex.h>

> > > +#include <linux/of_device.h>

> > > +#include <linux/platform_device.h>

> > > +#include <linux/pm_runtime.h>

> > > +#include <linux/reset.h>

> > > +

> > > +#include <media/v4l2-subdev.h>

> > > +

> > > +#define ISPINPUTSEL0_REG				0x0008

> > > +#define ISPINPUTSEL0_SEL_CSI0				BIT(31)

> > > +

> > > +#define ISPSTART_REG					0x0014

> > > +#define ISPSTART_START					0xffff

> > > +#define ISPSTART_STOP					0x0000

> > > +

> > > +#define ISPPROCMODE_DT_REG(n)			(0x1100 + (0x4 * n))


Should 'n' be () enclosed ? Here and below

> > > +#define ISPPROCMODE_DT_PROC_MODE_VC3(pm)		(((pm) & 0x3f) << 24)

> > > +#define ISPPROCMODE_DT_PROC_MODE_VC2(pm)		(((pm) & 0x3f) << 16)

> > > +#define ISPPROCMODE_DT_PROC_MODE_VC1(pm)		(((pm) & 0x3f) << 8)

> > > +#define ISPPROCMODE_DT_PROC_MODE_VC0(pm)		((pm) & 0x3f)

> > > +

> > > +#define ISPCS_FILTER_ID_CH_REG(n)			(0x3000 + (0x0100 * n))

> > > +

> > > +#define ISPCS_DT_CODE03_CH_REG(n)			(0x3008 + (0x100 * n))

> > > +#define ISPCS_DT_CODE03_EN3				BIT(31)

> > > +#define ISPCS_DT_CODE03_DT3(dt)				(((dt) & 0x3f) << 24)

> > > +#define ISPCS_DT_CODE03_EN2				BIT(23)

> > > +#define ISPCS_DT_CODE03_DT2(dt)				(((dt) & 0x3f) << 16)

> > > +#define ISPCS_DT_CODE03_EN1				BIT(15)

> > > +#define ISPCS_DT_CODE03_DT1(dt)				(((dt) & 0x3f) << 8)

> > > +#define ISPCS_DT_CODE03_EN0				BIT(7)

> > > +#define ISPCS_DT_CODE03_DT0(dt)				((dt) & 0x3f)

> > > +

> > > +struct rcar_isp_format {

> > > +	u32 code;

> > > +	unsigned int datatype;

> > > +	unsigned int procmode;

> > > +};

> > > +

> > > +static const struct rcar_isp_format rcar_isp_formats[] = {

> > > +	{ .code = MEDIA_BUS_FMT_RGB888_1X24,	.datatype = 0x24, .procmode = 0x15 },

> > > +	{ .code = MEDIA_BUS_FMT_Y10_1X10,	.datatype = 0x2b, .procmode = 0x10 },

> > > +	{ .code = MEDIA_BUS_FMT_UYVY8_1X16,	.datatype = 0x1e, .procmode = 0x0c },

> > > +	{ .code = MEDIA_BUS_FMT_YUYV8_1X16,	.datatype = 0x1e, .procmode = 0x0c },

> > > +	{ .code = MEDIA_BUS_FMT_UYVY8_2X8,	.datatype = 0x1e, .procmode = 0x0c },

> > > +	{ .code = MEDIA_BUS_FMT_YUYV10_2X10,	.datatype = 0x1e, .procmode = 0x0c },

> > > +};

> > > +

> > > +static const struct rcar_isp_format *risp_code_to_fmt(unsigned int code)

> > > +{

> > > +	unsigned int i;

> > > +

> > > +	for (i = 0; i < ARRAY_SIZE(rcar_isp_formats); i++)

> > > +		if (rcar_isp_formats[i].code == code)

> > > +			return &rcar_isp_formats[i];

> >

> > Shouldn't the for loop be enclosed in { }  ?

>

> No, why? Maybe it's a matter of taste but it will not effect the code

> and IMHO adding { } here would just make it harder to read.

>


From Documentation/process/coding-style.rst


Also, use braces when a loop contains more than a single simple statement:

.. code-block:: c

	while (condition) {
		if (test)
			do_something();
	}


> >

> > > +

> > > +	return NULL;

> > > +}

> > > +

> > > +enum rcar_isp_input {

> > > +	RISP_CSI_INPUT0,

> > > +	RISP_CSI_INPUT1,

> > > +};

> > > +

> > > +enum rcar_isp_pads {

> > > +	RCAR_ISP_SINK,

> > > +	RCAR_ISP_PORT0,

> > > +	RCAR_ISP_PORT1,

> > > +	RCAR_ISP_PORT2,

> > > +	RCAR_ISP_PORT3,

> > > +	RCAR_ISP_PORT4,

> > > +	RCAR_ISP_PORT5,

> > > +	RCAR_ISP_PORT6,

> > > +	RCAR_ISP_PORT7,

> > > +	RCAR_ISP_MAX_PAD,

> > > +};

> > > +

> > > +struct rcar_isp {

> > > +	struct device *dev;

> > > +	void __iomem *base;

> > > +	struct reset_control *rstc;

> > > +

> > > +	enum rcar_isp_input csi_input;

> > > +

> > > +	struct v4l2_subdev subdev;

> > > +	struct media_pad pads[RCAR_ISP_MAX_PAD];

> > > +

> > > +	struct v4l2_async_notifier notifier;

> > > +	struct v4l2_subdev *remote;

> > > +	unsigned int remote_pad;

> > > +

> > > +	struct v4l2_mbus_framefmt mf;

> > > +

> > > +	struct mutex lock;


Mutexes are usually documented stating what they protect

> > > +	int stream_count;

> > > +};

> > > +

> > > +static inline struct rcar_isp *sd_to_isp(struct v4l2_subdev *sd)

> > > +{

> > > +	return container_of(sd, struct rcar_isp, subdev);

> > > +}

> > > +

> > > +static inline struct rcar_isp *notifier_to_isp(struct v4l2_async_notifier *n)

> > > +{

> > > +	return container_of(n, struct rcar_isp, notifier);

> > > +}

> > > +

> > > +static void risp_write(struct rcar_isp *isp, u32 offset, u32 value)

> > > +{

> > > +	iowrite32(value, isp->base + offset);

> > > +}

> > > +

> > > +static u32 risp_read(struct rcar_isp *isp, u32 offset)

> > > +{

> > > +	return ioread32(isp->base + offset);

> > > +}

> > > +

> > > +static int risp_s_power(struct v4l2_subdev *sd, int on)

> > > +{

> > > +	struct rcar_isp *isp = sd_to_isp(sd);

> > > +	int ret;

> > > +

> > > +	if (on) {

> > > +		ret = pm_runtime_get_sync(isp->dev);

> >

> > pm_runtime_get_sync() increases the power usage count even it fails,

> > so it should be put in case of error.

> >

> > Or better, you can use pm_runtime_resume_and_get() towards which the

> > media subsystem is moving to. See

> > dd8088d5a896 ("PM: runtime: Add pm_runtime_resume_and_get to deal with usage counter")

>

> Good idea.

>

> >

> > > +		if (ret < 0)

> > > +			return ret;

> > > +

> > > +		ret = reset_control_deassert(isp->rstc);

> > > +		if (ret < 0)

> > > +			return ret;

> >

> > Where are the pm ops defined ? Shouldn't you define a pm suspend a

> > and a pm resume ops that assert/deassert the reset controller ?

>

> No that would be trick to get resume to work if a capture was going on

> at suspend time. Instead the suspend/resume for the capture chain is

> controlled from the R-Car VIN driver that stops/starts capture in it's

> suspend/resume handlers if capture is running. If no capture is running

> the device is already powered off.

>


I'm not sure I got this fully to be honest. VIN pm ops stop the DMA
transfers, but doesn't each subdevice in the capture chain do its own
housekeeping ? Otherwise this is just for ref-counting, isn't it ?

Maybe not an issue, I see the rcar-csi2 driver behaving the same, with the
enter/exit_standby routine that could easily be made pm_ops and be
called with pm_resume_and_get()/pm_resume_put() in rcsi2_start()
instead of being called directly. Otherwise the pm framework functions
are called just to keep its refcounting balanced, isn't it ?

> >

> > > +	} else {

> > > +		reset_control_assert(isp->rstc);

> > > +		pm_runtime_put(isp->dev);

> > > +	}

> >

> > This could be simplified as

> >

> >         if (!on) {

> > 		reset_control_assert(isp->rstc);

> >                 pm_runtime_put(isp->dev);

> >

> >                 return 0;

> >         }

> >

> >         ...

> >

> > But it's mostly a matter of tastes

>

> :-)

>

> >

> > > +

> > > +	return 0;

> > > +}

> > > +

> > > +static const struct v4l2_subdev_core_ops risp_core_ops = {

> > > +	.s_power = risp_s_power,

> > > +};

> > > +

> > > +static int risp_remote_code(struct rcar_isp *isp)

> > > +{

> > > +	struct v4l2_subdev_format fmt = {

> > > +		.which = V4L2_SUBDEV_FORMAT_ACTIVE,

> > > +	};

> > > +

> > > +	fmt.pad = isp->remote_pad;

> > > +	if (v4l2_subdev_call(isp->remote, pad, get_fmt, NULL, &fmt))

> > > +		return -EPIPE;

> > > +

> > > +	return fmt.format.code;

> > > +}

> > > +

> > > +static int risp_start(struct rcar_isp *isp)

> > > +{

> > > +	const struct rcar_isp_format *format;

> > > +	unsigned int vc;

> > > +	u32 sel_csi = 0;

> > > +

> > > +	format = risp_code_to_fmt(risp_remote_code(isp));

> >

> > Why are you quering the remote side format ? In a fully-mc driver

> > shouldn't the format on the active source pad be used ?

>

> In a perfect world yes. But until we have the media graph format

> validation introduced in different form from the multiplexed stream

> series the pad format validation in the core is broken. So I can either


Ah, I thought the purpose of v4l2_subdev_link_validate_default() was
exactly this regardless of the direction where multiplexed stream will
go.

> get the remote format here and compare it and fail capture start if they

> differ or I can just fetch it and use it.

>

> As both methods are "wrong" as we can't describe multiple formats for

> multiple streams on a CSI-2 link I choose to align this with how things

> are done in the R-Car CSI-2 driver which also is involved in the same

> capture chain. At least we are consistency "wrong" ;-)

>

> >

> > > +	if (!format) {

> > > +		dev_err(isp->dev, "Unsupported bus format\n");

> > > +		return -EINVAL;

> > > +	}

> > > +

> > > +	/* Select CSI-2 input source. */

> > > +	if (isp->csi_input == RISP_CSI_INPUT1)

> > > +		sel_csi = ISPINPUTSEL0_SEL_CSI0;

> >

> > Depending on my question below on how many endpoint we can have,

> > shouldn't the channel selection depend on the active media link ?

>

> We should indeed do that. The schematics are a bit unclear on how this

> is wired up on the V3U and I have been able to create the DT description

> used to test this driver by trail and error. So for now I have opted to

> keep the driver to only support a single endpoint. The blocker is not

> that it's hard to do but rather I can't test it.

>

> The bindings description takes this into account and allows for the two

> possible endpoints to be described correctly. But currently as you

> noticed the driver will fail to probe if two endpoints are described.


I see and I see the bindings not going into any detail about the
endpoints required on port0, so I guess this doesn't block anything
ahead. It should however be trivial to configure the CSI-2 routing at
link_setup() time so that once done will work with multiple
endpoints.. oh well, not a big deal now and can be easily added on top

>

> >

> > > +

> > > +	risp_write(isp, ISPINPUTSEL0_REG,

> > > +		   risp_read(isp, ISPINPUTSEL0_REG) | sel_csi);

> > > +

> > > +	/* Configure Channel Selector. */

> > > +	for (vc = 0; vc < 4; vc++) {

> > > +		u8 ch = vc + 4;

> > > +		u8 dt = format->datatype;

> > > +

> > > +		risp_write(isp, ISPCS_FILTER_ID_CH_REG(ch), BIT(vc));

> > > +		risp_write(isp, ISPCS_DT_CODE03_CH_REG(ch),

> > > +			   ISPCS_DT_CODE03_EN3 | ISPCS_DT_CODE03_DT3(dt) |

> > > +			   ISPCS_DT_CODE03_EN2 | ISPCS_DT_CODE03_DT2(dt) |

> > > +			   ISPCS_DT_CODE03_EN1 | ISPCS_DT_CODE03_DT1(dt) |

> > > +			   ISPCS_DT_CODE03_EN0 | ISPCS_DT_CODE03_DT0(dt));

> > > +	}

> > > +

> > > +	/* Setup processing method. */

> > > +	risp_write(isp, ISPPROCMODE_DT_REG(format->datatype),

> > > +		   ISPPROCMODE_DT_PROC_MODE_VC3(format->procmode) |

> > > +		   ISPPROCMODE_DT_PROC_MODE_VC2(format->procmode) |

> > > +		   ISPPROCMODE_DT_PROC_MODE_VC1(format->procmode) |

> > > +		   ISPPROCMODE_DT_PROC_MODE_VC0(format->procmode));

> > > +

> > > +	/* Start ISP. */

> > > +	risp_write(isp, ISPSTART_REG, ISPSTART_START);

> > > +

> > > +	return v4l2_subdev_call(isp->remote, video, s_stream, 1);

> > > +}

> > > +

> > > +static void risp_stop(struct rcar_isp *isp)

> > > +{

> > > +	v4l2_subdev_call(isp->remote, video, s_stream, 0);

> > > +

> > > +	/* Stop ISP. */

> > > +	risp_write(isp, ISPSTART_REG, ISPSTART_STOP);

> > > +}

> > > +

> > > +static int risp_s_stream(struct v4l2_subdev *sd, int enable)

> > > +{

> > > +	struct rcar_isp *isp = sd_to_isp(sd);

> > > +	int ret = 0;

> > > +

> > > +	mutex_lock(&isp->lock);

> > > +

> > > +	if (!isp->remote) {

> >

> > If we don't have a remote the media graph is not completed, hence can

> > we ever get here ?

> >

> > Also, does this need to be checked while holding the mutex ?

>

> This goes a bit hand in hand with your question above. For a single

> endpoint with an immutable media link we can't get here. But as soon as

> we allow for the link selection in the graph we could get here if both

> links are disabled.

>


Doesn't __media_pipeline_start() make sure that at least one link is
valid for you ?


> >

> > > +		ret = -ENODEV;

> > > +		goto out;

> > > +	}

> > > +

> > > +	if (enable && isp->stream_count == 0) {

> > > +		ret = risp_start(isp);

> > > +		if (ret)

> > > +			goto out;

> > > +	} else if (!enable && isp->stream_count == 1) {

> > > +		risp_stop(isp);

> > > +	}

> > > +

> > > +	isp->stream_count += enable ? 1 : -1;

> > > +out:

> > > +	mutex_unlock(&isp->lock);

> > > +

> > > +	return ret;

> > > +}

> > > +

> > > +static const struct v4l2_subdev_video_ops risp_video_ops = {

> > > +	.s_stream = risp_s_stream,

> > > +};

> > > +

> > > +static int risp_set_pad_format(struct v4l2_subdev *sd,

> > > +			       struct v4l2_subdev_pad_config *cfg,

> > > +			       struct v4l2_subdev_format *format)

> > > +{

> > > +	struct rcar_isp *isp = sd_to_isp(sd);

> > > +	struct v4l2_mbus_framefmt *framefmt;

> > > +

> > > +	if (!risp_code_to_fmt(format->format.code))

> > > +		format->format.code = rcar_isp_formats[0].code;

> >

> > Doesn't this mean the format is not supported ?

>

> Yes, and then we need to set it to something that is.

>


Correct, we should adjust not refuse it

> >

> > > +

> > > +	if (format->which == V4L2_SUBDEV_FORMAT_ACTIVE) {

> > > +		isp->mf = format->format;

> > > +	} else {

> > > +		framefmt = v4l2_subdev_get_try_format(sd, cfg, 0);

> > > +		*framefmt = format->format;

> > > +	}

> > > +

> > > +	return 0;

> > > +}

> > > +

> > > +static int risp_get_pad_format(struct v4l2_subdev *sd,

> > > +			       struct v4l2_subdev_pad_config *cfg,

> > > +			       struct v4l2_subdev_format *format)

> > > +{

> > > +	struct rcar_isp *isp = sd_to_isp(sd);

> > > +

> > > +	if (format->which == V4L2_SUBDEV_FORMAT_ACTIVE)

> > > +		format->format = isp->mf;

> > > +	else

> > > +		format->format = *v4l2_subdev_get_try_format(sd, cfg, 0);

> > > +

> > > +	return 0;

> > > +}

> > > +

> > > +static const struct v4l2_subdev_pad_ops risp_pad_ops = {

> > > +	.set_fmt = risp_set_pad_format,

> > > +	.get_fmt = risp_get_pad_format,

> > > +};

> > > +

> > > +static const struct v4l2_subdev_ops rcar_isp_subdev_ops = {

> > > +	.core	= &risp_core_ops,

> > > +	.video	= &risp_video_ops,

> > > +	.pad	= &risp_pad_ops,

> > > +};

> > > +

> > > +/* -----------------------------------------------------------------------------

> > > + * Async handling and registration of subdevices and links

> > > + */

> > > +

> > > +static int risp_notify_bound(struct v4l2_async_notifier *notifier,

> > > +			     struct v4l2_subdev *subdev,

> > > +			     struct v4l2_async_subdev *asd)

> > > +{

> > > +	struct rcar_isp *isp = notifier_to_isp(notifier);

> > > +	int pad;

> > > +

> > > +	pad = media_entity_get_fwnode_pad(&subdev->entity, asd->match.fwnode,

> > > +					  MEDIA_PAD_FL_SOURCE);

> > > +	if (pad < 0) {

> > > +		dev_err(isp->dev, "Failed to find pad for %s\n", subdev->name);

> > > +		return pad;

> > > +	}

> > > +

> > > +	isp->remote = subdev;

> > > +	isp->remote_pad = pad;

> > > +

> > > +	dev_dbg(isp->dev, "Bound %s pad: %d\n", subdev->name, pad);

> > > +

> > > +	return media_create_pad_link(&subdev->entity, pad,

> > > +				     &isp->subdev.entity, 0,

> > > +				     MEDIA_LNK_FL_ENABLED |

> > > +				     MEDIA_LNK_FL_IMMUTABLE);

> >

> > Depending on the answer to my question below about endpoints, should

> > the links be created for all connected entities and isp->remote

> > assigned at link enablement time ?

>

> As state above yes, once we can test it.

>

> >

> > > +}

> > > +

> > > +static void risp_notify_unbind(struct v4l2_async_notifier *notifier,

> > > +			       struct v4l2_subdev *subdev,

> > > +			       struct v4l2_async_subdev *asd)

> > > +{

> > > +	struct rcar_isp *isp = notifier_to_isp(notifier);

> > > +

> > > +	isp->remote = NULL;

> > > +

> > > +	dev_dbg(isp->dev, "Unbind %s\n", subdev->name);

> > > +}

> > > +

> > > +static const struct v4l2_async_notifier_operations risp_notify_ops = {

> > > +	.bound = risp_notify_bound,

> > > +	.unbind = risp_notify_unbind,

> > > +};

> > > +

> > > +static int risp_parse_dt(struct rcar_isp *isp)

> > > +{

> > > +	struct v4l2_async_subdev *asd;

> > > +	struct fwnode_handle *fwnode;

> > > +	struct fwnode_handle *ep;

> > > +	unsigned int id;

> > > +	int ret;

> > > +

> > > +	for (id = 0; id < 2; id++) {

> > > +		ep = fwnode_graph_get_endpoint_by_id(dev_fwnode(isp->dev),

> > > +						     0, id, 0);

> > > +		if (ep)

> > > +			break;

> > > +	}

> > > +

> > > +	if (!ep) {

> > > +		dev_err(isp->dev, "Not connected to subdevice\n");

> > > +		return -EINVAL;

> > > +	}

> > > +

> > > +	if (id == 1)

> > > +		isp->csi_input = RISP_CSI_INPUT1;

> >

> > This seems to check which endpoints are specified on the local port

> > node. Am I wrong or this implies that only one endpoint at the time

> > should be specified ?

> >

> > Shouldn't we have both endpoints in the local node but only have one

> > media link active at the time ?

>

> Yes :-)

>

> >

> > > +

> > > +	fwnode = fwnode_graph_get_remote_endpoint(ep);

> > > +	fwnode_handle_put(ep);

> > > +

> > > +	dev_dbg(isp->dev, "Found '%pOF'\n", to_of_node(fwnode));

> > > +

> > > +	v4l2_async_notifier_init(&isp->notifier);

> > > +	isp->notifier.ops = &risp_notify_ops;

> > > +

> > > +	asd = v4l2_async_notifier_add_fwnode_subdev(&isp->notifier, fwnode,

> > > +						    struct v4l2_async_subdev);

> > > +	fwnode_handle_put(fwnode);

> > > +	if (IS_ERR(asd))

> > > +		return PTR_ERR(asd);

> > > +

> > > +	ret = v4l2_async_subdev_notifier_register(&isp->subdev, &isp->notifier);

> > > +	if (ret)

> > > +		v4l2_async_notifier_cleanup(&isp->notifier);

> > > +

> > > +	return ret;

> > > +}

> > > +

> > > +/* -----------------------------------------------------------------------------

> > > + * Platform Device Driver

> > > + */

> > > +

> > > +static const struct media_entity_operations risp_entity_ops = {

> > > +	.link_validate = v4l2_subdev_link_validate,

> > > +};

> > > +

> > > +static int risp_probe_resources(struct rcar_isp *isp,

> > > +				struct platform_device *pdev)

> > > +{

> > > +	struct resource *res;

> > > +

> > > +	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);

> > > +	isp->base = devm_ioremap_resource(&pdev->dev, res);

> > > +	if (IS_ERR(isp->base))

> > > +		return PTR_ERR(isp->base);

> > > +

> > > +	isp->rstc = devm_reset_control_get(&pdev->dev, NULL);

> > > +

> > > +	return PTR_ERR_OR_ZERO(isp->rstc);

> > > +}

> > > +

> > > +static const struct of_device_id risp_of_id_table[] = {

> > > +	{ .compatible = "renesas,r8a779a0-isp" },

> > > +	{ /* sentinel */ },

> > > +};

> > > +MODULE_DEVICE_TABLE(of, risp_of_id_table);

> >

> > Can this block be moved after _remove() ?

>

> I'm sure it could. But this is the style used in rcar-vin and rcar-csi2

> and I like to be consistent.

>

> >

> > > +

> > > +static int risp_probe(struct platform_device *pdev)

> > > +{

> > > +	struct rcar_isp *isp;

> > > +	unsigned int i;

> > > +	int ret;

> > > +

> > > +	isp = devm_kzalloc(&pdev->dev, sizeof(*isp), GFP_KERNEL);

> > > +	if (!isp)

> > > +		return -ENOMEM;

> > > +

> > > +	isp->dev = &pdev->dev;

> > > +

> > > +	mutex_init(&isp->lock);

> > > +	isp->stream_count = 0;

> >

> > isp is kzalloc-ed, is this required ?

>

> Good point, no.

>

> >

> > > +

> > > +	ret = risp_probe_resources(isp, pdev);

> > > +	if (ret) {

> > > +		dev_err(isp->dev, "Failed to get resources\n");

> > > +		return ret;

> > > +	}

> > > +

> > > +	platform_set_drvdata(pdev, isp);

> > > +

> > > +	ret = risp_parse_dt(isp);

> > > +	if (ret)

> > > +		return ret;

> > > +

> > > +	isp->subdev.owner = THIS_MODULE;

> > > +	isp->subdev.dev = &pdev->dev;

> > > +	v4l2_subdev_init(&isp->subdev, &rcar_isp_subdev_ops);

> > > +	v4l2_set_subdevdata(&isp->subdev, &pdev->dev);

> > > +	snprintf(isp->subdev.name, V4L2_SUBDEV_NAME_SIZE, "%s %s",

> > > +		 KBUILD_MODNAME, dev_name(&pdev->dev));

> > > +	isp->subdev.flags = V4L2_SUBDEV_FL_HAS_DEVNODE;

> > > +

> > > +	isp->subdev.entity.function = MEDIA_ENT_F_PROC_VIDEO_PIXEL_FORMATTER;

> > > +	isp->subdev.entity.ops = &risp_entity_ops;

> > > +

> > > +	isp->pads[RCAR_ISP_SINK].flags = MEDIA_PAD_FL_SINK;

> > > +	for (i = RCAR_ISP_PORT0; i < RCAR_ISP_MAX_PAD; i++)

> > > +		isp->pads[i].flags = MEDIA_PAD_FL_SOURCE;

> > > +

> > > +	ret = media_entity_pads_init(&isp->subdev.entity, RCAR_ISP_MAX_PAD,

> > > +				     isp->pads);

> > > +	if (ret)

> > > +		goto error;

> > > +

> > > +	pm_runtime_enable(&pdev->dev);

> > > +

> > > +	ret = v4l2_async_register_subdev(&isp->subdev);

> > > +	if (ret < 0)

> > > +		goto error;

> > > +

> > > +	dev_info(isp->dev, "Using CSI-2 input: %u\n", isp->csi_input);

> > > +

> > > +	return 0;

> > > +error:

> > > +	v4l2_async_notifier_unregister(&isp->notifier);

> > > +	v4l2_async_notifier_cleanup(&isp->notifier);

> > > +

> > > +	return ret;

> > > +}

> > > +

> > > +static int risp_remove(struct platform_device *pdev)

> > > +{

> > > +	struct rcar_isp *isp = platform_get_drvdata(pdev);

> > > +

> > > +	v4l2_async_notifier_unregister(&isp->notifier);

> > > +	v4l2_async_notifier_cleanup(&isp->notifier);

> > > +	v4l2_async_unregister_subdev(&isp->subdev);

> > > +

> > > +	pm_runtime_disable(&pdev->dev);

> >

> > Isn't it better to turn power off first, then unregister the subdev ?

>

> Why? I like that remove is done in reverse order from probe. Is there a

> down side I'm missing?


No, it's actually better the way it is :)

>

> >

> > Also, I wonder if we can enforce the reset sequence as specified in

> > "25B.6.3.1 Boot up sequence type 1" which implies the VIN and ISP

> > resets should be ordered.

>

> I don't think so, it has to be enforced from user-space by the order of

> unbinding of the devices, no?


Not sure, that what I was wondering about, and there's probably not
much we can do here...

>

> On the same note I'm toying with the idea of setting suppress_bind_attrs

> for all drivers involved as unbinding and then rebinding things using

> v4l-async is horribly broken anyhow ;-)

>


I would not mind indeed :) less problems and as we all know rebooting a device
is the only solution that works fine in 100% of the cases :)

Thanks
   j

> >

> > Thanks

> >    j

> >

> > > +

> > > +	return 0;

> > > +}

> > > +

> > > +static struct platform_driver rcar_isp_driver = {

> > > +	.driver = {

> > > +		.name = "rcar-isp",

> > > +		.of_match_table = risp_of_id_table,

> > > +	},

> > > +	.probe = risp_probe,

> > > +	.remove = risp_remove,

> > > +};

> > > +

> > > +module_platform_driver(rcar_isp_driver);

> > > +

> > > +MODULE_AUTHOR("Niklas Söderlund <niklas.soderlund@ragnatech.se>");

> > > +MODULE_DESCRIPTION("Renesas R-Car ISP Channel Selector driver");

> > > +MODULE_LICENSE("GPL");

> > > --

> > > 2.31.1

> > >

>

> --

> Regards,

> Niklas Söderlund
diff mbox series

Patch

diff --git a/MAINTAINERS b/MAINTAINERS
index c35a9c93da84f4f7..03f3d52e03596f66 100644
--- a/MAINTAINERS
+++ b/MAINTAINERS
@@ -11400,6 +11400,7 @@  T:	git git://linuxtv.org/media_tree.git
 F:	Documentation/devicetree/bindings/media/renesas,csi2.yaml
 F:	Documentation/devicetree/bindings/media/renesas,isp.yaml
 F:	Documentation/devicetree/bindings/media/renesas,vin.yaml
+F:	drivers/media/platform/rcar-isp.c
 F:	drivers/media/platform/rcar-vin/
 
 MEDIA DRIVERS FOR RENESAS - VSP1
diff --git a/drivers/media/platform/Kconfig b/drivers/media/platform/Kconfig
index 157c924686e4b61b..a8777d5dd6bc3ec1 100644
--- a/drivers/media/platform/Kconfig
+++ b/drivers/media/platform/Kconfig
@@ -200,6 +200,22 @@  config VIDEO_TI_CAL_MC
 
 endif # VIDEO_TI_CAL
 
+config VIDEO_RCAR_ISP
+	tristate "R-Car Image Signal Processor (ISP)"
+	depends on VIDEO_V4L2 && OF
+	depends on ARCH_RENESAS || COMPILE_TEST
+	select MEDIA_CONTROLLER
+	select VIDEO_V4L2_SUBDEV_API
+	select RESET_CONTROLLER
+	select V4L2_FWNODE
+	help
+	  Support for Renesas R-Car Image Signal Processor (ISP).
+	  Enable this to support the Renesas R-Car Image Signal
+	  Processor (ISP).
+
+	  To compile this driver as a module, choose M here: the
+	  module will be called rcar-isp.
+
 endif # V4L_PLATFORM_DRIVERS
 
 menuconfig V4L_MEM2MEM_DRIVERS
diff --git a/drivers/media/platform/Makefile b/drivers/media/platform/Makefile
index eedc14aafb32c2fa..8ae543f6ef764c48 100644
--- a/drivers/media/platform/Makefile
+++ b/drivers/media/platform/Makefile
@@ -63,6 +63,7 @@  obj-$(CONFIG_VIDEO_AM437X_VPFE)		+= am437x/
 
 obj-$(CONFIG_VIDEO_XILINX)		+= xilinx/
 
+obj-$(CONFIG_VIDEO_RCAR_ISP)		+= rcar-isp.o
 obj-$(CONFIG_VIDEO_RCAR_VIN)		+= rcar-vin/
 
 obj-$(CONFIG_VIDEO_ATMEL_ISC)		+= atmel/
diff --git a/drivers/media/platform/rcar-isp.c b/drivers/media/platform/rcar-isp.c
new file mode 100644
index 0000000000000000..bf6a376354ece89d
--- /dev/null
+++ b/drivers/media/platform/rcar-isp.c
@@ -0,0 +1,500 @@ 
+// SPDX-License-Identifier: GPL-2.0
+/*
+ * Driver for Renesas R-Car ISP Channel Selector
+ *
+ * Copyright (C) 2021 Renesas Electronics Corp.
+ */
+
+#include <linux/module.h>
+#include <linux/mutex.h>
+#include <linux/of_device.h>
+#include <linux/platform_device.h>
+#include <linux/pm_runtime.h>
+#include <linux/reset.h>
+
+#include <media/v4l2-subdev.h>
+
+#define ISPINPUTSEL0_REG				0x0008
+#define ISPINPUTSEL0_SEL_CSI0				BIT(31)
+
+#define ISPSTART_REG					0x0014
+#define ISPSTART_START					0xffff
+#define ISPSTART_STOP					0x0000
+
+#define ISPPROCMODE_DT_REG(n)				(0x1100 + (0x4 * n))
+#define ISPPROCMODE_DT_PROC_MODE_VC3(pm)		(((pm) & 0x3f) << 24)
+#define ISPPROCMODE_DT_PROC_MODE_VC2(pm)		(((pm) & 0x3f) << 16)
+#define ISPPROCMODE_DT_PROC_MODE_VC1(pm)		(((pm) & 0x3f) << 8)
+#define ISPPROCMODE_DT_PROC_MODE_VC0(pm)		((pm) & 0x3f)
+
+#define ISPCS_FILTER_ID_CH_REG(n)			(0x3000 + (0x0100 * n))
+
+#define ISPCS_DT_CODE03_CH_REG(n)			(0x3008 + (0x100 * n))
+#define ISPCS_DT_CODE03_EN3				BIT(31)
+#define ISPCS_DT_CODE03_DT3(dt)				(((dt) & 0x3f) << 24)
+#define ISPCS_DT_CODE03_EN2				BIT(23)
+#define ISPCS_DT_CODE03_DT2(dt)				(((dt) & 0x3f) << 16)
+#define ISPCS_DT_CODE03_EN1				BIT(15)
+#define ISPCS_DT_CODE03_DT1(dt)				(((dt) & 0x3f) << 8)
+#define ISPCS_DT_CODE03_EN0				BIT(7)
+#define ISPCS_DT_CODE03_DT0(dt)				((dt) & 0x3f)
+
+struct rcar_isp_format {
+	u32 code;
+	unsigned int datatype;
+	unsigned int procmode;
+};
+
+static const struct rcar_isp_format rcar_isp_formats[] = {
+	{ .code = MEDIA_BUS_FMT_RGB888_1X24,	.datatype = 0x24, .procmode = 0x15 },
+	{ .code = MEDIA_BUS_FMT_Y10_1X10,	.datatype = 0x2b, .procmode = 0x10 },
+	{ .code = MEDIA_BUS_FMT_UYVY8_1X16,	.datatype = 0x1e, .procmode = 0x0c },
+	{ .code = MEDIA_BUS_FMT_YUYV8_1X16,	.datatype = 0x1e, .procmode = 0x0c },
+	{ .code = MEDIA_BUS_FMT_UYVY8_2X8,	.datatype = 0x1e, .procmode = 0x0c },
+	{ .code = MEDIA_BUS_FMT_YUYV10_2X10,	.datatype = 0x1e, .procmode = 0x0c },
+};
+
+static const struct rcar_isp_format *risp_code_to_fmt(unsigned int code)
+{
+	unsigned int i;
+
+	for (i = 0; i < ARRAY_SIZE(rcar_isp_formats); i++)
+		if (rcar_isp_formats[i].code == code)
+			return &rcar_isp_formats[i];
+
+	return NULL;
+}
+
+enum rcar_isp_input {
+	RISP_CSI_INPUT0,
+	RISP_CSI_INPUT1,
+};
+
+enum rcar_isp_pads {
+	RCAR_ISP_SINK,
+	RCAR_ISP_PORT0,
+	RCAR_ISP_PORT1,
+	RCAR_ISP_PORT2,
+	RCAR_ISP_PORT3,
+	RCAR_ISP_PORT4,
+	RCAR_ISP_PORT5,
+	RCAR_ISP_PORT6,
+	RCAR_ISP_PORT7,
+	RCAR_ISP_MAX_PAD,
+};
+
+struct rcar_isp {
+	struct device *dev;
+	void __iomem *base;
+	struct reset_control *rstc;
+
+	enum rcar_isp_input csi_input;
+
+	struct v4l2_subdev subdev;
+	struct media_pad pads[RCAR_ISP_MAX_PAD];
+
+	struct v4l2_async_notifier notifier;
+	struct v4l2_subdev *remote;
+	unsigned int remote_pad;
+
+	struct v4l2_mbus_framefmt mf;
+
+	struct mutex lock;
+	int stream_count;
+};
+
+static inline struct rcar_isp *sd_to_isp(struct v4l2_subdev *sd)
+{
+	return container_of(sd, struct rcar_isp, subdev);
+}
+
+static inline struct rcar_isp *notifier_to_isp(struct v4l2_async_notifier *n)
+{
+	return container_of(n, struct rcar_isp, notifier);
+}
+
+static void risp_write(struct rcar_isp *isp, u32 offset, u32 value)
+{
+	iowrite32(value, isp->base + offset);
+}
+
+static u32 risp_read(struct rcar_isp *isp, u32 offset)
+{
+	return ioread32(isp->base + offset);
+}
+
+static int risp_s_power(struct v4l2_subdev *sd, int on)
+{
+	struct rcar_isp *isp = sd_to_isp(sd);
+	int ret;
+
+	if (on) {
+		ret = pm_runtime_get_sync(isp->dev);
+		if (ret < 0)
+			return ret;
+
+		ret = reset_control_deassert(isp->rstc);
+		if (ret < 0)
+			return ret;
+	} else {
+		reset_control_assert(isp->rstc);
+		pm_runtime_put(isp->dev);
+	}
+
+	return 0;
+}
+
+static const struct v4l2_subdev_core_ops risp_core_ops = {
+	.s_power = risp_s_power,
+};
+
+static int risp_remote_code(struct rcar_isp *isp)
+{
+	struct v4l2_subdev_format fmt = {
+		.which = V4L2_SUBDEV_FORMAT_ACTIVE,
+	};
+
+	fmt.pad = isp->remote_pad;
+	if (v4l2_subdev_call(isp->remote, pad, get_fmt, NULL, &fmt))
+		return -EPIPE;
+
+	return fmt.format.code;
+}
+
+static int risp_start(struct rcar_isp *isp)
+{
+	const struct rcar_isp_format *format;
+	unsigned int vc;
+	u32 sel_csi = 0;
+
+	format = risp_code_to_fmt(risp_remote_code(isp));
+	if (!format) {
+		dev_err(isp->dev, "Unsupported bus format\n");
+		return -EINVAL;
+	}
+
+	/* Select CSI-2 input source. */
+	if (isp->csi_input == RISP_CSI_INPUT1)
+		sel_csi = ISPINPUTSEL0_SEL_CSI0;
+
+	risp_write(isp, ISPINPUTSEL0_REG,
+		   risp_read(isp, ISPINPUTSEL0_REG) | sel_csi);
+
+	/* Configure Channel Selector. */
+	for (vc = 0; vc < 4; vc++) {
+		u8 ch = vc + 4;
+		u8 dt = format->datatype;
+
+		risp_write(isp, ISPCS_FILTER_ID_CH_REG(ch), BIT(vc));
+		risp_write(isp, ISPCS_DT_CODE03_CH_REG(ch),
+			   ISPCS_DT_CODE03_EN3 | ISPCS_DT_CODE03_DT3(dt) |
+			   ISPCS_DT_CODE03_EN2 | ISPCS_DT_CODE03_DT2(dt) |
+			   ISPCS_DT_CODE03_EN1 | ISPCS_DT_CODE03_DT1(dt) |
+			   ISPCS_DT_CODE03_EN0 | ISPCS_DT_CODE03_DT0(dt));
+	}
+
+	/* Setup processing method. */
+	risp_write(isp, ISPPROCMODE_DT_REG(format->datatype),
+		   ISPPROCMODE_DT_PROC_MODE_VC3(format->procmode) |
+		   ISPPROCMODE_DT_PROC_MODE_VC2(format->procmode) |
+		   ISPPROCMODE_DT_PROC_MODE_VC1(format->procmode) |
+		   ISPPROCMODE_DT_PROC_MODE_VC0(format->procmode));
+
+	/* Start ISP. */
+	risp_write(isp, ISPSTART_REG, ISPSTART_START);
+
+	return v4l2_subdev_call(isp->remote, video, s_stream, 1);
+}
+
+static void risp_stop(struct rcar_isp *isp)
+{
+	v4l2_subdev_call(isp->remote, video, s_stream, 0);
+
+	/* Stop ISP. */
+	risp_write(isp, ISPSTART_REG, ISPSTART_STOP);
+}
+
+static int risp_s_stream(struct v4l2_subdev *sd, int enable)
+{
+	struct rcar_isp *isp = sd_to_isp(sd);
+	int ret = 0;
+
+	mutex_lock(&isp->lock);
+
+	if (!isp->remote) {
+		ret = -ENODEV;
+		goto out;
+	}
+
+	if (enable && isp->stream_count == 0) {
+		ret = risp_start(isp);
+		if (ret)
+			goto out;
+	} else if (!enable && isp->stream_count == 1) {
+		risp_stop(isp);
+	}
+
+	isp->stream_count += enable ? 1 : -1;
+out:
+	mutex_unlock(&isp->lock);
+
+	return ret;
+}
+
+static const struct v4l2_subdev_video_ops risp_video_ops = {
+	.s_stream = risp_s_stream,
+};
+
+static int risp_set_pad_format(struct v4l2_subdev *sd,
+			       struct v4l2_subdev_pad_config *cfg,
+			       struct v4l2_subdev_format *format)
+{
+	struct rcar_isp *isp = sd_to_isp(sd);
+	struct v4l2_mbus_framefmt *framefmt;
+
+	if (!risp_code_to_fmt(format->format.code))
+		format->format.code = rcar_isp_formats[0].code;
+
+	if (format->which == V4L2_SUBDEV_FORMAT_ACTIVE) {
+		isp->mf = format->format;
+	} else {
+		framefmt = v4l2_subdev_get_try_format(sd, cfg, 0);
+		*framefmt = format->format;
+	}
+
+	return 0;
+}
+
+static int risp_get_pad_format(struct v4l2_subdev *sd,
+			       struct v4l2_subdev_pad_config *cfg,
+			       struct v4l2_subdev_format *format)
+{
+	struct rcar_isp *isp = sd_to_isp(sd);
+
+	if (format->which == V4L2_SUBDEV_FORMAT_ACTIVE)
+		format->format = isp->mf;
+	else
+		format->format = *v4l2_subdev_get_try_format(sd, cfg, 0);
+
+	return 0;
+}
+
+static const struct v4l2_subdev_pad_ops risp_pad_ops = {
+	.set_fmt = risp_set_pad_format,
+	.get_fmt = risp_get_pad_format,
+};
+
+static const struct v4l2_subdev_ops rcar_isp_subdev_ops = {
+	.core	= &risp_core_ops,
+	.video	= &risp_video_ops,
+	.pad	= &risp_pad_ops,
+};
+
+/* -----------------------------------------------------------------------------
+ * Async handling and registration of subdevices and links
+ */
+
+static int risp_notify_bound(struct v4l2_async_notifier *notifier,
+			     struct v4l2_subdev *subdev,
+			     struct v4l2_async_subdev *asd)
+{
+	struct rcar_isp *isp = notifier_to_isp(notifier);
+	int pad;
+
+	pad = media_entity_get_fwnode_pad(&subdev->entity, asd->match.fwnode,
+					  MEDIA_PAD_FL_SOURCE);
+	if (pad < 0) {
+		dev_err(isp->dev, "Failed to find pad for %s\n", subdev->name);
+		return pad;
+	}
+
+	isp->remote = subdev;
+	isp->remote_pad = pad;
+
+	dev_dbg(isp->dev, "Bound %s pad: %d\n", subdev->name, pad);
+
+	return media_create_pad_link(&subdev->entity, pad,
+				     &isp->subdev.entity, 0,
+				     MEDIA_LNK_FL_ENABLED |
+				     MEDIA_LNK_FL_IMMUTABLE);
+}
+
+static void risp_notify_unbind(struct v4l2_async_notifier *notifier,
+			       struct v4l2_subdev *subdev,
+			       struct v4l2_async_subdev *asd)
+{
+	struct rcar_isp *isp = notifier_to_isp(notifier);
+
+	isp->remote = NULL;
+
+	dev_dbg(isp->dev, "Unbind %s\n", subdev->name);
+}
+
+static const struct v4l2_async_notifier_operations risp_notify_ops = {
+	.bound = risp_notify_bound,
+	.unbind = risp_notify_unbind,
+};
+
+static int risp_parse_dt(struct rcar_isp *isp)
+{
+	struct v4l2_async_subdev *asd;
+	struct fwnode_handle *fwnode;
+	struct fwnode_handle *ep;
+	unsigned int id;
+	int ret;
+
+	for (id = 0; id < 2; id++) {
+		ep = fwnode_graph_get_endpoint_by_id(dev_fwnode(isp->dev),
+						     0, id, 0);
+		if (ep)
+			break;
+	}
+
+	if (!ep) {
+		dev_err(isp->dev, "Not connected to subdevice\n");
+		return -EINVAL;
+	}
+
+	if (id == 1)
+		isp->csi_input = RISP_CSI_INPUT1;
+
+	fwnode = fwnode_graph_get_remote_endpoint(ep);
+	fwnode_handle_put(ep);
+
+	dev_dbg(isp->dev, "Found '%pOF'\n", to_of_node(fwnode));
+
+	v4l2_async_notifier_init(&isp->notifier);
+	isp->notifier.ops = &risp_notify_ops;
+
+	asd = v4l2_async_notifier_add_fwnode_subdev(&isp->notifier, fwnode,
+						    struct v4l2_async_subdev);
+	fwnode_handle_put(fwnode);
+	if (IS_ERR(asd))
+		return PTR_ERR(asd);
+
+	ret = v4l2_async_subdev_notifier_register(&isp->subdev, &isp->notifier);
+	if (ret)
+		v4l2_async_notifier_cleanup(&isp->notifier);
+
+	return ret;
+}
+
+/* -----------------------------------------------------------------------------
+ * Platform Device Driver
+ */
+
+static const struct media_entity_operations risp_entity_ops = {
+	.link_validate = v4l2_subdev_link_validate,
+};
+
+static int risp_probe_resources(struct rcar_isp *isp,
+				struct platform_device *pdev)
+{
+	struct resource *res;
+
+	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
+	isp->base = devm_ioremap_resource(&pdev->dev, res);
+	if (IS_ERR(isp->base))
+		return PTR_ERR(isp->base);
+
+	isp->rstc = devm_reset_control_get(&pdev->dev, NULL);
+
+	return PTR_ERR_OR_ZERO(isp->rstc);
+}
+
+static const struct of_device_id risp_of_id_table[] = {
+	{ .compatible = "renesas,r8a779a0-isp" },
+	{ /* sentinel */ },
+};
+MODULE_DEVICE_TABLE(of, risp_of_id_table);
+
+static int risp_probe(struct platform_device *pdev)
+{
+	struct rcar_isp *isp;
+	unsigned int i;
+	int ret;
+
+	isp = devm_kzalloc(&pdev->dev, sizeof(*isp), GFP_KERNEL);
+	if (!isp)
+		return -ENOMEM;
+
+	isp->dev = &pdev->dev;
+
+	mutex_init(&isp->lock);
+	isp->stream_count = 0;
+
+	ret = risp_probe_resources(isp, pdev);
+	if (ret) {
+		dev_err(isp->dev, "Failed to get resources\n");
+		return ret;
+	}
+
+	platform_set_drvdata(pdev, isp);
+
+	ret = risp_parse_dt(isp);
+	if (ret)
+		return ret;
+
+	isp->subdev.owner = THIS_MODULE;
+	isp->subdev.dev = &pdev->dev;
+	v4l2_subdev_init(&isp->subdev, &rcar_isp_subdev_ops);
+	v4l2_set_subdevdata(&isp->subdev, &pdev->dev);
+	snprintf(isp->subdev.name, V4L2_SUBDEV_NAME_SIZE, "%s %s",
+		 KBUILD_MODNAME, dev_name(&pdev->dev));
+	isp->subdev.flags = V4L2_SUBDEV_FL_HAS_DEVNODE;
+
+	isp->subdev.entity.function = MEDIA_ENT_F_PROC_VIDEO_PIXEL_FORMATTER;
+	isp->subdev.entity.ops = &risp_entity_ops;
+
+	isp->pads[RCAR_ISP_SINK].flags = MEDIA_PAD_FL_SINK;
+	for (i = RCAR_ISP_PORT0; i < RCAR_ISP_MAX_PAD; i++)
+		isp->pads[i].flags = MEDIA_PAD_FL_SOURCE;
+
+	ret = media_entity_pads_init(&isp->subdev.entity, RCAR_ISP_MAX_PAD,
+				     isp->pads);
+	if (ret)
+		goto error;
+
+	pm_runtime_enable(&pdev->dev);
+
+	ret = v4l2_async_register_subdev(&isp->subdev);
+	if (ret < 0)
+		goto error;
+
+	dev_info(isp->dev, "Using CSI-2 input: %u\n", isp->csi_input);
+
+	return 0;
+error:
+	v4l2_async_notifier_unregister(&isp->notifier);
+	v4l2_async_notifier_cleanup(&isp->notifier);
+
+	return ret;
+}
+
+static int risp_remove(struct platform_device *pdev)
+{
+	struct rcar_isp *isp = platform_get_drvdata(pdev);
+
+	v4l2_async_notifier_unregister(&isp->notifier);
+	v4l2_async_notifier_cleanup(&isp->notifier);
+	v4l2_async_unregister_subdev(&isp->subdev);
+
+	pm_runtime_disable(&pdev->dev);
+
+	return 0;
+}
+
+static struct platform_driver rcar_isp_driver = {
+	.driver = {
+		.name = "rcar-isp",
+		.of_match_table = risp_of_id_table,
+	},
+	.probe = risp_probe,
+	.remove = risp_remove,
+};
+
+module_platform_driver(rcar_isp_driver);
+
+MODULE_AUTHOR("Niklas Söderlund <niklas.soderlund@ragnatech.se>");
+MODULE_DESCRIPTION("Renesas R-Car ISP Channel Selector driver");
+MODULE_LICENSE("GPL");