Lines Matching +full:video +full:- +full:mux
1 // SPDX-License-Identifier: GPL-2.0-or-later
3 * video stream multiplexer controlled via mux control
6 * Copyright (C) 2016-2017 Pengutronix, Philipp Zabel <kernel@pengutronix.de>
12 #include <linux/mux/consumer.h>
17 #include <media/v4l2-async.h>
18 #include <media/v4l2-device.h>
19 #include <media/v4l2-fwnode.h>
20 #include <media/v4l2-mc.h>
21 #include <media/v4l2-subdev.h>
28 struct mux_control *mux; member
57 u16 source_pad = entity->num_pads - 1; in video_mux_link_setup()
61 * The mux state is determined by the enabled sink pad link. in video_mux_link_setup()
64 if (local->flags & MEDIA_PAD_FL_SOURCE) in video_mux_link_setup()
67 dev_dbg(sd->dev, "link setup '%s':%d->'%s':%d[%d]", in video_mux_link_setup()
68 remote->entity->name, remote->index, local->entity->name, in video_mux_link_setup()
69 local->index, flags & MEDIA_LNK_FL_ENABLED); in video_mux_link_setup()
71 mutex_lock(&vmux->lock); in video_mux_link_setup()
74 if (vmux->active == local->index) in video_mux_link_setup()
77 if (vmux->active >= 0) { in video_mux_link_setup()
78 ret = -EBUSY; in video_mux_link_setup()
82 dev_dbg(sd->dev, "setting %d active\n", local->index); in video_mux_link_setup()
83 ret = mux_control_try_select(vmux->mux, local->index); in video_mux_link_setup()
86 vmux->active = local->index; in video_mux_link_setup()
89 vmux->format_mbus[source_pad] = vmux->format_mbus[vmux->active]; in video_mux_link_setup()
91 if (vmux->active != local->index) in video_mux_link_setup()
94 dev_dbg(sd->dev, "going inactive\n"); in video_mux_link_setup()
95 mux_control_deselect(vmux->mux); in video_mux_link_setup()
96 vmux->active = -1; in video_mux_link_setup()
100 mutex_unlock(&vmux->lock); in video_mux_link_setup()
116 if (vmux->active == -1) { in video_mux_s_stream()
117 dev_err(sd->dev, "Can not start streaming on inactive mux\n"); in video_mux_s_stream()
118 return -EINVAL; in video_mux_s_stream()
121 pad = media_pad_remote_pad_first(&sd->entity.pads[vmux->active]); in video_mux_s_stream()
123 dev_err(sd->dev, "Failed to find remote source pad\n"); in video_mux_s_stream()
124 return -ENOLINK; in video_mux_s_stream()
127 if (!is_media_entity_v4l2_subdev(pad->entity)) { in video_mux_s_stream()
128 dev_err(sd->dev, "Upstream entity is not a v4l2 subdev\n"); in video_mux_s_stream()
129 return -ENODEV; in video_mux_s_stream()
132 upstream_sd = media_entity_to_v4l2_subdev(pad->entity); in video_mux_s_stream()
134 return v4l2_subdev_call(upstream_sd, video, s_stream, enable); in video_mux_s_stream()
152 return &vmux->format_mbus[pad]; in __video_mux_get_pad_format()
164 mutex_lock(&vmux->lock); in video_mux_get_format()
166 sdformat->format = *__video_mux_get_pad_format(sd, sd_state, in video_mux_get_format()
167 sdformat->pad, in video_mux_get_format()
168 sdformat->which); in video_mux_get_format()
170 mutex_unlock(&vmux->lock); in video_mux_get_format()
181 struct media_pad *pad = &vmux->pads[sdformat->pad]; in video_mux_set_format()
182 u16 source_pad = sd->entity.num_pads - 1; in video_mux_set_format()
184 mbusformat = __video_mux_get_pad_format(sd, sd_state, sdformat->pad, in video_mux_set_format()
185 sdformat->which); in video_mux_set_format()
187 return -EINVAL; in video_mux_set_format()
191 sdformat->which); in video_mux_set_format()
193 return -EINVAL; in video_mux_set_format()
196 v4l_bound_align_image(&sdformat->format.width, 1, 65536, 0, in video_mux_set_format()
197 &sdformat->format.height, 1, 65536, 0, 0); in video_mux_set_format()
200 switch (sdformat->format.code) { in video_mux_set_format()
291 sdformat->format.code = MEDIA_BUS_FMT_Y8_1X8; in video_mux_set_format()
294 if (sdformat->format.field == V4L2_FIELD_ANY) in video_mux_set_format()
295 sdformat->format.field = V4L2_FIELD_NONE; in video_mux_set_format()
297 mutex_lock(&vmux->lock); in video_mux_set_format()
300 if ((pad->flags & MEDIA_PAD_FL_SOURCE) && vmux->active >= 0) in video_mux_set_format()
301 sdformat->format = vmux->format_mbus[vmux->active]; in video_mux_set_format()
303 *mbusformat = sdformat->format; in video_mux_set_format()
306 if ((pad->flags & MEDIA_PAD_FL_SINK) && (pad->index == vmux->active)) in video_mux_set_format()
307 *source_mbusformat = sdformat->format; in video_mux_set_format()
309 mutex_unlock(&vmux->lock); in video_mux_set_format()
321 mutex_lock(&vmux->lock); in video_mux_init_cfg()
323 for (i = 0; i < sd->entity.num_pads; i++) { in video_mux_init_cfg()
328 mutex_unlock(&vmux->lock); in video_mux_init_cfg()
341 .video = &video_mux_subdev_video_ops,
350 return v4l2_create_fwnode_links(sd, &vmux->subdev); in video_mux_notify_bound()
363 v4l2_async_nf_init(&vmux->notifier); in video_mux_async_register()
370 dev_fwnode(vmux->subdev.dev), i, 0, in video_mux_async_register()
383 asd = v4l2_async_nf_add_fwnode_remote(&vmux->notifier, ep, in video_mux_async_register()
391 if (ret != -EEXIST) in video_mux_async_register()
396 vmux->notifier.ops = &video_mux_notify_ops; in video_mux_async_register()
398 ret = v4l2_async_subdev_nf_register(&vmux->subdev, &vmux->notifier); in video_mux_async_register()
402 return v4l2_async_register_subdev(&vmux->subdev); in video_mux_async_register()
407 struct device_node *np = pdev->dev.of_node; in video_mux_probe()
408 struct device *dev = &pdev->dev; in video_mux_probe()
417 return -ENOMEM; in video_mux_probe()
421 v4l2_subdev_init(&vmux->subdev, &video_mux_subdev_ops); in video_mux_probe()
422 snprintf(vmux->subdev.name, sizeof(vmux->subdev.name), "%pOFn", np); in video_mux_probe()
423 vmux->subdev.flags |= V4L2_SUBDEV_FL_HAS_DEVNODE; in video_mux_probe()
424 vmux->subdev.dev = dev; in video_mux_probe()
439 return -EINVAL; in video_mux_probe()
442 vmux->mux = devm_mux_control_get(dev, NULL); in video_mux_probe()
443 if (IS_ERR(vmux->mux)) { in video_mux_probe()
444 ret = PTR_ERR(vmux->mux); in video_mux_probe()
445 return dev_err_probe(dev, ret, "Failed to get mux\n"); in video_mux_probe()
448 mutex_init(&vmux->lock); in video_mux_probe()
449 vmux->active = -1; in video_mux_probe()
450 vmux->pads = devm_kcalloc(dev, num_pads, sizeof(*vmux->pads), in video_mux_probe()
452 if (!vmux->pads) in video_mux_probe()
453 return -ENOMEM; in video_mux_probe()
455 vmux->format_mbus = devm_kcalloc(dev, num_pads, in video_mux_probe()
456 sizeof(*vmux->format_mbus), in video_mux_probe()
458 if (!vmux->format_mbus) in video_mux_probe()
459 return -ENOMEM; in video_mux_probe()
462 vmux->pads[i].flags = (i < num_pads - 1) ? MEDIA_PAD_FL_SINK in video_mux_probe()
464 vmux->format_mbus[i] = video_mux_format_mbus_default; in video_mux_probe()
467 vmux->subdev.entity.function = MEDIA_ENT_F_VID_MUX; in video_mux_probe()
468 ret = media_entity_pads_init(&vmux->subdev.entity, num_pads, in video_mux_probe()
469 vmux->pads); in video_mux_probe()
473 vmux->subdev.entity.ops = &video_mux_ops; in video_mux_probe()
475 ret = video_mux_async_register(vmux, num_pads - 1); in video_mux_probe()
477 v4l2_async_nf_unregister(&vmux->notifier); in video_mux_probe()
478 v4l2_async_nf_cleanup(&vmux->notifier); in video_mux_probe()
487 struct v4l2_subdev *sd = &vmux->subdev; in video_mux_remove()
489 v4l2_async_nf_unregister(&vmux->notifier); in video_mux_remove()
490 v4l2_async_nf_cleanup(&vmux->notifier); in video_mux_remove()
492 media_entity_cleanup(&sd->entity); in video_mux_remove()
498 { .compatible = "video-mux", },
508 .name = "video-mux",
514 MODULE_DESCRIPTION("video stream multiplexer");