uvc_entity.c

  1// SPDX-License-Identifier: GPL-2.0-or-later
  2/*
  3 *      uvc_entity.c  --  USB Video Class driver
  4 *
  5 *      Copyright (C) 2005-2011
  6 *          Laurent Pinchart (laurent.pinchart@ideasonboard.com)
  7 */
  8
  9#include <linux/kernel.h>
 10#include <linux/list.h>
 11#include <linux/videodev2.h>
 12
 13#include <media/v4l2-common.h>
 14
 15#include "uvcvideo.h"
 16
 17static int uvc_mc_create_links(struct uvc_video_chain *chain,
 18				    struct uvc_entity *entity)
 19{
 20	const u32 flags = MEDIA_LNK_FL_ENABLED | MEDIA_LNK_FL_IMMUTABLE;
 21	struct media_entity *sink;
 22	unsigned int i;
 23	int ret;
 24
 25	sink = (UVC_ENTITY_TYPE(entity) == UVC_TT_STREAMING)
 26	     ? (entity->vdev ? &entity->vdev->entity : NULL)
 27	     : &entity->subdev.entity;
 28	if (sink == NULL)
 29		return 0;
 30
 31	for (i = 0; i < entity->num_pads; ++i) {
 32		struct media_entity *source;
 33		struct uvc_entity *remote;
 34		u8 remote_pad;
 35
 36		if (!(entity->pads[i].flags & MEDIA_PAD_FL_SINK))
 37			continue;
 38
 39		remote = uvc_entity_by_id(chain->dev, entity->baSourceID[i]);
 40		if (remote == NULL || remote->num_pads == 0)
 41			return -EINVAL;
 42
 43		source = (UVC_ENTITY_TYPE(remote) == UVC_TT_STREAMING)
 44		       ? (remote->vdev ? &remote->vdev->entity : NULL)
 45		       : &remote->subdev.entity;
 46		if (source == NULL)
 47			continue;
 48
 49		remote_pad = remote->num_pads - 1;
 50		ret = media_create_pad_link(source, remote_pad,
 51					       sink, i, flags);
 52		if (ret < 0)
 53			return ret;
 54	}
 55
 56	return 0;
 57}
 58
 59static const struct v4l2_subdev_ops uvc_subdev_ops = {
 60};
 61
 62void uvc_mc_cleanup_entity(struct uvc_entity *entity)
 63{
 64	if (UVC_ENTITY_TYPE(entity) != UVC_TT_STREAMING)
 65		media_entity_cleanup(&entity->subdev.entity);
 66	else if (entity->vdev != NULL)
 67		media_entity_cleanup(&entity->vdev->entity);
 68}
 69
 70static int uvc_mc_init_entity(struct uvc_video_chain *chain,
 71			      struct uvc_entity *entity)
 72{
 73	int ret;
 74
 75	if (UVC_ENTITY_TYPE(entity) != UVC_TT_STREAMING) {
 76		u32 function;
 77
 78		v4l2_subdev_init(&entity->subdev, &uvc_subdev_ops);
 79		strscpy(entity->subdev.name, entity->name,
 80			sizeof(entity->subdev.name));
 81
 82		switch (UVC_ENTITY_TYPE(entity)) {
 83		case UVC_VC_SELECTOR_UNIT:
 84			function = MEDIA_ENT_F_VID_MUX;
 85			break;
 86		case UVC_VC_PROCESSING_UNIT:
 87		case UVC_VC_EXTENSION_UNIT:
 88			/* For lack of a better option. */
 89			function = MEDIA_ENT_F_PROC_VIDEO_PIXEL_FORMATTER;
 90			break;
 91		case UVC_COMPOSITE_CONNECTOR:
 92		case UVC_COMPONENT_CONNECTOR:
 93			function = MEDIA_ENT_F_CONN_COMPOSITE;
 94			break;
 95		case UVC_SVIDEO_CONNECTOR:
 96			function = MEDIA_ENT_F_CONN_SVIDEO;
 97			break;
 98		case UVC_ITT_CAMERA:
 99			function = MEDIA_ENT_F_CAM_SENSOR;
100			break;
101		case UVC_TT_VENDOR_SPECIFIC:
102		case UVC_ITT_VENDOR_SPECIFIC:
103		case UVC_ITT_MEDIA_TRANSPORT_INPUT:
104		case UVC_OTT_VENDOR_SPECIFIC:
105		case UVC_OTT_DISPLAY:
106		case UVC_OTT_MEDIA_TRANSPORT_OUTPUT:
107		case UVC_EXTERNAL_VENDOR_SPECIFIC:
108		case UVC_EXT_GPIO_UNIT:
109		default:
110			function = MEDIA_ENT_F_V4L2_SUBDEV_UNKNOWN;
111			break;
112		}
113
114		entity->subdev.entity.function = function;
115
116		ret = media_entity_pads_init(&entity->subdev.entity,
117					entity->num_pads, entity->pads);
118
119		if (ret < 0)
120			return ret;
121
122		ret = v4l2_device_register_subdev(&chain->dev->vdev,
123						  &entity->subdev);
124	} else if (entity->vdev != NULL) {
125		ret = media_entity_pads_init(&entity->vdev->entity,
126					entity->num_pads, entity->pads);
127		if (entity->flags & UVC_ENTITY_FLAG_DEFAULT)
128			entity->vdev->entity.flags |= MEDIA_ENT_FL_DEFAULT;
129	} else
130		ret = 0;
131
132	return ret;
133}
134
135int uvc_mc_register_entities(struct uvc_video_chain *chain)
136{
137	struct uvc_entity *entity;
138	int ret;
139
140	list_for_each_entry(entity, &chain->entities, chain) {
141		ret = uvc_mc_init_entity(chain, entity);
142		if (ret < 0) {
143			dev_info(&chain->dev->intf->dev,
144				 "Failed to initialize entity for entity %u\n",
145				 entity->id);
146			return ret;
147		}
148	}
149
150	list_for_each_entry(entity, &chain->entities, chain) {
151		ret = uvc_mc_create_links(chain, entity);
152		if (ret < 0) {
153			dev_info(&chain->dev->intf->dev,
154				 "Failed to create links for entity %u\n",
155				 entity->id);
156			return ret;
157		}
158	}
159
160	return 0;
161}