src/main.c

   1 /*
   2  * Media controller test application
   3  *
   4  * Copyright (C) 2010 Ideas on board SPRL <laurent.pinchart@ideasonboard.com>
   5  *
   6  * This program is free software; you can redistribute it and/or modify
   7  * it under the terms of the GNU General Public License as published by
   8  * the Free Software Foundation; either version 2 of the License, or
   9  * (at your option) any later version.
  10  *
  11  * This program is distributed in the hope that it will be useful,
  12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14  * GNU General Public License for more details.
  15  *
  16  * You should have received a copy of the GNU General Public License along
  17  * with this program; if not, write to the Free Software Foundation, Inc.,
  18  */
  19
  20 #include <sys/mman.h>
  21 #include <sys/ioctl.h>
  22 #include <sys/time.h>
  23 #include <sys/stat.h>
  24
  25 #include <ctype.h>
  26 #include <errno.h>
  27 #include <fcntl.h>
  28 #include <stdio.h>
  29 #include <stdlib.h>
  30 #include <string.h>
  31 #include <unistd.h>
  32
  33 #include <linux/types.h>
  34 #include <linux/media.h>
  35 #include <linux/v4l2-mediabus.h>
  36 #include <linux/v4l2-subdev.h>
  37 #include <linux/videodev2.h>
  38
  39 #include "media.h"
  40 #include "options.h"
  41 #include "subdev.h"
  42 #include "tools.h"
  43
  44 /* -----------------------------------------------------------------------------
  45  * Printing
  46  */
  47
  48 static struct {
  49         const char *name;
  50         enum v4l2_mbus_pixelcode code;
  51 } mbus_formats[] = {
  52         { "Y8", V4L2_MBUS_FMT_Y8_1X8},
  53         { "Y10", V4L2_MBUS_FMT_Y10_1X10 },
  54         { "Y12", V4L2_MBUS_FMT_Y12_1X12 },
  55         { "YUYV", V4L2_MBUS_FMT_YUYV8_1X16 },
  56         { "UYVY", V4L2_MBUS_FMT_UYVY8_1X16 },
  57         { "SBGGR8", V4L2_MBUS_FMT_SBGGR8_1X8 },
  58         { "SGBRG8", V4L2_MBUS_FMT_SGBRG8_1X8 },
  59         { "SGRBG8", V4L2_MBUS_FMT_SGRBG8_1X8 },
  60         { "SRGGB8", V4L2_MBUS_FMT_SRGGB8_1X8 },
  61         { "SBGGR10", V4L2_MBUS_FMT_SBGGR10_1X10 },
  62         { "SGBRG10", V4L2_MBUS_FMT_SGBRG10_1X10 },
  63         { "SGRBG10", V4L2_MBUS_FMT_SGRBG10_1X10 },
  64         { "SRGGB10", V4L2_MBUS_FMT_SRGGB10_1X10 },
  65         { "SBGGR10_DPCM8", V4L2_MBUS_FMT_SBGGR10_DPCM8_1X8 },
  66         { "SGBRG10_DPCM8", V4L2_MBUS_FMT_SGBRG10_DPCM8_1X8 },
  67         { "SGRBG10_DPCM8", V4L2_MBUS_FMT_SGRBG10_DPCM8_1X8 },
  68         { "SRGGB10_DPCM8", V4L2_MBUS_FMT_SRGGB10_DPCM8_1X8 },
  69         { "SBGGR12", V4L2_MBUS_FMT_SBGGR12_1X12 },
  70         { "SGBRG12", V4L2_MBUS_FMT_SGBRG12_1X12 },
  71         { "SGRBG12", V4L2_MBUS_FMT_SGRBG12_1X12 },
  72         { "SRGGB12", V4L2_MBUS_FMT_SRGGB12_1X12 },
  73 };
  74
  75 static const char *pixelcode_to_string(enum v4l2_mbus_pixelcode code)
  76 {
  77         unsigned int i;
  78
  79         for (i = 0; i < ARRAY_SIZE(mbus_formats); ++i) {
  80                 if (mbus_formats[i].code == code)
  81                         return mbus_formats[i].name;
  82         }
  83
  84         return "unknown";
  85 }
  86
  87 static enum v4l2_mbus_pixelcode string_to_pixelcode(const char *string,
  88                                              unsigned int length)
  89 {
  90         unsigned int i;
  91
  92         for (i = 0; i < ARRAY_SIZE(mbus_formats); ++i) {
  93                 if (strncmp(mbus_formats[i].name, string, length) == 0)
  94                         break;
  95         }
  96
  97         if (i == ARRAY_SIZE(mbus_formats))
  98                 return (enum v4l2_mbus_pixelcode)-1;
  99
 100         return mbus_formats[i].code;
 101 }
 102
 103 static void v4l2_subdev_print_format(struct media_entity *entity,
 104         unsigned int pad, enum v4l2_subdev_format_whence which)
 105 {
 106         struct v4l2_mbus_framefmt format;
 107         struct v4l2_rect rect;
 108         int ret;
 109
 110         ret = v4l2_subdev_get_format(entity, &format, pad, which);
 111         if (ret != 0)
 112                 return;
 113
 114         printf("[%s %ux%u", pixelcode_to_string(format.code),
 115                format.width, format.height);
 116
 117         ret = v4l2_subdev_get_crop(entity, &rect, pad, which);
 118         if (ret == 0)
 119                 printf(" (%u,%u)/%ux%u", rect.left, rect.top,
 120                        rect.width, rect.height);
 121         printf("]");
 122 }
 123
 124 static const char *media_entity_type_to_string(unsigned type)
 125 {
 126         static const struct {
 127                 __u32 type;
 128                 const char *name;
 129         } types[] = {
 130                 { MEDIA_ENT_T_DEVNODE, "Node" },
 131                 { MEDIA_ENT_T_V4L2_SUBDEV, "V4L2 subdev" },
 132         };
 133
 134         unsigned int i;
 135
 136         type &= MEDIA_ENT_TYPE_MASK;
 137
 138         for (i = 0; i < ARRAY_SIZE(types); i++) {
 139                 if (types[i].type == type)
 140                         return types[i].name;
 141         }
 142
 143         return "Unknown";
 144 }
 145
 146 static const char *media_entity_subtype_to_string(unsigned type)
 147 {
 148         static const char *node_types[] = {
 149                 "Unknown",
 150                 "V4L",
 151                 "FB",
 152                 "ALSA",
 153                 "DVB",
 154         };
 155         static const char *subdev_types[] = {
 156                 "Unknown",
 157                 "Sensor",
 158                 "Flash",
 159                 "Lens",
 160         };
 161
 162         unsigned int subtype = type & MEDIA_ENT_SUBTYPE_MASK;
 163
 164         switch (type & MEDIA_ENT_TYPE_MASK) {
 165         case MEDIA_ENT_T_DEVNODE:
 166                 if (subtype >= ARRAY_SIZE(node_types))
 167                         subtype = 0;
 168                 return node_types[subtype];
 169
 170         case MEDIA_ENT_T_V4L2_SUBDEV:
 171                 if (subtype >= ARRAY_SIZE(subdev_types))
 172                         subtype = 0;
 173                 return subdev_types[subtype];
 174         default:
 175                 return node_types[0];
 176         }
 177 }
 178
 179 static const char *media_pad_type_to_string(unsigned flag)
 180 {
 181         static const struct {
 182                 __u32 flag;
 183                 const char *name;
 184         } flags[] = {
 185                 { MEDIA_PAD_FL_SINK, "Input" },
 186                 { MEDIA_PAD_FL_SOURCE, "Output" },
 187         };
 188
 189         unsigned int i;
 190
 191         for (i = 0; i < ARRAY_SIZE(flags); i++) {
 192                 if (flags[i].flag & flag)
 193                         return flags[i].name;
 194         }
 195
 196         return "Unknown";
 197 }
 198
 199 static void media_print_topology_dot(struct media_device *media)
 200 {
 201         unsigned int i, j;
 202
 203         printf("digraph board {\n");
 204         printf("\trankdir=TB\n");
 205
 206         for (i = 0; i < media->entities_count; ++i) {
 207                 struct media_entity *entity = &media->entities[i];
 208                 unsigned int npads;
 209
 210                 switch (media_entity_type(entity)) {
 211                 case MEDIA_ENT_T_DEVNODE:
 212                         printf("\tn%08x [label=\"%s\\n%s\", shape=box, style=filled, "
 213                                "fillcolor=yellow]\n",
 214                                entity->info.id, entity->info.name, entity->devname);
 215                         break;
 216
 217                 case MEDIA_ENT_T_V4L2_SUBDEV:
 218                         printf("\tn%08x [label=\"{{", entity->info.id);
 219
 220                         for (j = 0, npads = 0; j < entity->info.pads; ++j) {
 221                                 if (!(entity->pads[j].flags & MEDIA_PAD_FL_SINK))
 222                                         continue;
 223
 224                                 printf("%s<port%u> %u", npads ? " | " : "", j, j);
 225                                 npads++;
 226                         }
 227
 228                         printf("} | %s", entity->info.name);
 229                         if (entity->devname)
 230                                 printf("\\n%s", entity->devname);
 231                         printf(" | {");
 232
 233                         for (j = 0, npads = 0; j < entity->info.pads; ++j) {
 234                                 if (!(entity->pads[j].flags & MEDIA_PAD_FL_SOURCE))
 235                                         continue;
 236
 237                                 printf("%s<port%u> %u", npads ? " | " : "", j, j);
 238                                 npads++;
 239                         }
 240
 241                         printf("}}\", shape=Mrecord, style=filled, fillcolor=green]\n");
 242                         break;
 243
 244                 default:
 245                         continue;
 246                 }
 247
 248                 for (j = 0; j < entity->num_links; j++) {
 249                         struct media_link *link = &entity->links[j];
 250
 251                         if (link->source->entity != entity)
 252                                 continue;
 253
 254                         printf("\tn%08x", link->source->entity->info.id);
 255                         if (media_entity_type(link->source->entity) == MEDIA_ENT_T_V4L2_SUBDEV)
 256                                 printf(":port%u", link->source->index);
 257                         printf(" -> ");
 258                         printf("n%08x", link->sink->entity->info.id);
 259                         if (media_entity_type(link->sink->entity) == MEDIA_ENT_T_V4L2_SUBDEV)
 260                                 printf(":port%u", link->sink->index);
 261
 262                         if (link->flags & MEDIA_LNK_FL_IMMUTABLE)
 263                                 printf(" [style=bold]");
 264                         else if (!(link->flags & MEDIA_LNK_FL_ENABLED))
 265                                 printf(" [style=dashed]");
 266                         printf("\n");
 267                 }
 268         }
 269
 270         printf("}\n");
 271 }
 272
 273 static void media_print_topology_text(struct media_device *media)
 274 {
 275         unsigned int i, j, k;
 276         unsigned int padding;
 277
 278         printf("Device topology\n");
 279
 280         for (i = 0; i < media->entities_count; ++i) {
 281                 struct media_entity *entity = &media->entities[i];
 282
 283                 padding = printf("- entity %u: ", entity->info.id);
 284                 printf("%s (%u pad%s, %u link%s)\n", entity->info.name,
 285                         entity->info.pads, entity->info.pads > 1 ? "s" : "",
 286                         entity->num_links, entity->num_links > 1 ? "s" : "");
 287                 printf("%*ctype %s subtype %s\n", padding, ' ',
 288                         media_entity_type_to_string(entity->info.type),
 289                         media_entity_subtype_to_string(entity->info.type));
 290                 if (entity->devname[0])
 291                         printf("%*cdevice node name %s\n", padding, ' ', entity->devname);
 292
 293                 for (j = 0; j < entity->info.pads; j++) {
 294                         struct media_pad *pad = &entity->pads[j];
 295
 296                         printf("\tpad%u: %s ", j, media_pad_type_to_string(pad->flags));
 297
 298                         if (media_entity_type(entity) == MEDIA_ENT_T_V4L2_SUBDEV)
 299                                 v4l2_subdev_print_format(entity, j, V4L2_SUBDEV_FORMAT_ACTIVE);
 300
 301                         printf("\n");
 302
 303                         for (k = 0; k < entity->num_links; k++) {
 304                                 struct media_link *link = &entity->links[k];
 305                                 struct media_pad *source = link->source;
 306                                 struct media_pad *sink = link->sink;
 307
 308                                 if (source->entity == entity && source->index == j)
 309                                         printf("\t\t-> '%s':pad%u [",
 310                                                 sink->entity->info.name, sink->index);
 311                                 else if (sink->entity == entity && sink->index == j)
 312                                         printf("\t\t<- '%s':pad%u [",
 313                                                 source->entity->info.name, source->index);
 314                                 else
 315                                         continue;
 316
 317                                 if (link->flags & MEDIA_LNK_FL_IMMUTABLE)
 318                                         printf("IMMUTABLE,");
 319                                 if (link->flags & MEDIA_LNK_FL_ENABLED)
 320                                         printf("ACTIVE");
 321
 322                                 printf("]\n");
 323                         }
 324                 }
 325                 printf("\n");
 326         }
 327 }
 328
 329 void media_print_topology(struct media_device *media, int dot)
 330 {
 331         if (dot)
 332                 media_print_topology_dot(media);
 333         else
 334                 media_print_topology_text(media);
 335 }
 336
 337 /* -----------------------------------------------------------------------------
 338  * Links setup
 339  */
 340
 341 static struct media_pad *parse_pad(struct media_device *media, const char *p, char **endp)
 342 {
 343         unsigned int entity_id, pad;
 344         struct media_entity *entity;
 345         char *end;
 346
 347         for (; isspace(*p); ++p);
 348
 349         if (*p == '"') {
 350                 for (end = (char *)p + 1; *end && *end != '"'; ++end);
 351                 if (*end != '"')
 352                         return NULL;
 353
 354                 entity = media_get_entity_by_name(media, p + 1, end - p - 1);
 355                 if (entity == NULL)
 356                         return NULL;
 357
 358                 ++end;
 359         } else {
 360                 entity_id = strtoul(p, &end, 10);
 361                 entity = media_get_entity_by_id(media, entity_id);
 362                 if (entity == NULL)
 363                         return NULL;
 364         }
 365         for (; isspace(*end); ++end);
 366
 367         if (*end != ':')
 368                 return NULL;
 369         for (p = end + 1; isspace(*p); ++p);
 370
 371         pad = strtoul(p, &end, 10);
 372         for (p = end; isspace(*p); ++p);
 373
 374         if (pad >= entity->info.pads)
 375                 return NULL;
 376
 377         for (p = end; isspace(*p); ++p);
 378         if (endp)
 379                 *endp = (char *)p;
 380
 381         return &entity->pads[pad];
 382 }
 383
 384 static struct media_link *parse_link(struct media_device *media, const char *p, char **endp)
 385 {
 386         struct media_link *link;
 387         struct media_pad *source;
 388         struct media_pad *sink;
 389         unsigned int i;
 390         char *end;
 391
 392         source = parse_pad(media, p, &end);
 393         if (source == NULL)
 394                 return NULL;
 395
 396         if (end[0] != '-' || end[1] != '>')
 397                 return NULL;
 398         p = end + 2;
 399
 400         sink = parse_pad(media, p, &end);
 401         if (sink == NULL)
 402                 return NULL;
 403
 404         *endp = end;
 405
 406         for (i = 0; i < source->entity->num_links; i++) {
 407                 link = &source->entity->links[i];
 408
 409                 if (link->source == source && link->sink == sink)
 410                         return link;
 411         }
 412
 413         return NULL;
 414 }
 415
 416 static int setup_link(struct media_device *media, const char *p, char **endp)
 417 {
 418         struct media_link *link;
 419         __u32 flags;
 420         char *end;
 421
 422         link = parse_link(media, p, &end);
 423         if (link == NULL) {
 424                 printf("Unable to parse link\n");
 425                 return -EINVAL;
 426         }
 427
 428         p = end;
 429         if (*p++ != '[') {
 430                 printf("Unable to parse link flags\n");
 431                 return -EINVAL;
 432         }
 433
 434         flags = strtoul(p, &end, 10);
 435         for (p = end; isspace(*p); p++);
 436         if (*p++ != ']') {
 437                 printf("Unable to parse link flags\n");
 438                 return -EINVAL;
 439         }
 440
 441         for (; isspace(*p); p++);
 442         *endp = (char *)p;
 443
 444         printf("Setting up link %u:%u -> %u:%u [%u]\n",
 445                 link->source->entity->info.id, link->source->index,
 446                 link->sink->entity->info.id, link->sink->index,
 447                 flags);
 448
 449         return media_setup_link(media, link->source, link->sink, flags);
 450 }
 451
 452 static int setup_links(struct media_device *media, const char *p)
 453 {
 454         char *end;
 455         int ret;
 456
 457         do {
 458                 ret = setup_link(media, p, &end);
 459                 if (ret < 0)
 460                         return ret;
 461
 462                 p = end + 1;
 463         } while (*end == ',');
 464
 465         return *end ? -EINVAL : 0;
 466 }
 467
 468 /* -----------------------------------------------------------------------------
 469  * Formats setup
 470  */
 471
 472 static int parse_format(struct v4l2_mbus_framefmt *format, const char *p, char **endp)
 473 {
 474         enum v4l2_mbus_pixelcode code;
 475         unsigned int width, height;
 476         char *end;
 477
 478         for (; isspace(*p); ++p);
 479         for (end = (char *)p; !isspace(*end) && *end != '\0'; ++end);
 480
 481         code = string_to_pixelcode(p, end - p);
 482         if (code == (enum v4l2_mbus_pixelcode)-1)
 483                 return -EINVAL;
 484
 485         for (p = end; isspace(*p); ++p);
 486         width = strtoul(p, &end, 10);
 487         if (*end != 'x')
 488                 return -EINVAL;
 489
 490         p = end + 1;
 491         height = strtoul(p, &end, 10);
 492         *endp = end;
 493
 494         memset(format, 0, sizeof(*format));
 495         format->width = width;
 496         format->height = height;
 497         format->code = code;
 498
 499         return 0;
 500 }
 501
 502 static int parse_crop(struct v4l2_rect *crop, const char *p, char **endp)
 503 {
 504         char *end;
 505
 506         if (*p++ != '(')
 507                 return -EINVAL;
 508
 509         crop->left = strtoul(p, &end, 10);
 510         if (*end != ',')
 511                 return -EINVAL;
 512
 513         p = end + 1;
 514         crop->top = strtoul(p, &end, 10);
 515         if (*end++ != ')')
 516                 return -EINVAL;
 517         if (*end != '/')
 518                 return -EINVAL;
 519
 520         p = end + 1;
 521         crop->width = strtoul(p, &end, 10);
 522         if (*end != 'x')
 523                 return -EINVAL;
 524
 525         p = end + 1;
 526         crop->height = strtoul(p, &end, 10);
 527         *endp = end;
 528
 529         return 0;
 530 }
 531
 532 static int parse_frame_interval(struct v4l2_fract *interval, const char *p, char **endp)
 533 {
 534         char *end;
 535
 536         for (; isspace(*p); ++p);
 537
 538         interval->numerator = strtoul(p, &end, 10);
 539
 540         for (p = end; isspace(*p); ++p);
 541         if (*p++ != '/')
 542                 return -EINVAL;
 543
 544         for (; isspace(*p); ++p);
 545         interval->denominator = strtoul(p, &end, 10);
 546
 547         *endp = end;
 548         return 0;
 549 }
 550
 551 static struct media_pad *parse_pad_format(struct media_device *media,
 552         struct v4l2_mbus_framefmt *format, struct v4l2_rect *crop,
 553         struct v4l2_fract *interval, const char *p, char **endp)
 554 {
 555         struct media_pad *pad;
 556         char *end;
 557         int ret;
 558
 559         for (; isspace(*p); ++p);
 560
 561         pad = parse_pad(media, p, &end);
 562         if (pad == NULL)
 563                 return NULL;
 564
 565         for (p = end; isspace(*p); ++p);
 566         if (*p++ != '[')
 567                 return NULL;
 568
 569         for (; isspace(*p); ++p);
 570
 571         if (isalnum(*p)) {
 572                 ret = parse_format(format, p, &end);
 573                 if (ret < 0)
 574                         return NULL;
 575
 576                 for (p = end; isspace(*p); p++);
 577         }
 578
 579         if (*p == '(') {
 580                 ret = parse_crop(crop, p, &end);
 581                 if (ret < 0)
 582                         return NULL;
 583
 584                 for (p = end; isspace(*p); p++);
 585         }
 586
 587         if (*p == '@') {
 588                 ret = parse_frame_interval(interval, ++p, &end);
 589                 if (ret < 0)
 590                         return NULL;
 591
 592                 for (p = end; isspace(*p); p++);
 593         }
 594
 595         if (*p != ']')
 596                 return NULL;
 597
 598         *endp = (char *)p + 1;
 599         return pad;
 600 }
 601
 602 static int set_format(struct media_pad *pad, struct v4l2_mbus_framefmt *format)
 603 {
 604         int ret;
 605
 606         if (format->width == 0 || format->height == 0)
 607                 return 0;
 608
 609         printf("Setting up format %s %ux%u on pad %s/%u\n",
 610                 pixelcode_to_string(format->code), format->width, format->height,
 611                 pad->entity->info.name, pad->index);
 612
 613         ret = v4l2_subdev_set_format(pad->entity, format, pad->index,
 614                                      V4L2_SUBDEV_FORMAT_ACTIVE);
 615         if (ret < 0) {
 616                 printf("Unable to set format: %s (%d)\n", strerror(-ret), ret);
 617                 return ret;
 618         }
 619
 620         printf("Format set: %s %ux%u\n",
 621                 pixelcode_to_string(format->code), format->width, format->height);
 622
 623         return 0;
 624 }
 625
 626 static int set_crop(struct media_pad *pad, struct v4l2_rect *crop)
 627 {
 628         int ret;
 629
 630         if (crop->left == -1 || crop->top == -1)
 631                 return 0;
 632
 633         printf("Setting up crop rectangle (%u,%u)/%ux%u on pad %s/%u\n",
 634                 crop->left, crop->top, crop->width, crop->height,
 635                 pad->entity->info.name, pad->index);
 636
 637         ret = v4l2_subdev_set_crop(pad->entity, crop, pad->index,
 638                                    V4L2_SUBDEV_FORMAT_ACTIVE);
 639         if (ret < 0) {
 640                 printf("Unable to set crop rectangle: %s (%d)\n", strerror(-ret), ret);
 641                 return ret;
 642         }
 643
 644         printf("Crop rectangle set: (%u,%u)/%ux%u\n",
 645                 crop->left, crop->top, crop->width, crop->height);
 646
 647         return 0;
 648 }
 649
 650 static int set_frame_interval(struct media_entity *entity, struct v4l2_fract *interval)
 651 {
 652         int ret;
 653
 654         if (interval->numerator == 0)
 655                 return 0;
 656
 657         printf("Setting up frame interval %u/%u on entity %s\n",
 658                 interval->numerator, interval->denominator, entity->info.name);
 659
 660         ret = v4l2_subdev_set_frame_interval(entity, interval);
 661         if (ret < 0) {
 662                 printf("Unable to set frame interval: %s (%d)", strerror(-ret), ret);
 663                 return ret;
 664         }
 665
 666         printf("Frame interval set: %u/%u\n",
 667                 interval->numerator, interval->denominator);
 668
 669         return 0;
 670 }
 671
 672
 673 static int setup_format(struct media_device *media, const char *p, char **endp)
 674 {
 675         struct v4l2_mbus_framefmt format = { 0, 0, 0 };
 676         struct media_pad *pad;
 677         struct v4l2_rect crop = { -1, -1, -1, -1 };
 678         struct v4l2_fract interval = { 0, 0 };
 679         unsigned int i;
 680         char *end;
 681         int ret;
 682
 683         pad = parse_pad_format(media, &format, &crop, &interval, p, &end);
 684         if (pad == NULL) {
 685                 printf("Unable to parse format\n");
 686                 return -EINVAL;
 687         }
 688
 689         if (pad->flags & MEDIA_PAD_FL_SOURCE) {
 690                 ret = set_crop(pad, &crop);
 691                 if (ret < 0)
 692                         return ret;
 693         }
 694
 695         ret = set_format(pad, &format);
 696         if (ret < 0)
 697                 return ret;
 698
 699         if (pad->flags & MEDIA_PAD_FL_SINK) {
 700                 ret = set_crop(pad, &crop);
 701                 if (ret < 0)
 702                         return ret;
 703         }
 704
 705         ret = set_frame_interval(pad->entity, &interval);
 706         if (ret < 0)
 707                 return ret;
 708
 709
 710         /* If the pad is an output pad, automatically set the same format on
 711          * the remote subdev input pads, if any.
 712          */
 713         if (pad->flags & MEDIA_PAD_FL_SOURCE) {
 714                 for (i = 0; i < pad->entity->num_links; ++i) {
 715                         struct media_link *link = &pad->entity->links[i];
 716                         struct v4l2_mbus_framefmt remote_format;
 717
 718                         if (!(link->flags & MEDIA_LNK_FL_ENABLED))
 719                                 continue;
 720
 721                         if (link->source == pad &&
 722                             link->sink->entity->info.type == MEDIA_ENT_T_V4L2_SUBDEV) {
 723                                 remote_format = format;
 724                                 set_format(link->sink, &remote_format);
 725                         }
 726                 }
 727         }
 728
 729         *endp = end;
 730         return 0;
 731 }
 732
 733 static int setup_formats(struct media_device *media, const char *p)
 734 {
 735         char *end;
 736         int ret;
 737
 738         do {
 739                 ret = setup_format(media, p, &end);
 740                 if (ret < 0)
 741                         return ret;
 742
 743                 p = end + 1;
 744         } while (*end == ',');
 745
 746         return *end ? -EINVAL : 0;
 747 }
 748
 749 int main(int argc, char **argv)
 750 {
 751         struct media_device *media;
 752         int ret = -1;
 753
 754         if (parse_cmdline(argc, argv))
 755                 return EXIT_FAILURE;
 756
 757         /* Open the media device and enumerate entities, pads and links. */
 758         media = media_open(media_opts.devname, media_opts.verbose);
 759         if (media == NULL)
 760                 goto out;
 761
 762         if (media_opts.entity) {
 763                 struct media_entity *entity;
 764
 765                 entity = media_get_entity_by_name(media, media_opts.entity,
 766                                                   strlen(media_opts.entity));
 767                 if (entity == NULL) {
 768                         printf("Entity '%s' not found\n", media_opts.entity);
 769                         goto out;
 770                 }
 771
 772                 printf("%s\n", entity->devname);
 773         }
 774
 775         if (media_opts.pad) {
 776                 struct media_pad *pad;
 777
 778                 pad = parse_pad(media, media_opts.pad, NULL);
 779                 if (pad == NULL) {
 780                         printf("Pad '%s' not found\n", media_opts.pad);
 781                         goto out;
 782                 }
 783
 784                 v4l2_subdev_print_format(pad->entity, pad->index,
 785                                          V4L2_SUBDEV_FORMAT_ACTIVE);
 786                 printf("\n");
 787         }
 788
 789         if (media_opts.print || media_opts.print_dot) {
 790                 media_print_topology(media, media_opts.print_dot);
 791                 printf("\n");
 792         }
 793
 794         if (media_opts.reset) {
 795                 printf("Resetting all links to inactive\n");
 796                 media_reset_links(media);
 797         }
 798
 799         if (media_opts.links)
 800                 setup_links(media, media_opts.links);
 801
 802         if (media_opts.formats)
 803                 setup_formats(media, media_opts.formats);
 804
 805         if (media_opts.interactive) {
 806                 while (1) {
 807                         char buffer[32];
 808                         char *end;
 809
 810                         printf("Enter a link to modify or enter to stop\n");
 811                         if (fgets(buffer, sizeof buffer, stdin) == NULL)
 812                                 break;
 813
 814                         if (buffer[0] == '\n')
 815                                 break;
 816
 817                         setup_link(media, buffer, &end);
 818                 }
 819         }
 820
 821         ret = 0;
 822
 823 out:
 824         if (media)
 825                 media_close(media);
 826
 827         return ret ? EXIT_FAILURE : EXIT_SUCCESS;
 828 }
 829