2008-11-30 00:36:58 +00:00
|
|
|
/*
|
|
|
|
V4L2 device support.
|
|
|
|
|
|
|
|
Copyright (C) 2008 Hans Verkuil <hverkuil@xs4all.nl>
|
|
|
|
|
|
|
|
This program is free software; you can redistribute it and/or modify
|
|
|
|
it under the terms of the GNU General Public License as published by
|
|
|
|
the Free Software Foundation; either version 2 of the License, or
|
|
|
|
(at your option) any later version.
|
|
|
|
|
|
|
|
This program is distributed in the hope that it will be useful,
|
|
|
|
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
|
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
|
|
GNU General Public License for more details.
|
|
|
|
|
|
|
|
You should have received a copy of the GNU General Public License
|
|
|
|
along with this program; if not, write to the Free Software
|
|
|
|
Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include <linux/types.h>
|
|
|
|
#include <linux/ioctl.h>
|
2011-07-03 18:03:12 +00:00
|
|
|
#include <linux/module.h>
|
2008-11-30 00:36:58 +00:00
|
|
|
#include <linux/i2c.h>
|
2011-09-13 11:07:55 +00:00
|
|
|
#include <linux/slab.h>
|
2010-03-23 14:23:29 +00:00
|
|
|
#if defined(CONFIG_SPI)
|
|
|
|
#include <linux/spi/spi.h>
|
|
|
|
#endif
|
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);
|
2013-01-20 04:32:56 +00:00
|
|
|
#if IS_ENABLED(CONFIG_I2C)
|
2009-05-02 13:58:51 +00:00
|
|
|
if (sd->flags & V4L2_SUBDEV_FL_IS_I2C) {
|
|
|
|
struct i2c_client *client = v4l2_get_subdevdata(sd);
|
|
|
|
|
2015-11-12 09:01:07 +00:00
|
|
|
/*
|
|
|
|
* We need to unregister the i2c client
|
|
|
|
* explicitly. We cannot rely on
|
|
|
|
* i2c_del_adapter to always unregister
|
|
|
|
* clients for us, since if the i2c bus is a
|
|
|
|
* platform bus, then it is never deleted.
|
|
|
|
*
|
|
|
|
* Device tree or ACPI based devices must not
|
|
|
|
* be unregistered as they have not been
|
|
|
|
* registered by us, and would not be
|
|
|
|
* re-created by just probing the V4L2 driver.
|
|
|
|
*/
|
|
|
|
if (client &&
|
|
|
|
!client->dev.of_node && !client->dev.fwnode)
|
2009-05-02 13:58:51 +00:00
|
|
|
i2c_unregister_device(client);
|
2011-01-11 20:48:21 +00:00
|
|
|
continue;
|
2009-05-02 13:58:51 +00:00
|
|
|
}
|
2010-03-23 14:23:29 +00:00
|
|
|
#endif
|
|
|
|
#if defined(CONFIG_SPI)
|
|
|
|
if (sd->flags & V4L2_SUBDEV_FL_IS_SPI) {
|
|
|
|
struct spi_device *spi = v4l2_get_subdevdata(sd);
|
|
|
|
|
2015-11-12 09:01:07 +00:00
|
|
|
if (spi && !spi->dev.of_node && !spi->dev.fwnode)
|
2010-03-23 14:23:29 +00:00
|
|
|
spi_unregister_device(spi);
|
2011-01-11 20:48:21 +00:00
|
|
|
continue;
|
2010-03-23 14:23:29 +00:00
|
|
|
}
|
2009-05-11 16:37:41 +00:00
|
|
|
#endif
|
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
|
|
|
{
|
2009-12-09 11:40:08 +00:00
|
|
|
#if defined(CONFIG_MEDIA_CONTROLLER)
|
|
|
|
struct media_entity *entity = &sd->entity;
|
|
|
|
#endif
|
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 */
|
2012-09-14 10:15:03 +00:00
|
|
|
err = v4l2_ctrl_add_handler(v4l2_dev->ctrl_handler, sd->ctrl_handler, NULL);
|
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) {
|
|
|
|
err = media_device_register_entity(v4l2_dev->mdev, 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)
|
|
|
|
media_device_unregister_entity(entity);
|
|
|
|
#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);
|
|
|
|
|
2011-09-13 11:07:55 +00:00
|
|
|
static void v4l2_device_release_subdev_node(struct video_device *vdev)
|
|
|
|
{
|
|
|
|
struct v4l2_subdev *sd = video_get_drvdata(vdev);
|
|
|
|
sd->devnode = NULL;
|
|
|
|
kfree(vdev);
|
|
|
|
}
|
|
|
|
|
2009-12-09 11:38:49 +00:00
|
|
|
int v4l2_device_register_subdev_nodes(struct v4l2_device *v4l2_dev)
|
|
|
|
{
|
|
|
|
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);
|
2009-12-09 11:38:49 +00:00
|
|
|
strlcpy(vdev->name, sd->name, sizeof(vdev->name));
|
|
|
|
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;
|
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) {
|
|
|
|
kfree(vdev);
|
|
|
|
goto clean_up;
|
|
|
|
}
|
2017-01-15 19:05:30 +00:00
|
|
|
sd->devnode = vdev;
|
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,
|
[media] v4l2 core: enable all interface links at init
Interface links are normally enabled, meaning that the interfaces are
bound to the entities. So, any ioctl send to the interface are reflected
at the entities managed by the interface.
However, when a device is used, other interfaces for the same hardware
could be decoupled from the entities linked to them, because the
hardware may have some parts busy.
That's for example, what happens when an hybrid TV device is in use.
If it is streaming analog TV or capturing signals from S-Video/Composite
connectors, typically the digital part of the hardware can't be used and
vice-versa.
This is generally due to some internal hardware or firmware limitation,
that it is not easily mapped via data pipelines.
What the Kernel drivers do internally is that they decouple the hardware
from the interface. So, all changes, if allowed, are done only at some
interface cache, but not physically changed at the hardware.
The usage is similar to the usage of the MEDIA_LNK_FL_ENABLED on data
links. So, let's use the same flag to indicate if either the interface
to entity link is bound/enabled or not.
Acked-by: Hans Verkuil <hans.verkuil@cisco.com>
Signed-off-by: Mauro Carvalho Chehab <mchehab@osg.samsung.com>
2015-09-04 18:39:43 +00:00
|
|
|
MEDIA_LNK_FL_ENABLED);
|
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
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(v4l2_device_register_subdev_nodes);
|
|
|
|
|
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
|
2011-09-13 11:07:55 +00:00
|
|
|
video_unregister_device(sd->devnode);
|
2013-12-12 12:36:46 +00:00
|
|
|
if (!sd->owner_v4l2_dev)
|
|
|
|
module_put(sd->owner);
|
2008-11-30 00:36:58 +00:00
|
|
|
}
|
|
|
|
EXPORT_SYMBOL_GPL(v4l2_device_unregister_subdev);
|