Replace V4L2 subdev selection targets with the V4L2 ones
[media-ctl.git] / src / mediactl.c
index 82ede25..14cff30 100644 (file)
@@ -1,20 +1,22 @@
 /*
  * Media controller interface library
  *
- * Copyright (C) 2010 Ideas on board SPRL <laurent.pinchart@ideasonboard.com>
+ * Copyright (C) 2010-2011 Ideas on board SPRL
+ *
+ * Contact: Laurent Pinchart <laurent.pinchart@ideasonboard.com>
  *
  * 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
+ * it under the terms of the GNU Lesser General Public License as published
+ * by the Free Software Foundation; either version 2.1 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.
+ * GNU Lesser 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.,
+ * You should have received a copy of the GNU Lesser General Public License
+ * along with this program. If not, see <http://www.gnu.org/licenses/>.
  */
 
 #include "config.h"
@@ -24,6 +26,7 @@
 #include <sys/types.h>
 
 #include <unistd.h>
+#include <stdbool.h>
 #include <stdio.h>
 #include <stdlib.h>
 #include <string.h>
 #include "mediactl.h"
 #include "tools.h"
 
-#ifdef DEBUG
-#define dprintf(...) printf(__VA_ARGS__)
-#else
-#define dprintf(...)
-#endif
-
 struct media_pad *media_entity_remote_source(struct media_pad *pad)
 {
        unsigned int i;
@@ -67,10 +64,17 @@ struct media_entity *media_get_entity_by_name(struct media_device *media,
 {
        unsigned int i;
 
+       /* A match is impossible if the entity name is longer than the maximum
+        * size we can get from the kernel.
+        */
+       if (length >= FIELD_SIZEOF(struct media_entity_desc, name))
+               return NULL;
+
        for (i = 0; i < media->entities_count; ++i) {
                struct media_entity *entity = &media->entities[i];
 
-               if (strncmp(entity->info.name, name, length) == 0)
+               if (strncmp(entity->info.name, name, length) == 0 &&
+                   entity->info.name[length] == '\0')
                        return entity;
        }
 
@@ -80,12 +84,16 @@ struct media_entity *media_get_entity_by_name(struct media_device *media,
 struct media_entity *media_get_entity_by_id(struct media_device *media,
                                            __u32 id)
 {
+       bool next = id & MEDIA_ENT_ID_FLAG_NEXT;
        unsigned int i;
 
+       id &= ~MEDIA_ENT_ID_FLAG_NEXT;
+
        for (i = 0; i < media->entities_count; ++i) {
                struct media_entity *entity = &media->entities[i];
 
-               if (entity->info.id == id)
+               if ((entity->info.id == id && !next) ||
+                   (entity->info.id > id && next))
                        return entity;
        }
 
@@ -113,7 +121,7 @@ int media_setup_link(struct media_device *media,
        }
 
        if (i == source->entity->num_links) {
-               dprintf("%s: Link not found\n", __func__);
+               media_dbg(media, "%s: Link not found\n", __func__);
                return -ENOENT;
        }
 
@@ -131,8 +139,8 @@ int media_setup_link(struct media_device *media,
 
        ret = ioctl(media->fd, MEDIA_IOC_SETUP_LINK, &ulink);
        if (ret == -1) {
-               dprintf("%s: Unable to setup link (%s)\n", __func__,
-                       strerror(errno));
+               media_dbg(media, "%s: Unable to setup link (%s)\n",
+                         __func__, strerror(errno));
                return -errno;
        }
 
@@ -202,8 +210,9 @@ static int media_enum_links(struct media_device *media)
                links.links = malloc(entity->info.links * sizeof(struct media_link_desc));
 
                if (ioctl(media->fd, MEDIA_IOC_ENUM_LINKS, &links) < 0) {
-                       dprintf("%s: Unable to enumerate pads and links (%s).\n",
-                               __func__, strerror(errno));
+                       media_dbg(media,
+                                 "%s: Unable to enumerate pads and links (%s).\n",
+                                 __func__, strerror(errno));
                        free(links.pads);
                        free(links.links);
                        return -errno;
@@ -226,9 +235,12 @@ static int media_enum_links(struct media_device *media)
                        sink = media_get_entity_by_id(media, link->sink.entity);
 
                        if (source == NULL || sink == NULL) {
-                               dprintf("WARNING entity %u link %u from %u/%u to %u/%u is invalid!\n",
-                                       id, i, link->source.entity, link->source.index,
-                                       link->sink.entity, link->sink.index);
+                               media_dbg(media,
+                                         "WARNING entity %u link %u from %u/%u to %u/%u is invalid!\n",
+                                         id, i, link->source.entity,
+                                         link->source.index,
+                                         link->sink.entity,
+                                         link->sink.index);
                                ret = -EINVAL;
                        } else {
                                fwdlink = media_entity_add_link(source);
@@ -272,7 +284,7 @@ static inline void media_udev_close(struct udev *udev)
 }
 
 static int media_get_devname_udev(struct udev *udev,
-               struct media_entity *entity, int verbose)
+               struct media_entity *entity)
 {
        struct udev_device *device;
        dev_t devnum;
@@ -283,8 +295,8 @@ static int media_get_devname_udev(struct udev *udev,
                return -EINVAL;
 
        devnum = makedev(entity->info.v4l.major, entity->info.v4l.minor);
-       if (verbose)
-               printf("looking up device: %u:%u\n", major(devnum), minor(devnum));
+       media_dbg(entity->media, "looking up device: %u:%u\n",
+                 major(devnum), minor(devnum));
        device = udev_device_new_from_devnum(udev, 'c', devnum);
        if (device) {
                p = udev_device_get_devnode(device);
@@ -309,7 +321,7 @@ static inline int media_udev_open(struct udev **udev) { return 0; }
 static inline void media_udev_close(struct udev *udev) { }
 
 static inline int media_get_devname_udev(struct udev *udev,
-               struct media_entity *entity, int verbose)
+               struct media_entity *entity)
 {
        return -ENOTSUP;
 }
@@ -352,7 +364,7 @@ static int media_get_devname_sysfs(struct media_entity *entity)
        return 0;
 }
 
-static int media_enum_entities(struct media_device *media, int verbose)
+static int media_enum_entities(struct media_device *media)
 {
        struct media_entity *entity;
        struct udev *udev;
@@ -362,7 +374,7 @@ static int media_enum_entities(struct media_device *media, int verbose)
 
        ret = media_udev_open(&udev);
        if (ret < 0)
-               printf("%s: Can't get udev context\n", __func__);
+               media_dbg(media, "Can't get udev context\n");
 
        for (id = 0, ret = 0; ; id = entity->info.id) {
                size = (media->entities_count + 1) * sizeof(*media->entities);
@@ -372,6 +384,7 @@ static int media_enum_entities(struct media_device *media, int verbose)
                memset(entity, 0, sizeof(*entity));
                entity->fd = -1;
                entity->info.id = id | MEDIA_ENT_ID_FLAG_NEXT;
+               entity->media = media;
 
                ret = ioctl(media->fd, MEDIA_IOC_ENUM_ENTITIES, &entity->info);
                if (ret < 0) {
@@ -400,7 +413,7 @@ static int media_enum_entities(struct media_device *media, int verbose)
                        continue;
 
                /* Try to get the device name via udev */
-               if (!media_get_devname_udev(udev, entity, verbose))
+               if (!media_get_devname_udev(udev, entity))
                        continue;
 
                /* Fall back to get the device name via sysfs */
@@ -411,48 +424,75 @@ static int media_enum_entities(struct media_device *media, int verbose)
        return ret;
 }
 
-struct media_device *media_open(const char *name, int verbose)
+static void media_debug_default(void *ptr, ...)
+{
+}
+
+void media_debug_set_handler(struct media_device *media,
+                            void (*debug_handler)(void *, ...),
+                            void *debug_priv)
+{
+       if (debug_handler) {
+               media->debug_handler = debug_handler;
+               media->debug_priv = debug_priv;
+       } else {
+               media->debug_handler = media_debug_default;
+               media->debug_priv = NULL;
+       }
+}
+
+struct media_device *media_open_debug(
+       const char *name, void (*debug_handler)(void *, ...),
+       void *debug_priv)
 {
        struct media_device *media;
        int ret;
 
        media = calloc(1, sizeof(*media));
-       if (media == NULL) {
-               dprintf("%s: unable to allocate memory\n", __func__);
+       if (media == NULL)
                return NULL;
-       }
 
-       if (verbose)
-               dprintf("Opening media device %s\n", name);
+       media_debug_set_handler(media, debug_handler, debug_priv);
+
+       media_dbg(media, "Opening media device %s\n", name);
 
        media->fd = open(name, O_RDWR);
        if (media->fd < 0) {
                media_close(media);
-               dprintf("%s: Can't open media device %s\n", __func__, name);
+               media_dbg(media, "%s: Can't open media device %s\n",
+                         __func__, name);
+               return NULL;
+       }
+
+       ret = ioctl(media->fd, MEDIA_IOC_DEVICE_INFO, &media->info);
+       if (ret < 0) {
+               media_dbg(media, "%s: Unable to retrieve media device "
+                         "information for device %s (%s)\n", __func__,
+                         name, strerror(errno));
+               media_close(media);
                return NULL;
        }
 
-       if (verbose)
-               dprintf("Enumerating entities\n");
+       media_dbg(media, "Enumerating entities\n");
 
-       ret = media_enum_entities(media, verbose);
+       ret = media_enum_entities(media);
 
        if (ret < 0) {
-               dprintf("%s: Unable to enumerate entities for device %s (%s)\n",
-                       __func__, name, strerror(-ret));
+               media_dbg(media,
+                         "%s: Unable to enumerate entities for device %s (%s)\n",
+                         __func__, name, strerror(-ret));
                media_close(media);
                return NULL;
        }
 
-       if (verbose) {
-               dprintf("Found %u entities\n", media->entities_count);
-               dprintf("Enumerating pads and links\n");
-       }
+       media_dbg(media, "Found %u entities\n", media->entities_count);
+       media_dbg(media, "Enumerating pads and links\n");
 
        ret = media_enum_links(media);
        if (ret < 0) {
-               dprintf("%s: Unable to enumerate pads and linksfor device %s\n",
-                       __func__, name);
+               media_dbg(media,
+                         "%s: Unable to enumerate pads and linksfor device %s\n",
+                         __func__, name);
                media_close(media);
                return NULL;
        }
@@ -460,6 +500,11 @@ struct media_device *media_open(const char *name, int verbose)
        return media;
 }
 
+struct media_device *media_open(const char *name)
+{
+       return media_open_debug(name, NULL, NULL);
+}
+
 void media_close(struct media_device *media)
 {
        unsigned int i;
@@ -566,30 +611,32 @@ int media_parse_setup_link(struct media_device *media,
 
        link = media_parse_link(media, p, &end);
        if (link == NULL) {
-               dprintf("Unable to parse link\n");
+               media_dbg(media,
+                         "%s: Unable to parse link\n", __func__);
                return -EINVAL;
        }
 
        p = end;
        if (*p++ != '[') {
-               dprintf("Unable to parse link flags\n");
+               media_dbg(media, "Unable to parse link flags\n");
                return -EINVAL;
        }
 
        flags = strtoul(p, &end, 10);
        for (p = end; isspace(*p); p++);
        if (*p++ != ']') {
-               dprintf("Unable to parse link flags\n");
+               media_dbg(media, "Unable to parse link flags\n");
                return -EINVAL;
        }
 
        for (; isspace(*p); p++);
        *endp = (char *)p;
 
-       dprintf("Setting up link %u:%u -> %u:%u [%u]\n",
-               link->source->entity->info.id, link->source->index,
-               link->sink->entity->info.id, link->sink->index,
-               flags);
+       media_dbg(media,
+                 "Setting up link %u:%u -> %u:%u [%u]\n",
+                 link->source->entity->info.id, link->source->index,
+                 link->sink->entity->info.id, link->sink->index,
+                 flags);
 
        return media_setup_link(media, link->source, link->sink, flags);
 }