11802d0beSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only
25bc3cb74SMauro Carvalho Chehab /*
35bc3cb74SMauro Carvalho Chehab * V4L2 sub-device
45bc3cb74SMauro Carvalho Chehab *
55bc3cb74SMauro Carvalho Chehab * Copyright (C) 2010 Nokia Corporation
65bc3cb74SMauro Carvalho Chehab *
75bc3cb74SMauro Carvalho Chehab * Contact: Laurent Pinchart <laurent.pinchart@ideasonboard.com>
85bc3cb74SMauro Carvalho Chehab * Sakari Ailus <sakari.ailus@iki.fi>
95bc3cb74SMauro Carvalho Chehab */
105bc3cb74SMauro Carvalho Chehab
11c2a7f7a4STomi Valkeinen #include <linux/export.h>
125bc3cb74SMauro Carvalho Chehab #include <linux/ioctl.h>
13b6e10ff6SHans de Goede #include <linux/leds.h>
14758d90e1STomasz Figa #include <linux/mm.h>
15218bf10eSHans Verkuil #include <linux/module.h>
1617bb9bf8STomi Valkeinen #include <linux/overflow.h>
175bc3cb74SMauro Carvalho Chehab #include <linux/slab.h>
185bc3cb74SMauro Carvalho Chehab #include <linux/types.h>
196446ec6cSHans Verkuil #include <linux/version.h>
20c2a7f7a4STomi Valkeinen #include <linux/videodev2.h>
215bc3cb74SMauro Carvalho Chehab
225bc3cb74SMauro Carvalho Chehab #include <media/v4l2-ctrls.h>
235bc3cb74SMauro Carvalho Chehab #include <media/v4l2-device.h>
245bc3cb74SMauro Carvalho Chehab #include <media/v4l2-event.h>
25c2a7f7a4STomi Valkeinen #include <media/v4l2-fh.h>
26c2a7f7a4STomi Valkeinen #include <media/v4l2-ioctl.h>
275bc3cb74SMauro Carvalho Chehab
288a546445STomi Valkeinen #if defined(CONFIG_VIDEO_V4L2_SUBDEV_API)
298a546445STomi Valkeinen /*
308a546445STomi Valkeinen * The Streams API is an experimental feature. To use the Streams API, set
318a546445STomi Valkeinen * 'v4l2_subdev_enable_streams_api' to 1 below.
328a546445STomi Valkeinen */
338a546445STomi Valkeinen
348a546445STomi Valkeinen static bool v4l2_subdev_enable_streams_api;
358a546445STomi Valkeinen #endif
368a546445STomi Valkeinen
37a418bb3fSLaurent Pinchart /*
38a418bb3fSLaurent Pinchart * Maximum stream ID is 63 for now, as we use u64 bitmask to represent a set
39a418bb3fSLaurent Pinchart * of streams.
40a418bb3fSLaurent Pinchart *
41a418bb3fSLaurent Pinchart * Note that V4L2_FRAME_DESC_ENTRY_MAX is related: V4L2_FRAME_DESC_ENTRY_MAX
42a418bb3fSLaurent Pinchart * restricts the total number of streams in a pad, although the stream ID is
43a418bb3fSLaurent Pinchart * not restricted.
44a418bb3fSLaurent Pinchart */
45a418bb3fSLaurent Pinchart #define V4L2_SUBDEV_MAX_STREAM_ID 63
465bc3cb74SMauro Carvalho Chehab
47b6e10ff6SHans de Goede #include "v4l2-subdev-priv.h"
48b6e10ff6SHans de Goede
49fb15db8cSJacopo Mondi #if defined(CONFIG_VIDEO_V4L2_SUBDEV_API)
subdev_fh_init(struct v4l2_subdev_fh * fh,struct v4l2_subdev * sd)505bc3cb74SMauro Carvalho Chehab static int subdev_fh_init(struct v4l2_subdev_fh *fh, struct v4l2_subdev *sd)
515bc3cb74SMauro Carvalho Chehab {
520d346d2aSTomi Valkeinen struct v4l2_subdev_state *state;
53ed647ea6STomi Valkeinen static struct lock_class_key key;
540d346d2aSTomi Valkeinen
55ed647ea6STomi Valkeinen state = __v4l2_subdev_state_alloc(sd, "fh->state->lock", &key);
560d346d2aSTomi Valkeinen if (IS_ERR(state))
570d346d2aSTomi Valkeinen return PTR_ERR(state);
580d346d2aSTomi Valkeinen
590d346d2aSTomi Valkeinen fh->state = state;
60fb15db8cSJacopo Mondi
615bc3cb74SMauro Carvalho Chehab return 0;
625bc3cb74SMauro Carvalho Chehab }
635bc3cb74SMauro Carvalho Chehab
subdev_fh_free(struct v4l2_subdev_fh * fh)645bc3cb74SMauro Carvalho Chehab static void subdev_fh_free(struct v4l2_subdev_fh *fh)
655bc3cb74SMauro Carvalho Chehab {
6640aaab9dSTomi Valkeinen __v4l2_subdev_state_free(fh->state);
670d346d2aSTomi Valkeinen fh->state = NULL;
685bc3cb74SMauro Carvalho Chehab }
695bc3cb74SMauro Carvalho Chehab
subdev_open(struct file * file)705bc3cb74SMauro Carvalho Chehab static int subdev_open(struct file *file)
715bc3cb74SMauro Carvalho Chehab {
725bc3cb74SMauro Carvalho Chehab struct video_device *vdev = video_devdata(file);
735bc3cb74SMauro Carvalho Chehab struct v4l2_subdev *sd = vdev_to_v4l2_subdev(vdev);
745bc3cb74SMauro Carvalho Chehab struct v4l2_subdev_fh *subdev_fh;
755bc3cb74SMauro Carvalho Chehab int ret;
765bc3cb74SMauro Carvalho Chehab
775bc3cb74SMauro Carvalho Chehab subdev_fh = kzalloc(sizeof(*subdev_fh), GFP_KERNEL);
785bc3cb74SMauro Carvalho Chehab if (subdev_fh == NULL)
795bc3cb74SMauro Carvalho Chehab return -ENOMEM;
805bc3cb74SMauro Carvalho Chehab
815bc3cb74SMauro Carvalho Chehab ret = subdev_fh_init(subdev_fh, sd);
825bc3cb74SMauro Carvalho Chehab if (ret) {
835bc3cb74SMauro Carvalho Chehab kfree(subdev_fh);
845bc3cb74SMauro Carvalho Chehab return ret;
855bc3cb74SMauro Carvalho Chehab }
865bc3cb74SMauro Carvalho Chehab
875bc3cb74SMauro Carvalho Chehab v4l2_fh_init(&subdev_fh->vfh, vdev);
885bc3cb74SMauro Carvalho Chehab v4l2_fh_add(&subdev_fh->vfh);
895bc3cb74SMauro Carvalho Chehab file->private_data = &subdev_fh->vfh;
90e550c370STomi Valkeinen
91218bf10eSHans Verkuil if (sd->v4l2_dev->mdev && sd->entity.graph_obj.mdev->dev) {
92218bf10eSHans Verkuil struct module *owner;
93218bf10eSHans Verkuil
94218bf10eSHans Verkuil owner = sd->entity.graph_obj.mdev->dev->driver->owner;
95218bf10eSHans Verkuil if (!try_module_get(owner)) {
965bc3cb74SMauro Carvalho Chehab ret = -EBUSY;
975bc3cb74SMauro Carvalho Chehab goto err;
985bc3cb74SMauro Carvalho Chehab }
99218bf10eSHans Verkuil subdev_fh->owner = owner;
1005bc3cb74SMauro Carvalho Chehab }
1015bc3cb74SMauro Carvalho Chehab
1025bc3cb74SMauro Carvalho Chehab if (sd->internal_ops && sd->internal_ops->open) {
1035bc3cb74SMauro Carvalho Chehab ret = sd->internal_ops->open(sd, subdev_fh);
1045bc3cb74SMauro Carvalho Chehab if (ret < 0)
1055bc3cb74SMauro Carvalho Chehab goto err;
1065bc3cb74SMauro Carvalho Chehab }
1075bc3cb74SMauro Carvalho Chehab
1085bc3cb74SMauro Carvalho Chehab return 0;
1095bc3cb74SMauro Carvalho Chehab
1105bc3cb74SMauro Carvalho Chehab err:
111218bf10eSHans Verkuil module_put(subdev_fh->owner);
1125bc3cb74SMauro Carvalho Chehab v4l2_fh_del(&subdev_fh->vfh);
1135bc3cb74SMauro Carvalho Chehab v4l2_fh_exit(&subdev_fh->vfh);
1145bc3cb74SMauro Carvalho Chehab subdev_fh_free(subdev_fh);
1155bc3cb74SMauro Carvalho Chehab kfree(subdev_fh);
1165bc3cb74SMauro Carvalho Chehab
1175bc3cb74SMauro Carvalho Chehab return ret;
1185bc3cb74SMauro Carvalho Chehab }
1195bc3cb74SMauro Carvalho Chehab
subdev_close(struct file * file)1205bc3cb74SMauro Carvalho Chehab static int subdev_close(struct file *file)
1215bc3cb74SMauro Carvalho Chehab {
1225bc3cb74SMauro Carvalho Chehab struct video_device *vdev = video_devdata(file);
1235bc3cb74SMauro Carvalho Chehab struct v4l2_subdev *sd = vdev_to_v4l2_subdev(vdev);
1245bc3cb74SMauro Carvalho Chehab struct v4l2_fh *vfh = file->private_data;
1255bc3cb74SMauro Carvalho Chehab struct v4l2_subdev_fh *subdev_fh = to_v4l2_subdev_fh(vfh);
1265bc3cb74SMauro Carvalho Chehab
1275bc3cb74SMauro Carvalho Chehab if (sd->internal_ops && sd->internal_ops->close)
1285bc3cb74SMauro Carvalho Chehab sd->internal_ops->close(sd, subdev_fh);
129218bf10eSHans Verkuil module_put(subdev_fh->owner);
1305bc3cb74SMauro Carvalho Chehab v4l2_fh_del(vfh);
1315bc3cb74SMauro Carvalho Chehab v4l2_fh_exit(vfh);
1325bc3cb74SMauro Carvalho Chehab subdev_fh_free(subdev_fh);
1335bc3cb74SMauro Carvalho Chehab kfree(subdev_fh);
1345bc3cb74SMauro Carvalho Chehab file->private_data = NULL;
1355bc3cb74SMauro Carvalho Chehab
1365bc3cb74SMauro Carvalho Chehab return 0;
1375bc3cb74SMauro Carvalho Chehab }
138fb15db8cSJacopo Mondi #else /* CONFIG_VIDEO_V4L2_SUBDEV_API */
subdev_open(struct file * file)139fb15db8cSJacopo Mondi static int subdev_open(struct file *file)
140fb15db8cSJacopo Mondi {
141fb15db8cSJacopo Mondi return -ENODEV;
142fb15db8cSJacopo Mondi }
143fb15db8cSJacopo Mondi
subdev_close(struct file * file)144fb15db8cSJacopo Mondi static int subdev_close(struct file *file)
145fb15db8cSJacopo Mondi {
146fb15db8cSJacopo Mondi return -ENODEV;
147fb15db8cSJacopo Mondi }
148fb15db8cSJacopo Mondi #endif /* CONFIG_VIDEO_V4L2_SUBDEV_API */
1495bc3cb74SMauro Carvalho Chehab
check_which(u32 which)1503cbd3d99SJanusz Krzysztofik static inline int check_which(u32 which)
151b225e398SSakari Ailus {
152a8fa5507SJanusz Krzysztofik if (which != V4L2_SUBDEV_FORMAT_TRY &&
153a8fa5507SJanusz Krzysztofik which != V4L2_SUBDEV_FORMAT_ACTIVE)
154b225e398SSakari Ailus return -EINVAL;
155b225e398SSakari Ailus
156b225e398SSakari Ailus return 0;
157b225e398SSakari Ailus }
158b225e398SSakari Ailus
check_pad(struct v4l2_subdev * sd,u32 pad)1593cbd3d99SJanusz Krzysztofik static inline int check_pad(struct v4l2_subdev *sd, u32 pad)
160b225e398SSakari Ailus {
161a8fa5507SJanusz Krzysztofik #if defined(CONFIG_MEDIA_CONTROLLER)
1626bda7073SHans Verkuil if (sd->entity.num_pads) {
163a8fa5507SJanusz Krzysztofik if (pad >= sd->entity.num_pads)
164b225e398SSakari Ailus return -EINVAL;
165b225e398SSakari Ailus return 0;
166b225e398SSakari Ailus }
167d352bcc9SMauro Carvalho Chehab #endif
168a8fa5507SJanusz Krzysztofik /* allow pad 0 on subdevices not registered as media entities */
169a8fa5507SJanusz Krzysztofik if (pad > 0)
170a8fa5507SJanusz Krzysztofik return -EINVAL;
171a8fa5507SJanusz Krzysztofik return 0;
172a8fa5507SJanusz Krzysztofik }
173a8fa5507SJanusz Krzysztofik
check_state(struct v4l2_subdev * sd,struct v4l2_subdev_state * state,u32 which,u32 pad,u32 stream)1742f91e10eSTomi Valkeinen static int check_state(struct v4l2_subdev *sd, struct v4l2_subdev_state *state,
1752f91e10eSTomi Valkeinen u32 which, u32 pad, u32 stream)
176374d62e7SJanusz Krzysztofik {
1772f91e10eSTomi Valkeinen if (sd->flags & V4L2_SUBDEV_FL_STREAMS) {
1782f91e10eSTomi Valkeinen #if defined(CONFIG_VIDEO_V4L2_SUBDEV_API)
1792f91e10eSTomi Valkeinen if (!v4l2_subdev_state_get_stream_format(state, pad, stream))
1802f91e10eSTomi Valkeinen return -EINVAL;
1812f91e10eSTomi Valkeinen return 0;
1822f91e10eSTomi Valkeinen #else
1832f91e10eSTomi Valkeinen return -EINVAL;
1842f91e10eSTomi Valkeinen #endif
1852f91e10eSTomi Valkeinen }
1862f91e10eSTomi Valkeinen
1872f91e10eSTomi Valkeinen if (stream != 0)
1882f91e10eSTomi Valkeinen return -EINVAL;
1892f91e10eSTomi Valkeinen
1900d346d2aSTomi Valkeinen if (which == V4L2_SUBDEV_FORMAT_TRY && (!state || !state->pads))
191374d62e7SJanusz Krzysztofik return -EINVAL;
192374d62e7SJanusz Krzysztofik
193374d62e7SJanusz Krzysztofik return 0;
194374d62e7SJanusz Krzysztofik }
195374d62e7SJanusz Krzysztofik
check_format(struct v4l2_subdev * sd,struct v4l2_subdev_state * state,struct v4l2_subdev_format * format)196a8fa5507SJanusz Krzysztofik static inline int check_format(struct v4l2_subdev *sd,
1970d346d2aSTomi Valkeinen struct v4l2_subdev_state *state,
198a8fa5507SJanusz Krzysztofik struct v4l2_subdev_format *format)
199a8fa5507SJanusz Krzysztofik {
200a4f4a763SJanusz Krzysztofik if (!format)
201a4f4a763SJanusz Krzysztofik return -EINVAL;
202a4f4a763SJanusz Krzysztofik
203374d62e7SJanusz Krzysztofik return check_which(format->which) ? : check_pad(sd, format->pad) ? :
2042f91e10eSTomi Valkeinen check_state(sd, state, format->which, format->pad, format->stream);
205a8fa5507SJanusz Krzysztofik }
206a8fa5507SJanusz Krzysztofik
call_get_fmt(struct v4l2_subdev * sd,struct v4l2_subdev_state * state,struct v4l2_subdev_format * format)207a8fa5507SJanusz Krzysztofik static int call_get_fmt(struct v4l2_subdev *sd,
2080d346d2aSTomi Valkeinen struct v4l2_subdev_state *state,
209a8fa5507SJanusz Krzysztofik struct v4l2_subdev_format *format)
210a8fa5507SJanusz Krzysztofik {
2110d346d2aSTomi Valkeinen return check_format(sd, state, format) ? :
2120d346d2aSTomi Valkeinen sd->ops->pad->get_fmt(sd, state, format);
213a8fa5507SJanusz Krzysztofik }
214a8fa5507SJanusz Krzysztofik
call_set_fmt(struct v4l2_subdev * sd,struct v4l2_subdev_state * state,struct v4l2_subdev_format * format)215a8fa5507SJanusz Krzysztofik static int call_set_fmt(struct v4l2_subdev *sd,
2160d346d2aSTomi Valkeinen struct v4l2_subdev_state *state,
217a8fa5507SJanusz Krzysztofik struct v4l2_subdev_format *format)
218a8fa5507SJanusz Krzysztofik {
2190d346d2aSTomi Valkeinen return check_format(sd, state, format) ? :
2200d346d2aSTomi Valkeinen sd->ops->pad->set_fmt(sd, state, format);
221a8fa5507SJanusz Krzysztofik }
222a8fa5507SJanusz Krzysztofik
call_enum_mbus_code(struct v4l2_subdev * sd,struct v4l2_subdev_state * state,struct v4l2_subdev_mbus_code_enum * code)223a8fa5507SJanusz Krzysztofik static int call_enum_mbus_code(struct v4l2_subdev *sd,
2240d346d2aSTomi Valkeinen struct v4l2_subdev_state *state,
225a8fa5507SJanusz Krzysztofik struct v4l2_subdev_mbus_code_enum *code)
226a8fa5507SJanusz Krzysztofik {
227a4f4a763SJanusz Krzysztofik if (!code)
228a4f4a763SJanusz Krzysztofik return -EINVAL;
229a4f4a763SJanusz Krzysztofik
230a8fa5507SJanusz Krzysztofik return check_which(code->which) ? : check_pad(sd, code->pad) ? :
2312f91e10eSTomi Valkeinen check_state(sd, state, code->which, code->pad, code->stream) ? :
2320d346d2aSTomi Valkeinen sd->ops->pad->enum_mbus_code(sd, state, code);
233a8fa5507SJanusz Krzysztofik }
234a8fa5507SJanusz Krzysztofik
call_enum_frame_size(struct v4l2_subdev * sd,struct v4l2_subdev_state * state,struct v4l2_subdev_frame_size_enum * fse)235a8fa5507SJanusz Krzysztofik static int call_enum_frame_size(struct v4l2_subdev *sd,
2360d346d2aSTomi Valkeinen struct v4l2_subdev_state *state,
237a8fa5507SJanusz Krzysztofik struct v4l2_subdev_frame_size_enum *fse)
238a8fa5507SJanusz Krzysztofik {
239a4f4a763SJanusz Krzysztofik if (!fse)
240a4f4a763SJanusz Krzysztofik return -EINVAL;
241a4f4a763SJanusz Krzysztofik
242a8fa5507SJanusz Krzysztofik return check_which(fse->which) ? : check_pad(sd, fse->pad) ? :
2432f91e10eSTomi Valkeinen check_state(sd, state, fse->which, fse->pad, fse->stream) ? :
2440d346d2aSTomi Valkeinen sd->ops->pad->enum_frame_size(sd, state, fse);
245a8fa5507SJanusz Krzysztofik }
246a8fa5507SJanusz Krzysztofik
check_frame_interval(struct v4l2_subdev * sd,struct v4l2_subdev_frame_interval * fi)247a8fa5507SJanusz Krzysztofik static inline int check_frame_interval(struct v4l2_subdev *sd,
248a8fa5507SJanusz Krzysztofik struct v4l2_subdev_frame_interval *fi)
249a8fa5507SJanusz Krzysztofik {
250a4f4a763SJanusz Krzysztofik if (!fi)
251a4f4a763SJanusz Krzysztofik return -EINVAL;
252a4f4a763SJanusz Krzysztofik
253a8fa5507SJanusz Krzysztofik return check_pad(sd, fi->pad);
254a8fa5507SJanusz Krzysztofik }
255a8fa5507SJanusz Krzysztofik
call_g_frame_interval(struct v4l2_subdev * sd,struct v4l2_subdev_frame_interval * fi)256a8fa5507SJanusz Krzysztofik static int call_g_frame_interval(struct v4l2_subdev *sd,
257a8fa5507SJanusz Krzysztofik struct v4l2_subdev_frame_interval *fi)
258a8fa5507SJanusz Krzysztofik {
259a8fa5507SJanusz Krzysztofik return check_frame_interval(sd, fi) ? :
260a8fa5507SJanusz Krzysztofik sd->ops->video->g_frame_interval(sd, fi);
261a8fa5507SJanusz Krzysztofik }
262a8fa5507SJanusz Krzysztofik
call_s_frame_interval(struct v4l2_subdev * sd,struct v4l2_subdev_frame_interval * fi)263a8fa5507SJanusz Krzysztofik static int call_s_frame_interval(struct v4l2_subdev *sd,
264a8fa5507SJanusz Krzysztofik struct v4l2_subdev_frame_interval *fi)
265a8fa5507SJanusz Krzysztofik {
266a8fa5507SJanusz Krzysztofik return check_frame_interval(sd, fi) ? :
267a8fa5507SJanusz Krzysztofik sd->ops->video->s_frame_interval(sd, fi);
268a8fa5507SJanusz Krzysztofik }
269a8fa5507SJanusz Krzysztofik
call_enum_frame_interval(struct v4l2_subdev * sd,struct v4l2_subdev_state * state,struct v4l2_subdev_frame_interval_enum * fie)270a8fa5507SJanusz Krzysztofik static int call_enum_frame_interval(struct v4l2_subdev *sd,
2710d346d2aSTomi Valkeinen struct v4l2_subdev_state *state,
272a8fa5507SJanusz Krzysztofik struct v4l2_subdev_frame_interval_enum *fie)
273a8fa5507SJanusz Krzysztofik {
274a4f4a763SJanusz Krzysztofik if (!fie)
275a4f4a763SJanusz Krzysztofik return -EINVAL;
276a4f4a763SJanusz Krzysztofik
277a8fa5507SJanusz Krzysztofik return check_which(fie->which) ? : check_pad(sd, fie->pad) ? :
2782f91e10eSTomi Valkeinen check_state(sd, state, fie->which, fie->pad, fie->stream) ? :
2790d346d2aSTomi Valkeinen sd->ops->pad->enum_frame_interval(sd, state, fie);
280a8fa5507SJanusz Krzysztofik }
281a8fa5507SJanusz Krzysztofik
check_selection(struct v4l2_subdev * sd,struct v4l2_subdev_state * state,struct v4l2_subdev_selection * sel)282a8fa5507SJanusz Krzysztofik static inline int check_selection(struct v4l2_subdev *sd,
2830d346d2aSTomi Valkeinen struct v4l2_subdev_state *state,
284a8fa5507SJanusz Krzysztofik struct v4l2_subdev_selection *sel)
285a8fa5507SJanusz Krzysztofik {
286a4f4a763SJanusz Krzysztofik if (!sel)
287a4f4a763SJanusz Krzysztofik return -EINVAL;
288a4f4a763SJanusz Krzysztofik
289374d62e7SJanusz Krzysztofik return check_which(sel->which) ? : check_pad(sd, sel->pad) ? :
2902f91e10eSTomi Valkeinen check_state(sd, state, sel->which, sel->pad, sel->stream);
291a8fa5507SJanusz Krzysztofik }
292a8fa5507SJanusz Krzysztofik
call_get_selection(struct v4l2_subdev * sd,struct v4l2_subdev_state * state,struct v4l2_subdev_selection * sel)293a8fa5507SJanusz Krzysztofik static int call_get_selection(struct v4l2_subdev *sd,
2940d346d2aSTomi Valkeinen struct v4l2_subdev_state *state,
295a8fa5507SJanusz Krzysztofik struct v4l2_subdev_selection *sel)
296a8fa5507SJanusz Krzysztofik {
2970d346d2aSTomi Valkeinen return check_selection(sd, state, sel) ? :
2980d346d2aSTomi Valkeinen sd->ops->pad->get_selection(sd, state, sel);
299a8fa5507SJanusz Krzysztofik }
300a8fa5507SJanusz Krzysztofik
call_set_selection(struct v4l2_subdev * sd,struct v4l2_subdev_state * state,struct v4l2_subdev_selection * sel)301a8fa5507SJanusz Krzysztofik static int call_set_selection(struct v4l2_subdev *sd,
3020d346d2aSTomi Valkeinen struct v4l2_subdev_state *state,
303a8fa5507SJanusz Krzysztofik struct v4l2_subdev_selection *sel)
304a8fa5507SJanusz Krzysztofik {
3050d346d2aSTomi Valkeinen return check_selection(sd, state, sel) ? :
3060d346d2aSTomi Valkeinen sd->ops->pad->set_selection(sd, state, sel);
307a8fa5507SJanusz Krzysztofik }
308a8fa5507SJanusz Krzysztofik
check_edid(struct v4l2_subdev * sd,struct v4l2_subdev_edid * edid)309a8fa5507SJanusz Krzysztofik static inline int check_edid(struct v4l2_subdev *sd,
310a8fa5507SJanusz Krzysztofik struct v4l2_subdev_edid *edid)
311a8fa5507SJanusz Krzysztofik {
312a4f4a763SJanusz Krzysztofik if (!edid)
313a4f4a763SJanusz Krzysztofik return -EINVAL;
314a4f4a763SJanusz Krzysztofik
315a8fa5507SJanusz Krzysztofik if (edid->blocks && edid->edid == NULL)
316a8fa5507SJanusz Krzysztofik return -EINVAL;
317a8fa5507SJanusz Krzysztofik
318a8fa5507SJanusz Krzysztofik return check_pad(sd, edid->pad);
319a8fa5507SJanusz Krzysztofik }
320a8fa5507SJanusz Krzysztofik
call_get_edid(struct v4l2_subdev * sd,struct v4l2_subdev_edid * edid)321a8fa5507SJanusz Krzysztofik static int call_get_edid(struct v4l2_subdev *sd, struct v4l2_subdev_edid *edid)
322a8fa5507SJanusz Krzysztofik {
323a8fa5507SJanusz Krzysztofik return check_edid(sd, edid) ? : sd->ops->pad->get_edid(sd, edid);
324a8fa5507SJanusz Krzysztofik }
325a8fa5507SJanusz Krzysztofik
call_set_edid(struct v4l2_subdev * sd,struct v4l2_subdev_edid * edid)326a8fa5507SJanusz Krzysztofik static int call_set_edid(struct v4l2_subdev *sd, struct v4l2_subdev_edid *edid)
327a8fa5507SJanusz Krzysztofik {
328a8fa5507SJanusz Krzysztofik return check_edid(sd, edid) ? : sd->ops->pad->set_edid(sd, edid);
329a8fa5507SJanusz Krzysztofik }
330a8fa5507SJanusz Krzysztofik
call_dv_timings_cap(struct v4l2_subdev * sd,struct v4l2_dv_timings_cap * cap)331a8fa5507SJanusz Krzysztofik static int call_dv_timings_cap(struct v4l2_subdev *sd,
332a8fa5507SJanusz Krzysztofik struct v4l2_dv_timings_cap *cap)
333a8fa5507SJanusz Krzysztofik {
334a4f4a763SJanusz Krzysztofik if (!cap)
335a4f4a763SJanusz Krzysztofik return -EINVAL;
336a4f4a763SJanusz Krzysztofik
337a8fa5507SJanusz Krzysztofik return check_pad(sd, cap->pad) ? :
338a8fa5507SJanusz Krzysztofik sd->ops->pad->dv_timings_cap(sd, cap);
339a8fa5507SJanusz Krzysztofik }
340a8fa5507SJanusz Krzysztofik
call_enum_dv_timings(struct v4l2_subdev * sd,struct v4l2_enum_dv_timings * dvt)341a8fa5507SJanusz Krzysztofik static int call_enum_dv_timings(struct v4l2_subdev *sd,
342a8fa5507SJanusz Krzysztofik struct v4l2_enum_dv_timings *dvt)
343a8fa5507SJanusz Krzysztofik {
344a4f4a763SJanusz Krzysztofik if (!dvt)
345a4f4a763SJanusz Krzysztofik return -EINVAL;
346a4f4a763SJanusz Krzysztofik
347a8fa5507SJanusz Krzysztofik return check_pad(sd, dvt->pad) ? :
348a8fa5507SJanusz Krzysztofik sd->ops->pad->enum_dv_timings(sd, dvt);
349a8fa5507SJanusz Krzysztofik }
350a8fa5507SJanusz Krzysztofik
call_get_mbus_config(struct v4l2_subdev * sd,unsigned int pad,struct v4l2_mbus_config * config)35138df0b85SJacopo Mondi static int call_get_mbus_config(struct v4l2_subdev *sd, unsigned int pad,
35238df0b85SJacopo Mondi struct v4l2_mbus_config *config)
35338df0b85SJacopo Mondi {
35438df0b85SJacopo Mondi return check_pad(sd, pad) ? :
35538df0b85SJacopo Mondi sd->ops->pad->get_mbus_config(sd, pad, config);
35638df0b85SJacopo Mondi }
35738df0b85SJacopo Mondi
call_s_stream(struct v4l2_subdev * sd,int enable)358379c2586SSakari Ailus static int call_s_stream(struct v4l2_subdev *sd, int enable)
359379c2586SSakari Ailus {
360379c2586SSakari Ailus int ret;
361379c2586SSakari Ailus
36235556d0eSLaurent Pinchart /*
36335556d0eSLaurent Pinchart * The .s_stream() operation must never be called to start or stop an
36435556d0eSLaurent Pinchart * already started or stopped subdev. Catch offenders but don't return
36535556d0eSLaurent Pinchart * an error yet to avoid regressions.
36635556d0eSLaurent Pinchart *
36735556d0eSLaurent Pinchart * As .s_stream() is mutually exclusive with the .enable_streams() and
36835556d0eSLaurent Pinchart * .disable_streams() operation, we can use the enabled_streams field
36935556d0eSLaurent Pinchart * to store the subdev streaming state.
37035556d0eSLaurent Pinchart */
37135556d0eSLaurent Pinchart if (WARN_ON(!!sd->enabled_streams == !!enable))
37235556d0eSLaurent Pinchart return 0;
37335556d0eSLaurent Pinchart
3749a496f7dSSakari Ailus ret = sd->ops->video->s_stream(sd, enable);
3759a496f7dSSakari Ailus
3769a496f7dSSakari Ailus if (!enable && ret < 0) {
3779a496f7dSSakari Ailus dev_warn(sd->dev, "disabling streaming failed (%d)\n", ret);
3789a496f7dSSakari Ailus ret = 0;
3799a496f7dSSakari Ailus }
3809a496f7dSSakari Ailus
3819a496f7dSSakari Ailus if (!ret) {
3829a496f7dSSakari Ailus sd->enabled_streams = enable ? BIT(0) : 0;
3839a496f7dSSakari Ailus
384b6e10ff6SHans de Goede #if IS_REACHABLE(CONFIG_LEDS_CLASS)
385b6e10ff6SHans de Goede if (!IS_ERR_OR_NULL(sd->privacy_led)) {
386b6e10ff6SHans de Goede if (enable)
387b6e10ff6SHans de Goede led_set_brightness(sd->privacy_led,
388b6e10ff6SHans de Goede sd->privacy_led->max_brightness);
389b6e10ff6SHans de Goede else
390b6e10ff6SHans de Goede led_set_brightness(sd->privacy_led, 0);
391b6e10ff6SHans de Goede }
392b6e10ff6SHans de Goede #endif
393379c2586SSakari Ailus }
394379c2586SSakari Ailus
395379c2586SSakari Ailus return ret;
396379c2586SSakari Ailus }
397379c2586SSakari Ailus
398b2ac2387STomi Valkeinen #ifdef CONFIG_MEDIA_CONTROLLER
399b2ac2387STomi Valkeinen /*
400b2ac2387STomi Valkeinen * Create state-management wrapper for pad ops dealing with subdev state. The
401b2ac2387STomi Valkeinen * wrapper handles the case where the caller does not provide the called
402b2ac2387STomi Valkeinen * subdev's state. This should be removed when all the callers are fixed.
403b2ac2387STomi Valkeinen */
404b2ac2387STomi Valkeinen #define DEFINE_STATE_WRAPPER(f, arg_type) \
405b2ac2387STomi Valkeinen static int call_##f##_state(struct v4l2_subdev *sd, \
406b2ac2387STomi Valkeinen struct v4l2_subdev_state *_state, \
407b2ac2387STomi Valkeinen arg_type *arg) \
408b2ac2387STomi Valkeinen { \
409b2ac2387STomi Valkeinen struct v4l2_subdev_state *state = _state; \
410b2ac2387STomi Valkeinen int ret; \
411b2ac2387STomi Valkeinen if (!_state) \
412b2ac2387STomi Valkeinen state = v4l2_subdev_lock_and_get_active_state(sd); \
413b2ac2387STomi Valkeinen ret = call_##f(sd, state, arg); \
414b2ac2387STomi Valkeinen if (!_state && state) \
415b2ac2387STomi Valkeinen v4l2_subdev_unlock_state(state); \
416b2ac2387STomi Valkeinen return ret; \
417b2ac2387STomi Valkeinen }
418b2ac2387STomi Valkeinen
419b2ac2387STomi Valkeinen #else /* CONFIG_MEDIA_CONTROLLER */
420b2ac2387STomi Valkeinen
421b2ac2387STomi Valkeinen #define DEFINE_STATE_WRAPPER(f, arg_type) \
422b2ac2387STomi Valkeinen static int call_##f##_state(struct v4l2_subdev *sd, \
423b2ac2387STomi Valkeinen struct v4l2_subdev_state *state, \
424b2ac2387STomi Valkeinen arg_type *arg) \
425b2ac2387STomi Valkeinen { \
426b2ac2387STomi Valkeinen return call_##f(sd, state, arg); \
427b2ac2387STomi Valkeinen }
428b2ac2387STomi Valkeinen
429b2ac2387STomi Valkeinen #endif /* CONFIG_MEDIA_CONTROLLER */
430b2ac2387STomi Valkeinen
431b2ac2387STomi Valkeinen DEFINE_STATE_WRAPPER(get_fmt, struct v4l2_subdev_format);
432b2ac2387STomi Valkeinen DEFINE_STATE_WRAPPER(set_fmt, struct v4l2_subdev_format);
433b2ac2387STomi Valkeinen DEFINE_STATE_WRAPPER(enum_mbus_code, struct v4l2_subdev_mbus_code_enum);
434b2ac2387STomi Valkeinen DEFINE_STATE_WRAPPER(enum_frame_size, struct v4l2_subdev_frame_size_enum);
435b2ac2387STomi Valkeinen DEFINE_STATE_WRAPPER(enum_frame_interval, struct v4l2_subdev_frame_interval_enum);
436b2ac2387STomi Valkeinen DEFINE_STATE_WRAPPER(get_selection, struct v4l2_subdev_selection);
437b2ac2387STomi Valkeinen DEFINE_STATE_WRAPPER(set_selection, struct v4l2_subdev_selection);
438b2ac2387STomi Valkeinen
439a8fa5507SJanusz Krzysztofik static const struct v4l2_subdev_pad_ops v4l2_subdev_call_pad_wrappers = {
440b2ac2387STomi Valkeinen .get_fmt = call_get_fmt_state,
441b2ac2387STomi Valkeinen .set_fmt = call_set_fmt_state,
442b2ac2387STomi Valkeinen .enum_mbus_code = call_enum_mbus_code_state,
443b2ac2387STomi Valkeinen .enum_frame_size = call_enum_frame_size_state,
444b2ac2387STomi Valkeinen .enum_frame_interval = call_enum_frame_interval_state,
445b2ac2387STomi Valkeinen .get_selection = call_get_selection_state,
446b2ac2387STomi Valkeinen .set_selection = call_set_selection_state,
447a8fa5507SJanusz Krzysztofik .get_edid = call_get_edid,
448a8fa5507SJanusz Krzysztofik .set_edid = call_set_edid,
449a8fa5507SJanusz Krzysztofik .dv_timings_cap = call_dv_timings_cap,
450a8fa5507SJanusz Krzysztofik .enum_dv_timings = call_enum_dv_timings,
45138df0b85SJacopo Mondi .get_mbus_config = call_get_mbus_config,
452a8fa5507SJanusz Krzysztofik };
453a8fa5507SJanusz Krzysztofik
454a8fa5507SJanusz Krzysztofik static const struct v4l2_subdev_video_ops v4l2_subdev_call_video_wrappers = {
455a8fa5507SJanusz Krzysztofik .g_frame_interval = call_g_frame_interval,
456a8fa5507SJanusz Krzysztofik .s_frame_interval = call_s_frame_interval,
457379c2586SSakari Ailus .s_stream = call_s_stream,
458a8fa5507SJanusz Krzysztofik };
459a8fa5507SJanusz Krzysztofik
460a8fa5507SJanusz Krzysztofik const struct v4l2_subdev_ops v4l2_subdev_call_wrappers = {
461a8fa5507SJanusz Krzysztofik .pad = &v4l2_subdev_call_pad_wrappers,
462a8fa5507SJanusz Krzysztofik .video = &v4l2_subdev_call_video_wrappers,
463a8fa5507SJanusz Krzysztofik };
464a8fa5507SJanusz Krzysztofik EXPORT_SYMBOL(v4l2_subdev_call_wrappers);
465b225e398SSakari Ailus
466fb15db8cSJacopo Mondi #if defined(CONFIG_VIDEO_V4L2_SUBDEV_API)
4673cc7a4bbSTomi Valkeinen
4683cc7a4bbSTomi Valkeinen static struct v4l2_subdev_state *
subdev_ioctl_get_state(struct v4l2_subdev * sd,struct v4l2_subdev_fh * subdev_fh,unsigned int cmd,void * arg)4693cc7a4bbSTomi Valkeinen subdev_ioctl_get_state(struct v4l2_subdev *sd, struct v4l2_subdev_fh *subdev_fh,
4703cc7a4bbSTomi Valkeinen unsigned int cmd, void *arg)
4713cc7a4bbSTomi Valkeinen {
4723cc7a4bbSTomi Valkeinen u32 which;
4733cc7a4bbSTomi Valkeinen
4743cc7a4bbSTomi Valkeinen switch (cmd) {
4753cc7a4bbSTomi Valkeinen default:
4763cc7a4bbSTomi Valkeinen return NULL;
4773cc7a4bbSTomi Valkeinen case VIDIOC_SUBDEV_G_FMT:
4783cc7a4bbSTomi Valkeinen case VIDIOC_SUBDEV_S_FMT:
4793cc7a4bbSTomi Valkeinen which = ((struct v4l2_subdev_format *)arg)->which;
4803cc7a4bbSTomi Valkeinen break;
4813cc7a4bbSTomi Valkeinen case VIDIOC_SUBDEV_G_CROP:
4823cc7a4bbSTomi Valkeinen case VIDIOC_SUBDEV_S_CROP:
4833cc7a4bbSTomi Valkeinen which = ((struct v4l2_subdev_crop *)arg)->which;
4843cc7a4bbSTomi Valkeinen break;
4853cc7a4bbSTomi Valkeinen case VIDIOC_SUBDEV_ENUM_MBUS_CODE:
4863cc7a4bbSTomi Valkeinen which = ((struct v4l2_subdev_mbus_code_enum *)arg)->which;
4873cc7a4bbSTomi Valkeinen break;
4883cc7a4bbSTomi Valkeinen case VIDIOC_SUBDEV_ENUM_FRAME_SIZE:
4893cc7a4bbSTomi Valkeinen which = ((struct v4l2_subdev_frame_size_enum *)arg)->which;
4903cc7a4bbSTomi Valkeinen break;
4913cc7a4bbSTomi Valkeinen case VIDIOC_SUBDEV_ENUM_FRAME_INTERVAL:
4923cc7a4bbSTomi Valkeinen which = ((struct v4l2_subdev_frame_interval_enum *)arg)->which;
4933cc7a4bbSTomi Valkeinen break;
4943cc7a4bbSTomi Valkeinen case VIDIOC_SUBDEV_G_SELECTION:
4953cc7a4bbSTomi Valkeinen case VIDIOC_SUBDEV_S_SELECTION:
4963cc7a4bbSTomi Valkeinen which = ((struct v4l2_subdev_selection *)arg)->which;
4973cc7a4bbSTomi Valkeinen break;
498a418bb3fSLaurent Pinchart case VIDIOC_SUBDEV_G_ROUTING:
499a418bb3fSLaurent Pinchart case VIDIOC_SUBDEV_S_ROUTING:
500a418bb3fSLaurent Pinchart which = ((struct v4l2_subdev_routing *)arg)->which;
501a418bb3fSLaurent Pinchart break;
5023cc7a4bbSTomi Valkeinen }
5033cc7a4bbSTomi Valkeinen
5043cc7a4bbSTomi Valkeinen return which == V4L2_SUBDEV_FORMAT_TRY ?
5053cc7a4bbSTomi Valkeinen subdev_fh->state :
506ed647ea6STomi Valkeinen v4l2_subdev_get_unlocked_active_state(sd);
5073cc7a4bbSTomi Valkeinen }
5083cc7a4bbSTomi Valkeinen
subdev_do_ioctl(struct file * file,unsigned int cmd,void * arg,struct v4l2_subdev_state * state)509ed647ea6STomi Valkeinen static long subdev_do_ioctl(struct file *file, unsigned int cmd, void *arg,
510ed647ea6STomi Valkeinen struct v4l2_subdev_state *state)
5115bc3cb74SMauro Carvalho Chehab {
5125bc3cb74SMauro Carvalho Chehab struct video_device *vdev = video_devdata(file);
5135bc3cb74SMauro Carvalho Chehab struct v4l2_subdev *sd = vdev_to_v4l2_subdev(vdev);
5145bc3cb74SMauro Carvalho Chehab struct v4l2_fh *vfh = file->private_data;
515f57fa295STomi Valkeinen struct v4l2_subdev_fh *subdev_fh = to_v4l2_subdev_fh(vfh);
516f75c431eSJacopo Mondi bool ro_subdev = test_bit(V4L2_FL_SUBDEV_RO_DEVNODE, &vdev->flags);
5179a6b5bf4STomi Valkeinen bool streams_subdev = sd->flags & V4L2_SUBDEV_FL_STREAMS;
518f57fa295STomi Valkeinen bool client_supports_streams = subdev_fh->client_caps &
519f57fa295STomi Valkeinen V4L2_SUBDEV_CLIENT_CAP_STREAMS;
5201a6c0b36SArnd Bergmann int rval;
5215bc3cb74SMauro Carvalho Chehab
5224800021cSHans de Goede /*
5234800021cSHans de Goede * If the streams API is not enabled, remove V4L2_SUBDEV_CAP_STREAMS.
5244800021cSHans de Goede * Remove this when the API is no longer experimental.
5254800021cSHans de Goede */
5264800021cSHans de Goede if (!v4l2_subdev_enable_streams_api)
5274800021cSHans de Goede streams_subdev = false;
5284800021cSHans de Goede
5295bc3cb74SMauro Carvalho Chehab switch (cmd) {
5306446ec6cSHans Verkuil case VIDIOC_SUBDEV_QUERYCAP: {
5316446ec6cSHans Verkuil struct v4l2_subdev_capability *cap = arg;
5326446ec6cSHans Verkuil
5336446ec6cSHans Verkuil memset(cap->reserved, 0, sizeof(cap->reserved));
5346446ec6cSHans Verkuil cap->version = LINUX_VERSION_CODE;
5359a6b5bf4STomi Valkeinen cap->capabilities =
5369a6b5bf4STomi Valkeinen (ro_subdev ? V4L2_SUBDEV_CAP_RO_SUBDEV : 0) |
5379a6b5bf4STomi Valkeinen (streams_subdev ? V4L2_SUBDEV_CAP_STREAMS : 0);
5386446ec6cSHans Verkuil
5396446ec6cSHans Verkuil return 0;
5406446ec6cSHans Verkuil }
5416446ec6cSHans Verkuil
5425bc3cb74SMauro Carvalho Chehab case VIDIOC_QUERYCTRL:
5433103c7b4SHans Verkuil /*
5443103c7b4SHans Verkuil * TODO: this really should be folded into v4l2_queryctrl (this
5453103c7b4SHans Verkuil * currently returns -EINVAL for NULL control handlers).
5463103c7b4SHans Verkuil * However, v4l2_queryctrl() is still called directly by
5473103c7b4SHans Verkuil * drivers as well and until that has been addressed I believe
5483103c7b4SHans Verkuil * it is safer to do the check here. The same is true for the
5493103c7b4SHans Verkuil * other control ioctls below.
5503103c7b4SHans Verkuil */
5513103c7b4SHans Verkuil if (!vfh->ctrl_handler)
5523103c7b4SHans Verkuil return -ENOTTY;
5535bc3cb74SMauro Carvalho Chehab return v4l2_queryctrl(vfh->ctrl_handler, arg);
5545bc3cb74SMauro Carvalho Chehab
555e6bee368SHans Verkuil case VIDIOC_QUERY_EXT_CTRL:
5563103c7b4SHans Verkuil if (!vfh->ctrl_handler)
5573103c7b4SHans Verkuil return -ENOTTY;
558e6bee368SHans Verkuil return v4l2_query_ext_ctrl(vfh->ctrl_handler, arg);
559e6bee368SHans Verkuil
5605bc3cb74SMauro Carvalho Chehab case VIDIOC_QUERYMENU:
5613103c7b4SHans Verkuil if (!vfh->ctrl_handler)
5623103c7b4SHans Verkuil return -ENOTTY;
5635bc3cb74SMauro Carvalho Chehab return v4l2_querymenu(vfh->ctrl_handler, arg);
5645bc3cb74SMauro Carvalho Chehab
5655bc3cb74SMauro Carvalho Chehab case VIDIOC_G_CTRL:
5663103c7b4SHans Verkuil if (!vfh->ctrl_handler)
5673103c7b4SHans Verkuil return -ENOTTY;
5685bc3cb74SMauro Carvalho Chehab return v4l2_g_ctrl(vfh->ctrl_handler, arg);
5695bc3cb74SMauro Carvalho Chehab
5705bc3cb74SMauro Carvalho Chehab case VIDIOC_S_CTRL:
5713103c7b4SHans Verkuil if (!vfh->ctrl_handler)
5723103c7b4SHans Verkuil return -ENOTTY;
5735bc3cb74SMauro Carvalho Chehab return v4l2_s_ctrl(vfh, vfh->ctrl_handler, arg);
5745bc3cb74SMauro Carvalho Chehab
5755bc3cb74SMauro Carvalho Chehab case VIDIOC_G_EXT_CTRLS:
5763103c7b4SHans Verkuil if (!vfh->ctrl_handler)
5773103c7b4SHans Verkuil return -ENOTTY;
578c41e9cffSHans Verkuil return v4l2_g_ext_ctrls(vfh->ctrl_handler,
579173f6eacSEzequiel Garcia vdev, sd->v4l2_dev->mdev, arg);
5805bc3cb74SMauro Carvalho Chehab
5815bc3cb74SMauro Carvalho Chehab case VIDIOC_S_EXT_CTRLS:
5823103c7b4SHans Verkuil if (!vfh->ctrl_handler)
5833103c7b4SHans Verkuil return -ENOTTY;
584c41e9cffSHans Verkuil return v4l2_s_ext_ctrls(vfh, vfh->ctrl_handler,
585173f6eacSEzequiel Garcia vdev, sd->v4l2_dev->mdev, arg);
5865bc3cb74SMauro Carvalho Chehab
5875bc3cb74SMauro Carvalho Chehab case VIDIOC_TRY_EXT_CTRLS:
5883103c7b4SHans Verkuil if (!vfh->ctrl_handler)
5893103c7b4SHans Verkuil return -ENOTTY;
590c41e9cffSHans Verkuil return v4l2_try_ext_ctrls(vfh->ctrl_handler,
591173f6eacSEzequiel Garcia vdev, sd->v4l2_dev->mdev, arg);
5925bc3cb74SMauro Carvalho Chehab
5935bc3cb74SMauro Carvalho Chehab case VIDIOC_DQEVENT:
5945bc3cb74SMauro Carvalho Chehab if (!(sd->flags & V4L2_SUBDEV_FL_HAS_EVENTS))
5955bc3cb74SMauro Carvalho Chehab return -ENOIOCTLCMD;
5965bc3cb74SMauro Carvalho Chehab
5975bc3cb74SMauro Carvalho Chehab return v4l2_event_dequeue(vfh, arg, file->f_flags & O_NONBLOCK);
5985bc3cb74SMauro Carvalho Chehab
5995bc3cb74SMauro Carvalho Chehab case VIDIOC_SUBSCRIBE_EVENT:
6005bc3cb74SMauro Carvalho Chehab return v4l2_subdev_call(sd, core, subscribe_event, vfh, arg);
6015bc3cb74SMauro Carvalho Chehab
6025bc3cb74SMauro Carvalho Chehab case VIDIOC_UNSUBSCRIBE_EVENT:
6035bc3cb74SMauro Carvalho Chehab return v4l2_subdev_call(sd, core, unsubscribe_event, vfh, arg);
6045bc3cb74SMauro Carvalho Chehab
6055bc3cb74SMauro Carvalho Chehab #ifdef CONFIG_VIDEO_ADV_DEBUG
6065bc3cb74SMauro Carvalho Chehab case VIDIOC_DBG_G_REGISTER:
6075bc3cb74SMauro Carvalho Chehab {
6085bc3cb74SMauro Carvalho Chehab struct v4l2_dbg_register *p = arg;
6095bc3cb74SMauro Carvalho Chehab
6105bc3cb74SMauro Carvalho Chehab if (!capable(CAP_SYS_ADMIN))
6115bc3cb74SMauro Carvalho Chehab return -EPERM;
6125bc3cb74SMauro Carvalho Chehab return v4l2_subdev_call(sd, core, g_register, p);
6135bc3cb74SMauro Carvalho Chehab }
6145bc3cb74SMauro Carvalho Chehab case VIDIOC_DBG_S_REGISTER:
6155bc3cb74SMauro Carvalho Chehab {
6165bc3cb74SMauro Carvalho Chehab struct v4l2_dbg_register *p = arg;
6175bc3cb74SMauro Carvalho Chehab
6185bc3cb74SMauro Carvalho Chehab if (!capable(CAP_SYS_ADMIN))
6195bc3cb74SMauro Carvalho Chehab return -EPERM;
6205bc3cb74SMauro Carvalho Chehab return v4l2_subdev_call(sd, core, s_register, p);
6215bc3cb74SMauro Carvalho Chehab }
622f437a7cbSHans Verkuil case VIDIOC_DBG_G_CHIP_INFO:
623f437a7cbSHans Verkuil {
624f437a7cbSHans Verkuil struct v4l2_dbg_chip_info *p = arg;
625f437a7cbSHans Verkuil
626f437a7cbSHans Verkuil if (p->match.type != V4L2_CHIP_MATCH_SUBDEV || p->match.addr)
627f437a7cbSHans Verkuil return -EINVAL;
628f437a7cbSHans Verkuil if (sd->ops->core && sd->ops->core->s_register)
629f437a7cbSHans Verkuil p->flags |= V4L2_CHIP_FL_WRITABLE;
630f437a7cbSHans Verkuil if (sd->ops->core && sd->ops->core->g_register)
631f437a7cbSHans Verkuil p->flags |= V4L2_CHIP_FL_READABLE;
632c0decac1SMauro Carvalho Chehab strscpy(p->name, sd->name, sizeof(p->name));
633f437a7cbSHans Verkuil return 0;
634f437a7cbSHans Verkuil }
6355bc3cb74SMauro Carvalho Chehab #endif
6365bc3cb74SMauro Carvalho Chehab
6375bc3cb74SMauro Carvalho Chehab case VIDIOC_LOG_STATUS: {
6385bc3cb74SMauro Carvalho Chehab int ret;
6395bc3cb74SMauro Carvalho Chehab
6405bc3cb74SMauro Carvalho Chehab pr_info("%s: ================= START STATUS =================\n",
6415bc3cb74SMauro Carvalho Chehab sd->name);
6425bc3cb74SMauro Carvalho Chehab ret = v4l2_subdev_call(sd, core, log_status);
6435bc3cb74SMauro Carvalho Chehab pr_info("%s: ================== END STATUS ==================\n",
6445bc3cb74SMauro Carvalho Chehab sd->name);
6455bc3cb74SMauro Carvalho Chehab return ret;
6465bc3cb74SMauro Carvalho Chehab }
6475bc3cb74SMauro Carvalho Chehab
6485bc3cb74SMauro Carvalho Chehab case VIDIOC_SUBDEV_G_FMT: {
6495bc3cb74SMauro Carvalho Chehab struct v4l2_subdev_format *format = arg;
6505bc3cb74SMauro Carvalho Chehab
651f57fa295STomi Valkeinen if (!client_supports_streams)
652f57fa295STomi Valkeinen format->stream = 0;
653f57fa295STomi Valkeinen
6547c8a940aSHans Verkuil memset(format->reserved, 0, sizeof(format->reserved));
6557c8a940aSHans Verkuil memset(format->format.reserved, 0, sizeof(format->format.reserved));
6563cc7a4bbSTomi Valkeinen return v4l2_subdev_call(sd, pad, get_fmt, state, format);
6575bc3cb74SMauro Carvalho Chehab }
6585bc3cb74SMauro Carvalho Chehab
6595bc3cb74SMauro Carvalho Chehab case VIDIOC_SUBDEV_S_FMT: {
6605bc3cb74SMauro Carvalho Chehab struct v4l2_subdev_format *format = arg;
6615bc3cb74SMauro Carvalho Chehab
662f75c431eSJacopo Mondi if (format->which != V4L2_SUBDEV_FORMAT_TRY && ro_subdev)
663f75c431eSJacopo Mondi return -EPERM;
664f75c431eSJacopo Mondi
665f57fa295STomi Valkeinen if (!client_supports_streams)
666f57fa295STomi Valkeinen format->stream = 0;
667f57fa295STomi Valkeinen
6687c8a940aSHans Verkuil memset(format->reserved, 0, sizeof(format->reserved));
6697c8a940aSHans Verkuil memset(format->format.reserved, 0, sizeof(format->format.reserved));
6703cc7a4bbSTomi Valkeinen return v4l2_subdev_call(sd, pad, set_fmt, state, format);
6715bc3cb74SMauro Carvalho Chehab }
6725bc3cb74SMauro Carvalho Chehab
6735bc3cb74SMauro Carvalho Chehab case VIDIOC_SUBDEV_G_CROP: {
6745bc3cb74SMauro Carvalho Chehab struct v4l2_subdev_crop *crop = arg;
6755bc3cb74SMauro Carvalho Chehab struct v4l2_subdev_selection sel;
6765bc3cb74SMauro Carvalho Chehab
677f57fa295STomi Valkeinen if (!client_supports_streams)
678f57fa295STomi Valkeinen crop->stream = 0;
679f57fa295STomi Valkeinen
6807c8a940aSHans Verkuil memset(crop->reserved, 0, sizeof(crop->reserved));
6815bc3cb74SMauro Carvalho Chehab memset(&sel, 0, sizeof(sel));
6825bc3cb74SMauro Carvalho Chehab sel.which = crop->which;
6835bc3cb74SMauro Carvalho Chehab sel.pad = crop->pad;
684983e91adSLaurent Pinchart sel.stream = crop->stream;
6855bc3cb74SMauro Carvalho Chehab sel.target = V4L2_SEL_TGT_CROP;
6865bc3cb74SMauro Carvalho Chehab
6875bc3cb74SMauro Carvalho Chehab rval = v4l2_subdev_call(
6883cc7a4bbSTomi Valkeinen sd, pad, get_selection, state, &sel);
6895bc3cb74SMauro Carvalho Chehab
6905bc3cb74SMauro Carvalho Chehab crop->rect = sel.r;
6915bc3cb74SMauro Carvalho Chehab
6925bc3cb74SMauro Carvalho Chehab return rval;
6935bc3cb74SMauro Carvalho Chehab }
6945bc3cb74SMauro Carvalho Chehab
6955bc3cb74SMauro Carvalho Chehab case VIDIOC_SUBDEV_S_CROP: {
6965bc3cb74SMauro Carvalho Chehab struct v4l2_subdev_crop *crop = arg;
6975bc3cb74SMauro Carvalho Chehab struct v4l2_subdev_selection sel;
6985bc3cb74SMauro Carvalho Chehab
699f75c431eSJacopo Mondi if (crop->which != V4L2_SUBDEV_FORMAT_TRY && ro_subdev)
700f75c431eSJacopo Mondi return -EPERM;
701f75c431eSJacopo Mondi
702f57fa295STomi Valkeinen if (!client_supports_streams)
703f57fa295STomi Valkeinen crop->stream = 0;
704f57fa295STomi Valkeinen
7057c8a940aSHans Verkuil memset(crop->reserved, 0, sizeof(crop->reserved));
7065bc3cb74SMauro Carvalho Chehab memset(&sel, 0, sizeof(sel));
7075bc3cb74SMauro Carvalho Chehab sel.which = crop->which;
7085bc3cb74SMauro Carvalho Chehab sel.pad = crop->pad;
709983e91adSLaurent Pinchart sel.stream = crop->stream;
7105bc3cb74SMauro Carvalho Chehab sel.target = V4L2_SEL_TGT_CROP;
7115bc3cb74SMauro Carvalho Chehab sel.r = crop->rect;
7125bc3cb74SMauro Carvalho Chehab
7135bc3cb74SMauro Carvalho Chehab rval = v4l2_subdev_call(
7143cc7a4bbSTomi Valkeinen sd, pad, set_selection, state, &sel);
7155bc3cb74SMauro Carvalho Chehab
7165bc3cb74SMauro Carvalho Chehab crop->rect = sel.r;
7175bc3cb74SMauro Carvalho Chehab
7185bc3cb74SMauro Carvalho Chehab return rval;
7195bc3cb74SMauro Carvalho Chehab }
7205bc3cb74SMauro Carvalho Chehab
7215bc3cb74SMauro Carvalho Chehab case VIDIOC_SUBDEV_ENUM_MBUS_CODE: {
7225bc3cb74SMauro Carvalho Chehab struct v4l2_subdev_mbus_code_enum *code = arg;
7235bc3cb74SMauro Carvalho Chehab
724f57fa295STomi Valkeinen if (!client_supports_streams)
725f57fa295STomi Valkeinen code->stream = 0;
726f57fa295STomi Valkeinen
7277c8a940aSHans Verkuil memset(code->reserved, 0, sizeof(code->reserved));
7283cc7a4bbSTomi Valkeinen return v4l2_subdev_call(sd, pad, enum_mbus_code, state,
7295bc3cb74SMauro Carvalho Chehab code);
7305bc3cb74SMauro Carvalho Chehab }
7315bc3cb74SMauro Carvalho Chehab
7325bc3cb74SMauro Carvalho Chehab case VIDIOC_SUBDEV_ENUM_FRAME_SIZE: {
7335bc3cb74SMauro Carvalho Chehab struct v4l2_subdev_frame_size_enum *fse = arg;
7345bc3cb74SMauro Carvalho Chehab
735f57fa295STomi Valkeinen if (!client_supports_streams)
736f57fa295STomi Valkeinen fse->stream = 0;
737f57fa295STomi Valkeinen
7387c8a940aSHans Verkuil memset(fse->reserved, 0, sizeof(fse->reserved));
7393cc7a4bbSTomi Valkeinen return v4l2_subdev_call(sd, pad, enum_frame_size, state,
7405bc3cb74SMauro Carvalho Chehab fse);
7415bc3cb74SMauro Carvalho Chehab }
7425bc3cb74SMauro Carvalho Chehab
743743e1837SSakari Ailus case VIDIOC_SUBDEV_G_FRAME_INTERVAL: {
744743e1837SSakari Ailus struct v4l2_subdev_frame_interval *fi = arg;
7455bc3cb74SMauro Carvalho Chehab
746f57fa295STomi Valkeinen if (!client_supports_streams)
747f57fa295STomi Valkeinen fi->stream = 0;
748f57fa295STomi Valkeinen
7497c8a940aSHans Verkuil memset(fi->reserved, 0, sizeof(fi->reserved));
750743e1837SSakari Ailus return v4l2_subdev_call(sd, video, g_frame_interval, arg);
751743e1837SSakari Ailus }
752743e1837SSakari Ailus
753743e1837SSakari Ailus case VIDIOC_SUBDEV_S_FRAME_INTERVAL: {
754743e1837SSakari Ailus struct v4l2_subdev_frame_interval *fi = arg;
755743e1837SSakari Ailus
756f75c431eSJacopo Mondi if (ro_subdev)
757f75c431eSJacopo Mondi return -EPERM;
758f75c431eSJacopo Mondi
759f57fa295STomi Valkeinen if (!client_supports_streams)
760f57fa295STomi Valkeinen fi->stream = 0;
761f57fa295STomi Valkeinen
7627c8a940aSHans Verkuil memset(fi->reserved, 0, sizeof(fi->reserved));
7635bc3cb74SMauro Carvalho Chehab return v4l2_subdev_call(sd, video, s_frame_interval, arg);
764743e1837SSakari Ailus }
7655bc3cb74SMauro Carvalho Chehab
7665bc3cb74SMauro Carvalho Chehab case VIDIOC_SUBDEV_ENUM_FRAME_INTERVAL: {
7675bc3cb74SMauro Carvalho Chehab struct v4l2_subdev_frame_interval_enum *fie = arg;
7685bc3cb74SMauro Carvalho Chehab
769f57fa295STomi Valkeinen if (!client_supports_streams)
770f57fa295STomi Valkeinen fie->stream = 0;
771f57fa295STomi Valkeinen
7727c8a940aSHans Verkuil memset(fie->reserved, 0, sizeof(fie->reserved));
7733cc7a4bbSTomi Valkeinen return v4l2_subdev_call(sd, pad, enum_frame_interval, state,
7745bc3cb74SMauro Carvalho Chehab fie);
7755bc3cb74SMauro Carvalho Chehab }
7765bc3cb74SMauro Carvalho Chehab
7775bc3cb74SMauro Carvalho Chehab case VIDIOC_SUBDEV_G_SELECTION: {
7785bc3cb74SMauro Carvalho Chehab struct v4l2_subdev_selection *sel = arg;
7795bc3cb74SMauro Carvalho Chehab
780f57fa295STomi Valkeinen if (!client_supports_streams)
781f57fa295STomi Valkeinen sel->stream = 0;
782f57fa295STomi Valkeinen
7837c8a940aSHans Verkuil memset(sel->reserved, 0, sizeof(sel->reserved));
7845bc3cb74SMauro Carvalho Chehab return v4l2_subdev_call(
7853cc7a4bbSTomi Valkeinen sd, pad, get_selection, state, sel);
7865bc3cb74SMauro Carvalho Chehab }
7875bc3cb74SMauro Carvalho Chehab
7885bc3cb74SMauro Carvalho Chehab case VIDIOC_SUBDEV_S_SELECTION: {
7895bc3cb74SMauro Carvalho Chehab struct v4l2_subdev_selection *sel = arg;
7905bc3cb74SMauro Carvalho Chehab
791f75c431eSJacopo Mondi if (sel->which != V4L2_SUBDEV_FORMAT_TRY && ro_subdev)
792f75c431eSJacopo Mondi return -EPERM;
793f75c431eSJacopo Mondi
794f57fa295STomi Valkeinen if (!client_supports_streams)
795f57fa295STomi Valkeinen sel->stream = 0;
796f57fa295STomi Valkeinen
7977c8a940aSHans Verkuil memset(sel->reserved, 0, sizeof(sel->reserved));
7985bc3cb74SMauro Carvalho Chehab return v4l2_subdev_call(
7993cc7a4bbSTomi Valkeinen sd, pad, set_selection, state, sel);
8005bc3cb74SMauro Carvalho Chehab }
801ed45ce2cSHans Verkuil
802f2e90847SLaurent Pinchart case VIDIOC_G_EDID: {
803f2e90847SLaurent Pinchart struct v4l2_subdev_edid *edid = arg;
804ed45ce2cSHans Verkuil
805f2e90847SLaurent Pinchart return v4l2_subdev_call(sd, pad, get_edid, edid);
806f2e90847SLaurent Pinchart }
807f2e90847SLaurent Pinchart
808f2e90847SLaurent Pinchart case VIDIOC_S_EDID: {
809f2e90847SLaurent Pinchart struct v4l2_subdev_edid *edid = arg;
810f2e90847SLaurent Pinchart
811f2e90847SLaurent Pinchart return v4l2_subdev_call(sd, pad, set_edid, edid);
812f2e90847SLaurent Pinchart }
8139cfd65e8SLaurent Pinchart
8149cfd65e8SLaurent Pinchart case VIDIOC_SUBDEV_DV_TIMINGS_CAP: {
8159cfd65e8SLaurent Pinchart struct v4l2_dv_timings_cap *cap = arg;
8169cfd65e8SLaurent Pinchart
8179cfd65e8SLaurent Pinchart return v4l2_subdev_call(sd, pad, dv_timings_cap, cap);
8189cfd65e8SLaurent Pinchart }
8199cfd65e8SLaurent Pinchart
8209cfd65e8SLaurent Pinchart case VIDIOC_SUBDEV_ENUM_DV_TIMINGS: {
8219cfd65e8SLaurent Pinchart struct v4l2_enum_dv_timings *dvt = arg;
8229cfd65e8SLaurent Pinchart
8239cfd65e8SLaurent Pinchart return v4l2_subdev_call(sd, pad, enum_dv_timings, dvt);
8249cfd65e8SLaurent Pinchart }
8259cfd65e8SLaurent Pinchart
8269cfd65e8SLaurent Pinchart case VIDIOC_SUBDEV_QUERY_DV_TIMINGS:
8279cfd65e8SLaurent Pinchart return v4l2_subdev_call(sd, video, query_dv_timings, arg);
8289cfd65e8SLaurent Pinchart
8299cfd65e8SLaurent Pinchart case VIDIOC_SUBDEV_G_DV_TIMINGS:
8309cfd65e8SLaurent Pinchart return v4l2_subdev_call(sd, video, g_dv_timings, arg);
8319cfd65e8SLaurent Pinchart
8329cfd65e8SLaurent Pinchart case VIDIOC_SUBDEV_S_DV_TIMINGS:
833f75c431eSJacopo Mondi if (ro_subdev)
834f75c431eSJacopo Mondi return -EPERM;
835f75c431eSJacopo Mondi
8369cfd65e8SLaurent Pinchart return v4l2_subdev_call(sd, video, s_dv_timings, arg);
83756ab8cdbSNiklas Söderlund
83856ab8cdbSNiklas Söderlund case VIDIOC_SUBDEV_G_STD:
83956ab8cdbSNiklas Söderlund return v4l2_subdev_call(sd, video, g_std, arg);
84056ab8cdbSNiklas Söderlund
84156ab8cdbSNiklas Söderlund case VIDIOC_SUBDEV_S_STD: {
84256ab8cdbSNiklas Söderlund v4l2_std_id *std = arg;
84356ab8cdbSNiklas Söderlund
844f75c431eSJacopo Mondi if (ro_subdev)
845f75c431eSJacopo Mondi return -EPERM;
846f75c431eSJacopo Mondi
84756ab8cdbSNiklas Söderlund return v4l2_subdev_call(sd, video, s_std, *std);
84856ab8cdbSNiklas Söderlund }
84956ab8cdbSNiklas Söderlund
85056ab8cdbSNiklas Söderlund case VIDIOC_SUBDEV_ENUMSTD: {
85156ab8cdbSNiklas Söderlund struct v4l2_standard *p = arg;
85256ab8cdbSNiklas Söderlund v4l2_std_id id;
85356ab8cdbSNiklas Söderlund
85456ab8cdbSNiklas Söderlund if (v4l2_subdev_call(sd, video, g_tvnorms, &id))
85556ab8cdbSNiklas Söderlund return -EINVAL;
85656ab8cdbSNiklas Söderlund
85756ab8cdbSNiklas Söderlund return v4l_video_std_enumstd(p, id);
85856ab8cdbSNiklas Söderlund }
85956ab8cdbSNiklas Söderlund
86056ab8cdbSNiklas Söderlund case VIDIOC_SUBDEV_QUERYSTD:
86156ab8cdbSNiklas Söderlund return v4l2_subdev_call(sd, video, querystd, arg);
862fb15db8cSJacopo Mondi
863a418bb3fSLaurent Pinchart case VIDIOC_SUBDEV_G_ROUTING: {
864a418bb3fSLaurent Pinchart struct v4l2_subdev_routing *routing = arg;
865a418bb3fSLaurent Pinchart struct v4l2_subdev_krouting *krouting;
866a418bb3fSLaurent Pinchart
8678a546445STomi Valkeinen if (!v4l2_subdev_enable_streams_api)
8688a546445STomi Valkeinen return -ENOIOCTLCMD;
8698a546445STomi Valkeinen
870a418bb3fSLaurent Pinchart if (!(sd->flags & V4L2_SUBDEV_FL_STREAMS))
871a418bb3fSLaurent Pinchart return -ENOIOCTLCMD;
872a418bb3fSLaurent Pinchart
873a418bb3fSLaurent Pinchart memset(routing->reserved, 0, sizeof(routing->reserved));
874a418bb3fSLaurent Pinchart
875a418bb3fSLaurent Pinchart krouting = &state->routing;
876a418bb3fSLaurent Pinchart
877a418bb3fSLaurent Pinchart if (routing->num_routes < krouting->num_routes) {
878a418bb3fSLaurent Pinchart routing->num_routes = krouting->num_routes;
879a418bb3fSLaurent Pinchart return -ENOSPC;
880a418bb3fSLaurent Pinchart }
881a418bb3fSLaurent Pinchart
882a418bb3fSLaurent Pinchart memcpy((struct v4l2_subdev_route *)(uintptr_t)routing->routes,
883a418bb3fSLaurent Pinchart krouting->routes,
884a418bb3fSLaurent Pinchart krouting->num_routes * sizeof(*krouting->routes));
885a418bb3fSLaurent Pinchart routing->num_routes = krouting->num_routes;
886a418bb3fSLaurent Pinchart
887a418bb3fSLaurent Pinchart return 0;
888a418bb3fSLaurent Pinchart }
889a418bb3fSLaurent Pinchart
890a418bb3fSLaurent Pinchart case VIDIOC_SUBDEV_S_ROUTING: {
891a418bb3fSLaurent Pinchart struct v4l2_subdev_routing *routing = arg;
892a418bb3fSLaurent Pinchart struct v4l2_subdev_route *routes =
893a418bb3fSLaurent Pinchart (struct v4l2_subdev_route *)(uintptr_t)routing->routes;
894a418bb3fSLaurent Pinchart struct v4l2_subdev_krouting krouting = {};
895a418bb3fSLaurent Pinchart unsigned int i;
896a418bb3fSLaurent Pinchart
8978a546445STomi Valkeinen if (!v4l2_subdev_enable_streams_api)
8988a546445STomi Valkeinen return -ENOIOCTLCMD;
8998a546445STomi Valkeinen
900a418bb3fSLaurent Pinchart if (!(sd->flags & V4L2_SUBDEV_FL_STREAMS))
901a418bb3fSLaurent Pinchart return -ENOIOCTLCMD;
902a418bb3fSLaurent Pinchart
903a418bb3fSLaurent Pinchart if (routing->which != V4L2_SUBDEV_FORMAT_TRY && ro_subdev)
904a418bb3fSLaurent Pinchart return -EPERM;
905a418bb3fSLaurent Pinchart
906a418bb3fSLaurent Pinchart memset(routing->reserved, 0, sizeof(routing->reserved));
907a418bb3fSLaurent Pinchart
908a418bb3fSLaurent Pinchart for (i = 0; i < routing->num_routes; ++i) {
909a418bb3fSLaurent Pinchart const struct v4l2_subdev_route *route = &routes[i];
910a418bb3fSLaurent Pinchart const struct media_pad *pads = sd->entity.pads;
911a418bb3fSLaurent Pinchart
912a418bb3fSLaurent Pinchart if (route->sink_stream > V4L2_SUBDEV_MAX_STREAM_ID ||
913a418bb3fSLaurent Pinchart route->source_stream > V4L2_SUBDEV_MAX_STREAM_ID)
914a418bb3fSLaurent Pinchart return -EINVAL;
915a418bb3fSLaurent Pinchart
916a418bb3fSLaurent Pinchart if (route->sink_pad >= sd->entity.num_pads)
917a418bb3fSLaurent Pinchart return -EINVAL;
918a418bb3fSLaurent Pinchart
919a418bb3fSLaurent Pinchart if (!(pads[route->sink_pad].flags &
920a418bb3fSLaurent Pinchart MEDIA_PAD_FL_SINK))
921a418bb3fSLaurent Pinchart return -EINVAL;
922a418bb3fSLaurent Pinchart
923a418bb3fSLaurent Pinchart if (route->source_pad >= sd->entity.num_pads)
924a418bb3fSLaurent Pinchart return -EINVAL;
925a418bb3fSLaurent Pinchart
926a418bb3fSLaurent Pinchart if (!(pads[route->source_pad].flags &
927a418bb3fSLaurent Pinchart MEDIA_PAD_FL_SOURCE))
928a418bb3fSLaurent Pinchart return -EINVAL;
929a418bb3fSLaurent Pinchart }
930a418bb3fSLaurent Pinchart
931a418bb3fSLaurent Pinchart krouting.num_routes = routing->num_routes;
932a418bb3fSLaurent Pinchart krouting.routes = routes;
933a418bb3fSLaurent Pinchart
934a418bb3fSLaurent Pinchart return v4l2_subdev_call(sd, pad, set_routing, state,
935a418bb3fSLaurent Pinchart routing->which, &krouting);
936a418bb3fSLaurent Pinchart }
937a418bb3fSLaurent Pinchart
938f57fa295STomi Valkeinen case VIDIOC_SUBDEV_G_CLIENT_CAP: {
939f57fa295STomi Valkeinen struct v4l2_subdev_client_capability *client_cap = arg;
940f57fa295STomi Valkeinen
941f57fa295STomi Valkeinen client_cap->capabilities = subdev_fh->client_caps;
942f57fa295STomi Valkeinen
943f57fa295STomi Valkeinen return 0;
944f57fa295STomi Valkeinen }
945f57fa295STomi Valkeinen
946f57fa295STomi Valkeinen case VIDIOC_SUBDEV_S_CLIENT_CAP: {
947f57fa295STomi Valkeinen struct v4l2_subdev_client_capability *client_cap = arg;
948f57fa295STomi Valkeinen
949f57fa295STomi Valkeinen /*
950f57fa295STomi Valkeinen * Clear V4L2_SUBDEV_CLIENT_CAP_STREAMS if streams API is not
951f57fa295STomi Valkeinen * enabled. Remove this when streams API is no longer
952f57fa295STomi Valkeinen * experimental.
953f57fa295STomi Valkeinen */
954f57fa295STomi Valkeinen if (!v4l2_subdev_enable_streams_api)
955f57fa295STomi Valkeinen client_cap->capabilities &= ~V4L2_SUBDEV_CLIENT_CAP_STREAMS;
956f57fa295STomi Valkeinen
957f57fa295STomi Valkeinen /* Filter out unsupported capabilities */
958f57fa295STomi Valkeinen client_cap->capabilities &= V4L2_SUBDEV_CLIENT_CAP_STREAMS;
959f57fa295STomi Valkeinen
960f57fa295STomi Valkeinen subdev_fh->client_caps = client_cap->capabilities;
961f57fa295STomi Valkeinen
962f57fa295STomi Valkeinen return 0;
963f57fa295STomi Valkeinen }
964f57fa295STomi Valkeinen
9655bc3cb74SMauro Carvalho Chehab default:
9665bc3cb74SMauro Carvalho Chehab return v4l2_subdev_call(sd, core, ioctl, cmd, arg);
9675bc3cb74SMauro Carvalho Chehab }
9685bc3cb74SMauro Carvalho Chehab
9695bc3cb74SMauro Carvalho Chehab return 0;
9705bc3cb74SMauro Carvalho Chehab }
9715bc3cb74SMauro Carvalho Chehab
subdev_do_ioctl_lock(struct file * file,unsigned int cmd,void * arg)97273a11062SHans Verkuil static long subdev_do_ioctl_lock(struct file *file, unsigned int cmd, void *arg)
97373a11062SHans Verkuil {
97473a11062SHans Verkuil struct video_device *vdev = video_devdata(file);
97573a11062SHans Verkuil struct mutex *lock = vdev->lock;
97673a11062SHans Verkuil long ret = -ENODEV;
97773a11062SHans Verkuil
97873a11062SHans Verkuil if (lock && mutex_lock_interruptible(lock))
97973a11062SHans Verkuil return -ERESTARTSYS;
980ed647ea6STomi Valkeinen
981ed647ea6STomi Valkeinen if (video_is_registered(vdev)) {
982ed647ea6STomi Valkeinen struct v4l2_subdev *sd = vdev_to_v4l2_subdev(vdev);
983ed647ea6STomi Valkeinen struct v4l2_fh *vfh = file->private_data;
984ed647ea6STomi Valkeinen struct v4l2_subdev_fh *subdev_fh = to_v4l2_subdev_fh(vfh);
985ed647ea6STomi Valkeinen struct v4l2_subdev_state *state;
986ed647ea6STomi Valkeinen
987ed647ea6STomi Valkeinen state = subdev_ioctl_get_state(sd, subdev_fh, cmd, arg);
988ed647ea6STomi Valkeinen
989ed647ea6STomi Valkeinen if (state)
990ed647ea6STomi Valkeinen v4l2_subdev_lock_state(state);
991ed647ea6STomi Valkeinen
992ed647ea6STomi Valkeinen ret = subdev_do_ioctl(file, cmd, arg, state);
993ed647ea6STomi Valkeinen
994ed647ea6STomi Valkeinen if (state)
995ed647ea6STomi Valkeinen v4l2_subdev_unlock_state(state);
996ed647ea6STomi Valkeinen }
997ed647ea6STomi Valkeinen
99873a11062SHans Verkuil if (lock)
99973a11062SHans Verkuil mutex_unlock(lock);
100073a11062SHans Verkuil return ret;
100173a11062SHans Verkuil }
100273a11062SHans Verkuil
subdev_ioctl(struct file * file,unsigned int cmd,unsigned long arg)10035bc3cb74SMauro Carvalho Chehab static long subdev_ioctl(struct file *file, unsigned int cmd,
10045bc3cb74SMauro Carvalho Chehab unsigned long arg)
10055bc3cb74SMauro Carvalho Chehab {
100673a11062SHans Verkuil return video_usercopy(file, cmd, arg, subdev_do_ioctl_lock);
10075bc3cb74SMauro Carvalho Chehab }
10085bc3cb74SMauro Carvalho Chehab
1009ab58a301SHans Verkuil #ifdef CONFIG_COMPAT
subdev_compat_ioctl32(struct file * file,unsigned int cmd,unsigned long arg)1010ab58a301SHans Verkuil static long subdev_compat_ioctl32(struct file *file, unsigned int cmd,
1011ab58a301SHans Verkuil unsigned long arg)
1012ab58a301SHans Verkuil {
1013ab58a301SHans Verkuil struct video_device *vdev = video_devdata(file);
1014ab58a301SHans Verkuil struct v4l2_subdev *sd = vdev_to_v4l2_subdev(vdev);
1015ab58a301SHans Verkuil
1016ab58a301SHans Verkuil return v4l2_subdev_call(sd, core, compat_ioctl32, cmd, arg);
1017ab58a301SHans Verkuil }
1018ab58a301SHans Verkuil #endif
1019ab58a301SHans Verkuil
1020fb15db8cSJacopo Mondi #else /* CONFIG_VIDEO_V4L2_SUBDEV_API */
subdev_ioctl(struct file * file,unsigned int cmd,unsigned long arg)1021fb15db8cSJacopo Mondi static long subdev_ioctl(struct file *file, unsigned int cmd,
1022fb15db8cSJacopo Mondi unsigned long arg)
1023fb15db8cSJacopo Mondi {
1024fb15db8cSJacopo Mondi return -ENODEV;
1025fb15db8cSJacopo Mondi }
1026fb15db8cSJacopo Mondi
1027fb15db8cSJacopo Mondi #ifdef CONFIG_COMPAT
subdev_compat_ioctl32(struct file * file,unsigned int cmd,unsigned long arg)1028fb15db8cSJacopo Mondi static long subdev_compat_ioctl32(struct file *file, unsigned int cmd,
1029fb15db8cSJacopo Mondi unsigned long arg)
1030fb15db8cSJacopo Mondi {
1031fb15db8cSJacopo Mondi return -ENODEV;
1032fb15db8cSJacopo Mondi }
1033fb15db8cSJacopo Mondi #endif
1034fb15db8cSJacopo Mondi #endif /* CONFIG_VIDEO_V4L2_SUBDEV_API */
1035fb15db8cSJacopo Mondi
subdev_poll(struct file * file,poll_table * wait)1036c23e0cb8SAl Viro static __poll_t subdev_poll(struct file *file, poll_table *wait)
10375bc3cb74SMauro Carvalho Chehab {
10385bc3cb74SMauro Carvalho Chehab struct video_device *vdev = video_devdata(file);
10395bc3cb74SMauro Carvalho Chehab struct v4l2_subdev *sd = vdev_to_v4l2_subdev(vdev);
10405bc3cb74SMauro Carvalho Chehab struct v4l2_fh *fh = file->private_data;
10415bc3cb74SMauro Carvalho Chehab
10425bc3cb74SMauro Carvalho Chehab if (!(sd->flags & V4L2_SUBDEV_FL_HAS_EVENTS))
1043a9a08845SLinus Torvalds return EPOLLERR;
10445bc3cb74SMauro Carvalho Chehab
10455bc3cb74SMauro Carvalho Chehab poll_wait(file, &fh->wait, wait);
10465bc3cb74SMauro Carvalho Chehab
10475bc3cb74SMauro Carvalho Chehab if (v4l2_event_pending(fh))
1048a9a08845SLinus Torvalds return EPOLLPRI;
10495bc3cb74SMauro Carvalho Chehab
10505bc3cb74SMauro Carvalho Chehab return 0;
10515bc3cb74SMauro Carvalho Chehab }
10525bc3cb74SMauro Carvalho Chehab
10535bc3cb74SMauro Carvalho Chehab const struct v4l2_file_operations v4l2_subdev_fops = {
10545bc3cb74SMauro Carvalho Chehab .owner = THIS_MODULE,
10555bc3cb74SMauro Carvalho Chehab .open = subdev_open,
10565bc3cb74SMauro Carvalho Chehab .unlocked_ioctl = subdev_ioctl,
1057ab58a301SHans Verkuil #ifdef CONFIG_COMPAT
1058ab58a301SHans Verkuil .compat_ioctl32 = subdev_compat_ioctl32,
1059ab58a301SHans Verkuil #endif
10605bc3cb74SMauro Carvalho Chehab .release = subdev_close,
10615bc3cb74SMauro Carvalho Chehab .poll = subdev_poll,
10625bc3cb74SMauro Carvalho Chehab };
10635bc3cb74SMauro Carvalho Chehab
10645bc3cb74SMauro Carvalho Chehab #ifdef CONFIG_MEDIA_CONTROLLER
10658fe784b9SSteve Longerbeam
v4l2_subdev_get_fwnode_pad_1_to_1(struct media_entity * entity,struct fwnode_endpoint * endpoint)10668fe784b9SSteve Longerbeam int v4l2_subdev_get_fwnode_pad_1_to_1(struct media_entity *entity,
10678fe784b9SSteve Longerbeam struct fwnode_endpoint *endpoint)
10688fe784b9SSteve Longerbeam {
10698fe784b9SSteve Longerbeam struct fwnode_handle *fwnode;
10708fe784b9SSteve Longerbeam struct v4l2_subdev *sd;
10718fe784b9SSteve Longerbeam
10728fe784b9SSteve Longerbeam if (!is_media_entity_v4l2_subdev(entity))
10738fe784b9SSteve Longerbeam return -EINVAL;
10748fe784b9SSteve Longerbeam
10758fe784b9SSteve Longerbeam sd = media_entity_to_v4l2_subdev(entity);
10768fe784b9SSteve Longerbeam
10778fe784b9SSteve Longerbeam fwnode = fwnode_graph_get_port_parent(endpoint->local_fwnode);
10788fe784b9SSteve Longerbeam fwnode_handle_put(fwnode);
10798fe784b9SSteve Longerbeam
1080026df230SAndy Shevchenko if (device_match_fwnode(sd->dev, fwnode))
10818fe784b9SSteve Longerbeam return endpoint->port;
10828fe784b9SSteve Longerbeam
10838fe784b9SSteve Longerbeam return -ENXIO;
10848fe784b9SSteve Longerbeam }
10858fe784b9SSteve Longerbeam EXPORT_SYMBOL_GPL(v4l2_subdev_get_fwnode_pad_1_to_1);
10868fe784b9SSteve Longerbeam
v4l2_subdev_link_validate_default(struct v4l2_subdev * sd,struct media_link * link,struct v4l2_subdev_format * source_fmt,struct v4l2_subdev_format * sink_fmt)10875bc3cb74SMauro Carvalho Chehab int v4l2_subdev_link_validate_default(struct v4l2_subdev *sd,
10885bc3cb74SMauro Carvalho Chehab struct media_link *link,
10895bc3cb74SMauro Carvalho Chehab struct v4l2_subdev_format *source_fmt,
10905bc3cb74SMauro Carvalho Chehab struct v4l2_subdev_format *sink_fmt)
10915bc3cb74SMauro Carvalho Chehab {
1092db8e94e7SSakari Ailus bool pass = true;
1093db8e94e7SSakari Ailus
109424acf8b2SLaurent Pinchart /* The width, height and code must match. */
1095db8e94e7SSakari Ailus if (source_fmt->format.width != sink_fmt->format.width) {
1096db8e94e7SSakari Ailus dev_dbg(sd->entity.graph_obj.mdev->dev,
1097db8e94e7SSakari Ailus "%s: width does not match (source %u, sink %u)\n",
1098db8e94e7SSakari Ailus __func__,
1099db8e94e7SSakari Ailus source_fmt->format.width, sink_fmt->format.width);
1100db8e94e7SSakari Ailus pass = false;
1101db8e94e7SSakari Ailus }
1102db8e94e7SSakari Ailus
1103db8e94e7SSakari Ailus if (source_fmt->format.height != sink_fmt->format.height) {
1104db8e94e7SSakari Ailus dev_dbg(sd->entity.graph_obj.mdev->dev,
1105db8e94e7SSakari Ailus "%s: height does not match (source %u, sink %u)\n",
1106db8e94e7SSakari Ailus __func__,
1107db8e94e7SSakari Ailus source_fmt->format.height, sink_fmt->format.height);
1108db8e94e7SSakari Ailus pass = false;
1109db8e94e7SSakari Ailus }
1110db8e94e7SSakari Ailus
1111db8e94e7SSakari Ailus if (source_fmt->format.code != sink_fmt->format.code) {
1112db8e94e7SSakari Ailus dev_dbg(sd->entity.graph_obj.mdev->dev,
1113db8e94e7SSakari Ailus "%s: media bus code does not match (source 0x%8.8x, sink 0x%8.8x)\n",
1114db8e94e7SSakari Ailus __func__,
1115db8e94e7SSakari Ailus source_fmt->format.code, sink_fmt->format.code);
1116db8e94e7SSakari Ailus pass = false;
1117db8e94e7SSakari Ailus }
11185bc3cb74SMauro Carvalho Chehab
111924acf8b2SLaurent Pinchart /* The field order must match, or the sink field order must be NONE
112024acf8b2SLaurent Pinchart * to support interlaced hardware connected to bridges that support
112124acf8b2SLaurent Pinchart * progressive formats only.
112224acf8b2SLaurent Pinchart */
112324acf8b2SLaurent Pinchart if (source_fmt->format.field != sink_fmt->format.field &&
1124db8e94e7SSakari Ailus sink_fmt->format.field != V4L2_FIELD_NONE) {
1125db8e94e7SSakari Ailus dev_dbg(sd->entity.graph_obj.mdev->dev,
1126db8e94e7SSakari Ailus "%s: field does not match (source %u, sink %u)\n",
1127db8e94e7SSakari Ailus __func__,
1128db8e94e7SSakari Ailus source_fmt->format.field, sink_fmt->format.field);
1129db8e94e7SSakari Ailus pass = false;
1130db8e94e7SSakari Ailus }
113124acf8b2SLaurent Pinchart
1132db8e94e7SSakari Ailus if (pass)
11335bc3cb74SMauro Carvalho Chehab return 0;
1134db8e94e7SSakari Ailus
1135db8e94e7SSakari Ailus dev_dbg(sd->entity.graph_obj.mdev->dev,
1136db8e94e7SSakari Ailus "%s: link was \"%s\":%u -> \"%s\":%u\n", __func__,
1137db8e94e7SSakari Ailus link->source->entity->name, link->source->index,
1138db8e94e7SSakari Ailus link->sink->entity->name, link->sink->index);
1139db8e94e7SSakari Ailus
1140db8e94e7SSakari Ailus return -EPIPE;
11415bc3cb74SMauro Carvalho Chehab }
11425bc3cb74SMauro Carvalho Chehab EXPORT_SYMBOL_GPL(v4l2_subdev_link_validate_default);
11435bc3cb74SMauro Carvalho Chehab
11445bc3cb74SMauro Carvalho Chehab static int
v4l2_subdev_link_validate_get_format(struct media_pad * pad,u32 stream,struct v4l2_subdev_format * fmt,bool states_locked)1145a6b995edSTomi Valkeinen v4l2_subdev_link_validate_get_format(struct media_pad *pad, u32 stream,
114653077915STomi Valkeinen struct v4l2_subdev_format *fmt,
114753077915STomi Valkeinen bool states_locked)
11485bc3cb74SMauro Carvalho Chehab {
114953077915STomi Valkeinen struct v4l2_subdev_state *state;
115053077915STomi Valkeinen struct v4l2_subdev *sd;
115153077915STomi Valkeinen int ret;
1152864a1212SLaurent Pinchart
115353077915STomi Valkeinen if (!is_media_entity_v4l2_subdev(pad->entity)) {
11544ca72efaSMauro Carvalho Chehab WARN(pad->entity->function != MEDIA_ENT_F_IO_V4L,
1155864a1212SLaurent Pinchart "Driver bug! Wrong media entity type 0x%08x, entity %s\n",
11560e576b76SMauro Carvalho Chehab pad->entity->function, pad->entity->name);
1157864a1212SLaurent Pinchart
1158864a1212SLaurent Pinchart return -EINVAL;
11595bc3cb74SMauro Carvalho Chehab }
11605bc3cb74SMauro Carvalho Chehab
116153077915STomi Valkeinen sd = media_entity_to_v4l2_subdev(pad->entity);
116253077915STomi Valkeinen
116353077915STomi Valkeinen fmt->which = V4L2_SUBDEV_FORMAT_ACTIVE;
116453077915STomi Valkeinen fmt->pad = pad->index;
116553077915STomi Valkeinen fmt->stream = stream;
116653077915STomi Valkeinen
116753077915STomi Valkeinen if (states_locked)
116853077915STomi Valkeinen state = v4l2_subdev_get_locked_active_state(sd);
116953077915STomi Valkeinen else
117053077915STomi Valkeinen state = v4l2_subdev_lock_and_get_active_state(sd);
117153077915STomi Valkeinen
117253077915STomi Valkeinen ret = v4l2_subdev_call(sd, pad, get_fmt, state, fmt);
117353077915STomi Valkeinen
117453077915STomi Valkeinen if (!states_locked && state)
117553077915STomi Valkeinen v4l2_subdev_unlock_state(state);
117653077915STomi Valkeinen
117753077915STomi Valkeinen return ret;
117853077915STomi Valkeinen }
117953077915STomi Valkeinen
1180a6b995edSTomi Valkeinen #if defined(CONFIG_VIDEO_V4L2_SUBDEV_API)
1181a6b995edSTomi Valkeinen
__v4l2_link_validate_get_streams(struct media_pad * pad,u64 * streams_mask,bool states_locked)1182a6b995edSTomi Valkeinen static void __v4l2_link_validate_get_streams(struct media_pad *pad,
118353077915STomi Valkeinen u64 *streams_mask,
118453077915STomi Valkeinen bool states_locked)
1185a6b995edSTomi Valkeinen {
1186a6b995edSTomi Valkeinen struct v4l2_subdev_route *route;
1187a6b995edSTomi Valkeinen struct v4l2_subdev_state *state;
1188a6b995edSTomi Valkeinen struct v4l2_subdev *subdev;
1189a6b995edSTomi Valkeinen
1190a6b995edSTomi Valkeinen subdev = media_entity_to_v4l2_subdev(pad->entity);
1191a6b995edSTomi Valkeinen
1192a6b995edSTomi Valkeinen *streams_mask = 0;
1193a6b995edSTomi Valkeinen
119453077915STomi Valkeinen if (states_locked)
1195a6b995edSTomi Valkeinen state = v4l2_subdev_get_locked_active_state(subdev);
119653077915STomi Valkeinen else
119753077915STomi Valkeinen state = v4l2_subdev_lock_and_get_active_state(subdev);
119853077915STomi Valkeinen
1199a6b995edSTomi Valkeinen if (WARN_ON(!state))
1200a6b995edSTomi Valkeinen return;
1201a6b995edSTomi Valkeinen
1202a6b995edSTomi Valkeinen for_each_active_route(&state->routing, route) {
1203a6b995edSTomi Valkeinen u32 route_pad;
1204a6b995edSTomi Valkeinen u32 route_stream;
1205a6b995edSTomi Valkeinen
1206a6b995edSTomi Valkeinen if (pad->flags & MEDIA_PAD_FL_SOURCE) {
1207a6b995edSTomi Valkeinen route_pad = route->source_pad;
1208a6b995edSTomi Valkeinen route_stream = route->source_stream;
1209a6b995edSTomi Valkeinen } else {
1210a6b995edSTomi Valkeinen route_pad = route->sink_pad;
1211a6b995edSTomi Valkeinen route_stream = route->sink_stream;
1212a6b995edSTomi Valkeinen }
1213a6b995edSTomi Valkeinen
1214a6b995edSTomi Valkeinen if (route_pad != pad->index)
1215a6b995edSTomi Valkeinen continue;
1216a6b995edSTomi Valkeinen
1217a6b995edSTomi Valkeinen *streams_mask |= BIT_ULL(route_stream);
1218a6b995edSTomi Valkeinen }
121953077915STomi Valkeinen
122053077915STomi Valkeinen if (!states_locked)
122153077915STomi Valkeinen v4l2_subdev_unlock_state(state);
1222a6b995edSTomi Valkeinen }
1223a6b995edSTomi Valkeinen
1224a6b995edSTomi Valkeinen #endif /* CONFIG_VIDEO_V4L2_SUBDEV_API */
1225a6b995edSTomi Valkeinen
v4l2_link_validate_get_streams(struct media_pad * pad,u64 * streams_mask,bool states_locked)1226a6b995edSTomi Valkeinen static void v4l2_link_validate_get_streams(struct media_pad *pad,
122753077915STomi Valkeinen u64 *streams_mask,
122853077915STomi Valkeinen bool states_locked)
1229a6b995edSTomi Valkeinen {
1230a6b995edSTomi Valkeinen struct v4l2_subdev *subdev = media_entity_to_v4l2_subdev(pad->entity);
1231a6b995edSTomi Valkeinen
1232a6b995edSTomi Valkeinen if (!(subdev->flags & V4L2_SUBDEV_FL_STREAMS)) {
1233a6b995edSTomi Valkeinen /* Non-streams subdevs have an implicit stream 0 */
1234a6b995edSTomi Valkeinen *streams_mask = BIT_ULL(0);
1235a6b995edSTomi Valkeinen return;
1236a6b995edSTomi Valkeinen }
1237a6b995edSTomi Valkeinen
1238a6b995edSTomi Valkeinen #if defined(CONFIG_VIDEO_V4L2_SUBDEV_API)
123953077915STomi Valkeinen __v4l2_link_validate_get_streams(pad, streams_mask, states_locked);
1240a6b995edSTomi Valkeinen #else
1241a6b995edSTomi Valkeinen /* This shouldn't happen */
1242a6b995edSTomi Valkeinen *streams_mask = 0;
1243a6b995edSTomi Valkeinen #endif
1244a6b995edSTomi Valkeinen }
1245a6b995edSTomi Valkeinen
v4l2_subdev_link_validate_locked(struct media_link * link,bool states_locked)124653077915STomi Valkeinen static int v4l2_subdev_link_validate_locked(struct media_link *link, bool states_locked)
1247a6b995edSTomi Valkeinen {
1248a6b995edSTomi Valkeinen struct v4l2_subdev *sink_subdev =
1249a6b995edSTomi Valkeinen media_entity_to_v4l2_subdev(link->sink->entity);
1250a6b995edSTomi Valkeinen struct device *dev = sink_subdev->entity.graph_obj.mdev->dev;
1251a6b995edSTomi Valkeinen u64 source_streams_mask;
1252a6b995edSTomi Valkeinen u64 sink_streams_mask;
1253a6b995edSTomi Valkeinen u64 dangling_sink_streams;
1254a6b995edSTomi Valkeinen u32 stream;
1255a6b995edSTomi Valkeinen int ret;
1256a6b995edSTomi Valkeinen
1257a6b995edSTomi Valkeinen dev_dbg(dev, "validating link \"%s\":%u -> \"%s\":%u\n",
1258a6b995edSTomi Valkeinen link->source->entity->name, link->source->index,
1259a6b995edSTomi Valkeinen link->sink->entity->name, link->sink->index);
1260a6b995edSTomi Valkeinen
126153077915STomi Valkeinen v4l2_link_validate_get_streams(link->source, &source_streams_mask, states_locked);
126253077915STomi Valkeinen v4l2_link_validate_get_streams(link->sink, &sink_streams_mask, states_locked);
1263a6b995edSTomi Valkeinen
1264a6b995edSTomi Valkeinen /*
1265a6b995edSTomi Valkeinen * It is ok to have more source streams than sink streams as extra
1266a6b995edSTomi Valkeinen * source streams can just be ignored by the receiver, but having extra
1267a6b995edSTomi Valkeinen * sink streams is an error as streams must have a source.
1268a6b995edSTomi Valkeinen */
1269a6b995edSTomi Valkeinen dangling_sink_streams = (source_streams_mask ^ sink_streams_mask) &
1270a6b995edSTomi Valkeinen sink_streams_mask;
1271a6b995edSTomi Valkeinen if (dangling_sink_streams) {
1272a6b995edSTomi Valkeinen dev_err(dev, "Dangling sink streams: mask %#llx\n",
1273a6b995edSTomi Valkeinen dangling_sink_streams);
1274a6b995edSTomi Valkeinen return -EINVAL;
1275a6b995edSTomi Valkeinen }
1276a6b995edSTomi Valkeinen
1277a6b995edSTomi Valkeinen /* Validate source and sink stream formats */
1278a6b995edSTomi Valkeinen
1279a6b995edSTomi Valkeinen for (stream = 0; stream < sizeof(sink_streams_mask) * 8; ++stream) {
1280a6b995edSTomi Valkeinen struct v4l2_subdev_format sink_fmt, source_fmt;
1281a6b995edSTomi Valkeinen
1282a6b995edSTomi Valkeinen if (!(sink_streams_mask & BIT_ULL(stream)))
1283a6b995edSTomi Valkeinen continue;
1284a6b995edSTomi Valkeinen
1285a6b995edSTomi Valkeinen dev_dbg(dev, "validating stream \"%s\":%u:%u -> \"%s\":%u:%u\n",
1286a6b995edSTomi Valkeinen link->source->entity->name, link->source->index, stream,
1287a6b995edSTomi Valkeinen link->sink->entity->name, link->sink->index, stream);
1288a6b995edSTomi Valkeinen
1289a6b995edSTomi Valkeinen ret = v4l2_subdev_link_validate_get_format(link->source, stream,
129053077915STomi Valkeinen &source_fmt, states_locked);
1291a6b995edSTomi Valkeinen if (ret < 0) {
1292a6b995edSTomi Valkeinen dev_dbg(dev,
1293a6b995edSTomi Valkeinen "Failed to get format for \"%s\":%u:%u (but that's ok)\n",
1294a6b995edSTomi Valkeinen link->source->entity->name, link->source->index,
1295a6b995edSTomi Valkeinen stream);
1296a6b995edSTomi Valkeinen continue;
1297a6b995edSTomi Valkeinen }
1298a6b995edSTomi Valkeinen
1299a6b995edSTomi Valkeinen ret = v4l2_subdev_link_validate_get_format(link->sink, stream,
130053077915STomi Valkeinen &sink_fmt, states_locked);
1301a6b995edSTomi Valkeinen if (ret < 0) {
1302a6b995edSTomi Valkeinen dev_dbg(dev,
1303a6b995edSTomi Valkeinen "Failed to get format for \"%s\":%u:%u (but that's ok)\n",
1304a6b995edSTomi Valkeinen link->sink->entity->name, link->sink->index,
1305a6b995edSTomi Valkeinen stream);
1306a6b995edSTomi Valkeinen continue;
1307a6b995edSTomi Valkeinen }
1308a6b995edSTomi Valkeinen
1309a6b995edSTomi Valkeinen /* TODO: add stream number to link_validate() */
1310a6b995edSTomi Valkeinen ret = v4l2_subdev_call(sink_subdev, pad, link_validate, link,
1311a6b995edSTomi Valkeinen &source_fmt, &sink_fmt);
1312a6b995edSTomi Valkeinen if (!ret)
1313a6b995edSTomi Valkeinen continue;
1314a6b995edSTomi Valkeinen
1315a6b995edSTomi Valkeinen if (ret != -ENOIOCTLCMD)
1316a6b995edSTomi Valkeinen return ret;
1317a6b995edSTomi Valkeinen
1318a6b995edSTomi Valkeinen ret = v4l2_subdev_link_validate_default(sink_subdev, link,
1319a6b995edSTomi Valkeinen &source_fmt, &sink_fmt);
1320a6b995edSTomi Valkeinen
1321a6b995edSTomi Valkeinen if (ret)
1322a6b995edSTomi Valkeinen return ret;
1323a6b995edSTomi Valkeinen }
1324a6b995edSTomi Valkeinen
1325a6b995edSTomi Valkeinen return 0;
1326a6b995edSTomi Valkeinen }
1327a6b995edSTomi Valkeinen
v4l2_subdev_link_validate(struct media_link * link)13285bc3cb74SMauro Carvalho Chehab int v4l2_subdev_link_validate(struct media_link *link)
13295bc3cb74SMauro Carvalho Chehab {
1330a6b995edSTomi Valkeinen struct v4l2_subdev *source_sd, *sink_sd;
1331a6b995edSTomi Valkeinen struct v4l2_subdev_state *source_state, *sink_state;
133253077915STomi Valkeinen bool states_locked;
1333a6b995edSTomi Valkeinen int ret;
13345bc3cb74SMauro Carvalho Chehab
133555f1ecb1SSakari Ailus if (!is_media_entity_v4l2_subdev(link->sink->entity) ||
133655f1ecb1SSakari Ailus !is_media_entity_v4l2_subdev(link->source->entity)) {
133755f1ecb1SSakari Ailus pr_warn_once("%s of link '%s':%u->'%s':%u is not a V4L2 sub-device, driver bug!\n",
133855f1ecb1SSakari Ailus !is_media_entity_v4l2_subdev(link->sink->entity) ?
133955f1ecb1SSakari Ailus "sink" : "source",
134055f1ecb1SSakari Ailus link->source->entity->name, link->source->index,
134155f1ecb1SSakari Ailus link->sink->entity->name, link->sink->index);
134255f1ecb1SSakari Ailus return 0;
134355f1ecb1SSakari Ailus }
134455f1ecb1SSakari Ailus
1345a6b995edSTomi Valkeinen sink_sd = media_entity_to_v4l2_subdev(link->sink->entity);
1346a6b995edSTomi Valkeinen source_sd = media_entity_to_v4l2_subdev(link->source->entity);
13475bc3cb74SMauro Carvalho Chehab
1348a6b995edSTomi Valkeinen sink_state = v4l2_subdev_get_unlocked_active_state(sink_sd);
1349a6b995edSTomi Valkeinen source_state = v4l2_subdev_get_unlocked_active_state(source_sd);
13505bc3cb74SMauro Carvalho Chehab
135153077915STomi Valkeinen states_locked = sink_state && source_state;
135253077915STomi Valkeinen
135353077915STomi Valkeinen if (states_locked) {
1354a6b995edSTomi Valkeinen v4l2_subdev_lock_state(sink_state);
1355a6b995edSTomi Valkeinen v4l2_subdev_lock_state(source_state);
135653077915STomi Valkeinen }
13575bc3cb74SMauro Carvalho Chehab
135853077915STomi Valkeinen ret = v4l2_subdev_link_validate_locked(link, states_locked);
1359a6b995edSTomi Valkeinen
136053077915STomi Valkeinen if (states_locked) {
1361a6b995edSTomi Valkeinen v4l2_subdev_unlock_state(sink_state);
1362a6b995edSTomi Valkeinen v4l2_subdev_unlock_state(source_state);
136353077915STomi Valkeinen }
1364a6b995edSTomi Valkeinen
1365a6b995edSTomi Valkeinen return ret;
13665bc3cb74SMauro Carvalho Chehab }
13675bc3cb74SMauro Carvalho Chehab EXPORT_SYMBOL_GPL(v4l2_subdev_link_validate);
13689b02cbb3SLaurent Pinchart
v4l2_subdev_has_pad_interdep(struct media_entity * entity,unsigned int pad0,unsigned int pad1)136933c0ddbeSTomi Valkeinen bool v4l2_subdev_has_pad_interdep(struct media_entity *entity,
137033c0ddbeSTomi Valkeinen unsigned int pad0, unsigned int pad1)
137133c0ddbeSTomi Valkeinen {
137233c0ddbeSTomi Valkeinen struct v4l2_subdev *sd = media_entity_to_v4l2_subdev(entity);
137333c0ddbeSTomi Valkeinen struct v4l2_subdev_krouting *routing;
137433c0ddbeSTomi Valkeinen struct v4l2_subdev_state *state;
137533c0ddbeSTomi Valkeinen unsigned int i;
137633c0ddbeSTomi Valkeinen
137733c0ddbeSTomi Valkeinen state = v4l2_subdev_lock_and_get_active_state(sd);
137833c0ddbeSTomi Valkeinen
137933c0ddbeSTomi Valkeinen routing = &state->routing;
138033c0ddbeSTomi Valkeinen
138133c0ddbeSTomi Valkeinen for (i = 0; i < routing->num_routes; ++i) {
138233c0ddbeSTomi Valkeinen struct v4l2_subdev_route *route = &routing->routes[i];
138333c0ddbeSTomi Valkeinen
138433c0ddbeSTomi Valkeinen if (!(route->flags & V4L2_SUBDEV_ROUTE_FL_ACTIVE))
138533c0ddbeSTomi Valkeinen continue;
138633c0ddbeSTomi Valkeinen
138733c0ddbeSTomi Valkeinen if ((route->sink_pad == pad0 && route->source_pad == pad1) ||
138833c0ddbeSTomi Valkeinen (route->source_pad == pad0 && route->sink_pad == pad1)) {
138933c0ddbeSTomi Valkeinen v4l2_subdev_unlock_state(state);
139033c0ddbeSTomi Valkeinen return true;
139133c0ddbeSTomi Valkeinen }
139233c0ddbeSTomi Valkeinen }
139333c0ddbeSTomi Valkeinen
139433c0ddbeSTomi Valkeinen v4l2_subdev_unlock_state(state);
139533c0ddbeSTomi Valkeinen
139633c0ddbeSTomi Valkeinen return false;
139733c0ddbeSTomi Valkeinen }
139833c0ddbeSTomi Valkeinen EXPORT_SYMBOL_GPL(v4l2_subdev_has_pad_interdep);
139933c0ddbeSTomi Valkeinen
1400ed647ea6STomi Valkeinen struct v4l2_subdev_state *
__v4l2_subdev_state_alloc(struct v4l2_subdev * sd,const char * lock_name,struct lock_class_key * lock_key)1401ed647ea6STomi Valkeinen __v4l2_subdev_state_alloc(struct v4l2_subdev *sd, const char *lock_name,
1402ed647ea6STomi Valkeinen struct lock_class_key *lock_key)
14039b02cbb3SLaurent Pinchart {
14040d346d2aSTomi Valkeinen struct v4l2_subdev_state *state;
14059b02cbb3SLaurent Pinchart int ret;
14069b02cbb3SLaurent Pinchart
14070d346d2aSTomi Valkeinen state = kzalloc(sizeof(*state), GFP_KERNEL);
14080d346d2aSTomi Valkeinen if (!state)
14090d346d2aSTomi Valkeinen return ERR_PTR(-ENOMEM);
14109b02cbb3SLaurent Pinchart
1411ed647ea6STomi Valkeinen __mutex_init(&state->_lock, lock_name, lock_key);
1412ed647ea6STomi Valkeinen if (sd->state_lock)
1413ed647ea6STomi Valkeinen state->lock = sd->state_lock;
1414ed647ea6STomi Valkeinen else
1415ed647ea6STomi Valkeinen state->lock = &state->_lock;
1416ed647ea6STomi Valkeinen
14172f91e10eSTomi Valkeinen /* Drivers that support streams do not need the legacy pad config */
14182f91e10eSTomi Valkeinen if (!(sd->flags & V4L2_SUBDEV_FL_STREAMS) && sd->entity.num_pads) {
14198af592e2SHans Verkuil state->pads = kvcalloc(sd->entity.num_pads,
14208af592e2SHans Verkuil sizeof(*state->pads), GFP_KERNEL);
14210d346d2aSTomi Valkeinen if (!state->pads) {
14220d346d2aSTomi Valkeinen ret = -ENOMEM;
14230d346d2aSTomi Valkeinen goto err;
14240d346d2aSTomi Valkeinen }
14259b02cbb3SLaurent Pinchart }
14269b02cbb3SLaurent Pinchart
1427ed647ea6STomi Valkeinen /*
1428ed647ea6STomi Valkeinen * There can be no race at this point, but we lock the state anyway to
1429ed647ea6STomi Valkeinen * satisfy lockdep checks.
1430ed647ea6STomi Valkeinen */
1431ed647ea6STomi Valkeinen v4l2_subdev_lock_state(state);
14320d346d2aSTomi Valkeinen ret = v4l2_subdev_call(sd, pad, init_cfg, state);
1433ed647ea6STomi Valkeinen v4l2_subdev_unlock_state(state);
1434ed647ea6STomi Valkeinen
14350d346d2aSTomi Valkeinen if (ret < 0 && ret != -ENOIOCTLCMD)
14360d346d2aSTomi Valkeinen goto err;
14379b02cbb3SLaurent Pinchart
14380d346d2aSTomi Valkeinen return state;
14390d346d2aSTomi Valkeinen
14400d346d2aSTomi Valkeinen err:
14410d346d2aSTomi Valkeinen if (state && state->pads)
14420d346d2aSTomi Valkeinen kvfree(state->pads);
14430d346d2aSTomi Valkeinen
14440d346d2aSTomi Valkeinen kfree(state);
14450d346d2aSTomi Valkeinen
14460d346d2aSTomi Valkeinen return ERR_PTR(ret);
14470d346d2aSTomi Valkeinen }
144840aaab9dSTomi Valkeinen EXPORT_SYMBOL_GPL(__v4l2_subdev_state_alloc);
14490d346d2aSTomi Valkeinen
__v4l2_subdev_state_free(struct v4l2_subdev_state * state)145040aaab9dSTomi Valkeinen void __v4l2_subdev_state_free(struct v4l2_subdev_state *state)
14519b02cbb3SLaurent Pinchart {
14520d346d2aSTomi Valkeinen if (!state)
14530d346d2aSTomi Valkeinen return;
14540d346d2aSTomi Valkeinen
1455ed647ea6STomi Valkeinen mutex_destroy(&state->_lock);
1456ed647ea6STomi Valkeinen
1457a418bb3fSLaurent Pinchart kfree(state->routing.routes);
14582f91e10eSTomi Valkeinen kvfree(state->stream_configs.configs);
14590d346d2aSTomi Valkeinen kvfree(state->pads);
14600d346d2aSTomi Valkeinen kfree(state);
14619b02cbb3SLaurent Pinchart }
146240aaab9dSTomi Valkeinen EXPORT_SYMBOL_GPL(__v4l2_subdev_state_free);
14630d346d2aSTomi Valkeinen
__v4l2_subdev_init_finalize(struct v4l2_subdev * sd,const char * name,struct lock_class_key * key)1464ed647ea6STomi Valkeinen int __v4l2_subdev_init_finalize(struct v4l2_subdev *sd, const char *name,
1465ed647ea6STomi Valkeinen struct lock_class_key *key)
1466f69952a4STomi Valkeinen {
1467f69952a4STomi Valkeinen struct v4l2_subdev_state *state;
1468f69952a4STomi Valkeinen
1469ed647ea6STomi Valkeinen state = __v4l2_subdev_state_alloc(sd, name, key);
1470f69952a4STomi Valkeinen if (IS_ERR(state))
1471f69952a4STomi Valkeinen return PTR_ERR(state);
1472f69952a4STomi Valkeinen
1473f69952a4STomi Valkeinen sd->active_state = state;
1474f69952a4STomi Valkeinen
1475f69952a4STomi Valkeinen return 0;
1476f69952a4STomi Valkeinen }
1477ed647ea6STomi Valkeinen EXPORT_SYMBOL_GPL(__v4l2_subdev_init_finalize);
1478f69952a4STomi Valkeinen
v4l2_subdev_cleanup(struct v4l2_subdev * sd)1479f69952a4STomi Valkeinen void v4l2_subdev_cleanup(struct v4l2_subdev *sd)
1480f69952a4STomi Valkeinen {
1481e74f7a96SSakari Ailus struct v4l2_async_subdev_endpoint *ase, *ase_tmp;
1482e74f7a96SSakari Ailus
1483f69952a4STomi Valkeinen __v4l2_subdev_state_free(sd->active_state);
1484f69952a4STomi Valkeinen sd->active_state = NULL;
1485e74f7a96SSakari Ailus
1486e74f7a96SSakari Ailus if (list_empty(&sd->async_subdev_endpoint_list))
1487e74f7a96SSakari Ailus return;
1488e74f7a96SSakari Ailus
1489e74f7a96SSakari Ailus list_for_each_entry_safe(ase, ase_tmp, &sd->async_subdev_endpoint_list,
1490e74f7a96SSakari Ailus async_subdev_endpoint_entry) {
1491e74f7a96SSakari Ailus list_del(&ase->async_subdev_endpoint_entry);
1492e74f7a96SSakari Ailus
1493e74f7a96SSakari Ailus kfree(ase);
1494e74f7a96SSakari Ailus }
1495f69952a4STomi Valkeinen }
1496f69952a4STomi Valkeinen EXPORT_SYMBOL_GPL(v4l2_subdev_cleanup);
1497f69952a4STomi Valkeinen
149814a6fca7STomi Valkeinen #if defined(CONFIG_VIDEO_V4L2_SUBDEV_API)
149914a6fca7STomi Valkeinen
15002f91e10eSTomi Valkeinen static int
v4l2_subdev_init_stream_configs(struct v4l2_subdev_stream_configs * stream_configs,const struct v4l2_subdev_krouting * routing)15012f91e10eSTomi Valkeinen v4l2_subdev_init_stream_configs(struct v4l2_subdev_stream_configs *stream_configs,
15022f91e10eSTomi Valkeinen const struct v4l2_subdev_krouting *routing)
15032f91e10eSTomi Valkeinen {
15042f91e10eSTomi Valkeinen struct v4l2_subdev_stream_configs new_configs = { 0 };
15052f91e10eSTomi Valkeinen struct v4l2_subdev_route *route;
15062f91e10eSTomi Valkeinen u32 idx;
15072f91e10eSTomi Valkeinen
15082f91e10eSTomi Valkeinen /* Count number of formats needed */
15092f91e10eSTomi Valkeinen for_each_active_route(routing, route) {
15102f91e10eSTomi Valkeinen /*
15112f91e10eSTomi Valkeinen * Each route needs a format on both ends of the route.
15122f91e10eSTomi Valkeinen */
15132f91e10eSTomi Valkeinen new_configs.num_configs += 2;
15142f91e10eSTomi Valkeinen }
15152f91e10eSTomi Valkeinen
15162f91e10eSTomi Valkeinen if (new_configs.num_configs) {
15172f91e10eSTomi Valkeinen new_configs.configs = kvcalloc(new_configs.num_configs,
15182f91e10eSTomi Valkeinen sizeof(*new_configs.configs),
15192f91e10eSTomi Valkeinen GFP_KERNEL);
15202f91e10eSTomi Valkeinen
15212f91e10eSTomi Valkeinen if (!new_configs.configs)
15222f91e10eSTomi Valkeinen return -ENOMEM;
15232f91e10eSTomi Valkeinen }
15242f91e10eSTomi Valkeinen
15252f91e10eSTomi Valkeinen /*
15262f91e10eSTomi Valkeinen * Fill in the 'pad' and stream' value for each item in the array from
15272f91e10eSTomi Valkeinen * the routing table
15282f91e10eSTomi Valkeinen */
15292f91e10eSTomi Valkeinen idx = 0;
15302f91e10eSTomi Valkeinen
15312f91e10eSTomi Valkeinen for_each_active_route(routing, route) {
15322f91e10eSTomi Valkeinen new_configs.configs[idx].pad = route->sink_pad;
15332f91e10eSTomi Valkeinen new_configs.configs[idx].stream = route->sink_stream;
15342f91e10eSTomi Valkeinen
15352f91e10eSTomi Valkeinen idx++;
15362f91e10eSTomi Valkeinen
15372f91e10eSTomi Valkeinen new_configs.configs[idx].pad = route->source_pad;
15382f91e10eSTomi Valkeinen new_configs.configs[idx].stream = route->source_stream;
15392f91e10eSTomi Valkeinen
15402f91e10eSTomi Valkeinen idx++;
15412f91e10eSTomi Valkeinen }
15422f91e10eSTomi Valkeinen
15432f91e10eSTomi Valkeinen kvfree(stream_configs->configs);
15442f91e10eSTomi Valkeinen *stream_configs = new_configs;
15452f91e10eSTomi Valkeinen
15462f91e10eSTomi Valkeinen return 0;
15472f91e10eSTomi Valkeinen }
15482f91e10eSTomi Valkeinen
v4l2_subdev_get_fmt(struct v4l2_subdev * sd,struct v4l2_subdev_state * state,struct v4l2_subdev_format * format)154914a6fca7STomi Valkeinen int v4l2_subdev_get_fmt(struct v4l2_subdev *sd, struct v4l2_subdev_state *state,
155014a6fca7STomi Valkeinen struct v4l2_subdev_format *format)
155114a6fca7STomi Valkeinen {
155214a6fca7STomi Valkeinen struct v4l2_mbus_framefmt *fmt;
155314a6fca7STomi Valkeinen
155472c5fbcaSTomi Valkeinen if (sd->flags & V4L2_SUBDEV_FL_STREAMS)
155572c5fbcaSTomi Valkeinen fmt = v4l2_subdev_state_get_stream_format(state, format->pad,
155672c5fbcaSTomi Valkeinen format->stream);
155772c5fbcaSTomi Valkeinen else if (format->pad < sd->entity.num_pads && format->stream == 0)
155814a6fca7STomi Valkeinen fmt = v4l2_subdev_get_pad_format(sd, state, format->pad);
155972c5fbcaSTomi Valkeinen else
156072c5fbcaSTomi Valkeinen fmt = NULL;
156172c5fbcaSTomi Valkeinen
156214a6fca7STomi Valkeinen if (!fmt)
156314a6fca7STomi Valkeinen return -EINVAL;
156414a6fca7STomi Valkeinen
156514a6fca7STomi Valkeinen format->format = *fmt;
156614a6fca7STomi Valkeinen
156714a6fca7STomi Valkeinen return 0;
156814a6fca7STomi Valkeinen }
156914a6fca7STomi Valkeinen EXPORT_SYMBOL_GPL(v4l2_subdev_get_fmt);
157014a6fca7STomi Valkeinen
v4l2_subdev_set_routing(struct v4l2_subdev * sd,struct v4l2_subdev_state * state,const struct v4l2_subdev_krouting * routing)157117bb9bf8STomi Valkeinen int v4l2_subdev_set_routing(struct v4l2_subdev *sd,
157217bb9bf8STomi Valkeinen struct v4l2_subdev_state *state,
157317bb9bf8STomi Valkeinen const struct v4l2_subdev_krouting *routing)
157417bb9bf8STomi Valkeinen {
157517bb9bf8STomi Valkeinen struct v4l2_subdev_krouting *dst = &state->routing;
157617bb9bf8STomi Valkeinen const struct v4l2_subdev_krouting *src = routing;
157717bb9bf8STomi Valkeinen struct v4l2_subdev_krouting new_routing = { 0 };
157817bb9bf8STomi Valkeinen size_t bytes;
15792f91e10eSTomi Valkeinen int r;
158017bb9bf8STomi Valkeinen
158117bb9bf8STomi Valkeinen if (unlikely(check_mul_overflow((size_t)src->num_routes,
158217bb9bf8STomi Valkeinen sizeof(*src->routes), &bytes)))
158317bb9bf8STomi Valkeinen return -EOVERFLOW;
158417bb9bf8STomi Valkeinen
158517bb9bf8STomi Valkeinen lockdep_assert_held(state->lock);
158617bb9bf8STomi Valkeinen
158717bb9bf8STomi Valkeinen if (src->num_routes > 0) {
158817bb9bf8STomi Valkeinen new_routing.routes = kmemdup(src->routes, bytes, GFP_KERNEL);
158917bb9bf8STomi Valkeinen if (!new_routing.routes)
159017bb9bf8STomi Valkeinen return -ENOMEM;
159117bb9bf8STomi Valkeinen }
159217bb9bf8STomi Valkeinen
159317bb9bf8STomi Valkeinen new_routing.num_routes = src->num_routes;
159417bb9bf8STomi Valkeinen
15952f91e10eSTomi Valkeinen r = v4l2_subdev_init_stream_configs(&state->stream_configs,
15962f91e10eSTomi Valkeinen &new_routing);
15972f91e10eSTomi Valkeinen if (r) {
15982f91e10eSTomi Valkeinen kfree(new_routing.routes);
15992f91e10eSTomi Valkeinen return r;
16002f91e10eSTomi Valkeinen }
16012f91e10eSTomi Valkeinen
160217bb9bf8STomi Valkeinen kfree(dst->routes);
160317bb9bf8STomi Valkeinen *dst = new_routing;
160417bb9bf8STomi Valkeinen
160517bb9bf8STomi Valkeinen return 0;
160617bb9bf8STomi Valkeinen }
160717bb9bf8STomi Valkeinen EXPORT_SYMBOL_GPL(v4l2_subdev_set_routing);
160817bb9bf8STomi Valkeinen
1609837f92f0SJacopo Mondi struct v4l2_subdev_route *
__v4l2_subdev_next_active_route(const struct v4l2_subdev_krouting * routing,struct v4l2_subdev_route * route)1610837f92f0SJacopo Mondi __v4l2_subdev_next_active_route(const struct v4l2_subdev_krouting *routing,
1611837f92f0SJacopo Mondi struct v4l2_subdev_route *route)
1612837f92f0SJacopo Mondi {
1613837f92f0SJacopo Mondi if (route)
1614837f92f0SJacopo Mondi ++route;
1615837f92f0SJacopo Mondi else
1616837f92f0SJacopo Mondi route = &routing->routes[0];
1617837f92f0SJacopo Mondi
1618837f92f0SJacopo Mondi for (; route < routing->routes + routing->num_routes; ++route) {
1619837f92f0SJacopo Mondi if (!(route->flags & V4L2_SUBDEV_ROUTE_FL_ACTIVE))
1620837f92f0SJacopo Mondi continue;
1621837f92f0SJacopo Mondi
1622837f92f0SJacopo Mondi return route;
1623837f92f0SJacopo Mondi }
1624837f92f0SJacopo Mondi
1625837f92f0SJacopo Mondi return NULL;
1626837f92f0SJacopo Mondi }
1627837f92f0SJacopo Mondi EXPORT_SYMBOL_GPL(__v4l2_subdev_next_active_route);
1628837f92f0SJacopo Mondi
v4l2_subdev_set_routing_with_fmt(struct v4l2_subdev * sd,struct v4l2_subdev_state * state,const struct v4l2_subdev_krouting * routing,const struct v4l2_mbus_framefmt * fmt)16295b0d85b3STomi Valkeinen int v4l2_subdev_set_routing_with_fmt(struct v4l2_subdev *sd,
16305b0d85b3STomi Valkeinen struct v4l2_subdev_state *state,
1631bb05820eSTomi Valkeinen const struct v4l2_subdev_krouting *routing,
16325b0d85b3STomi Valkeinen const struct v4l2_mbus_framefmt *fmt)
16335b0d85b3STomi Valkeinen {
16345b0d85b3STomi Valkeinen struct v4l2_subdev_stream_configs *stream_configs;
16355b0d85b3STomi Valkeinen unsigned int i;
16365b0d85b3STomi Valkeinen int ret;
16375b0d85b3STomi Valkeinen
16385b0d85b3STomi Valkeinen ret = v4l2_subdev_set_routing(sd, state, routing);
16395b0d85b3STomi Valkeinen if (ret)
16405b0d85b3STomi Valkeinen return ret;
16415b0d85b3STomi Valkeinen
16425b0d85b3STomi Valkeinen stream_configs = &state->stream_configs;
16435b0d85b3STomi Valkeinen
16445b0d85b3STomi Valkeinen for (i = 0; i < stream_configs->num_configs; ++i)
16455b0d85b3STomi Valkeinen stream_configs->configs[i].fmt = *fmt;
16465b0d85b3STomi Valkeinen
16475b0d85b3STomi Valkeinen return 0;
16485b0d85b3STomi Valkeinen }
16495b0d85b3STomi Valkeinen EXPORT_SYMBOL_GPL(v4l2_subdev_set_routing_with_fmt);
16505b0d85b3STomi Valkeinen
16512f91e10eSTomi Valkeinen struct v4l2_mbus_framefmt *
v4l2_subdev_state_get_stream_format(struct v4l2_subdev_state * state,unsigned int pad,u32 stream)16522f91e10eSTomi Valkeinen v4l2_subdev_state_get_stream_format(struct v4l2_subdev_state *state,
16532f91e10eSTomi Valkeinen unsigned int pad, u32 stream)
16542f91e10eSTomi Valkeinen {
16552f91e10eSTomi Valkeinen struct v4l2_subdev_stream_configs *stream_configs;
16562f91e10eSTomi Valkeinen unsigned int i;
16572f91e10eSTomi Valkeinen
16582f91e10eSTomi Valkeinen lockdep_assert_held(state->lock);
16592f91e10eSTomi Valkeinen
16602f91e10eSTomi Valkeinen stream_configs = &state->stream_configs;
16612f91e10eSTomi Valkeinen
16622f91e10eSTomi Valkeinen for (i = 0; i < stream_configs->num_configs; ++i) {
16632f91e10eSTomi Valkeinen if (stream_configs->configs[i].pad == pad &&
16642f91e10eSTomi Valkeinen stream_configs->configs[i].stream == stream)
16652f91e10eSTomi Valkeinen return &stream_configs->configs[i].fmt;
16662f91e10eSTomi Valkeinen }
16672f91e10eSTomi Valkeinen
16682f91e10eSTomi Valkeinen return NULL;
16692f91e10eSTomi Valkeinen }
16702f91e10eSTomi Valkeinen EXPORT_SYMBOL_GPL(v4l2_subdev_state_get_stream_format);
16712f91e10eSTomi Valkeinen
16722f91e10eSTomi Valkeinen struct v4l2_rect *
v4l2_subdev_state_get_stream_crop(struct v4l2_subdev_state * state,unsigned int pad,u32 stream)16732f91e10eSTomi Valkeinen v4l2_subdev_state_get_stream_crop(struct v4l2_subdev_state *state,
16742f91e10eSTomi Valkeinen unsigned int pad, u32 stream)
16752f91e10eSTomi Valkeinen {
16762f91e10eSTomi Valkeinen struct v4l2_subdev_stream_configs *stream_configs;
16772f91e10eSTomi Valkeinen unsigned int i;
16782f91e10eSTomi Valkeinen
16792f91e10eSTomi Valkeinen lockdep_assert_held(state->lock);
16802f91e10eSTomi Valkeinen
16812f91e10eSTomi Valkeinen stream_configs = &state->stream_configs;
16822f91e10eSTomi Valkeinen
16832f91e10eSTomi Valkeinen for (i = 0; i < stream_configs->num_configs; ++i) {
16842f91e10eSTomi Valkeinen if (stream_configs->configs[i].pad == pad &&
16852f91e10eSTomi Valkeinen stream_configs->configs[i].stream == stream)
16862f91e10eSTomi Valkeinen return &stream_configs->configs[i].crop;
16872f91e10eSTomi Valkeinen }
16882f91e10eSTomi Valkeinen
16892f91e10eSTomi Valkeinen return NULL;
16902f91e10eSTomi Valkeinen }
16912f91e10eSTomi Valkeinen EXPORT_SYMBOL_GPL(v4l2_subdev_state_get_stream_crop);
16922f91e10eSTomi Valkeinen
16932f91e10eSTomi Valkeinen struct v4l2_rect *
v4l2_subdev_state_get_stream_compose(struct v4l2_subdev_state * state,unsigned int pad,u32 stream)16942f91e10eSTomi Valkeinen v4l2_subdev_state_get_stream_compose(struct v4l2_subdev_state *state,
16952f91e10eSTomi Valkeinen unsigned int pad, u32 stream)
16962f91e10eSTomi Valkeinen {
16972f91e10eSTomi Valkeinen struct v4l2_subdev_stream_configs *stream_configs;
16982f91e10eSTomi Valkeinen unsigned int i;
16992f91e10eSTomi Valkeinen
17002f91e10eSTomi Valkeinen lockdep_assert_held(state->lock);
17012f91e10eSTomi Valkeinen
17022f91e10eSTomi Valkeinen stream_configs = &state->stream_configs;
17032f91e10eSTomi Valkeinen
17042f91e10eSTomi Valkeinen for (i = 0; i < stream_configs->num_configs; ++i) {
17052f91e10eSTomi Valkeinen if (stream_configs->configs[i].pad == pad &&
17062f91e10eSTomi Valkeinen stream_configs->configs[i].stream == stream)
17072f91e10eSTomi Valkeinen return &stream_configs->configs[i].compose;
17082f91e10eSTomi Valkeinen }
17092f91e10eSTomi Valkeinen
17102f91e10eSTomi Valkeinen return NULL;
17112f91e10eSTomi Valkeinen }
17122f91e10eSTomi Valkeinen EXPORT_SYMBOL_GPL(v4l2_subdev_state_get_stream_compose);
17132f91e10eSTomi Valkeinen
v4l2_subdev_routing_find_opposite_end(const struct v4l2_subdev_krouting * routing,u32 pad,u32 stream,u32 * other_pad,u32 * other_stream)1714d00f1a07STomi Valkeinen int v4l2_subdev_routing_find_opposite_end(const struct v4l2_subdev_krouting *routing,
1715d00f1a07STomi Valkeinen u32 pad, u32 stream, u32 *other_pad,
1716d00f1a07STomi Valkeinen u32 *other_stream)
1717d00f1a07STomi Valkeinen {
1718d00f1a07STomi Valkeinen unsigned int i;
1719d00f1a07STomi Valkeinen
1720d00f1a07STomi Valkeinen for (i = 0; i < routing->num_routes; ++i) {
1721d00f1a07STomi Valkeinen struct v4l2_subdev_route *route = &routing->routes[i];
1722d00f1a07STomi Valkeinen
1723d00f1a07STomi Valkeinen if (route->source_pad == pad &&
1724d00f1a07STomi Valkeinen route->source_stream == stream) {
1725d00f1a07STomi Valkeinen if (other_pad)
1726d00f1a07STomi Valkeinen *other_pad = route->sink_pad;
1727d00f1a07STomi Valkeinen if (other_stream)
1728d00f1a07STomi Valkeinen *other_stream = route->sink_stream;
1729d00f1a07STomi Valkeinen return 0;
1730d00f1a07STomi Valkeinen }
1731d00f1a07STomi Valkeinen
1732d00f1a07STomi Valkeinen if (route->sink_pad == pad && route->sink_stream == stream) {
1733d00f1a07STomi Valkeinen if (other_pad)
1734d00f1a07STomi Valkeinen *other_pad = route->source_pad;
1735d00f1a07STomi Valkeinen if (other_stream)
1736d00f1a07STomi Valkeinen *other_stream = route->source_stream;
1737d00f1a07STomi Valkeinen return 0;
1738d00f1a07STomi Valkeinen }
1739d00f1a07STomi Valkeinen }
1740d00f1a07STomi Valkeinen
1741d00f1a07STomi Valkeinen return -EINVAL;
1742d00f1a07STomi Valkeinen }
1743d00f1a07STomi Valkeinen EXPORT_SYMBOL_GPL(v4l2_subdev_routing_find_opposite_end);
1744d00f1a07STomi Valkeinen
1745d00f1a07STomi Valkeinen struct v4l2_mbus_framefmt *
v4l2_subdev_state_get_opposite_stream_format(struct v4l2_subdev_state * state,u32 pad,u32 stream)1746d00f1a07STomi Valkeinen v4l2_subdev_state_get_opposite_stream_format(struct v4l2_subdev_state *state,
1747d00f1a07STomi Valkeinen u32 pad, u32 stream)
1748d00f1a07STomi Valkeinen {
1749d00f1a07STomi Valkeinen u32 other_pad, other_stream;
1750d00f1a07STomi Valkeinen int ret;
1751d00f1a07STomi Valkeinen
1752d00f1a07STomi Valkeinen ret = v4l2_subdev_routing_find_opposite_end(&state->routing,
1753d00f1a07STomi Valkeinen pad, stream,
1754d00f1a07STomi Valkeinen &other_pad, &other_stream);
1755d00f1a07STomi Valkeinen if (ret)
1756d00f1a07STomi Valkeinen return NULL;
1757d00f1a07STomi Valkeinen
1758d00f1a07STomi Valkeinen return v4l2_subdev_state_get_stream_format(state, other_pad,
1759d00f1a07STomi Valkeinen other_stream);
1760d00f1a07STomi Valkeinen }
1761d00f1a07STomi Valkeinen EXPORT_SYMBOL_GPL(v4l2_subdev_state_get_opposite_stream_format);
1762d00f1a07STomi Valkeinen
v4l2_subdev_state_xlate_streams(const struct v4l2_subdev_state * state,u32 pad0,u32 pad1,u64 * streams)1763c4a73f31SLaurent Pinchart u64 v4l2_subdev_state_xlate_streams(const struct v4l2_subdev_state *state,
1764c4a73f31SLaurent Pinchart u32 pad0, u32 pad1, u64 *streams)
1765c4a73f31SLaurent Pinchart {
1766c4a73f31SLaurent Pinchart const struct v4l2_subdev_krouting *routing = &state->routing;
1767c4a73f31SLaurent Pinchart struct v4l2_subdev_route *route;
1768c4a73f31SLaurent Pinchart u64 streams0 = 0;
1769c4a73f31SLaurent Pinchart u64 streams1 = 0;
1770c4a73f31SLaurent Pinchart
1771c4a73f31SLaurent Pinchart for_each_active_route(routing, route) {
1772c4a73f31SLaurent Pinchart if (route->sink_pad == pad0 && route->source_pad == pad1 &&
1773c4a73f31SLaurent Pinchart (*streams & BIT_ULL(route->sink_stream))) {
1774c4a73f31SLaurent Pinchart streams0 |= BIT_ULL(route->sink_stream);
1775c4a73f31SLaurent Pinchart streams1 |= BIT_ULL(route->source_stream);
1776c4a73f31SLaurent Pinchart }
1777c4a73f31SLaurent Pinchart if (route->source_pad == pad0 && route->sink_pad == pad1 &&
1778c4a73f31SLaurent Pinchart (*streams & BIT_ULL(route->source_stream))) {
1779c4a73f31SLaurent Pinchart streams0 |= BIT_ULL(route->source_stream);
1780c4a73f31SLaurent Pinchart streams1 |= BIT_ULL(route->sink_stream);
1781c4a73f31SLaurent Pinchart }
1782c4a73f31SLaurent Pinchart }
1783c4a73f31SLaurent Pinchart
1784c4a73f31SLaurent Pinchart *streams = streams0;
1785c4a73f31SLaurent Pinchart return streams1;
1786c4a73f31SLaurent Pinchart }
1787c4a73f31SLaurent Pinchart EXPORT_SYMBOL_GPL(v4l2_subdev_state_xlate_streams);
1788c4a73f31SLaurent Pinchart
v4l2_subdev_routing_validate(struct v4l2_subdev * sd,const struct v4l2_subdev_krouting * routing,enum v4l2_subdev_routing_restriction disallow)178969c0fe7aSLaurent Pinchart int v4l2_subdev_routing_validate(struct v4l2_subdev *sd,
179069c0fe7aSLaurent Pinchart const struct v4l2_subdev_krouting *routing,
179169c0fe7aSLaurent Pinchart enum v4l2_subdev_routing_restriction disallow)
179269c0fe7aSLaurent Pinchart {
179369c0fe7aSLaurent Pinchart u32 *remote_pads = NULL;
179469c0fe7aSLaurent Pinchart unsigned int i, j;
179569c0fe7aSLaurent Pinchart int ret = -EINVAL;
179669c0fe7aSLaurent Pinchart
1797a1299df6STomi Valkeinen if (disallow & (V4L2_SUBDEV_ROUTING_NO_STREAM_MIX |
1798a1299df6STomi Valkeinen V4L2_SUBDEV_ROUTING_NO_MULTIPLEXING)) {
179969c0fe7aSLaurent Pinchart remote_pads = kcalloc(sd->entity.num_pads, sizeof(*remote_pads),
180069c0fe7aSLaurent Pinchart GFP_KERNEL);
180169c0fe7aSLaurent Pinchart if (!remote_pads)
180269c0fe7aSLaurent Pinchart return -ENOMEM;
180369c0fe7aSLaurent Pinchart
180469c0fe7aSLaurent Pinchart for (i = 0; i < sd->entity.num_pads; ++i)
180569c0fe7aSLaurent Pinchart remote_pads[i] = U32_MAX;
180669c0fe7aSLaurent Pinchart }
180769c0fe7aSLaurent Pinchart
180869c0fe7aSLaurent Pinchart for (i = 0; i < routing->num_routes; ++i) {
180969c0fe7aSLaurent Pinchart const struct v4l2_subdev_route *route = &routing->routes[i];
181069c0fe7aSLaurent Pinchart
181169c0fe7aSLaurent Pinchart /* Validate the sink and source pad numbers. */
181269c0fe7aSLaurent Pinchart if (route->sink_pad >= sd->entity.num_pads ||
181369c0fe7aSLaurent Pinchart !(sd->entity.pads[route->sink_pad].flags & MEDIA_PAD_FL_SINK)) {
181469c0fe7aSLaurent Pinchart dev_dbg(sd->dev, "route %u sink (%u) is not a sink pad\n",
181569c0fe7aSLaurent Pinchart i, route->sink_pad);
181669c0fe7aSLaurent Pinchart goto out;
181769c0fe7aSLaurent Pinchart }
181869c0fe7aSLaurent Pinchart
181969c0fe7aSLaurent Pinchart if (route->source_pad >= sd->entity.num_pads ||
182069c0fe7aSLaurent Pinchart !(sd->entity.pads[route->source_pad].flags & MEDIA_PAD_FL_SOURCE)) {
182169c0fe7aSLaurent Pinchart dev_dbg(sd->dev, "route %u source (%u) is not a source pad\n",
182269c0fe7aSLaurent Pinchart i, route->source_pad);
182369c0fe7aSLaurent Pinchart goto out;
182469c0fe7aSLaurent Pinchart }
182569c0fe7aSLaurent Pinchart
182669c0fe7aSLaurent Pinchart /*
1827698a619aSTomi Valkeinen * V4L2_SUBDEV_ROUTING_NO_SINK_STREAM_MIX: all streams from a
1828698a619aSTomi Valkeinen * sink pad must be routed to a single source pad.
182969c0fe7aSLaurent Pinchart */
1830698a619aSTomi Valkeinen if (disallow & V4L2_SUBDEV_ROUTING_NO_SINK_STREAM_MIX) {
183169c0fe7aSLaurent Pinchart if (remote_pads[route->sink_pad] != U32_MAX &&
183269c0fe7aSLaurent Pinchart remote_pads[route->sink_pad] != route->source_pad) {
183369c0fe7aSLaurent Pinchart dev_dbg(sd->dev,
183469c0fe7aSLaurent Pinchart "route %u attempts to mix %s streams\n",
183569c0fe7aSLaurent Pinchart i, "sink");
183669c0fe7aSLaurent Pinchart goto out;
183769c0fe7aSLaurent Pinchart }
1838698a619aSTomi Valkeinen }
1839698a619aSTomi Valkeinen
1840698a619aSTomi Valkeinen /*
1841698a619aSTomi Valkeinen * V4L2_SUBDEV_ROUTING_NO_SOURCE_STREAM_MIX: all streams on a
1842698a619aSTomi Valkeinen * source pad must originate from a single sink pad.
1843698a619aSTomi Valkeinen */
1844698a619aSTomi Valkeinen if (disallow & V4L2_SUBDEV_ROUTING_NO_SOURCE_STREAM_MIX) {
184569c0fe7aSLaurent Pinchart if (remote_pads[route->source_pad] != U32_MAX &&
184669c0fe7aSLaurent Pinchart remote_pads[route->source_pad] != route->sink_pad) {
184769c0fe7aSLaurent Pinchart dev_dbg(sd->dev,
184869c0fe7aSLaurent Pinchart "route %u attempts to mix %s streams\n",
184969c0fe7aSLaurent Pinchart i, "source");
185069c0fe7aSLaurent Pinchart goto out;
185169c0fe7aSLaurent Pinchart }
1852a1299df6STomi Valkeinen }
185369c0fe7aSLaurent Pinchart
1854a1299df6STomi Valkeinen /*
1855a1299df6STomi Valkeinen * V4L2_SUBDEV_ROUTING_NO_SINK_MULTIPLEXING: Pads on the sink
1856a1299df6STomi Valkeinen * side can not do stream multiplexing, i.e. there can be only
1857a1299df6STomi Valkeinen * a single stream in a sink pad.
1858a1299df6STomi Valkeinen */
1859a1299df6STomi Valkeinen if (disallow & V4L2_SUBDEV_ROUTING_NO_SINK_MULTIPLEXING) {
1860a1299df6STomi Valkeinen if (remote_pads[route->sink_pad] != U32_MAX) {
1861a1299df6STomi Valkeinen dev_dbg(sd->dev,
1862a1299df6STomi Valkeinen "route %u attempts to multiplex on %s pad %u\n",
1863a1299df6STomi Valkeinen i, "sink", route->sink_pad);
1864a1299df6STomi Valkeinen goto out;
1865a1299df6STomi Valkeinen }
1866a1299df6STomi Valkeinen }
1867a1299df6STomi Valkeinen
1868a1299df6STomi Valkeinen /*
1869a1299df6STomi Valkeinen * V4L2_SUBDEV_ROUTING_NO_SOURCE_MULTIPLEXING: Pads on the
1870a1299df6STomi Valkeinen * source side can not do stream multiplexing, i.e. there can
1871a1299df6STomi Valkeinen * be only a single stream in a source pad.
1872a1299df6STomi Valkeinen */
1873a1299df6STomi Valkeinen if (disallow & V4L2_SUBDEV_ROUTING_NO_SOURCE_MULTIPLEXING) {
1874a1299df6STomi Valkeinen if (remote_pads[route->source_pad] != U32_MAX) {
1875a1299df6STomi Valkeinen dev_dbg(sd->dev,
1876a1299df6STomi Valkeinen "route %u attempts to multiplex on %s pad %u\n",
1877a1299df6STomi Valkeinen i, "source", route->source_pad);
1878a1299df6STomi Valkeinen goto out;
1879a1299df6STomi Valkeinen }
1880a1299df6STomi Valkeinen }
1881a1299df6STomi Valkeinen
1882a1299df6STomi Valkeinen if (remote_pads) {
1883a1299df6STomi Valkeinen remote_pads[route->sink_pad] = route->source_pad;
188469c0fe7aSLaurent Pinchart remote_pads[route->source_pad] = route->sink_pad;
188569c0fe7aSLaurent Pinchart }
188669c0fe7aSLaurent Pinchart
188769c0fe7aSLaurent Pinchart for (j = i + 1; j < routing->num_routes; ++j) {
188869c0fe7aSLaurent Pinchart const struct v4l2_subdev_route *r = &routing->routes[j];
188969c0fe7aSLaurent Pinchart
189069c0fe7aSLaurent Pinchart /*
189169c0fe7aSLaurent Pinchart * V4L2_SUBDEV_ROUTING_NO_1_TO_N: No two routes can
189269c0fe7aSLaurent Pinchart * originate from the same (sink) stream.
189369c0fe7aSLaurent Pinchart */
189469c0fe7aSLaurent Pinchart if ((disallow & V4L2_SUBDEV_ROUTING_NO_1_TO_N) &&
189569c0fe7aSLaurent Pinchart route->sink_pad == r->sink_pad &&
189669c0fe7aSLaurent Pinchart route->sink_stream == r->sink_stream) {
189769c0fe7aSLaurent Pinchart dev_dbg(sd->dev,
189869c0fe7aSLaurent Pinchart "routes %u and %u originate from same sink (%u/%u)\n",
189969c0fe7aSLaurent Pinchart i, j, route->sink_pad,
190069c0fe7aSLaurent Pinchart route->sink_stream);
190169c0fe7aSLaurent Pinchart goto out;
190269c0fe7aSLaurent Pinchart }
190369c0fe7aSLaurent Pinchart
190469c0fe7aSLaurent Pinchart /*
190569c0fe7aSLaurent Pinchart * V4L2_SUBDEV_ROUTING_NO_N_TO_1: No two routes can end
190669c0fe7aSLaurent Pinchart * at the same (source) stream.
190769c0fe7aSLaurent Pinchart */
190869c0fe7aSLaurent Pinchart if ((disallow & V4L2_SUBDEV_ROUTING_NO_N_TO_1) &&
190969c0fe7aSLaurent Pinchart route->source_pad == r->source_pad &&
191069c0fe7aSLaurent Pinchart route->source_stream == r->source_stream) {
191169c0fe7aSLaurent Pinchart dev_dbg(sd->dev,
191269c0fe7aSLaurent Pinchart "routes %u and %u end at same source (%u/%u)\n",
191369c0fe7aSLaurent Pinchart i, j, route->source_pad,
191469c0fe7aSLaurent Pinchart route->source_stream);
191569c0fe7aSLaurent Pinchart goto out;
191669c0fe7aSLaurent Pinchart }
191769c0fe7aSLaurent Pinchart }
191869c0fe7aSLaurent Pinchart }
191969c0fe7aSLaurent Pinchart
192069c0fe7aSLaurent Pinchart ret = 0;
192169c0fe7aSLaurent Pinchart
192269c0fe7aSLaurent Pinchart out:
192369c0fe7aSLaurent Pinchart kfree(remote_pads);
192469c0fe7aSLaurent Pinchart return ret;
192569c0fe7aSLaurent Pinchart }
192669c0fe7aSLaurent Pinchart EXPORT_SYMBOL_GPL(v4l2_subdev_routing_validate);
192769c0fe7aSLaurent Pinchart
v4l2_subdev_enable_streams_fallback(struct v4l2_subdev * sd,u32 pad,u64 streams_mask)1928d0749adbSLaurent Pinchart static int v4l2_subdev_enable_streams_fallback(struct v4l2_subdev *sd, u32 pad,
1929d0749adbSLaurent Pinchart u64 streams_mask)
1930d0749adbSLaurent Pinchart {
1931d0749adbSLaurent Pinchart struct device *dev = sd->entity.graph_obj.mdev->dev;
1932d0749adbSLaurent Pinchart unsigned int i;
1933d0749adbSLaurent Pinchart int ret;
1934d0749adbSLaurent Pinchart
1935d0749adbSLaurent Pinchart /*
1936d0749adbSLaurent Pinchart * The subdev doesn't implement pad-based stream enable, fall back
1937d0749adbSLaurent Pinchart * on the .s_stream() operation. This can only be done for subdevs that
1938d0749adbSLaurent Pinchart * have a single source pad, as sd->enabled_streams is global to the
1939d0749adbSLaurent Pinchart * subdev.
1940d0749adbSLaurent Pinchart */
1941d0749adbSLaurent Pinchart if (!(sd->entity.pads[pad].flags & MEDIA_PAD_FL_SOURCE))
1942d0749adbSLaurent Pinchart return -EOPNOTSUPP;
1943d0749adbSLaurent Pinchart
1944d0749adbSLaurent Pinchart for (i = 0; i < sd->entity.num_pads; ++i) {
1945d0749adbSLaurent Pinchart if (i != pad && sd->entity.pads[i].flags & MEDIA_PAD_FL_SOURCE)
1946d0749adbSLaurent Pinchart return -EOPNOTSUPP;
1947d0749adbSLaurent Pinchart }
1948d0749adbSLaurent Pinchart
1949d0749adbSLaurent Pinchart if (sd->enabled_streams & streams_mask) {
1950d0749adbSLaurent Pinchart dev_dbg(dev, "set of streams %#llx already enabled on %s:%u\n",
1951d0749adbSLaurent Pinchart streams_mask, sd->entity.name, pad);
1952d0749adbSLaurent Pinchart return -EALREADY;
1953d0749adbSLaurent Pinchart }
1954d0749adbSLaurent Pinchart
1955d0749adbSLaurent Pinchart /* Start streaming when the first streams are enabled. */
1956d0749adbSLaurent Pinchart if (!sd->enabled_streams) {
1957d0749adbSLaurent Pinchart ret = v4l2_subdev_call(sd, video, s_stream, 1);
1958d0749adbSLaurent Pinchart if (ret)
1959d0749adbSLaurent Pinchart return ret;
1960d0749adbSLaurent Pinchart }
1961d0749adbSLaurent Pinchart
1962d0749adbSLaurent Pinchart sd->enabled_streams |= streams_mask;
1963d0749adbSLaurent Pinchart
1964d0749adbSLaurent Pinchart return 0;
1965d0749adbSLaurent Pinchart }
1966d0749adbSLaurent Pinchart
v4l2_subdev_enable_streams(struct v4l2_subdev * sd,u32 pad,u64 streams_mask)1967d0749adbSLaurent Pinchart int v4l2_subdev_enable_streams(struct v4l2_subdev *sd, u32 pad,
1968d0749adbSLaurent Pinchart u64 streams_mask)
1969d0749adbSLaurent Pinchart {
1970d0749adbSLaurent Pinchart struct device *dev = sd->entity.graph_obj.mdev->dev;
1971d0749adbSLaurent Pinchart struct v4l2_subdev_state *state;
1972d0749adbSLaurent Pinchart u64 found_streams = 0;
1973d0749adbSLaurent Pinchart unsigned int i;
1974d0749adbSLaurent Pinchart int ret;
1975d0749adbSLaurent Pinchart
1976d0749adbSLaurent Pinchart /* A few basic sanity checks first. */
1977d0749adbSLaurent Pinchart if (pad >= sd->entity.num_pads)
1978d0749adbSLaurent Pinchart return -EINVAL;
1979d0749adbSLaurent Pinchart
1980d0749adbSLaurent Pinchart if (!streams_mask)
1981d0749adbSLaurent Pinchart return 0;
1982d0749adbSLaurent Pinchart
1983d0749adbSLaurent Pinchart /* Fallback on .s_stream() if .enable_streams() isn't available. */
1984d0749adbSLaurent Pinchart if (!sd->ops->pad || !sd->ops->pad->enable_streams)
1985d0749adbSLaurent Pinchart return v4l2_subdev_enable_streams_fallback(sd, pad,
1986d0749adbSLaurent Pinchart streams_mask);
1987d0749adbSLaurent Pinchart
1988d0749adbSLaurent Pinchart state = v4l2_subdev_lock_and_get_active_state(sd);
1989d0749adbSLaurent Pinchart
1990d0749adbSLaurent Pinchart /*
1991d0749adbSLaurent Pinchart * Verify that the requested streams exist and that they are not
1992d0749adbSLaurent Pinchart * already enabled.
1993d0749adbSLaurent Pinchart */
1994d0749adbSLaurent Pinchart for (i = 0; i < state->stream_configs.num_configs; ++i) {
1995d0749adbSLaurent Pinchart struct v4l2_subdev_stream_config *cfg =
1996d0749adbSLaurent Pinchart &state->stream_configs.configs[i];
1997d0749adbSLaurent Pinchart
1998d0749adbSLaurent Pinchart if (cfg->pad != pad || !(streams_mask & BIT_ULL(cfg->stream)))
1999d0749adbSLaurent Pinchart continue;
2000d0749adbSLaurent Pinchart
2001d0749adbSLaurent Pinchart found_streams |= BIT_ULL(cfg->stream);
2002d0749adbSLaurent Pinchart
2003d0749adbSLaurent Pinchart if (cfg->enabled) {
2004d0749adbSLaurent Pinchart dev_dbg(dev, "stream %u already enabled on %s:%u\n",
2005d0749adbSLaurent Pinchart cfg->stream, sd->entity.name, pad);
2006d0749adbSLaurent Pinchart ret = -EALREADY;
2007d0749adbSLaurent Pinchart goto done;
2008d0749adbSLaurent Pinchart }
2009d0749adbSLaurent Pinchart }
2010d0749adbSLaurent Pinchart
2011d0749adbSLaurent Pinchart if (found_streams != streams_mask) {
2012d0749adbSLaurent Pinchart dev_dbg(dev, "streams 0x%llx not found on %s:%u\n",
2013d0749adbSLaurent Pinchart streams_mask & ~found_streams, sd->entity.name, pad);
2014d0749adbSLaurent Pinchart ret = -EINVAL;
2015d0749adbSLaurent Pinchart goto done;
2016d0749adbSLaurent Pinchart }
2017d0749adbSLaurent Pinchart
201835a29918STomi Valkeinen dev_dbg(dev, "enable streams %u:%#llx\n", pad, streams_mask);
201935a29918STomi Valkeinen
2020d0749adbSLaurent Pinchart /* Call the .enable_streams() operation. */
2021d0749adbSLaurent Pinchart ret = v4l2_subdev_call(sd, pad, enable_streams, state, pad,
2022d0749adbSLaurent Pinchart streams_mask);
202335a29918STomi Valkeinen if (ret) {
202435a29918STomi Valkeinen dev_dbg(dev, "enable streams %u:%#llx failed: %d\n", pad,
202535a29918STomi Valkeinen streams_mask, ret);
2026d0749adbSLaurent Pinchart goto done;
202735a29918STomi Valkeinen }
2028d0749adbSLaurent Pinchart
2029d0749adbSLaurent Pinchart /* Mark the streams as enabled. */
2030d0749adbSLaurent Pinchart for (i = 0; i < state->stream_configs.num_configs; ++i) {
2031d0749adbSLaurent Pinchart struct v4l2_subdev_stream_config *cfg =
2032d0749adbSLaurent Pinchart &state->stream_configs.configs[i];
2033d0749adbSLaurent Pinchart
2034d0749adbSLaurent Pinchart if (cfg->pad == pad && (streams_mask & BIT_ULL(cfg->stream)))
2035d0749adbSLaurent Pinchart cfg->enabled = true;
2036d0749adbSLaurent Pinchart }
2037d0749adbSLaurent Pinchart
2038d0749adbSLaurent Pinchart done:
2039d0749adbSLaurent Pinchart v4l2_subdev_unlock_state(state);
2040d0749adbSLaurent Pinchart
2041d0749adbSLaurent Pinchart return ret;
2042d0749adbSLaurent Pinchart }
2043d0749adbSLaurent Pinchart EXPORT_SYMBOL_GPL(v4l2_subdev_enable_streams);
2044d0749adbSLaurent Pinchart
v4l2_subdev_disable_streams_fallback(struct v4l2_subdev * sd,u32 pad,u64 streams_mask)2045d0749adbSLaurent Pinchart static int v4l2_subdev_disable_streams_fallback(struct v4l2_subdev *sd, u32 pad,
2046d0749adbSLaurent Pinchart u64 streams_mask)
2047d0749adbSLaurent Pinchart {
2048d0749adbSLaurent Pinchart struct device *dev = sd->entity.graph_obj.mdev->dev;
2049d0749adbSLaurent Pinchart unsigned int i;
2050d0749adbSLaurent Pinchart int ret;
2051d0749adbSLaurent Pinchart
2052d0749adbSLaurent Pinchart /*
2053d0749adbSLaurent Pinchart * If the subdev doesn't implement pad-based stream enable, fall back
2054d0749adbSLaurent Pinchart * on the .s_stream() operation. This can only be done for subdevs that
2055d0749adbSLaurent Pinchart * have a single source pad, as sd->enabled_streams is global to the
2056d0749adbSLaurent Pinchart * subdev.
2057d0749adbSLaurent Pinchart */
2058d0749adbSLaurent Pinchart if (!(sd->entity.pads[pad].flags & MEDIA_PAD_FL_SOURCE))
2059d0749adbSLaurent Pinchart return -EOPNOTSUPP;
2060d0749adbSLaurent Pinchart
2061d0749adbSLaurent Pinchart for (i = 0; i < sd->entity.num_pads; ++i) {
2062d0749adbSLaurent Pinchart if (i != pad && sd->entity.pads[i].flags & MEDIA_PAD_FL_SOURCE)
2063d0749adbSLaurent Pinchart return -EOPNOTSUPP;
2064d0749adbSLaurent Pinchart }
2065d0749adbSLaurent Pinchart
2066d0749adbSLaurent Pinchart if ((sd->enabled_streams & streams_mask) != streams_mask) {
2067d0749adbSLaurent Pinchart dev_dbg(dev, "set of streams %#llx already disabled on %s:%u\n",
2068d0749adbSLaurent Pinchart streams_mask, sd->entity.name, pad);
2069d0749adbSLaurent Pinchart return -EALREADY;
2070d0749adbSLaurent Pinchart }
2071d0749adbSLaurent Pinchart
2072d0749adbSLaurent Pinchart /* Stop streaming when the last streams are disabled. */
2073d0749adbSLaurent Pinchart if (!(sd->enabled_streams & ~streams_mask)) {
2074d0749adbSLaurent Pinchart ret = v4l2_subdev_call(sd, video, s_stream, 0);
2075d0749adbSLaurent Pinchart if (ret)
2076d0749adbSLaurent Pinchart return ret;
2077d0749adbSLaurent Pinchart }
2078d0749adbSLaurent Pinchart
2079d0749adbSLaurent Pinchart sd->enabled_streams &= ~streams_mask;
2080d0749adbSLaurent Pinchart
2081d0749adbSLaurent Pinchart return 0;
2082d0749adbSLaurent Pinchart }
2083d0749adbSLaurent Pinchart
v4l2_subdev_disable_streams(struct v4l2_subdev * sd,u32 pad,u64 streams_mask)2084d0749adbSLaurent Pinchart int v4l2_subdev_disable_streams(struct v4l2_subdev *sd, u32 pad,
2085d0749adbSLaurent Pinchart u64 streams_mask)
2086d0749adbSLaurent Pinchart {
2087d0749adbSLaurent Pinchart struct device *dev = sd->entity.graph_obj.mdev->dev;
2088d0749adbSLaurent Pinchart struct v4l2_subdev_state *state;
2089d0749adbSLaurent Pinchart u64 found_streams = 0;
2090d0749adbSLaurent Pinchart unsigned int i;
2091d0749adbSLaurent Pinchart int ret;
2092d0749adbSLaurent Pinchart
2093d0749adbSLaurent Pinchart /* A few basic sanity checks first. */
2094d0749adbSLaurent Pinchart if (pad >= sd->entity.num_pads)
2095d0749adbSLaurent Pinchart return -EINVAL;
2096d0749adbSLaurent Pinchart
2097d0749adbSLaurent Pinchart if (!streams_mask)
2098d0749adbSLaurent Pinchart return 0;
2099d0749adbSLaurent Pinchart
2100d0749adbSLaurent Pinchart /* Fallback on .s_stream() if .disable_streams() isn't available. */
2101d0749adbSLaurent Pinchart if (!sd->ops->pad || !sd->ops->pad->disable_streams)
2102d0749adbSLaurent Pinchart return v4l2_subdev_disable_streams_fallback(sd, pad,
2103d0749adbSLaurent Pinchart streams_mask);
2104d0749adbSLaurent Pinchart
2105d0749adbSLaurent Pinchart state = v4l2_subdev_lock_and_get_active_state(sd);
2106d0749adbSLaurent Pinchart
2107d0749adbSLaurent Pinchart /*
2108d0749adbSLaurent Pinchart * Verify that the requested streams exist and that they are not
2109d0749adbSLaurent Pinchart * already disabled.
2110d0749adbSLaurent Pinchart */
2111d0749adbSLaurent Pinchart for (i = 0; i < state->stream_configs.num_configs; ++i) {
2112d0749adbSLaurent Pinchart struct v4l2_subdev_stream_config *cfg =
2113d0749adbSLaurent Pinchart &state->stream_configs.configs[i];
2114d0749adbSLaurent Pinchart
2115d0749adbSLaurent Pinchart if (cfg->pad != pad || !(streams_mask & BIT_ULL(cfg->stream)))
2116d0749adbSLaurent Pinchart continue;
2117d0749adbSLaurent Pinchart
2118d0749adbSLaurent Pinchart found_streams |= BIT_ULL(cfg->stream);
2119d0749adbSLaurent Pinchart
2120d0749adbSLaurent Pinchart if (!cfg->enabled) {
2121d0749adbSLaurent Pinchart dev_dbg(dev, "stream %u already disabled on %s:%u\n",
2122d0749adbSLaurent Pinchart cfg->stream, sd->entity.name, pad);
2123d0749adbSLaurent Pinchart ret = -EALREADY;
2124d0749adbSLaurent Pinchart goto done;
2125d0749adbSLaurent Pinchart }
2126d0749adbSLaurent Pinchart }
2127d0749adbSLaurent Pinchart
2128d0749adbSLaurent Pinchart if (found_streams != streams_mask) {
2129d0749adbSLaurent Pinchart dev_dbg(dev, "streams 0x%llx not found on %s:%u\n",
2130d0749adbSLaurent Pinchart streams_mask & ~found_streams, sd->entity.name, pad);
2131d0749adbSLaurent Pinchart ret = -EINVAL;
2132d0749adbSLaurent Pinchart goto done;
2133d0749adbSLaurent Pinchart }
2134d0749adbSLaurent Pinchart
213535a29918STomi Valkeinen dev_dbg(dev, "disable streams %u:%#llx\n", pad, streams_mask);
213635a29918STomi Valkeinen
2137d0749adbSLaurent Pinchart /* Call the .disable_streams() operation. */
2138d0749adbSLaurent Pinchart ret = v4l2_subdev_call(sd, pad, disable_streams, state, pad,
2139d0749adbSLaurent Pinchart streams_mask);
214035a29918STomi Valkeinen if (ret) {
214135a29918STomi Valkeinen dev_dbg(dev, "disable streams %u:%#llx failed: %d\n", pad,
214235a29918STomi Valkeinen streams_mask, ret);
2143d0749adbSLaurent Pinchart goto done;
214435a29918STomi Valkeinen }
2145d0749adbSLaurent Pinchart
2146d0749adbSLaurent Pinchart /* Mark the streams as disabled. */
2147d0749adbSLaurent Pinchart for (i = 0; i < state->stream_configs.num_configs; ++i) {
2148d0749adbSLaurent Pinchart struct v4l2_subdev_stream_config *cfg =
2149d0749adbSLaurent Pinchart &state->stream_configs.configs[i];
2150d0749adbSLaurent Pinchart
2151d0749adbSLaurent Pinchart if (cfg->pad == pad && (streams_mask & BIT_ULL(cfg->stream)))
2152d0749adbSLaurent Pinchart cfg->enabled = false;
2153d0749adbSLaurent Pinchart }
2154d0749adbSLaurent Pinchart
2155d0749adbSLaurent Pinchart done:
2156d0749adbSLaurent Pinchart v4l2_subdev_unlock_state(state);
2157d0749adbSLaurent Pinchart
2158d0749adbSLaurent Pinchart return ret;
2159d0749adbSLaurent Pinchart }
2160d0749adbSLaurent Pinchart EXPORT_SYMBOL_GPL(v4l2_subdev_disable_streams);
2161d0749adbSLaurent Pinchart
v4l2_subdev_s_stream_helper(struct v4l2_subdev * sd,int enable)216234a315ceSLaurent Pinchart int v4l2_subdev_s_stream_helper(struct v4l2_subdev *sd, int enable)
216334a315ceSLaurent Pinchart {
216434a315ceSLaurent Pinchart struct v4l2_subdev_state *state;
216534a315ceSLaurent Pinchart struct v4l2_subdev_route *route;
216634a315ceSLaurent Pinchart struct media_pad *pad;
216734a315ceSLaurent Pinchart u64 source_mask = 0;
216834a315ceSLaurent Pinchart int pad_index = -1;
216934a315ceSLaurent Pinchart
217034a315ceSLaurent Pinchart /*
217134a315ceSLaurent Pinchart * Find the source pad. This helper is meant for subdevs that have a
217234a315ceSLaurent Pinchart * single source pad, so failures shouldn't happen, but catch them
217334a315ceSLaurent Pinchart * loudly nonetheless as they indicate a driver bug.
217434a315ceSLaurent Pinchart */
217534a315ceSLaurent Pinchart media_entity_for_each_pad(&sd->entity, pad) {
217634a315ceSLaurent Pinchart if (pad->flags & MEDIA_PAD_FL_SOURCE) {
217734a315ceSLaurent Pinchart pad_index = pad->index;
217834a315ceSLaurent Pinchart break;
217934a315ceSLaurent Pinchart }
218034a315ceSLaurent Pinchart }
218134a315ceSLaurent Pinchart
218234a315ceSLaurent Pinchart if (WARN_ON(pad_index == -1))
218334a315ceSLaurent Pinchart return -EINVAL;
218434a315ceSLaurent Pinchart
218534a315ceSLaurent Pinchart /*
218634a315ceSLaurent Pinchart * As there's a single source pad, just collect all the source streams.
218734a315ceSLaurent Pinchart */
218834a315ceSLaurent Pinchart state = v4l2_subdev_lock_and_get_active_state(sd);
218934a315ceSLaurent Pinchart
219034a315ceSLaurent Pinchart for_each_active_route(&state->routing, route)
219134a315ceSLaurent Pinchart source_mask |= BIT_ULL(route->source_stream);
219234a315ceSLaurent Pinchart
219334a315ceSLaurent Pinchart v4l2_subdev_unlock_state(state);
219434a315ceSLaurent Pinchart
219534a315ceSLaurent Pinchart if (enable)
219634a315ceSLaurent Pinchart return v4l2_subdev_enable_streams(sd, pad_index, source_mask);
219734a315ceSLaurent Pinchart else
219834a315ceSLaurent Pinchart return v4l2_subdev_disable_streams(sd, pad_index, source_mask);
219934a315ceSLaurent Pinchart }
220034a315ceSLaurent Pinchart EXPORT_SYMBOL_GPL(v4l2_subdev_s_stream_helper);
220134a315ceSLaurent Pinchart
220214a6fca7STomi Valkeinen #endif /* CONFIG_VIDEO_V4L2_SUBDEV_API */
220314a6fca7STomi Valkeinen
22045bc3cb74SMauro Carvalho Chehab #endif /* CONFIG_MEDIA_CONTROLLER */
22055bc3cb74SMauro Carvalho Chehab
v4l2_subdev_init(struct v4l2_subdev * sd,const struct v4l2_subdev_ops * ops)22065bc3cb74SMauro Carvalho Chehab void v4l2_subdev_init(struct v4l2_subdev *sd, const struct v4l2_subdev_ops *ops)
22075bc3cb74SMauro Carvalho Chehab {
22085bc3cb74SMauro Carvalho Chehab INIT_LIST_HEAD(&sd->list);
22095bc3cb74SMauro Carvalho Chehab BUG_ON(!ops);
22105bc3cb74SMauro Carvalho Chehab sd->ops = ops;
22115bc3cb74SMauro Carvalho Chehab sd->v4l2_dev = NULL;
22125bc3cb74SMauro Carvalho Chehab sd->flags = 0;
22135bc3cb74SMauro Carvalho Chehab sd->name[0] = '\0';
22145bc3cb74SMauro Carvalho Chehab sd->grp_id = 0;
22155bc3cb74SMauro Carvalho Chehab sd->dev_priv = NULL;
22165bc3cb74SMauro Carvalho Chehab sd->host_priv = NULL;
2217b6e10ff6SHans de Goede sd->privacy_led = NULL;
2218e74f7a96SSakari Ailus INIT_LIST_HEAD(&sd->async_subdev_endpoint_list);
22195bc3cb74SMauro Carvalho Chehab #if defined(CONFIG_MEDIA_CONTROLLER)
22205bc3cb74SMauro Carvalho Chehab sd->entity.name = sd->name;
2221b76a2a8cSLaurent Pinchart sd->entity.obj_type = MEDIA_ENTITY_TYPE_V4L2_SUBDEV;
22224ca72efaSMauro Carvalho Chehab sd->entity.function = MEDIA_ENT_F_V4L2_SUBDEV_UNKNOWN;
22235bc3cb74SMauro Carvalho Chehab #endif
22245bc3cb74SMauro Carvalho Chehab }
22255bc3cb74SMauro Carvalho Chehab EXPORT_SYMBOL(v4l2_subdev_init);
22268ae5640fSLars-Peter Clausen
v4l2_subdev_notify_event(struct v4l2_subdev * sd,const struct v4l2_event * ev)22278ae5640fSLars-Peter Clausen void v4l2_subdev_notify_event(struct v4l2_subdev *sd,
22288ae5640fSLars-Peter Clausen const struct v4l2_event *ev)
22298ae5640fSLars-Peter Clausen {
22308ae5640fSLars-Peter Clausen v4l2_event_queue(sd->devnode, ev);
22318ae5640fSLars-Peter Clausen v4l2_subdev_notify(sd, V4L2_DEVICE_NOTIFY_EVENT, (void *)ev);
22328ae5640fSLars-Peter Clausen }
22338ae5640fSLars-Peter Clausen EXPORT_SYMBOL_GPL(v4l2_subdev_notify_event);
2234b6e10ff6SHans de Goede
v4l2_subdev_get_privacy_led(struct v4l2_subdev * sd)2235b6e10ff6SHans de Goede int v4l2_subdev_get_privacy_led(struct v4l2_subdev *sd)
2236b6e10ff6SHans de Goede {
2237b6e10ff6SHans de Goede #if IS_REACHABLE(CONFIG_LEDS_CLASS)
2238b6e10ff6SHans de Goede sd->privacy_led = led_get(sd->dev, "privacy-led");
2239b6e10ff6SHans de Goede if (IS_ERR(sd->privacy_led) && PTR_ERR(sd->privacy_led) != -ENOENT)
2240b6e10ff6SHans de Goede return dev_err_probe(sd->dev, PTR_ERR(sd->privacy_led),
2241b6e10ff6SHans de Goede "getting privacy LED\n");
2242b6e10ff6SHans de Goede
2243b6e10ff6SHans de Goede if (!IS_ERR_OR_NULL(sd->privacy_led)) {
2244b6e10ff6SHans de Goede mutex_lock(&sd->privacy_led->led_access);
2245b6e10ff6SHans de Goede led_sysfs_disable(sd->privacy_led);
2246b6e10ff6SHans de Goede led_trigger_remove(sd->privacy_led);
2247b6e10ff6SHans de Goede led_set_brightness(sd->privacy_led, 0);
2248b6e10ff6SHans de Goede mutex_unlock(&sd->privacy_led->led_access);
2249b6e10ff6SHans de Goede }
2250b6e10ff6SHans de Goede #endif
2251b6e10ff6SHans de Goede return 0;
2252b6e10ff6SHans de Goede }
2253b6e10ff6SHans de Goede EXPORT_SYMBOL_GPL(v4l2_subdev_get_privacy_led);
2254b6e10ff6SHans de Goede
v4l2_subdev_put_privacy_led(struct v4l2_subdev * sd)2255b6e10ff6SHans de Goede void v4l2_subdev_put_privacy_led(struct v4l2_subdev *sd)
2256b6e10ff6SHans de Goede {
2257b6e10ff6SHans de Goede #if IS_REACHABLE(CONFIG_LEDS_CLASS)
2258b6e10ff6SHans de Goede if (!IS_ERR_OR_NULL(sd->privacy_led)) {
2259b6e10ff6SHans de Goede mutex_lock(&sd->privacy_led->led_access);
2260b6e10ff6SHans de Goede led_sysfs_enable(sd->privacy_led);
2261b6e10ff6SHans de Goede mutex_unlock(&sd->privacy_led->led_access);
2262b6e10ff6SHans de Goede led_put(sd->privacy_led);
2263b6e10ff6SHans de Goede }
2264b6e10ff6SHans de Goede #endif
2265b6e10ff6SHans de Goede }
2266b6e10ff6SHans de Goede EXPORT_SYMBOL_GPL(v4l2_subdev_put_privacy_led);
2267