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		default:
109			function = MEDIA_ENT_F_V4L2_SUBDEV_UNKNOWN;
110			break;
111		}
112
113		entity->subdev.entity.function = function;
114
115		ret = media_entity_pads_init(&entity->subdev.entity,
116					entity->num_pads, entity->pads);
117
118		if (ret < 0)
119			return ret;
120
121		ret = v4l2_device_register_subdev(&chain->dev->vdev,
122						  &entity->subdev);
123	} else if (entity->vdev != NULL) {
124		ret = media_entity_pads_init(&entity->vdev->entity,
125					entity->num_pads, entity->pads);
126		if (entity->flags & UVC_ENTITY_FLAG_DEFAULT)
127			entity->vdev->entity.flags |= MEDIA_ENT_FL_DEFAULT;
128	} else
129		ret = 0;
130
131	return ret;
132}
133
134int uvc_mc_register_entities(struct uvc_video_chain *chain)
135{
136	struct uvc_entity *entity;
137	int ret;
138
139	list_for_each_entry(entity, &chain->entities, chain) {
140		ret = uvc_mc_init_entity(chain, entity);
141		if (ret < 0) {
142			uvc_printk(KERN_INFO, "Failed to initialize entity for "
143				   "entity %u\n", entity->id);
144			return ret;
145		}
146	}
147
148	list_for_each_entry(entity, &chain->entities, chain) {
149		ret = uvc_mc_create_links(chain, entity);
150		if (ret < 0) {
151			uvc_printk(KERN_INFO, "Failed to create links for "
152				   "entity %u\n", entity->id);
153			return ret;
154		}
155	}
156
157	return 0;
158}
159