Configure cropping on output pads before setting the format
[media-ctl.git] / main.c
diff --git a/main.c b/main.c
index 9b8951a..15ccfb2 100644 (file)
--- a/main.c
+++ b/main.c
@@ -61,13 +61,14 @@ static struct media_entity_pad *parse_pad(struct media_device *media, const char
                if (entity == NULL)
                        return NULL;
 
-               for (++end; isspace(*end); ++end);
+               ++end;
        } else {
                entity_id = strtoul(p, &end, 10);
                entity = media_get_entity_by_id(media, entity_id);
                if (entity == NULL)
                        return NULL;
        }
+       for (; isspace(*end); ++end);
 
        if (*end != ':')
                return NULL;
@@ -230,9 +231,28 @@ static int parse_crop(struct v4l2_rect *crop, const char *p, char **endp)
        return 0;
 }
 
+static int parse_frame_interval(struct v4l2_fract *interval, const char *p, char **endp)
+{
+       char *end;
+
+       for (; isspace(*p); ++p);
+
+       interval->numerator = strtoul(p, &end, 10);
+
+       for (p = end; isspace(*p); ++p);
+       if (*p++ != '/')
+               return -EINVAL;
+
+       for (; isspace(*p); ++p);
+       interval->denominator = strtoul(p, &end, 10);
+
+       *endp = end;
+       return 0;
+}
+
 static struct media_entity_pad *parse_pad_format(struct media_device *media,
        struct v4l2_mbus_framefmt *format, struct v4l2_rect *crop,
-       const char *p, char **endp)
+       struct v4l2_fract *interval, const char *p, char **endp)
 {
        struct media_entity_pad *pad;
        char *end;
@@ -253,7 +273,7 @@ static struct media_entity_pad *parse_pad_format(struct media_device *media,
                return NULL;
 
        for (p = end; isspace(*p); p++);
-       if (*p != ']') {
+       if (isdigit(*p)) {
                ret = parse_crop(crop, p, &end);
                if (ret < 0)
                        return NULL;
@@ -261,6 +281,14 @@ static struct media_entity_pad *parse_pad_format(struct media_device *media,
                for (p = end; isspace(*p); p++);
        }
 
+       if (*p == '@') {
+               ret = parse_frame_interval(interval, ++p, &end);
+               if (ret < 0)
+                       return NULL;
+
+               for (p = end; isspace(*p); p++);
+       }
+
        if (*p != ']')
                return NULL;
 
@@ -293,6 +321,9 @@ static int set_crop(struct media_entity_pad *pad, struct v4l2_rect *crop)
 {
        int ret;
 
+       if (crop->left == -1 || crop->top == -1)
+               return 0;
+
        printf("Setting up crop rectangle %u,%u/%ux%u on pad %s/%u\n",
                crop->left, crop->top, crop->width, crop->height,
                pad->entity->info.name, pad->index);
@@ -310,31 +341,62 @@ static int set_crop(struct media_entity_pad *pad, struct v4l2_rect *crop)
        return 0;
 }
 
+static int set_frame_interval(struct media_entity *entity, struct v4l2_fract *interval)
+{
+       int ret;
+
+       printf("Setting up frame interval %u/%u on entity %s\n",
+               interval->numerator, interval->denominator, entity->info.name);
+
+       ret = v4l2_subdev_set_frame_interval(entity, interval);
+       if (ret < 0) {
+               printf("Unable to set frame interval: %s (%d)", strerror(-ret), ret);
+               return ret;
+       }
+
+       printf("Frame interval set: %u/%u\n",
+               interval->numerator, interval->denominator);
+
+       return 0;
+}
+
+
 static int setup_format(struct media_device *media, const char *p, char **endp)
 {
        struct v4l2_mbus_framefmt format;
        struct media_entity_pad *pad;
        struct v4l2_rect crop = { -1, -1, -1, -1 };
+       struct v4l2_fract interval = { 0, 0 };
        unsigned int i;
        char *end;
        int ret;
 
-       pad = parse_pad_format(media, &format, &crop, p, &end);
+       pad = parse_pad_format(media, &format, &crop, &interval, p, &end);
        if (pad == NULL) {
                printf("Unable to parse format\n");
                return -EINVAL;
        }
 
+       if (pad->type == MEDIA_PAD_TYPE_OUTPUT) {
+               ret = set_crop(pad, &crop);
+               if (ret < 0)
+                       return ret;
+       }
+
        ret = set_format(pad, &format);
-       if (ret < 0) {
-               printf("Unable to set format\n");
+       if (ret < 0)
                return ret;
-       }
 
-       if (crop.left != -1 && crop.top != -1) {
+       if (pad->type == MEDIA_PAD_TYPE_INPUT) {
                ret = set_crop(pad, &crop);
+               if (ret < 0)
+                       return ret;
+       }
+
+       if (interval.numerator != 0) {
+               ret = set_frame_interval(pad->entity, &interval);
                if (ret < 0) {
-                       printf("Unable to set crop rectangle\n");
+                       printf("Unable to set frame interval\n");
                        return ret;
                }
        }