2019-05-27 06:55:05 +00:00
|
|
|
// SPDX-License-Identifier: GPL-2.0-or-later
|
2008-11-30 00:36:58 +00:00
|
|
|
/*
|
|
|
|
V4L2 device support.
|
|
|
|
|
|
|
|
Copyright (C) 2008 Hans Verkuil <hverkuil@xs4all.nl>
|
|
|
|
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include <linux/types.h>
|
|
|
|
#include <linux/ioctl.h>
|
2011-07-03 18:03:12 +00:00
|
|
|
#include <linux/module.h>
|
2011-09-13 11:07:55 +00:00
|
|
|
#include <linux/slab.h>
|
2008-11-30 00:36:58 +00:00
|
|
|
#include <linux/videodev2.h>
|
|
|
|
#include <media/v4l2-device.h>
|
2010-05-16 12:24:06 +00:00
|
|
|
#include <media/v4l2-ctrls.h>
|
2008-11-30 00:36:58 +00:00
|
|
|
|
|
|
|
int v4l2_device_register(struct device *dev, struct v4l2_device *v4l2_dev)
|
|
|
|
{
|
2009-02-14 14:54:23 +00:00
|
|
|
if (v4l2_dev == NULL)
|
2008-11-30 00:36:58 +00:00
|
|
|
return -EINVAL;
|
2009-02-14 14:54:23 +00:00
|
|
|
|
2008-11-30 00:36:58 +00:00
|
|
|
INIT_LIST_HEAD(&v4l2_dev->subdevs);
|
|
|
|
spin_lock_init(&v4l2_dev->lock);
|
2011-02-24 13:42:24 +00:00
|
|
|
v4l2_prio_init(&v4l2_dev->prio);
|
2011-03-12 09:37:19 +00:00
|
|
|
kref_init(&v4l2_dev->ref);
|
2011-09-06 12:08:08 +00:00
|
|
|
get_device(dev);
|
2008-11-30 00:36:58 +00:00
|
|
|
v4l2_dev->dev = dev;
|
2009-02-14 14:54:23 +00:00
|
|
|
if (dev == NULL) {
|
|
|
|
/* If dev == NULL, then name must be filled in by the caller */
|
2013-06-12 09:04:04 +00:00
|
|
|
if (WARN_ON(!v4l2_dev->name[0]))
|
|
|
|
return -EINVAL;
|
2009-02-14 14:54:23 +00:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Set name to driver name + device name if it is empty. */
|
|
|
|
if (!v4l2_dev->name[0])
|
|
|
|
snprintf(v4l2_dev->name, sizeof(v4l2_dev->name), "%s %s",
|
2009-03-24 23:38:22 +00:00
|
|
|
dev->driver->name, dev_name(dev));
|
2009-12-09 11:40:05 +00:00
|
|
|
if (!dev_get_drvdata(dev))
|
|
|
|
dev_set_drvdata(dev, v4l2_dev);
|
2008-11-30 00:36:58 +00:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(v4l2_device_register);
|
|
|
|
|
2011-03-12 09:37:19 +00:00
|
|
|
static void v4l2_device_release(struct kref *ref)
|
|
|
|
{
|
|
|
|
struct v4l2_device *v4l2_dev =
|
|
|
|
container_of(ref, struct v4l2_device, ref);
|
|
|
|
|
|
|
|
if (v4l2_dev->release)
|
|
|
|
v4l2_dev->release(v4l2_dev);
|
|
|
|
}
|
|
|
|
|
|
|
|
int v4l2_device_put(struct v4l2_device *v4l2_dev)
|
|
|
|
{
|
|
|
|
return kref_put(&v4l2_dev->ref, v4l2_device_release);
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(v4l2_device_put);
|
|
|
|
|
2009-05-02 13:12:50 +00:00
|
|
|
int v4l2_device_set_name(struct v4l2_device *v4l2_dev, const char *basename,
|
|
|
|
atomic_t *instance)
|
|
|
|
{
|
|
|
|
int num = atomic_inc_return(instance) - 1;
|
|
|
|
int len = strlen(basename);
|
|
|
|
|
|
|
|
if (basename[len - 1] >= '0' && basename[len - 1] <= '9')
|
|
|
|
snprintf(v4l2_dev->name, sizeof(v4l2_dev->name),
|
|
|
|
"%s-%d", basename, num);
|
|
|
|
else
|
|
|
|
snprintf(v4l2_dev->name, sizeof(v4l2_dev->name),
|
|
|
|
"%s%d", basename, num);
|
|
|
|
return num;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(v4l2_device_set_name);
|
|
|
|
|
2009-03-14 11:28:45 +00:00
|
|
|
void v4l2_device_disconnect(struct v4l2_device *v4l2_dev)
|
|
|
|
{
|
2009-12-09 11:40:05 +00:00
|
|
|
if (v4l2_dev->dev == NULL)
|
|
|
|
return;
|
|
|
|
|
|
|
|
if (dev_get_drvdata(v4l2_dev->dev) == v4l2_dev)
|
2009-03-14 11:28:45 +00:00
|
|
|
dev_set_drvdata(v4l2_dev->dev, NULL);
|
2011-09-06 12:08:08 +00:00
|
|
|
put_device(v4l2_dev->dev);
|
2009-12-09 11:40:05 +00:00
|
|
|
v4l2_dev->dev = NULL;
|
2009-03-14 11:28:45 +00:00
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(v4l2_device_disconnect);
|
|
|
|
|
2008-11-30 00:36:58 +00:00
|
|
|
void v4l2_device_unregister(struct v4l2_device *v4l2_dev)
|
|
|
|
{
|
|
|
|
struct v4l2_subdev *sd, *next;
|
|
|
|
|
2013-06-12 09:04:04 +00:00
|
|
|
/* Just return if v4l2_dev is NULL or if it was already
|
|
|
|
* unregistered before. */
|
|
|
|
if (v4l2_dev == NULL || !v4l2_dev->name[0])
|
2008-11-30 00:36:58 +00:00
|
|
|
return;
|
2009-03-14 11:28:45 +00:00
|
|
|
v4l2_device_disconnect(v4l2_dev);
|
|
|
|
|
2009-02-14 14:54:23 +00:00
|
|
|
/* Unregister subdevs */
|
2009-05-02 13:58:51 +00:00
|
|
|
list_for_each_entry_safe(sd, next, &v4l2_dev->subdevs, list) {
|
2008-11-30 00:36:58 +00:00
|
|
|
v4l2_device_unregister_subdev(sd);
|
2019-08-15 16:48:05 +00:00
|
|
|
if (sd->flags & V4L2_SUBDEV_FL_IS_I2C)
|
|
|
|
v4l2_i2c_subdev_unregister(sd);
|
2019-08-15 16:48:04 +00:00
|
|
|
else if (sd->flags & V4L2_SUBDEV_FL_IS_SPI)
|
|
|
|
v4l2_spi_subdev_unregister(sd);
|
2009-05-02 13:58:51 +00:00
|
|
|
}
|
2013-06-12 09:04:04 +00:00
|
|
|
/* Mark as unregistered, thus preventing duplicate unregistrations */
|
|
|
|
v4l2_dev->name[0] = '\0';
|
2008-11-30 00:36:58 +00:00
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(v4l2_device_unregister);
|
|
|
|
|
2009-02-14 14:54:23 +00:00
|
|
|
int v4l2_device_register_subdev(struct v4l2_device *v4l2_dev,
|
2009-12-09 11:40:08 +00:00
|
|
|
struct v4l2_subdev *sd)
|
2008-11-30 00:36:58 +00:00
|
|
|
{
|
2010-05-16 12:24:06 +00:00
|
|
|
int err;
|
|
|
|
|
2008-11-30 00:36:58 +00:00
|
|
|
/* Check for valid input */
|
2016-08-11 10:18:37 +00:00
|
|
|
if (!v4l2_dev || !sd || sd->v4l2_dev || !sd->name[0])
|
2008-11-30 00:36:58 +00:00
|
|
|
return -EINVAL;
|
2009-12-09 11:38:49 +00:00
|
|
|
|
2013-12-12 12:36:46 +00:00
|
|
|
/*
|
|
|
|
* The reason to acquire the module here is to avoid unloading
|
|
|
|
* a module of sub-device which is registered to a media
|
|
|
|
* device. To make it possible to unload modules for media
|
|
|
|
* devices that also register sub-devices, do not
|
|
|
|
* try_module_get() such sub-device owners.
|
|
|
|
*/
|
|
|
|
sd->owner_v4l2_dev = v4l2_dev->dev && v4l2_dev->dev->driver &&
|
|
|
|
sd->owner == v4l2_dev->dev->driver->owner;
|
|
|
|
|
|
|
|
if (!sd->owner_v4l2_dev && !try_module_get(sd->owner))
|
2008-11-30 00:36:58 +00:00
|
|
|
return -ENODEV;
|
2009-12-09 11:38:49 +00:00
|
|
|
|
2011-01-08 10:15:53 +00:00
|
|
|
sd->v4l2_dev = v4l2_dev;
|
2010-05-16 12:24:06 +00:00
|
|
|
/* This just returns 0 if either of the two args is NULL */
|
2018-05-21 08:54:36 +00:00
|
|
|
err = v4l2_ctrl_add_handler(v4l2_dev->ctrl_handler, sd->ctrl_handler,
|
|
|
|
NULL, true);
|
2012-11-25 00:35:48 +00:00
|
|
|
if (err)
|
2015-12-27 23:45:00 +00:00
|
|
|
goto error_module;
|
2009-12-09 11:38:49 +00:00
|
|
|
|
2009-12-09 11:40:08 +00:00
|
|
|
#if defined(CONFIG_MEDIA_CONTROLLER)
|
|
|
|
/* Register the entity. */
|
|
|
|
if (v4l2_dev->mdev) {
|
2020-02-26 15:28:16 +00:00
|
|
|
err = media_device_register_entity(v4l2_dev->mdev, &sd->entity);
|
2012-11-25 00:35:48 +00:00
|
|
|
if (err < 0)
|
2015-12-27 23:45:00 +00:00
|
|
|
goto error_module;
|
2009-12-09 11:40:08 +00:00
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
2015-12-27 23:45:00 +00:00
|
|
|
if (sd->internal_ops && sd->internal_ops->registered) {
|
|
|
|
err = sd->internal_ops->registered(sd);
|
|
|
|
if (err)
|
|
|
|
goto error_unregister;
|
|
|
|
}
|
|
|
|
|
2009-02-14 14:54:23 +00:00
|
|
|
spin_lock(&v4l2_dev->lock);
|
|
|
|
list_add_tail(&sd->list, &v4l2_dev->subdevs);
|
|
|
|
spin_unlock(&v4l2_dev->lock);
|
2009-12-09 11:38:49 +00:00
|
|
|
|
2008-11-30 00:36:58 +00:00
|
|
|
return 0;
|
2012-11-25 00:35:48 +00:00
|
|
|
|
|
|
|
error_unregister:
|
2015-12-27 23:45:00 +00:00
|
|
|
#if defined(CONFIG_MEDIA_CONTROLLER)
|
2020-02-26 15:28:16 +00:00
|
|
|
media_device_unregister_entity(&sd->entity);
|
2015-12-27 23:45:00 +00:00
|
|
|
#endif
|
2012-11-25 00:35:48 +00:00
|
|
|
error_module:
|
2013-12-12 12:36:46 +00:00
|
|
|
if (!sd->owner_v4l2_dev)
|
|
|
|
module_put(sd->owner);
|
2012-11-25 00:35:48 +00:00
|
|
|
sd->v4l2_dev = NULL;
|
|
|
|
return err;
|
2008-11-30 00:36:58 +00:00
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(v4l2_device_register_subdev);
|
|
|
|
|
2019-02-21 13:37:42 +00:00
|
|
|
static void v4l2_subdev_release(struct v4l2_subdev *sd)
|
|
|
|
{
|
|
|
|
struct module *owner = !sd->owner_v4l2_dev ? sd->owner : NULL;
|
|
|
|
|
|
|
|
if (sd->internal_ops && sd->internal_ops->release)
|
|
|
|
sd->internal_ops->release(sd);
|
2020-02-19 15:25:54 +00:00
|
|
|
sd->devnode = NULL;
|
2019-02-21 13:37:42 +00:00
|
|
|
module_put(owner);
|
|
|
|
}
|
|
|
|
|
2011-09-13 11:07:55 +00:00
|
|
|
static void v4l2_device_release_subdev_node(struct video_device *vdev)
|
|
|
|
{
|
2019-02-21 13:37:42 +00:00
|
|
|
v4l2_subdev_release(video_get_drvdata(vdev));
|
2011-09-13 11:07:55 +00:00
|
|
|
kfree(vdev);
|
|
|
|
}
|
|
|
|
|
2020-05-07 15:12:50 +00:00
|
|
|
int __v4l2_device_register_subdev_nodes(struct v4l2_device *v4l2_dev,
|
|
|
|
bool read_only)
|
2009-12-09 11:38:49 +00:00
|
|
|
{
|
|
|
|
struct video_device *vdev;
|
|
|
|
struct v4l2_subdev *sd;
|
|
|
|
int err;
|
|
|
|
|
|
|
|
/* Register a device node for every subdev marked with the
|
|
|
|
* V4L2_SUBDEV_FL_HAS_DEVNODE flag.
|
|
|
|
*/
|
|
|
|
list_for_each_entry(sd, &v4l2_dev->subdevs, list) {
|
|
|
|
if (!(sd->flags & V4L2_SUBDEV_FL_HAS_DEVNODE))
|
|
|
|
continue;
|
|
|
|
|
2017-02-14 22:38:49 +00:00
|
|
|
if (sd->devnode)
|
|
|
|
continue;
|
|
|
|
|
2011-09-13 11:07:55 +00:00
|
|
|
vdev = kzalloc(sizeof(*vdev), GFP_KERNEL);
|
|
|
|
if (!vdev) {
|
|
|
|
err = -ENOMEM;
|
|
|
|
goto clean_up;
|
|
|
|
}
|
|
|
|
|
|
|
|
video_set_drvdata(vdev, sd);
|
2018-09-10 12:19:14 +00:00
|
|
|
strscpy(vdev->name, sd->name, sizeof(vdev->name));
|
2017-12-15 04:32:21 +00:00
|
|
|
vdev->dev_parent = sd->dev;
|
2009-12-09 11:38:49 +00:00
|
|
|
vdev->v4l2_dev = v4l2_dev;
|
|
|
|
vdev->fops = &v4l2_subdev_fops;
|
2011-09-13 11:07:55 +00:00
|
|
|
vdev->release = v4l2_device_release_subdev_node;
|
2011-05-25 11:52:13 +00:00
|
|
|
vdev->ctrl_handler = sd->ctrl_handler;
|
2020-05-07 15:12:50 +00:00
|
|
|
if (read_only)
|
|
|
|
set_bit(V4L2_FL_SUBDEV_RO_DEVNODE, &vdev->flags);
|
2019-08-15 07:36:49 +00:00
|
|
|
sd->devnode = vdev;
|
2009-12-09 11:38:49 +00:00
|
|
|
err = __video_register_device(vdev, VFL_TYPE_SUBDEV, -1, 1,
|
|
|
|
sd->owner);
|
2011-09-13 11:07:55 +00:00
|
|
|
if (err < 0) {
|
2019-08-15 07:36:49 +00:00
|
|
|
sd->devnode = NULL;
|
2011-09-13 11:07:55 +00:00
|
|
|
kfree(vdev);
|
|
|
|
goto clean_up;
|
|
|
|
}
|
2009-12-09 11:40:08 +00:00
|
|
|
#if defined(CONFIG_MEDIA_CONTROLLER)
|
[media] media: Fix DVB devnode representation at media controller
The previous provision for DVB media controller support were to
define an ID (likely meaning the adapter number) for the DVB
devnodes.
This is just plain wrong. Just like V4L, DVB devices (and any other
device node)) are uniquely identified via a (major, minor) tuple.
This is enough to uniquely identify a devnode, no matter what
API it implements.
So, before we go too far, let's mark the old v4l, fb, dvb and alsa
"devnode" info as deprecated, and just call it as "dev".
We can latter add fields specific to each API if needed.
As we don't want to break compilation on already existing apps,
let's just keep the old definitions as-is, adding a note that
those are deprecated at media-entity.h.
Signed-off-by: Mauro Carvalho Chehab <mchehab@osg.samsung.com>
2015-01-02 15:18:23 +00:00
|
|
|
sd->entity.info.dev.major = VIDEO_MAJOR;
|
|
|
|
sd->entity.info.dev.minor = vdev->minor;
|
2015-08-24 11:47:54 +00:00
|
|
|
|
|
|
|
/* Interface is created by __video_register_device() */
|
|
|
|
if (vdev->v4l2_dev->mdev) {
|
|
|
|
struct media_link *link;
|
|
|
|
|
|
|
|
link = media_create_intf_link(&sd->entity,
|
|
|
|
&vdev->intf_devnode->intf,
|
2018-07-02 12:43:02 +00:00
|
|
|
MEDIA_LNK_FL_ENABLED |
|
|
|
|
MEDIA_LNK_FL_IMMUTABLE);
|
2015-12-15 11:04:14 +00:00
|
|
|
if (!link) {
|
|
|
|
err = -ENOMEM;
|
2015-08-24 11:47:54 +00:00
|
|
|
goto clean_up;
|
2015-12-15 11:04:14 +00:00
|
|
|
}
|
2015-08-24 11:47:54 +00:00
|
|
|
}
|
2009-12-09 11:40:08 +00:00
|
|
|
#endif
|
2009-12-09 11:38:49 +00:00
|
|
|
}
|
|
|
|
return 0;
|
2011-09-13 11:07:55 +00:00
|
|
|
|
|
|
|
clean_up:
|
|
|
|
list_for_each_entry(sd, &v4l2_dev->subdevs, list) {
|
|
|
|
if (!sd->devnode)
|
|
|
|
break;
|
|
|
|
video_unregister_device(sd->devnode);
|
|
|
|
}
|
|
|
|
|
|
|
|
return err;
|
2009-12-09 11:38:49 +00:00
|
|
|
}
|
2020-05-07 15:12:50 +00:00
|
|
|
EXPORT_SYMBOL_GPL(__v4l2_device_register_subdev_nodes);
|
2009-12-09 11:38:49 +00:00
|
|
|
|
2008-11-30 00:36:58 +00:00
|
|
|
void v4l2_device_unregister_subdev(struct v4l2_subdev *sd)
|
|
|
|
{
|
2009-12-09 11:40:08 +00:00
|
|
|
struct v4l2_device *v4l2_dev;
|
|
|
|
|
2008-11-30 00:36:58 +00:00
|
|
|
/* return if it isn't registered */
|
2009-02-14 15:00:53 +00:00
|
|
|
if (sd == NULL || sd->v4l2_dev == NULL)
|
2008-11-30 00:36:58 +00:00
|
|
|
return;
|
2009-12-09 11:38:49 +00:00
|
|
|
|
2009-12-09 11:40:08 +00:00
|
|
|
v4l2_dev = sd->v4l2_dev;
|
|
|
|
|
|
|
|
spin_lock(&v4l2_dev->lock);
|
2008-11-30 00:36:58 +00:00
|
|
|
list_del(&sd->list);
|
2009-12-09 11:40:08 +00:00
|
|
|
spin_unlock(&v4l2_dev->lock);
|
|
|
|
|
2011-01-08 10:15:53 +00:00
|
|
|
if (sd->internal_ops && sd->internal_ops->unregistered)
|
|
|
|
sd->internal_ops->unregistered(sd);
|
2009-02-14 15:00:53 +00:00
|
|
|
sd->v4l2_dev = NULL;
|
2009-12-09 11:38:49 +00:00
|
|
|
|
2009-12-09 11:40:08 +00:00
|
|
|
#if defined(CONFIG_MEDIA_CONTROLLER)
|
2013-05-09 11:29:33 +00:00
|
|
|
if (v4l2_dev->mdev) {
|
2015-08-24 11:47:54 +00:00
|
|
|
/*
|
|
|
|
* No need to explicitly remove links, as both pads and
|
|
|
|
* links are removed by the function below, in the right order
|
|
|
|
*/
|
2009-12-09 11:40:08 +00:00
|
|
|
media_device_unregister_entity(&sd->entity);
|
2013-05-09 11:29:33 +00:00
|
|
|
}
|
2009-12-09 11:40:08 +00:00
|
|
|
#endif
|
2019-02-21 13:37:42 +00:00
|
|
|
if (sd->devnode)
|
|
|
|
video_unregister_device(sd->devnode);
|
|
|
|
else
|
|
|
|
v4l2_subdev_release(sd);
|
2008-11-30 00:36:58 +00:00
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(v4l2_device_unregister_subdev);
|