[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);
}

/**
 * vsp1_entity_get_pad_selection - Get a pad selection from storage for entity
 * @entity: the entity
 * @cfg: the configuration storage
 * @pad: the pad number
 * @target: the selection target
 *
 * Return the selection rectangle stored in the given configuration for an
 * entity's pad. The configuration can be an ACTIVE or TRY configuration. The
 * selection target can be COMPOSE or CROP.
 */
struct v4l2_rect *
vsp1_entity_get_pad_selection(struct vsp1_entity *entity,
			      struct v4l2_subdev_pad_config *cfg,
			      unsigned int pad, unsigned int target)
{
	switch (target) {
	case V4L2_SEL_TGT_COMPOSE:
		return v4l2_subdev_get_try_compose(&entity->subdev, cfg, pad);
	case V4L2_SEL_TGT_CROP:
		return v4l2_subdev_get_try_crop(&entity->subdev, cfg, pad);
	default:
		return NULL;
	}
}

/*
 * 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
ccd3d95a LP	90	/**
	91	* vsp1_entity_get_pad_selection - Get a pad selection from storage for entity
	92	* @entity: the entity
	93	* @cfg: the configuration storage
	94	* @pad: the pad number
	95	* @target: the selection target
	96	*
	97	* Return the selection rectangle stored in the given configuration for an
	98	* entity's pad. The configuration can be an ACTIVE or TRY configuration. The
	99	* selection target can be COMPOSE or CROP.
	100	*/
b7e5107e	101	struct v4l2_rect *
ccd3d95a LP	102	vsp1_entity_get_pad_selection(struct vsp1_entity *entity,
	103	struct v4l2_subdev_pad_config *cfg,
	104	unsigned int pad, unsigned int target)
b7e5107e	105	{
ccd3d95a LP	106	switch (target) {
	107	case V4L2_SEL_TGT_COMPOSE:
	108	return v4l2_subdev_get_try_compose(&entity->subdev, cfg, pad);
	109	case V4L2_SEL_TGT_CROP:
	110	return v4l2_subdev_get_try_crop(&entity->subdev, cfg, pad);
	111	default:
	112	return NULL;
	113	}
b7e5107e LP	114	}
b7e5107e LP	115
26e0ca22	116	/*
0efdf0f5	117	* vsp1_entity_init_cfg - Initialize formats on all pads
26e0ca22	118	* @subdev: V4L2 subdevice
f7234138	119	* @cfg: V4L2 subdev pad configuration
26e0ca22	120	*
0efdf0f5 LP	121	* Initialize all pad formats with default values in the given pad config. This
0efdf0f5 LP	122	* function can be used as a handler for the subdev pad::init_cfg operation.
26e0ca22	123	*/
0efdf0f5 LP	124	int vsp1_entity_init_cfg(struct v4l2_subdev *subdev,
0efdf0f5 LP	125	struct v4l2_subdev_pad_config *cfg)
26e0ca22 LP	126	{
	127	struct v4l2_subdev_format format;
	128	unsigned int pad;
	129
	130	for (pad = 0; pad < subdev->entity.num_pads - 1; ++pad) {
	131	memset(&format, 0, sizeof(format));
	132
	133	format.pad = pad;
f7234138	134	format.which = cfg ? V4L2_SUBDEV_FORMAT_TRY
26e0ca22 LP	135	: V4L2_SUBDEV_FORMAT_ACTIVE;
26e0ca22 LP	136
f7234138	137	v4l2_subdev_call(subdev, pad, set_fmt, cfg, &format);
26e0ca22	138	}
26e0ca22 LP	139
	140	return 0;
	141	}
	142
3f557220 LP	143	/*
	144	* vsp1_subdev_get_pad_format - Subdev pad get_fmt handler
	145	* @subdev: V4L2 subdevice
	146	* @cfg: V4L2 subdev pad configuration
	147	* @fmt: V4L2 subdev format
	148	*
	149	* This function implements the subdev get_fmt pad operation. It can be used as
	150	* a direct drop-in for the operation handler.
	151	*/
	152	int vsp1_subdev_get_pad_format(struct v4l2_subdev *subdev,
	153	struct v4l2_subdev_pad_config *cfg,
	154	struct v4l2_subdev_format *fmt)
	155	{
	156	struct vsp1_entity *entity = to_vsp1_entity(subdev);
	157	struct v4l2_subdev_pad_config *config;
	158
	159	config = vsp1_entity_get_pad_config(entity, cfg, fmt->which);
	160	if (!config)
	161	return -EINVAL;
	162
	163	fmt->format = *vsp1_entity_get_pad_format(entity, config, fmt->pad);
	164
	165	return 0;
	166	}
	167
6ad9ba9c LP	168	/*
	169	* vsp1_subdev_enum_mbus_code - Subdev pad enum_mbus_code handler
	170	* @subdev: V4L2 subdevice
	171	* @cfg: V4L2 subdev pad configuration
	172	* @code: Media bus code enumeration
	173	* @codes: Array of supported media bus codes
	174	* @ncodes: Number of supported media bus codes
	175	*
	176	* This function implements the subdev enum_mbus_code pad operation for entities
	177	* that do not support format conversion. It enumerates the given supported
	178	* media bus codes on the sink pad and reports a source pad format identical to
	179	* the sink pad.
	180	*/
	181	int vsp1_subdev_enum_mbus_code(struct v4l2_subdev *subdev,
	182	struct v4l2_subdev_pad_config *cfg,
	183	struct v4l2_subdev_mbus_code_enum *code,
	184	const unsigned int *codes, unsigned int ncodes)
	185	{
	186	struct vsp1_entity *entity = to_vsp1_entity(subdev);
	187
	188	if (code->pad == 0) {
	189	if (code->index >= ncodes)
	190	return -EINVAL;
	191
	192	code->code = codes[code->index];
	193	} else {
	194	struct v4l2_subdev_pad_config *config;
	195	struct v4l2_mbus_framefmt *format;
	196
	197	/* The entity can't perform format conversion, the sink format
	198	* is always identical to the source format.
	199	*/
	200	if (code->index)
	201	return -EINVAL;
	202
	203	config = vsp1_entity_get_pad_config(entity, cfg, code->which);
	204	if (!config)
	205	return -EINVAL;
	206
	207	format = vsp1_entity_get_pad_format(entity, config, 0);
	208	code->code = format->code;
	209	}
	210
	211	return 0;
	212	}
	213
076e834f LP	214	/*
	215	* vsp1_subdev_enum_frame_size - Subdev pad enum_frame_size handler
	216	* @subdev: V4L2 subdevice
	217	* @cfg: V4L2 subdev pad configuration
	218	* @fse: Frame size enumeration
	219	* @min_width: Minimum image width
	220	* @min_height: Minimum image height
	221	* @max_width: Maximum image width
	222	* @max_height: Maximum image height
	223	*
	224	* This function implements the subdev enum_frame_size pad operation for
	225	* entities that do not support scaling or cropping. It reports the given
	226	* minimum and maximum frame width and height on the sink pad, and a fixed
	227	* source pad size identical to the sink pad.
	228	*/
	229	int vsp1_subdev_enum_frame_size(struct v4l2_subdev *subdev,
	230	struct v4l2_subdev_pad_config *cfg,
	231	struct v4l2_subdev_frame_size_enum *fse,
	232	unsigned int min_width, unsigned int min_height,
	233	unsigned int max_width, unsigned int max_height)
	234	{
	235	struct vsp1_entity *entity = to_vsp1_entity(subdev);
	236	struct v4l2_subdev_pad_config *config;
	237	struct v4l2_mbus_framefmt *format;
	238
	239	config = vsp1_entity_get_pad_config(entity, cfg, fse->which);
	240	if (!config)
	241	return -EINVAL;
	242
	243	format = vsp1_entity_get_pad_format(entity, config, fse->pad);
	244
	245	if (fse->index \|\| fse->code != format->code)
	246	return -EINVAL;
	247
	248	if (fse->pad == 0) {
	249	fse->min_width = min_width;
	250	fse->max_width = max_width;
	251	fse->min_height = min_height;
	252	fse->max_height = max_height;
	253	} else {
	254	/* The size on the source pad are fixed and always identical to
	255	* the size on the sink pad.
	256	*/
	257	fse->min_width = format->width;
	258	fse->max_width = format->width;
	259	fse->min_height = format->height;
	260	fse->max_height = format->height;
	261	}
	262
	263	return 0;
	264	}
	265
26e0ca22 LP	266	/* -----------------------------------------------------------------------------
	267	* Media Operations
	268	*/
	269
babca007 LP	270	int vsp1_entity_link_setup(struct media_entity *entity,
	271	const struct media_pad *local,
	272	const struct media_pad *remote, u32 flags)
26e0ca22 LP	273	{
	274	struct vsp1_entity *source;
	275
	276	if (!(local->flags & MEDIA_PAD_FL_SOURCE))
	277	return 0;
	278
7cf0f123	279	source = media_entity_to_vsp1_entity(local->entity);
26e0ca22 LP	280
	281	if (!source->route)
	282	return 0;
	283
	284	if (flags & MEDIA_LNK_FL_ENABLED) {
	285	if (source->sink)
	286	return -EBUSY;
	287	source->sink = remote->entity;
d9b45ed3	288	source->sink_pad = remote->index;
26e0ca22 LP	289	} else {
26e0ca22 LP	290	source->sink = NULL;
d9b45ed3	291	source->sink_pad = 0;
26e0ca22 LP	292	}
	293
	294	return 0;
	295	}
	296
26e0ca22 LP	297	/* -----------------------------------------------------------------------------
	298	* Initialization
	299	*/
	300
44f46198 LP	301	#define VSP1_ENTITY_ROUTE(ent) \
	302	{ VSP1_ENTITY_##ent, 0, VI6_DPR_##ent##_ROUTE, \
	303	{ VI6_DPR_NODE_##ent }, VI6_DPR_NODE_##ent }
	304
	305	#define VSP1_ENTITY_ROUTE_RPF(idx) \
	306	{ VSP1_ENTITY_RPF, idx, VI6_DPR_RPF_ROUTE(idx), \
	307	{ 0, }, VI6_DPR_NODE_RPF(idx) }
	308
	309	#define VSP1_ENTITY_ROUTE_UDS(idx) \
	310	{ VSP1_ENTITY_UDS, idx, VI6_DPR_UDS_ROUTE(idx), \
	311	{ VI6_DPR_NODE_UDS(idx) }, VI6_DPR_NODE_UDS(idx) }
	312
	313	#define VSP1_ENTITY_ROUTE_WPF(idx) \
	314	{ VSP1_ENTITY_WPF, idx, 0, \
	315	{ VI6_DPR_NODE_WPF(idx) }, VI6_DPR_NODE_WPF(idx) }
	316
d9b45ed3	317	static const struct vsp1_route vsp1_routes[] = {
629bb6d4 LP	318	{ VSP1_ENTITY_BRU, 0, VI6_DPR_BRU_ROUTE,
629bb6d4 LP	319	{ VI6_DPR_NODE_BRU_IN(0), VI6_DPR_NODE_BRU_IN(1),
7f2d50f8	320	VI6_DPR_NODE_BRU_IN(2), VI6_DPR_NODE_BRU_IN(3),
44f46198 LP	321	VI6_DPR_NODE_BRU_IN(4) }, VI6_DPR_NODE_BRU_OUT },
	322	VSP1_ENTITY_ROUTE(HSI),
	323	VSP1_ENTITY_ROUTE(HST),
	324	{ VSP1_ENTITY_LIF, 0, 0, { VI6_DPR_NODE_LIF, }, VI6_DPR_NODE_LIF },
	325	VSP1_ENTITY_ROUTE(LUT),
	326	VSP1_ENTITY_ROUTE_RPF(0),
	327	VSP1_ENTITY_ROUTE_RPF(1),
	328	VSP1_ENTITY_ROUTE_RPF(2),
	329	VSP1_ENTITY_ROUTE_RPF(3),
	330	VSP1_ENTITY_ROUTE_RPF(4),
	331	VSP1_ENTITY_ROUTE(SRU),
	332	VSP1_ENTITY_ROUTE_UDS(0),
	333	VSP1_ENTITY_ROUTE_UDS(1),
	334	VSP1_ENTITY_ROUTE_UDS(2),
	335	VSP1_ENTITY_ROUTE_WPF(0),
	336	VSP1_ENTITY_ROUTE_WPF(1),
	337	VSP1_ENTITY_ROUTE_WPF(2),
	338	VSP1_ENTITY_ROUTE_WPF(3),
d9b45ed3 LP	339	};
d9b45ed3 LP	340
26e0ca22	341	int vsp1_entity_init(struct vsp1_device vsp1, struct vsp1_entity entity,
823329df LP	342	const char *name, unsigned int num_pads,
823329df LP	343	const struct v4l2_subdev_ops *ops)
26e0ca22	344	{
823329df	345	struct v4l2_subdev *subdev;
26e0ca22	346	unsigned int i;
823329df	347	int ret;
26e0ca22	348
d9b45ed3 LP	349	for (i = 0; i < ARRAY_SIZE(vsp1_routes); ++i) {
	350	if (vsp1_routes[i].type == entity->type &&
	351	vsp1_routes[i].index == entity->index) {
	352	entity->route = &vsp1_routes[i];
26e0ca22 LP	353	break;
	354	}
	355	}
	356
d9b45ed3	357	if (i == ARRAY_SIZE(vsp1_routes))
26e0ca22 LP	358	return -EINVAL;
	359
	360	entity->vsp1 = vsp1;
	361	entity->source_pad = num_pads - 1;
	362
e790c3cb	363	/* Allocate and initialize pads. */
26e0ca22 LP	364	entity->pads = devm_kzalloc(vsp1->dev, num_pads * sizeof(*entity->pads),
	365	GFP_KERNEL);
	366	if (entity->pads == NULL)
	367	return -ENOMEM;
	368
26e0ca22 LP	369	for (i = 0; i < num_pads - 1; ++i)
	370	entity->pads[i].flags = MEDIA_PAD_FL_SINK;
	371
	372	entity->pads[num_pads - 1].flags = MEDIA_PAD_FL_SOURCE;
	373
	374	/* Initialize the media entity. */
823329df LP	375	ret = media_entity_pads_init(&entity->subdev.entity, num_pads,
	376	entity->pads);
	377	if (ret < 0)
	378	return ret;
	379
	380	/* Initialize the V4L2 subdev. */
	381	subdev = &entity->subdev;
	382	v4l2_subdev_init(subdev, ops);
	383
	384	subdev->entity.ops = &vsp1->media_ops;
823329df LP	385	subdev->flags \|= V4L2_SUBDEV_FL_HAS_DEVNODE;
	386
	387	snprintf(subdev->name, sizeof(subdev->name), "%s %s",
	388	dev_name(vsp1->dev), name);
	389
0efdf0f5	390	vsp1_entity_init_cfg(subdev, NULL);
823329df	391
e790c3cb LP	392	/* Allocate the pad configuration to store formats and selection
	393	* rectangles.
	394	*/
	395	entity->config = v4l2_subdev_alloc_pad_config(&entity->subdev);
	396	if (entity->config == NULL) {
	397	media_entity_cleanup(&entity->subdev.entity);
	398	return -ENOMEM;
	399	}
	400
823329df	401	return 0;
26e0ca22 LP	402	}
	403
	404	void vsp1_entity_destroy(struct vsp1_entity *entity)
	405	{
52434534 LP	406	if (entity->ops && entity->ops->destroy)
52434534 LP	407	entity->ops->destroy(entity);
a626e64e LP	408	if (entity->subdev.ctrl_handler)
a626e64e LP	409	v4l2_ctrl_handler_free(entity->subdev.ctrl_handler);
e790c3cb	410	v4l2_subdev_free_pad_config(entity->config);
26e0ca22 LP	411	media_entity_cleanup(&entity->subdev.entity);
26e0ca22 LP	412	}