[deliverable/linux.git] / drivers / media / platform / vsp1 / vsp1_entity.c

/*
 * vsp1_entity.c  --  R-Car VSP1 Base Entity
 *
 * Copyright (C) 2013-2014 Renesas Electronics Corporation
 *
 * Contact: Laurent Pinchart (laurent.pinchart@ideasonboard.com)
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 */

#include <linux/device.h>
#include <linux/gfp.h>

#include <media/media-entity.h>
#include <media/v4l2-ctrls.h>
#include <media/v4l2-subdev.h>

#include "vsp1.h"
#include "vsp1_dl.h"
#include "vsp1_entity.h"

static inline struct vsp1_entity *
media_entity_to_vsp1_entity(struct media_entity *entity)
{
	return container_of(entity, struct vsp1_entity, subdev.entity);
}

void vsp1_entity_route_setup(struct vsp1_entity *source,
			     struct vsp1_dl_list *dl)
{
	struct vsp1_entity *sink;

	if (source->route->reg == 0)
		return;

	sink = media_entity_to_vsp1_entity(source->sink);
	vsp1_dl_list_write(dl, source->route->reg,
			   sink->route->inputs[source->sink_pad]);
}

/* -----------------------------------------------------------------------------
 * V4L2 Subdevice Operations
 */

/**
 * vsp1_entity_get_pad_config - Get the pad configuration for an entity
 * @entity: the entity
 * @cfg: the TRY pad configuration
 * @which: configuration selector (ACTIVE or TRY)
 *
 * Return the pad configuration requested by the which argument. The TRY
 * configuration is passed explicitly to the function through the cfg argument
 * and simply returned when requested. The ACTIVE configuration comes from the
 * entity structure.
 */
struct v4l2_subdev_pad_config *
vsp1_entity_get_pad_config(struct vsp1_entity *entity,
			   struct v4l2_subdev_pad_config *cfg,
			   enum v4l2_subdev_format_whence which)
{
	switch (which) {
	case V4L2_SUBDEV_FORMAT_ACTIVE:
		return entity->config;
	case V4L2_SUBDEV_FORMAT_TRY:
	default:
		return cfg;
	}
}

/**
 * vsp1_entity_get_pad_format - Get a pad format from storage for an entity
 * @entity: the entity
 * @cfg: the configuration storage
 * @pad: the pad number
 *
 * Return the format stored in the given configuration for an entity's pad. The
 * configuration can be an ACTIVE or TRY configuration.
 */
struct v4l2_mbus_framefmt *
vsp1_entity_get_pad_format(struct vsp1_entity *entity,
			   struct v4l2_subdev_pad_config *cfg,
			   unsigned int pad)
{
	return v4l2_subdev_get_try_format(&entity->subdev, cfg, pad);
}

struct v4l2_rect *
vsp1_entity_get_pad_compose(struct vsp1_entity *entity,
			    struct v4l2_subdev_pad_config *cfg,
			    unsigned int pad)
{
	return v4l2_subdev_get_try_compose(&entity->subdev, cfg, pad);
}

/*
 * vsp1_entity_init_cfg - Initialize formats on all pads
 * @subdev: V4L2 subdevice
 * @cfg: V4L2 subdev pad configuration
 *
 * Initialize all pad formats with default values in the given pad config. This
 * function can be used as a handler for the subdev pad::init_cfg operation.
 */
int vsp1_entity_init_cfg(struct v4l2_subdev *subdev,
			 struct v4l2_subdev_pad_config *cfg)
{
	struct v4l2_subdev_format format;
	unsigned int pad;

	for (pad = 0; pad < subdev->entity.num_pads - 1; ++pad) {
		memset(&format, 0, sizeof(format));

		format.pad = pad;
		format.which = cfg ? V4L2_SUBDEV_FORMAT_TRY
			     : V4L2_SUBDEV_FORMAT_ACTIVE;

		v4l2_subdev_call(subdev, pad, set_fmt, cfg, &format);
	}

	return 0;
}

/*
 * vsp1_subdev_get_pad_format - Subdev pad get_fmt handler
 * @subdev: V4L2 subdevice
 * @cfg: V4L2 subdev pad configuration
 * @fmt: V4L2 subdev format
 *
 * This function implements the subdev get_fmt pad operation. It can be used as
 * a direct drop-in for the operation handler.
 */
int vsp1_subdev_get_pad_format(struct v4l2_subdev *subdev,
			       struct v4l2_subdev_pad_config *cfg,
			       struct v4l2_subdev_format *fmt)
{
	struct vsp1_entity *entity = to_vsp1_entity(subdev);
	struct v4l2_subdev_pad_config *config;

	config = vsp1_entity_get_pad_config(entity, cfg, fmt->which);
	if (!config)
		return -EINVAL;

	fmt->format = *vsp1_entity_get_pad_format(entity, config, fmt->pad);

	return 0;
}

/*
 * vsp1_subdev_enum_mbus_code - Subdev pad enum_mbus_code handler
 * @subdev: V4L2 subdevice
 * @cfg: V4L2 subdev pad configuration
 * @code: Media bus code enumeration
 * @codes: Array of supported media bus codes
 * @ncodes: Number of supported media bus codes
 *
 * This function implements the subdev enum_mbus_code pad operation for entities
 * that do not support format conversion. It enumerates the given supported
 * media bus codes on the sink pad and reports a source pad format identical to
 * the sink pad.
 */
int vsp1_subdev_enum_mbus_code(struct v4l2_subdev *subdev,
			       struct v4l2_subdev_pad_config *cfg,
			       struct v4l2_subdev_mbus_code_enum *code,
			       const unsigned int *codes, unsigned int ncodes)
{
	struct vsp1_entity *entity = to_vsp1_entity(subdev);

	if (code->pad == 0) {
		if (code->index >= ncodes)
			return -EINVAL;

		code->code = codes[code->index];
	} else {
		struct v4l2_subdev_pad_config *config;
		struct v4l2_mbus_framefmt *format;

		/* The entity can't perform format conversion, the sink format
		 * is always identical to the source format.
		 */
		if (code->index)
			return -EINVAL;

		config = vsp1_entity_get_pad_config(entity, cfg, code->which);
		if (!config)
			return -EINVAL;

		format = vsp1_entity_get_pad_format(entity, config, 0);
		code->code = format->code;
	}

	return 0;
}

/*
 * vsp1_subdev_enum_frame_size - Subdev pad enum_frame_size handler
 * @subdev: V4L2 subdevice
 * @cfg: V4L2 subdev pad configuration
 * @fse: Frame size enumeration
 * @min_width: Minimum image width
 * @min_height: Minimum image height
 * @max_width: Maximum image width
 * @max_height: Maximum image height
 *
 * This function implements the subdev enum_frame_size pad operation for
 * entities that do not support scaling or cropping. It reports the given
 * minimum and maximum frame width and height on the sink pad, and a fixed
 * source pad size identical to the sink pad.
 */
int vsp1_subdev_enum_frame_size(struct v4l2_subdev *subdev,
				struct v4l2_subdev_pad_config *cfg,
				struct v4l2_subdev_frame_size_enum *fse,
				unsigned int min_width, unsigned int min_height,
				unsigned int max_width, unsigned int max_height)
{
	struct vsp1_entity *entity = to_vsp1_entity(subdev);
	struct v4l2_subdev_pad_config *config;
	struct v4l2_mbus_framefmt *format;

	config = vsp1_entity_get_pad_config(entity, cfg, fse->which);
	if (!config)
		return -EINVAL;

	format = vsp1_entity_get_pad_format(entity, config, fse->pad);

	if (fse->index || fse->code != format->code)
		return -EINVAL;

	if (fse->pad == 0) {
		fse->min_width = min_width;
		fse->max_width = max_width;
		fse->min_height = min_height;
		fse->max_height = max_height;
	} else {
		/* The size on the source pad are fixed and always identical to
		 * the size on the sink pad.
		 */
		fse->min_width = format->width;
		fse->max_width = format->width;
		fse->min_height = format->height;
		fse->max_height = format->height;
	}

	return 0;
}

/* -----------------------------------------------------------------------------
 * Media Operations
 */

int vsp1_entity_link_setup(struct media_entity *entity,
			   const struct media_pad *local,
			   const struct media_pad *remote, u32 flags)
{
	struct vsp1_entity *source;

	if (!(local->flags & MEDIA_PAD_FL_SOURCE))
		return 0;

	source = media_entity_to_vsp1_entity(local->entity);

	if (!source->route)
		return 0;

	if (flags & MEDIA_LNK_FL_ENABLED) {
		if (source->sink)
			return -EBUSY;
		source->sink = remote->entity;
		source->sink_pad = remote->index;
	} else {
		source->sink = NULL;
		source->sink_pad = 0;
	}

	return 0;
}

/* -----------------------------------------------------------------------------
 * Initialization
 */

#define VSP1_ENTITY_ROUTE(ent)						\
	{ VSP1_ENTITY_##ent, 0, VI6_DPR_##ent##_ROUTE,			\
	  { VI6_DPR_NODE_##ent }, VI6_DPR_NODE_##ent }

#define VSP1_ENTITY_ROUTE_RPF(idx)					\
	{ VSP1_ENTITY_RPF, idx, VI6_DPR_RPF_ROUTE(idx),			\
	  { 0, }, VI6_DPR_NODE_RPF(idx) }

#define VSP1_ENTITY_ROUTE_UDS(idx)					\
	{ VSP1_ENTITY_UDS, idx, VI6_DPR_UDS_ROUTE(idx),			\
	  { VI6_DPR_NODE_UDS(idx) }, VI6_DPR_NODE_UDS(idx) }

#define VSP1_ENTITY_ROUTE_WPF(idx)					\
	{ VSP1_ENTITY_WPF, idx, 0,					\
	  { VI6_DPR_NODE_WPF(idx) }, VI6_DPR_NODE_WPF(idx) }

static const struct vsp1_route vsp1_routes[] = {
	{ VSP1_ENTITY_BRU, 0, VI6_DPR_BRU_ROUTE,
	  { VI6_DPR_NODE_BRU_IN(0), VI6_DPR_NODE_BRU_IN(1),
	    VI6_DPR_NODE_BRU_IN(2), VI6_DPR_NODE_BRU_IN(3),
	    VI6_DPR_NODE_BRU_IN(4) }, VI6_DPR_NODE_BRU_OUT },
	VSP1_ENTITY_ROUTE(HSI),
	VSP1_ENTITY_ROUTE(HST),
	{ VSP1_ENTITY_LIF, 0, 0, { VI6_DPR_NODE_LIF, }, VI6_DPR_NODE_LIF },
	VSP1_ENTITY_ROUTE(LUT),
	VSP1_ENTITY_ROUTE_RPF(0),
	VSP1_ENTITY_ROUTE_RPF(1),
	VSP1_ENTITY_ROUTE_RPF(2),
	VSP1_ENTITY_ROUTE_RPF(3),
	VSP1_ENTITY_ROUTE_RPF(4),
	VSP1_ENTITY_ROUTE(SRU),
	VSP1_ENTITY_ROUTE_UDS(0),
	VSP1_ENTITY_ROUTE_UDS(1),
	VSP1_ENTITY_ROUTE_UDS(2),
	VSP1_ENTITY_ROUTE_WPF(0),
	VSP1_ENTITY_ROUTE_WPF(1),
	VSP1_ENTITY_ROUTE_WPF(2),
	VSP1_ENTITY_ROUTE_WPF(3),
};

int vsp1_entity_init(struct vsp1_device *vsp1, struct vsp1_entity *entity,
		     const char *name, unsigned int num_pads,
		     const struct v4l2_subdev_ops *ops)
{
	struct v4l2_subdev *subdev;
	unsigned int i;
	int ret;

	for (i = 0; i < ARRAY_SIZE(vsp1_routes); ++i) {
		if (vsp1_routes[i].type == entity->type &&
		    vsp1_routes[i].index == entity->index) {
			entity->route = &vsp1_routes[i];
			break;
		}
	}

	if (i == ARRAY_SIZE(vsp1_routes))
		return -EINVAL;

	entity->vsp1 = vsp1;
	entity->source_pad = num_pads - 1;

	/* Allocate and initialize pads. */
	entity->pads = devm_kzalloc(vsp1->dev, num_pads * sizeof(*entity->pads),
				    GFP_KERNEL);
	if (entity->pads == NULL)
		return -ENOMEM;

	for (i = 0; i < num_pads - 1; ++i)
		entity->pads[i].flags = MEDIA_PAD_FL_SINK;

	entity->pads[num_pads - 1].flags = MEDIA_PAD_FL_SOURCE;

	/* Initialize the media entity. */
	ret = media_entity_pads_init(&entity->subdev.entity, num_pads,
				     entity->pads);
	if (ret < 0)
		return ret;

	/* Initialize the V4L2 subdev. */
	subdev = &entity->subdev;
	v4l2_subdev_init(subdev, ops);

	subdev->entity.ops = &vsp1->media_ops;
	subdev->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;

	snprintf(subdev->name, sizeof(subdev->name), "%s %s",
		 dev_name(vsp1->dev), name);

	vsp1_entity_init_cfg(subdev, NULL);

	/* Allocate the pad configuration to store formats and selection
	 * rectangles.
	 */
	entity->config = v4l2_subdev_alloc_pad_config(&entity->subdev);
	if (entity->config == NULL) {
		media_entity_cleanup(&entity->subdev.entity);
		return -ENOMEM;
	}

	return 0;
}

void vsp1_entity_destroy(struct vsp1_entity *entity)
{
	if (entity->ops && entity->ops->destroy)
		entity->ops->destroy(entity);
	if (entity->subdev.ctrl_handler)
		v4l2_ctrl_handler_free(entity->subdev.ctrl_handler);
	v4l2_subdev_free_pad_config(entity->config);
	media_entity_cleanup(&entity->subdev.entity);
}
Commit	Line	Data
26e0ca22 LP	1	/*
	2	* vsp1_entity.c -- R-Car VSP1 Base Entity
	3	*
8a1edc55	4	* Copyright (C) 2013-2014 Renesas Electronics Corporation
26e0ca22 LP	5	*
	6	* Contact: Laurent Pinchart (laurent.pinchart@ideasonboard.com)
	7	*
	8	* This program is free software; you can redistribute it and/or modify
	9	* it under the terms of the GNU General Public License as published by
	10	* the Free Software Foundation; either version 2 of the License, or
	11	* (at your option) any later version.
	12	*/
	13
	14	#include <linux/device.h>
	15	#include <linux/gfp.h>
	16
	17	#include <media/media-entity.h>
a626e64e	18	#include <media/v4l2-ctrls.h>
26e0ca22 LP	19	#include <media/v4l2-subdev.h>
	20
	21	#include "vsp1.h"
aa380ea0	22	#include "vsp1_dl.h"
26e0ca22	23	#include "vsp1_entity.h"
aa380ea0	24
7cf0f123 LP	25	static inline struct vsp1_entity *
	26	media_entity_to_vsp1_entity(struct media_entity *entity)
	27	{
	28	return container_of(entity, struct vsp1_entity, subdev.entity);
	29	}
	30
5e8dbbf3 LP	31	void vsp1_entity_route_setup(struct vsp1_entity *source,
5e8dbbf3 LP	32	struct vsp1_dl_list *dl)
665b693c LP	33	{
	34	struct vsp1_entity *sink;
	35
	36	if (source->route->reg == 0)
	37	return;
	38
7cf0f123	39	sink = media_entity_to_vsp1_entity(source->sink);
5e8dbbf3 LP	40	vsp1_dl_list_write(dl, source->route->reg,
5e8dbbf3 LP	41	sink->route->inputs[source->sink_pad]);
665b693c LP	42	}
665b693c LP	43
26e0ca22 LP	44	/* -----------------------------------------------------------------------------
	45	* V4L2 Subdevice Operations
	46	*/
	47
e790c3cb LP	48	/**
	49	* vsp1_entity_get_pad_config - Get the pad configuration for an entity
	50	* @entity: the entity
	51	* @cfg: the TRY pad configuration
	52	* @which: configuration selector (ACTIVE or TRY)
	53	*
	54	* Return the pad configuration requested by the which argument. The TRY
	55	* configuration is passed explicitly to the function through the cfg argument
	56	* and simply returned when requested. The ACTIVE configuration comes from the
	57	* entity structure.
	58	*/
	59	struct v4l2_subdev_pad_config *
	60	vsp1_entity_get_pad_config(struct vsp1_entity *entity,
f7234138	61	struct v4l2_subdev_pad_config *cfg,
e790c3cb	62	enum v4l2_subdev_format_whence which)
26e0ca22 LP	63	{
26e0ca22 LP	64	switch (which) {
26e0ca22	65	case V4L2_SUBDEV_FORMAT_ACTIVE:
e790c3cb LP	66	return entity->config;
e790c3cb LP	67	case V4L2_SUBDEV_FORMAT_TRY:
26e0ca22	68	default:
e790c3cb	69	return cfg;
26e0ca22 LP	70	}
	71	}
	72
e790c3cb LP	73	/**
	74	* vsp1_entity_get_pad_format - Get a pad format from storage for an entity
	75	* @entity: the entity
	76	* @cfg: the configuration storage
	77	* @pad: the pad number
	78	*
	79	* Return the format stored in the given configuration for an entity's pad. The
	80	* configuration can be an ACTIVE or TRY configuration.
	81	*/
	82	struct v4l2_mbus_framefmt *
	83	vsp1_entity_get_pad_format(struct vsp1_entity *entity,
	84	struct v4l2_subdev_pad_config *cfg,
	85	unsigned int pad)
	86	{
	87	return v4l2_subdev_get_try_format(&entity->subdev, cfg, pad);
	88	}
	89
b7e5107e LP	90	struct v4l2_rect *
	91	vsp1_entity_get_pad_compose(struct vsp1_entity *entity,
	92	struct v4l2_subdev_pad_config *cfg,
	93	unsigned int pad)
	94	{
	95	return v4l2_subdev_get_try_compose(&entity->subdev, cfg, pad);
	96	}
	97
26e0ca22	98	/*
0efdf0f5	99	* vsp1_entity_init_cfg - Initialize formats on all pads
26e0ca22	100	* @subdev: V4L2 subdevice
f7234138	101	* @cfg: V4L2 subdev pad configuration
26e0ca22	102	*
0efdf0f5 LP	103	* Initialize all pad formats with default values in the given pad config. This
0efdf0f5 LP	104	* function can be used as a handler for the subdev pad::init_cfg operation.
26e0ca22	105	*/
0efdf0f5 LP	106	int vsp1_entity_init_cfg(struct v4l2_subdev *subdev,
0efdf0f5 LP	107	struct v4l2_subdev_pad_config *cfg)
26e0ca22 LP	108	{
	109	struct v4l2_subdev_format format;
	110	unsigned int pad;
	111
	112	for (pad = 0; pad < subdev->entity.num_pads - 1; ++pad) {
	113	memset(&format, 0, sizeof(format));
	114
	115	format.pad = pad;
f7234138	116	format.which = cfg ? V4L2_SUBDEV_FORMAT_TRY
26e0ca22 LP	117	: V4L2_SUBDEV_FORMAT_ACTIVE;
26e0ca22 LP	118
f7234138	119	v4l2_subdev_call(subdev, pad, set_fmt, cfg, &format);
26e0ca22	120	}
26e0ca22 LP	121
	122	return 0;
	123	}
	124
3f557220 LP	125	/*
	126	* vsp1_subdev_get_pad_format - Subdev pad get_fmt handler
	127	* @subdev: V4L2 subdevice
	128	* @cfg: V4L2 subdev pad configuration
	129	* @fmt: V4L2 subdev format
	130	*
	131	* This function implements the subdev get_fmt pad operation. It can be used as
	132	* a direct drop-in for the operation handler.
	133	*/
	134	int vsp1_subdev_get_pad_format(struct v4l2_subdev *subdev,
	135	struct v4l2_subdev_pad_config *cfg,
	136	struct v4l2_subdev_format *fmt)
	137	{
	138	struct vsp1_entity *entity = to_vsp1_entity(subdev);
	139	struct v4l2_subdev_pad_config *config;
	140
	141	config = vsp1_entity_get_pad_config(entity, cfg, fmt->which);
	142	if (!config)
	143	return -EINVAL;
	144
	145	fmt->format = *vsp1_entity_get_pad_format(entity, config, fmt->pad);
	146
	147	return 0;
	148	}
	149
6ad9ba9c LP	150	/*
	151	* vsp1_subdev_enum_mbus_code - Subdev pad enum_mbus_code handler
	152	* @subdev: V4L2 subdevice
	153	* @cfg: V4L2 subdev pad configuration
	154	* @code: Media bus code enumeration
	155	* @codes: Array of supported media bus codes
	156	* @ncodes: Number of supported media bus codes
	157	*
	158	* This function implements the subdev enum_mbus_code pad operation for entities
	159	* that do not support format conversion. It enumerates the given supported
	160	* media bus codes on the sink pad and reports a source pad format identical to
	161	* the sink pad.
	162	*/
	163	int vsp1_subdev_enum_mbus_code(struct v4l2_subdev *subdev,
	164	struct v4l2_subdev_pad_config *cfg,
	165	struct v4l2_subdev_mbus_code_enum *code,
	166	const unsigned int *codes, unsigned int ncodes)
	167	{
	168	struct vsp1_entity *entity = to_vsp1_entity(subdev);
	169
	170	if (code->pad == 0) {
	171	if (code->index >= ncodes)
	172	return -EINVAL;
	173
	174	code->code = codes[code->index];
	175	} else {
	176	struct v4l2_subdev_pad_config *config;
	177	struct v4l2_mbus_framefmt *format;
	178
	179	/* The entity can't perform format conversion, the sink format
	180	* is always identical to the source format.
	181	*/
	182	if (code->index)
	183	return -EINVAL;
	184
	185	config = vsp1_entity_get_pad_config(entity, cfg, code->which);
	186	if (!config)
	187	return -EINVAL;
	188
	189	format = vsp1_entity_get_pad_format(entity, config, 0);
	190	code->code = format->code;
	191	}
	192
	193	return 0;
	194	}
	195
076e834f LP	196	/*
	197	* vsp1_subdev_enum_frame_size - Subdev pad enum_frame_size handler
	198	* @subdev: V4L2 subdevice
	199	* @cfg: V4L2 subdev pad configuration
	200	* @fse: Frame size enumeration
	201	* @min_width: Minimum image width
	202	* @min_height: Minimum image height
	203	* @max_width: Maximum image width
	204	* @max_height: Maximum image height
	205	*
	206	* This function implements the subdev enum_frame_size pad operation for
	207	* entities that do not support scaling or cropping. It reports the given
	208	* minimum and maximum frame width and height on the sink pad, and a fixed
	209	* source pad size identical to the sink pad.
	210	*/
	211	int vsp1_subdev_enum_frame_size(struct v4l2_subdev *subdev,
	212	struct v4l2_subdev_pad_config *cfg,
	213	struct v4l2_subdev_frame_size_enum *fse,
	214	unsigned int min_width, unsigned int min_height,
	215	unsigned int max_width, unsigned int max_height)
	216	{
	217	struct vsp1_entity *entity = to_vsp1_entity(subdev);
	218	struct v4l2_subdev_pad_config *config;
	219	struct v4l2_mbus_framefmt *format;
	220
	221	config = vsp1_entity_get_pad_config(entity, cfg, fse->which);
	222	if (!config)
	223	return -EINVAL;
	224
	225	format = vsp1_entity_get_pad_format(entity, config, fse->pad);
	226
	227	if (fse->index \|\| fse->code != format->code)
	228	return -EINVAL;
	229
	230	if (fse->pad == 0) {
	231	fse->min_width = min_width;
	232	fse->max_width = max_width;
	233	fse->min_height = min_height;
	234	fse->max_height = max_height;
	235	} else {
	236	/* The size on the source pad are fixed and always identical to
	237	* the size on the sink pad.
	238	*/
	239	fse->min_width = format->width;
	240	fse->max_width = format->width;
	241	fse->min_height = format->height;
	242	fse->max_height = format->height;
	243	}
	244
	245	return 0;
	246	}
	247
26e0ca22 LP	248	/* -----------------------------------------------------------------------------
	249	* Media Operations
	250	*/
	251
babca007 LP	252	int vsp1_entity_link_setup(struct media_entity *entity,
	253	const struct media_pad *local,
	254	const struct media_pad *remote, u32 flags)
26e0ca22 LP	255	{
	256	struct vsp1_entity *source;
	257
	258	if (!(local->flags & MEDIA_PAD_FL_SOURCE))
	259	return 0;
	260
7cf0f123	261	source = media_entity_to_vsp1_entity(local->entity);
26e0ca22 LP	262
	263	if (!source->route)
	264	return 0;
	265
	266	if (flags & MEDIA_LNK_FL_ENABLED) {
	267	if (source->sink)
	268	return -EBUSY;
	269	source->sink = remote->entity;
d9b45ed3	270	source->sink_pad = remote->index;
26e0ca22 LP	271	} else {
26e0ca22 LP	272	source->sink = NULL;
d9b45ed3	273	source->sink_pad = 0;
26e0ca22 LP	274	}
	275
	276	return 0;
	277	}
	278
26e0ca22 LP	279	/* -----------------------------------------------------------------------------
	280	* Initialization
	281	*/
	282
44f46198 LP	283	#define VSP1_ENTITY_ROUTE(ent) \
	284	{ VSP1_ENTITY_##ent, 0, VI6_DPR_##ent##_ROUTE, \
	285	{ VI6_DPR_NODE_##ent }, VI6_DPR_NODE_##ent }
	286
	287	#define VSP1_ENTITY_ROUTE_RPF(idx) \
	288	{ VSP1_ENTITY_RPF, idx, VI6_DPR_RPF_ROUTE(idx), \
	289	{ 0, }, VI6_DPR_NODE_RPF(idx) }
	290
	291	#define VSP1_ENTITY_ROUTE_UDS(idx) \
	292	{ VSP1_ENTITY_UDS, idx, VI6_DPR_UDS_ROUTE(idx), \
	293	{ VI6_DPR_NODE_UDS(idx) }, VI6_DPR_NODE_UDS(idx) }
	294
	295	#define VSP1_ENTITY_ROUTE_WPF(idx) \
	296	{ VSP1_ENTITY_WPF, idx, 0, \
	297	{ VI6_DPR_NODE_WPF(idx) }, VI6_DPR_NODE_WPF(idx) }
	298
d9b45ed3	299	static const struct vsp1_route vsp1_routes[] = {
629bb6d4 LP	300	{ VSP1_ENTITY_BRU, 0, VI6_DPR_BRU_ROUTE,
629bb6d4 LP	301	{ VI6_DPR_NODE_BRU_IN(0), VI6_DPR_NODE_BRU_IN(1),
7f2d50f8	302	VI6_DPR_NODE_BRU_IN(2), VI6_DPR_NODE_BRU_IN(3),
44f46198 LP	303	VI6_DPR_NODE_BRU_IN(4) }, VI6_DPR_NODE_BRU_OUT },
	304	VSP1_ENTITY_ROUTE(HSI),
	305	VSP1_ENTITY_ROUTE(HST),
	306	{ VSP1_ENTITY_LIF, 0, 0, { VI6_DPR_NODE_LIF, }, VI6_DPR_NODE_LIF },
	307	VSP1_ENTITY_ROUTE(LUT),
	308	VSP1_ENTITY_ROUTE_RPF(0),
	309	VSP1_ENTITY_ROUTE_RPF(1),
	310	VSP1_ENTITY_ROUTE_RPF(2),
	311	VSP1_ENTITY_ROUTE_RPF(3),
	312	VSP1_ENTITY_ROUTE_RPF(4),
	313	VSP1_ENTITY_ROUTE(SRU),
	314	VSP1_ENTITY_ROUTE_UDS(0),
	315	VSP1_ENTITY_ROUTE_UDS(1),
	316	VSP1_ENTITY_ROUTE_UDS(2),
	317	VSP1_ENTITY_ROUTE_WPF(0),
	318	VSP1_ENTITY_ROUTE_WPF(1),
	319	VSP1_ENTITY_ROUTE_WPF(2),
	320	VSP1_ENTITY_ROUTE_WPF(3),
d9b45ed3 LP	321	};
d9b45ed3 LP	322
26e0ca22	323	int vsp1_entity_init(struct vsp1_device vsp1, struct vsp1_entity entity,
823329df LP	324	const char *name, unsigned int num_pads,
823329df LP	325	const struct v4l2_subdev_ops *ops)
26e0ca22	326	{
823329df	327	struct v4l2_subdev *subdev;
26e0ca22	328	unsigned int i;
823329df	329	int ret;
26e0ca22	330
d9b45ed3 LP	331	for (i = 0; i < ARRAY_SIZE(vsp1_routes); ++i) {
	332	if (vsp1_routes[i].type == entity->type &&
	333	vsp1_routes[i].index == entity->index) {
	334	entity->route = &vsp1_routes[i];
26e0ca22 LP	335	break;
	336	}
	337	}
	338
d9b45ed3	339	if (i == ARRAY_SIZE(vsp1_routes))
26e0ca22 LP	340	return -EINVAL;
	341
	342	entity->vsp1 = vsp1;
	343	entity->source_pad = num_pads - 1;
	344
e790c3cb	345	/* Allocate and initialize pads. */
26e0ca22 LP	346	entity->pads = devm_kzalloc(vsp1->dev, num_pads * sizeof(*entity->pads),
	347	GFP_KERNEL);
	348	if (entity->pads == NULL)
	349	return -ENOMEM;
	350
26e0ca22 LP	351	for (i = 0; i < num_pads - 1; ++i)
	352	entity->pads[i].flags = MEDIA_PAD_FL_SINK;
	353
	354	entity->pads[num_pads - 1].flags = MEDIA_PAD_FL_SOURCE;
	355
	356	/* Initialize the media entity. */
823329df LP	357	ret = media_entity_pads_init(&entity->subdev.entity, num_pads,
	358	entity->pads);
	359	if (ret < 0)
	360	return ret;
	361
	362	/* Initialize the V4L2 subdev. */
	363	subdev = &entity->subdev;
	364	v4l2_subdev_init(subdev, ops);
	365
	366	subdev->entity.ops = &vsp1->media_ops;
823329df LP	367	subdev->flags \|= V4L2_SUBDEV_FL_HAS_DEVNODE;
	368
	369	snprintf(subdev->name, sizeof(subdev->name), "%s %s",
	370	dev_name(vsp1->dev), name);
	371
0efdf0f5	372	vsp1_entity_init_cfg(subdev, NULL);
823329df	373
e790c3cb LP	374	/* Allocate the pad configuration to store formats and selection
	375	* rectangles.
	376	*/
	377	entity->config = v4l2_subdev_alloc_pad_config(&entity->subdev);
	378	if (entity->config == NULL) {
	379	media_entity_cleanup(&entity->subdev.entity);
	380	return -ENOMEM;
	381	}
	382
823329df	383	return 0;
26e0ca22 LP	384	}
	385
	386	void vsp1_entity_destroy(struct vsp1_entity *entity)
	387	{
52434534 LP	388	if (entity->ops && entity->ops->destroy)
52434534 LP	389	entity->ops->destroy(entity);
a626e64e LP	390	if (entity->subdev.ctrl_handler)
a626e64e LP	391	v4l2_ctrl_handler_free(entity->subdev.ctrl_handler);
e790c3cb	392	v4l2_subdev_free_pad_config(entity->config);
26e0ca22 LP	393	media_entity_cleanup(&entity->subdev.entity);
26e0ca22 LP	394	}