Split media_device creation and opening
[media-ctl.git] / src / mediactl.c
index 46562de..2b054e9 100644 (file)
 #include <sys/stat.h>
 #include <sys/types.h>
 
-#include <unistd.h>
+#include <ctype.h>
+#include <errno.h>
+#include <fcntl.h>
 #include <stdbool.h>
 #include <stdio.h>
 #include <stdlib.h>
 #include <string.h>
-#include <fcntl.h>
-#include <errno.h>
+#include <unistd.h>
 
-#include <linux/videodev2.h>
 #include <linux/media.h>
+#include <linux/videodev2.h>
 
 #include "mediactl.h"
 #include "tools.h"
@@ -100,6 +101,42 @@ struct media_entity *media_get_entity_by_id(struct media_device *media,
        return NULL;
 }
 
+/* -----------------------------------------------------------------------------
+ * Open/close
+ */
+
+static int media_device_open(struct media_device *media)
+{
+       int ret;
+
+       if (media->fd != -1)
+               return 0;
+
+       media_dbg(media, "Opening media device %s\n", media->devnode);
+
+       media->fd = open(media->devnode, O_RDWR);
+       if (media->fd < 0) {
+               ret = -errno;
+               media_dbg(media, "%s: Can't open media device %s\n",
+                         __func__, media->devnode);
+               return ret;
+       }
+
+       return 0;
+}
+
+static void media_device_close(struct media_device *media)
+{
+       if (media->fd != -1) {
+               close(media->fd);
+               media->fd = -1;
+       }
+}
+
+/* -----------------------------------------------------------------------------
+ * Link setup
+ */
+
 int media_setup_link(struct media_device *media,
                     struct media_pad *source,
                     struct media_pad *sink,
@@ -110,6 +147,10 @@ int media_setup_link(struct media_device *media,
        unsigned int i;
        int ret;
 
+       ret = media_device_open(media);
+       if (ret < 0)
+               goto done;
+
        for (i = 0; i < source->entity->num_links; i++) {
                link = &source->entity->links[i];
 
@@ -122,7 +163,8 @@ int media_setup_link(struct media_device *media,
 
        if (i == source->entity->num_links) {
                media_dbg(media, "%s: Link not found\n", __func__);
-               return -ENOENT;
+               ret = -ENOENT;
+               goto done;
        }
 
        /* source pad */
@@ -139,14 +181,20 @@ int media_setup_link(struct media_device *media,
 
        ret = ioctl(media->fd, MEDIA_IOC_SETUP_LINK, &ulink);
        if (ret == -1) {
+               ret = -errno;
                media_dbg(media, "%s: Unable to setup link (%s)\n",
                          __func__, strerror(errno));
-               return -errno;
+               goto done;
        }
 
        link->flags = ulink.flags;
        link->twin->flags = ulink.flags;
-       return 0;
+
+       ret = 0;
+
+done:
+       media_device_close(media);
+       return ret;
 }
 
 int media_reset_links(struct media_device *media)
@@ -210,12 +258,13 @@ static int media_enum_links(struct media_device *media)
                links.links = calloc(entity->info.links, sizeof(struct media_link_desc));
 
                if (ioctl(media->fd, MEDIA_IOC_ENUM_LINKS, &links) < 0) {
+                       ret = -errno;
                        media_dbg(media,
                                  "%s: Unable to enumerate pads and links (%s).\n",
                                  __func__, strerror(errno));
                        free(links.pads);
                        free(links.links);
-                       return -errno;
+                       return ret;
                }
 
                for (i = 0; i < entity->info.pads; ++i) {
@@ -424,6 +473,58 @@ static int media_enum_entities(struct media_device *media)
        return ret;
 }
 
+int media_device_enumerate(struct media_device *media)
+{
+       int ret;
+
+       if (media->entities)
+               return 0;
+
+       ret = media_device_open(media);
+       if (ret < 0)
+               return ret;
+
+       ret = ioctl(media->fd, MEDIA_IOC_DEVICE_INFO, &media->info);
+       if (ret < 0) {
+               ret = -errno;
+               media_dbg(media, "%s: Unable to retrieve media device "
+                         "information for device %s (%s)\n", __func__,
+                         media->devnode, strerror(errno));
+               goto done;
+       }
+
+       media_dbg(media, "Enumerating entities\n");
+
+       ret = media_enum_entities(media);
+       if (ret < 0) {
+               media_dbg(media,
+                         "%s: Unable to enumerate entities for device %s (%s)\n",
+                         __func__, media->devnode, strerror(-ret));
+               goto done;
+       }
+
+       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) {
+               media_dbg(media,
+                         "%s: Unable to enumerate pads and linksfor device %s\n",
+                         __func__, media->devnode);
+               goto done;
+       }
+
+       ret = 0;
+
+done:
+       media_device_close(media);
+       return ret;
+}
+
+/* -----------------------------------------------------------------------------
+ * Create/destroy
+ */
+
 static void media_debug_default(void *ptr, ...)
 {
 }
@@ -441,9 +542,7 @@ void media_debug_set_handler(struct media_device *media,
        }
 }
 
-struct media_device *media_open_debug(
-       const char *name, void (*debug_handler)(void *, ...),
-       void *debug_priv)
+struct media_device *media_device_new(const char *devnode)
 {
        struct media_device *media;
        int ret;
@@ -452,65 +551,33 @@ struct media_device *media_open_debug(
        if (media == NULL)
                return NULL;
 
-       media_debug_set_handler(media, debug_handler, debug_priv);
+       media->fd = -1;
+       media->refcount = 1;
 
-       media_dbg(media, "Opening media device %s\n", name);
+       media_debug_set_handler(media, NULL, NULL);
 
-       media->fd = open(name, O_RDWR);
-       if (media->fd < 0) {
-               media_close(media);
-               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;
-       }
-
-       media_dbg(media, "Enumerating entities\n");
-
-       ret = media_enum_entities(media);
-
-       if (ret < 0) {
-               media_dbg(media,
-                         "%s: Unable to enumerate entities for device %s (%s)\n",
-                         __func__, name, strerror(-ret));
-               media_close(media);
-               return NULL;
-       }
-
-       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) {
-               media_dbg(media,
-                         "%s: Unable to enumerate pads and linksfor device %s\n",
-                         __func__, name);
-               media_close(media);
+       media->devnode = strdup(devnode);
+       if (media->devnode == NULL) {
+               media_device_unref(media);
                return NULL;
        }
 
        return media;
 }
 
-struct media_device *media_open(const char *name)
+struct media_device *media_device_ref(struct media_device *media)
 {
-       return media_open_debug(name, NULL, NULL);
+       media->refcount++;
+       return media;
 }
 
-void media_close(struct media_device *media)
+void media_device_unref(struct media_device *media)
 {
        unsigned int i;
 
-       if (media->fd != -1)
-               close(media->fd);
+       media->refcount--;
+       if (media->refcount > 0)
+               return;
 
        for (i = 0; i < media->entities_count; ++i) {
                struct media_entity *entity = &media->entities[i];
@@ -522,9 +589,14 @@ void media_close(struct media_device *media)
        }
 
        free(media->entities);
+       free(media->devnode);
        free(media);
 }
 
+/* -----------------------------------------------------------------------------
+ * Parsing
+ */
+
 struct media_pad *media_parse_pad(struct media_device *media,
                                  const char *p, char **endp)
 {
@@ -532,39 +604,60 @@ struct media_pad *media_parse_pad(struct media_device *media,
        struct media_entity *entity;
        char *end;
 
+       /* endp can be NULL. To avoid spreading NULL checks across the function,
+        * set endp to &end in that case.
+        */
+       if (endp == NULL)
+               endp = &end;
+
        for (; isspace(*p); ++p);
 
-       if (*p == '"') {
-               for (end = (char *)p + 1; *end && *end != '"'; ++end);
-               if (*end != '"')
+       if (*p == '"' || *p == '\'') {
+               for (end = (char *)p + 1; *end && *end != '"' && *end != '\''; ++end);
+               if (*end != '"' && *end != '\'') {
+                       media_dbg(media, "missing matching '\"'\n");
+                       *endp = end;
                        return NULL;
+               }
 
                entity = media_get_entity_by_name(media, p + 1, end - p - 1);
-               if (entity == NULL)
+               if (entity == NULL) {
+                       media_dbg(media, "no such entity \"%.*s\"\n", end - p - 1, p + 1);
+                       *endp = (char *)p + 1;
                        return NULL;
+               }
 
                ++end;
        } else {
                entity_id = strtoul(p, &end, 10);
                entity = media_get_entity_by_id(media, entity_id);
-               if (entity == NULL)
+               if (entity == NULL) {
+                       media_dbg(media, "no such entity %d\n", entity_id);
+                       *endp = (char *)p;
                        return NULL;
+               }
        }
        for (; isspace(*end); ++end);
 
-       if (*end != ':')
+       if (*end != ':') {
+               media_dbg(media, "Expected ':'\n", *end);
+               *endp = end;
                return NULL;
+       }
+
        for (p = end + 1; isspace(*p); ++p);
 
        pad = strtoul(p, &end, 10);
-       for (p = end; isspace(*p); ++p);
 
-       if (pad >= entity->info.pads)
+       if (pad >= entity->info.pads) {
+               media_dbg(media, "No pad '%d' on entity \"%s\". Maximum pad number is %d\n",
+                               pad, entity->info.name, entity->info.pads - 1);
+               *endp = (char *)p;
                return NULL;
+       }
 
        for (p = end; isspace(*p); ++p);
-       if (endp)
-               *endp = (char *)p;
+       *endp = (char *)p;
 
        return &entity->pads[pad];
 }
@@ -579,16 +672,24 @@ struct media_link *media_parse_link(struct media_device *media,
        char *end;
 
        source = media_parse_pad(media, p, &end);
-       if (source == NULL)
+       if (source == NULL) {
+               *endp = end;
                return NULL;
+       }
 
-       if (end[0] != '-' || end[1] != '>')
+       if (end[0] != '-' || end[1] != '>') {
+               *endp = end;
+               media_dbg(media, "Expected '->'\n");
                return NULL;
+       }
+
        p = end + 2;
 
        sink = media_parse_pad(media, p, &end);
-       if (sink == NULL)
+       if (sink == NULL) {
+               *endp = end;
                return NULL;
+       }
 
        *endp = end;
 
@@ -599,6 +700,9 @@ struct media_link *media_parse_link(struct media_device *media,
                        return link;
        }
 
+       media_dbg(media, "No link between \"%s\":%d and \"%s\":%d\n",
+                       source->entity->info.name, source->index,
+                       sink->entity->info.name, sink->index);
        return NULL;
 }
 
@@ -613,19 +717,22 @@ int media_parse_setup_link(struct media_device *media,
        if (link == NULL) {
                media_dbg(media,
                          "%s: Unable to parse link\n", __func__);
+               *endp = end;
                return -EINVAL;
        }
 
        p = end;
        if (*p++ != '[') {
-               media_dbg(media, "Unable to parse link flags\n");
+               media_dbg(media, "Unable to parse link flags: expected '['.\n");
+               *endp = (char *)p - 1;
                return -EINVAL;
        }
 
        flags = strtoul(p, &end, 10);
        for (p = end; isspace(*p); p++);
        if (*p++ != ']') {
-               media_dbg(media, "Unable to parse link flags\n");
+               media_dbg(media, "Unable to parse link flags: expected ']'.\n");
+               *endp = (char *)p - 1;
                return -EINVAL;
        }
 
@@ -641,6 +748,23 @@ int media_parse_setup_link(struct media_device *media,
        return media_setup_link(media, link->source, link->sink, flags);
 }
 
+void media_print_streampos(struct media_device *media, const char *p,
+                          const char *end)
+{
+       int pos;
+
+       pos = end - p + 1;
+
+       if (pos < 0)
+               pos = 0;
+       if (pos > strlen(p))
+               pos = strlen(p);
+
+       media_dbg(media, "\n");
+       media_dbg(media, " %s\n", p);
+       media_dbg(media, " %*s\n", pos, "^");
+}
+
 int media_parse_setup_links(struct media_device *media, const char *p)
 {
        char *end;
@@ -648,8 +772,10 @@ int media_parse_setup_links(struct media_device *media, const char *p)
 
        do {
                ret = media_parse_setup_link(media, p, &end);
-               if (ret < 0)
+               if (ret < 0) {
+                       media_print_streampos(media, p, end);
                        return ret;
+               }
 
                p = end + 1;
        } while (*end == ',');