modetest.c revision 636d5e9f
1/* 2 * DRM based mode setting test program 3 * Copyright 2008 Tungsten Graphics 4 * Jakob Bornecrantz <jakob@tungstengraphics.com> 5 * Copyright 2008 Intel Corporation 6 * Jesse Barnes <jesse.barnes@intel.com> 7 * 8 * Permission is hereby granted, free of charge, to any person obtaining a 9 * copy of this software and associated documentation files (the "Software"), 10 * to deal in the Software without restriction, including without limitation 11 * the rights to use, copy, modify, merge, publish, distribute, sublicense, 12 * and/or sell copies of the Software, and to permit persons to whom the 13 * Software is furnished to do so, subject to the following conditions: 14 * 15 * The above copyright notice and this permission notice shall be included in 16 * all copies or substantial portions of the Software. 17 * 18 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR 19 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, 20 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE 21 * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER 22 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING 23 * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS 24 * IN THE SOFTWARE. 25 */ 26 27/* 28 * This fairly simple test program dumps output in a similar format to the 29 * "xrandr" tool everyone knows & loves. It's necessarily slightly different 30 * since the kernel separates outputs into encoder and connector structures, 31 * each with their own unique ID. The program also allows test testing of the 32 * memory management and mode setting APIs by allowing the user to specify a 33 * connector and mode to use for mode setting. If all works as expected, a 34 * blue background should be painted on the monitor attached to the specified 35 * connector after the selected mode is set. 36 * 37 * TODO: use cairo to write the mode info on the selected output once 38 * the mode has been programmed, along with possible test patterns. 39 */ 40 41#include <assert.h> 42#include <ctype.h> 43#include <stdbool.h> 44#include <stdio.h> 45#include <stdlib.h> 46#include <stdint.h> 47#include <inttypes.h> 48#include <unistd.h> 49#include <string.h> 50#include <strings.h> 51#include <errno.h> 52#include <poll.h> 53#include <sys/time.h> 54#if HAVE_SYS_SELECT_H 55#include <sys/select.h> 56#endif 57#include <math.h> 58 59#include "xf86drm.h" 60#include "xf86drmMode.h" 61#include "drm_fourcc.h" 62 63#include "util/common.h" 64#include "util/format.h" 65#include "util/kms.h" 66#include "util/pattern.h" 67 68#include "buffers.h" 69#include "cursor.h" 70 71static enum util_fill_pattern primary_fill = UTIL_PATTERN_SMPTE; 72static enum util_fill_pattern secondary_fill = UTIL_PATTERN_TILES; 73 74struct crtc { 75 drmModeCrtc *crtc; 76 drmModeObjectProperties *props; 77 drmModePropertyRes **props_info; 78 drmModeModeInfo *mode; 79}; 80 81struct encoder { 82 drmModeEncoder *encoder; 83}; 84 85struct connector { 86 drmModeConnector *connector; 87 drmModeObjectProperties *props; 88 drmModePropertyRes **props_info; 89 char *name; 90}; 91 92struct fb { 93 drmModeFB *fb; 94}; 95 96struct plane { 97 drmModePlane *plane; 98 drmModeObjectProperties *props; 99 drmModePropertyRes **props_info; 100}; 101 102struct resources { 103 struct crtc *crtcs; 104 int count_crtcs; 105 struct encoder *encoders; 106 int count_encoders; 107 struct connector *connectors; 108 int count_connectors; 109 struct fb *fbs; 110 int count_fbs; 111 struct plane *planes; 112 uint32_t count_planes; 113}; 114 115struct device { 116 int fd; 117 118 struct resources *resources; 119 120 struct { 121 unsigned int width; 122 unsigned int height; 123 124 unsigned int fb_id; 125 struct bo *bo; 126 struct bo *cursor_bo; 127 } mode; 128 129 int use_atomic; 130 drmModeAtomicReq *req; 131}; 132 133static inline int64_t U642I64(uint64_t val) 134{ 135 return (int64_t)*((int64_t *)&val); 136} 137 138static float mode_vrefresh(drmModeModeInfo *mode) 139{ 140 return mode->clock * 1000.00 141 / (mode->htotal * mode->vtotal); 142} 143 144#define bit_name_fn(res) \ 145const char * res##_str(int type) { \ 146 unsigned int i; \ 147 const char *sep = ""; \ 148 for (i = 0; i < ARRAY_SIZE(res##_names); i++) { \ 149 if (type & (1 << i)) { \ 150 printf("%s%s", sep, res##_names[i]); \ 151 sep = ", "; \ 152 } \ 153 } \ 154 return NULL; \ 155} 156 157static const char *mode_type_names[] = { 158 "builtin", 159 "clock_c", 160 "crtc_c", 161 "preferred", 162 "default", 163 "userdef", 164 "driver", 165}; 166 167static bit_name_fn(mode_type) 168 169static const char *mode_flag_names[] = { 170 "phsync", 171 "nhsync", 172 "pvsync", 173 "nvsync", 174 "interlace", 175 "dblscan", 176 "csync", 177 "pcsync", 178 "ncsync", 179 "hskew", 180 "bcast", 181 "pixmux", 182 "dblclk", 183 "clkdiv2" 184}; 185 186static bit_name_fn(mode_flag) 187 188static void dump_fourcc(uint32_t fourcc) 189{ 190 printf(" %c%c%c%c", 191 fourcc, 192 fourcc >> 8, 193 fourcc >> 16, 194 fourcc >> 24); 195} 196 197static void dump_encoders(struct device *dev) 198{ 199 drmModeEncoder *encoder; 200 int i; 201 202 printf("Encoders:\n"); 203 printf("id\tcrtc\ttype\tpossible crtcs\tpossible clones\t\n"); 204 for (i = 0; i < dev->resources->count_encoders; i++) { 205 encoder = dev->resources->encoders[i].encoder; 206 if (!encoder) 207 continue; 208 209 printf("%d\t%d\t%s\t0x%08x\t0x%08x\n", 210 encoder->encoder_id, 211 encoder->crtc_id, 212 util_lookup_encoder_type_name(encoder->encoder_type), 213 encoder->possible_crtcs, 214 encoder->possible_clones); 215 } 216 printf("\n"); 217} 218 219static void dump_mode(drmModeModeInfo *mode, int index) 220{ 221 printf(" #%i %s %.2f %d %d %d %d %d %d %d %d %d", 222 index, 223 mode->name, 224 mode_vrefresh(mode), 225 mode->hdisplay, 226 mode->hsync_start, 227 mode->hsync_end, 228 mode->htotal, 229 mode->vdisplay, 230 mode->vsync_start, 231 mode->vsync_end, 232 mode->vtotal, 233 mode->clock); 234 235 printf(" flags: "); 236 mode_flag_str(mode->flags); 237 printf("; type: "); 238 mode_type_str(mode->type); 239 printf("\n"); 240} 241 242static void dump_blob(struct device *dev, uint32_t blob_id) 243{ 244 uint32_t i; 245 unsigned char *blob_data; 246 drmModePropertyBlobPtr blob; 247 248 blob = drmModeGetPropertyBlob(dev->fd, blob_id); 249 if (!blob) { 250 printf("\n"); 251 return; 252 } 253 254 blob_data = blob->data; 255 256 for (i = 0; i < blob->length; i++) { 257 if (i % 16 == 0) 258 printf("\n\t\t\t"); 259 printf("%.2hhx", blob_data[i]); 260 } 261 printf("\n"); 262 263 drmModeFreePropertyBlob(blob); 264} 265 266static const char *modifier_to_string(uint64_t modifier) 267{ 268 static char mod_string[4096]; 269 270 char *modifier_name = drmGetFormatModifierName(modifier); 271 char *vendor_name = drmGetFormatModifierVendor(modifier); 272 memset(mod_string, 0x00, sizeof(mod_string)); 273 274 if (!modifier_name) { 275 if (vendor_name) 276 snprintf(mod_string, sizeof(mod_string), "%s_%s", 277 vendor_name, "UNKNOWN_MODIFIER"); 278 else 279 snprintf(mod_string, sizeof(mod_string), "%s_%s", 280 "UNKNOWN_VENDOR", "UNKNOWN_MODIFIER"); 281 /* safe, as free is no-op for NULL */ 282 free(vendor_name); 283 return mod_string; 284 } 285 286 if (modifier == DRM_FORMAT_MOD_LINEAR) { 287 snprintf(mod_string, sizeof(mod_string), "%s", modifier_name); 288 free(modifier_name); 289 free(vendor_name); 290 return mod_string; 291 } 292 293 snprintf(mod_string, sizeof(mod_string), "%s_%s", 294 vendor_name, modifier_name); 295 296 free(modifier_name); 297 free(vendor_name); 298 return mod_string; 299} 300 301static void dump_in_formats(struct device *dev, uint32_t blob_id) 302{ 303 uint32_t i, j; 304 drmModePropertyBlobPtr blob; 305 struct drm_format_modifier_blob *header; 306 uint32_t *formats; 307 struct drm_format_modifier *modifiers; 308 309 printf("\t\tin_formats blob decoded:\n"); 310 blob = drmModeGetPropertyBlob(dev->fd, blob_id); 311 if (!blob) { 312 printf("\n"); 313 return; 314 } 315 316 header = blob->data; 317 formats = (uint32_t *) ((char *) header + header->formats_offset); 318 modifiers = (struct drm_format_modifier *) 319 ((char *) header + header->modifiers_offset); 320 321 for (i = 0; i < header->count_formats; i++) { 322 printf("\t\t\t"); 323 dump_fourcc(formats[i]); 324 printf(": "); 325 for (j = 0; j < header->count_modifiers; j++) { 326 uint64_t mask = 1ULL << i; 327 if (modifiers[j].formats & mask) 328 printf(" %s", modifier_to_string(modifiers[j].modifier)); 329 } 330 printf("\n"); 331 } 332 333 drmModeFreePropertyBlob(blob); 334} 335 336static void dump_prop(struct device *dev, drmModePropertyPtr prop, 337 uint32_t prop_id, uint64_t value) 338{ 339 int i; 340 printf("\t%d", prop_id); 341 if (!prop) { 342 printf("\n"); 343 return; 344 } 345 346 printf(" %s:\n", prop->name); 347 348 printf("\t\tflags:"); 349 if (prop->flags & DRM_MODE_PROP_PENDING) 350 printf(" pending"); 351 if (prop->flags & DRM_MODE_PROP_IMMUTABLE) 352 printf(" immutable"); 353 if (drm_property_type_is(prop, DRM_MODE_PROP_SIGNED_RANGE)) 354 printf(" signed range"); 355 if (drm_property_type_is(prop, DRM_MODE_PROP_RANGE)) 356 printf(" range"); 357 if (drm_property_type_is(prop, DRM_MODE_PROP_ENUM)) 358 printf(" enum"); 359 if (drm_property_type_is(prop, DRM_MODE_PROP_BITMASK)) 360 printf(" bitmask"); 361 if (drm_property_type_is(prop, DRM_MODE_PROP_BLOB)) 362 printf(" blob"); 363 if (drm_property_type_is(prop, DRM_MODE_PROP_OBJECT)) 364 printf(" object"); 365 printf("\n"); 366 367 if (drm_property_type_is(prop, DRM_MODE_PROP_SIGNED_RANGE)) { 368 printf("\t\tvalues:"); 369 for (i = 0; i < prop->count_values; i++) 370 printf(" %"PRId64, U642I64(prop->values[i])); 371 printf("\n"); 372 } 373 374 if (drm_property_type_is(prop, DRM_MODE_PROP_RANGE)) { 375 printf("\t\tvalues:"); 376 for (i = 0; i < prop->count_values; i++) 377 printf(" %"PRIu64, prop->values[i]); 378 printf("\n"); 379 } 380 381 if (drm_property_type_is(prop, DRM_MODE_PROP_ENUM)) { 382 printf("\t\tenums:"); 383 for (i = 0; i < prop->count_enums; i++) 384 printf(" %s=%llu", prop->enums[i].name, 385 prop->enums[i].value); 386 printf("\n"); 387 } else if (drm_property_type_is(prop, DRM_MODE_PROP_BITMASK)) { 388 printf("\t\tvalues:"); 389 for (i = 0; i < prop->count_enums; i++) 390 printf(" %s=0x%llx", prop->enums[i].name, 391 (1LL << prop->enums[i].value)); 392 printf("\n"); 393 } else { 394 assert(prop->count_enums == 0); 395 } 396 397 if (drm_property_type_is(prop, DRM_MODE_PROP_BLOB)) { 398 printf("\t\tblobs:\n"); 399 for (i = 0; i < prop->count_blobs; i++) 400 dump_blob(dev, prop->blob_ids[i]); 401 printf("\n"); 402 } else { 403 assert(prop->count_blobs == 0); 404 } 405 406 printf("\t\tvalue:"); 407 if (drm_property_type_is(prop, DRM_MODE_PROP_BLOB)) 408 dump_blob(dev, value); 409 else if (drm_property_type_is(prop, DRM_MODE_PROP_SIGNED_RANGE)) 410 printf(" %"PRId64"\n", value); 411 else 412 printf(" %"PRIu64"\n", value); 413 414 if (strcmp(prop->name, "IN_FORMATS") == 0) 415 dump_in_formats(dev, value); 416} 417 418static void dump_connectors(struct device *dev) 419{ 420 int i, j; 421 422 printf("Connectors:\n"); 423 printf("id\tencoder\tstatus\t\tname\t\tsize (mm)\tmodes\tencoders\n"); 424 for (i = 0; i < dev->resources->count_connectors; i++) { 425 struct connector *_connector = &dev->resources->connectors[i]; 426 drmModeConnector *connector = _connector->connector; 427 if (!connector) 428 continue; 429 430 printf("%d\t%d\t%s\t%-15s\t%dx%d\t\t%d\t", 431 connector->connector_id, 432 connector->encoder_id, 433 util_lookup_connector_status_name(connector->connection), 434 _connector->name, 435 connector->mmWidth, connector->mmHeight, 436 connector->count_modes); 437 438 for (j = 0; j < connector->count_encoders; j++) 439 printf("%s%d", j > 0 ? ", " : "", connector->encoders[j]); 440 printf("\n"); 441 442 if (connector->count_modes) { 443 printf(" modes:\n"); 444 printf("\tindex name refresh (Hz) hdisp hss hse htot vdisp " 445 "vss vse vtot\n"); 446 for (j = 0; j < connector->count_modes; j++) 447 dump_mode(&connector->modes[j], j); 448 } 449 450 if (_connector->props) { 451 printf(" props:\n"); 452 for (j = 0; j < (int)_connector->props->count_props; j++) 453 dump_prop(dev, _connector->props_info[j], 454 _connector->props->props[j], 455 _connector->props->prop_values[j]); 456 } 457 } 458 printf("\n"); 459} 460 461static void dump_crtcs(struct device *dev) 462{ 463 int i; 464 uint32_t j; 465 466 printf("CRTCs:\n"); 467 printf("id\tfb\tpos\tsize\n"); 468 for (i = 0; i < dev->resources->count_crtcs; i++) { 469 struct crtc *_crtc = &dev->resources->crtcs[i]; 470 drmModeCrtc *crtc = _crtc->crtc; 471 if (!crtc) 472 continue; 473 474 printf("%d\t%d\t(%d,%d)\t(%dx%d)\n", 475 crtc->crtc_id, 476 crtc->buffer_id, 477 crtc->x, crtc->y, 478 crtc->width, crtc->height); 479 dump_mode(&crtc->mode, 0); 480 481 if (_crtc->props) { 482 printf(" props:\n"); 483 for (j = 0; j < _crtc->props->count_props; j++) 484 dump_prop(dev, _crtc->props_info[j], 485 _crtc->props->props[j], 486 _crtc->props->prop_values[j]); 487 } else { 488 printf(" no properties found\n"); 489 } 490 } 491 printf("\n"); 492} 493 494static void dump_framebuffers(struct device *dev) 495{ 496 drmModeFB *fb; 497 int i; 498 499 printf("Frame buffers:\n"); 500 printf("id\tsize\tpitch\n"); 501 for (i = 0; i < dev->resources->count_fbs; i++) { 502 fb = dev->resources->fbs[i].fb; 503 if (!fb) 504 continue; 505 506 printf("%u\t(%ux%u)\t%u\n", 507 fb->fb_id, 508 fb->width, fb->height, 509 fb->pitch); 510 } 511 printf("\n"); 512} 513 514static void dump_planes(struct device *dev) 515{ 516 unsigned int i, j; 517 518 printf("Planes:\n"); 519 printf("id\tcrtc\tfb\tCRTC x,y\tx,y\tgamma size\tpossible crtcs\n"); 520 521 for (i = 0; i < dev->resources->count_planes; i++) { 522 struct plane *plane = &dev->resources->planes[i]; 523 drmModePlane *ovr = plane->plane; 524 if (!ovr) 525 continue; 526 527 printf("%d\t%d\t%d\t%d,%d\t\t%d,%d\t%-8d\t0x%08x\n", 528 ovr->plane_id, ovr->crtc_id, ovr->fb_id, 529 ovr->crtc_x, ovr->crtc_y, ovr->x, ovr->y, 530 ovr->gamma_size, ovr->possible_crtcs); 531 532 if (!ovr->count_formats) 533 continue; 534 535 printf(" formats:"); 536 for (j = 0; j < ovr->count_formats; j++) 537 dump_fourcc(ovr->formats[j]); 538 printf("\n"); 539 540 if (plane->props) { 541 printf(" props:\n"); 542 for (j = 0; j < plane->props->count_props; j++) 543 dump_prop(dev, plane->props_info[j], 544 plane->props->props[j], 545 plane->props->prop_values[j]); 546 } else { 547 printf(" no properties found\n"); 548 } 549 } 550 printf("\n"); 551 552 return; 553} 554 555static void free_resources(struct resources *res) 556{ 557 int i; 558 559 if (!res) 560 return; 561 562#define free_resource(_res, type, Type) \ 563 do { \ 564 if (!(_res)->type##s) \ 565 break; \ 566 for (i = 0; i < (int)(_res)->count_##type##s; ++i) { \ 567 if (!(_res)->type##s[i].type) \ 568 break; \ 569 drmModeFree##Type((_res)->type##s[i].type); \ 570 } \ 571 free((_res)->type##s); \ 572 } while (0) 573 574#define free_properties(_res, type) \ 575 do { \ 576 for (i = 0; i < (int)(_res)->count_##type##s; ++i) { \ 577 unsigned int j; \ 578 for (j = 0; j < res->type##s[i].props->count_props; ++j)\ 579 drmModeFreeProperty(res->type##s[i].props_info[j]);\ 580 free(res->type##s[i].props_info); \ 581 drmModeFreeObjectProperties(res->type##s[i].props); \ 582 } \ 583 } while (0) 584 585 free_properties(res, plane); 586 free_resource(res, plane, Plane); 587 588 free_properties(res, connector); 589 free_properties(res, crtc); 590 591 for (i = 0; i < res->count_connectors; i++) 592 free(res->connectors[i].name); 593 594 free_resource(res, fb, FB); 595 free_resource(res, connector, Connector); 596 free_resource(res, encoder, Encoder); 597 free_resource(res, crtc, Crtc); 598 599 free(res); 600} 601 602static struct resources *get_resources(struct device *dev) 603{ 604 drmModeRes *_res; 605 drmModePlaneRes *plane_res; 606 struct resources *res; 607 int i; 608 609 res = calloc(1, sizeof(*res)); 610 if (res == 0) 611 return NULL; 612 613 drmSetClientCap(dev->fd, DRM_CLIENT_CAP_UNIVERSAL_PLANES, 1); 614 615 _res = drmModeGetResources(dev->fd); 616 if (!_res) { 617 fprintf(stderr, "drmModeGetResources failed: %s\n", 618 strerror(errno)); 619 free(res); 620 return NULL; 621 } 622 623 res->count_crtcs = _res->count_crtcs; 624 res->count_encoders = _res->count_encoders; 625 res->count_connectors = _res->count_connectors; 626 res->count_fbs = _res->count_fbs; 627 628 res->crtcs = calloc(res->count_crtcs, sizeof(*res->crtcs)); 629 res->encoders = calloc(res->count_encoders, sizeof(*res->encoders)); 630 res->connectors = calloc(res->count_connectors, sizeof(*res->connectors)); 631 res->fbs = calloc(res->count_fbs, sizeof(*res->fbs)); 632 633 if (!res->crtcs || !res->encoders || !res->connectors || !res->fbs) { 634 drmModeFreeResources(_res); 635 goto error; 636 } 637 638#define get_resource(_res, __res, type, Type) \ 639 do { \ 640 for (i = 0; i < (int)(_res)->count_##type##s; ++i) { \ 641 uint32_t type##id = (__res)->type##s[i]; \ 642 (_res)->type##s[i].type = \ 643 drmModeGet##Type(dev->fd, type##id); \ 644 if (!(_res)->type##s[i].type) \ 645 fprintf(stderr, "could not get %s %i: %s\n", \ 646 #type, type##id, \ 647 strerror(errno)); \ 648 } \ 649 } while (0) 650 651 get_resource(res, _res, crtc, Crtc); 652 get_resource(res, _res, encoder, Encoder); 653 get_resource(res, _res, connector, Connector); 654 get_resource(res, _res, fb, FB); 655 656 drmModeFreeResources(_res); 657 658 /* Set the name of all connectors based on the type name and the per-type ID. */ 659 for (i = 0; i < res->count_connectors; i++) { 660 struct connector *connector = &res->connectors[i]; 661 drmModeConnector *conn = connector->connector; 662 int num; 663 664 num = asprintf(&connector->name, "%s-%u", 665 util_lookup_connector_type_name(conn->connector_type), 666 conn->connector_type_id); 667 if (num < 0) 668 goto error; 669 } 670 671#define get_properties(_res, type, Type) \ 672 do { \ 673 for (i = 0; i < (int)(_res)->count_##type##s; ++i) { \ 674 struct type *obj = &res->type##s[i]; \ 675 unsigned int j; \ 676 obj->props = \ 677 drmModeObjectGetProperties(dev->fd, obj->type->type##_id, \ 678 DRM_MODE_OBJECT_##Type); \ 679 if (!obj->props) { \ 680 fprintf(stderr, \ 681 "could not get %s %i properties: %s\n", \ 682 #type, obj->type->type##_id, \ 683 strerror(errno)); \ 684 continue; \ 685 } \ 686 obj->props_info = calloc(obj->props->count_props, \ 687 sizeof(*obj->props_info)); \ 688 if (!obj->props_info) \ 689 continue; \ 690 for (j = 0; j < obj->props->count_props; ++j) \ 691 obj->props_info[j] = \ 692 drmModeGetProperty(dev->fd, obj->props->props[j]); \ 693 } \ 694 } while (0) 695 696 get_properties(res, crtc, CRTC); 697 get_properties(res, connector, CONNECTOR); 698 699 for (i = 0; i < res->count_crtcs; ++i) 700 res->crtcs[i].mode = &res->crtcs[i].crtc->mode; 701 702 plane_res = drmModeGetPlaneResources(dev->fd); 703 if (!plane_res) { 704 fprintf(stderr, "drmModeGetPlaneResources failed: %s\n", 705 strerror(errno)); 706 return res; 707 } 708 709 res->count_planes = plane_res->count_planes; 710 711 res->planes = calloc(res->count_planes, sizeof(*res->planes)); 712 if (!res->planes) { 713 drmModeFreePlaneResources(plane_res); 714 goto error; 715 } 716 717 get_resource(res, plane_res, plane, Plane); 718 drmModeFreePlaneResources(plane_res); 719 get_properties(res, plane, PLANE); 720 721 return res; 722 723error: 724 free_resources(res); 725 return NULL; 726} 727 728static struct crtc *get_crtc_by_id(struct device *dev, uint32_t id) 729{ 730 int i; 731 732 for (i = 0; i < dev->resources->count_crtcs; ++i) { 733 drmModeCrtc *crtc = dev->resources->crtcs[i].crtc; 734 if (crtc && crtc->crtc_id == id) 735 return &dev->resources->crtcs[i]; 736 } 737 738 return NULL; 739} 740 741static uint32_t get_crtc_mask(struct device *dev, struct crtc *crtc) 742{ 743 unsigned int i; 744 745 for (i = 0; i < (unsigned int)dev->resources->count_crtcs; i++) { 746 if (crtc->crtc->crtc_id == dev->resources->crtcs[i].crtc->crtc_id) 747 return 1 << i; 748 } 749 /* Unreachable: crtc->crtc is one of resources->crtcs[] */ 750 /* Don't return zero or static analysers will complain */ 751 abort(); 752 return 0; 753} 754 755static drmModeConnector *get_connector_by_name(struct device *dev, const char *name) 756{ 757 struct connector *connector; 758 int i; 759 760 for (i = 0; i < dev->resources->count_connectors; i++) { 761 connector = &dev->resources->connectors[i]; 762 763 if (strcmp(connector->name, name) == 0) 764 return connector->connector; 765 } 766 767 return NULL; 768} 769 770static drmModeConnector *get_connector_by_id(struct device *dev, uint32_t id) 771{ 772 drmModeConnector *connector; 773 int i; 774 775 for (i = 0; i < dev->resources->count_connectors; i++) { 776 connector = dev->resources->connectors[i].connector; 777 if (connector && connector->connector_id == id) 778 return connector; 779 } 780 781 return NULL; 782} 783 784static drmModeEncoder *get_encoder_by_id(struct device *dev, uint32_t id) 785{ 786 drmModeEncoder *encoder; 787 int i; 788 789 for (i = 0; i < dev->resources->count_encoders; i++) { 790 encoder = dev->resources->encoders[i].encoder; 791 if (encoder && encoder->encoder_id == id) 792 return encoder; 793 } 794 795 return NULL; 796} 797 798/* ----------------------------------------------------------------------------- 799 * Pipes and planes 800 */ 801 802/* 803 * Mode setting with the kernel interfaces is a bit of a chore. 804 * First you have to find the connector in question and make sure the 805 * requested mode is available. 806 * Then you need to find the encoder attached to that connector so you 807 * can bind it with a free crtc. 808 */ 809struct pipe_arg { 810 const char **cons; 811 uint32_t *con_ids; 812 unsigned int num_cons; 813 uint32_t crtc_id; 814 char mode_str[64]; 815 char format_str[5]; 816 float vrefresh; 817 unsigned int fourcc; 818 drmModeModeInfo *mode; 819 struct crtc *crtc; 820 unsigned int fb_id[2], current_fb_id; 821 struct timeval start; 822 823 int swap_count; 824}; 825 826struct plane_arg { 827 uint32_t plane_id; /* the id of plane to use */ 828 uint32_t crtc_id; /* the id of CRTC to bind to */ 829 bool has_position; 830 int32_t x, y; 831 uint32_t w, h; 832 double scale; 833 unsigned int fb_id; 834 unsigned int old_fb_id; 835 struct bo *bo; 836 struct bo *old_bo; 837 char format_str[5]; /* need to leave room for terminating \0 */ 838 unsigned int fourcc; 839}; 840 841static drmModeModeInfo * 842connector_find_mode(struct device *dev, uint32_t con_id, const char *mode_str, 843 const float vrefresh) 844{ 845 drmModeConnector *connector; 846 drmModeModeInfo *mode; 847 int i; 848 849 connector = get_connector_by_id(dev, con_id); 850 if (!connector || !connector->count_modes) 851 return NULL; 852 853 /* Pick by Index */ 854 if (mode_str[0] == '#') { 855 int index = atoi(mode_str + 1); 856 857 if (index >= connector->count_modes || index < 0) 858 return NULL; 859 return &connector->modes[index]; 860 } 861 862 /* Pick by Name */ 863 for (i = 0; i < connector->count_modes; i++) { 864 mode = &connector->modes[i]; 865 if (!strcmp(mode->name, mode_str)) { 866 /* If the vertical refresh frequency is not specified 867 * then return the first mode that match with the name. 868 * Else, return the mode that match the name and 869 * the specified vertical refresh frequency. 870 */ 871 if (vrefresh == 0) 872 return mode; 873 else if (fabs(mode_vrefresh(mode) - vrefresh) < 0.005) 874 return mode; 875 } 876 } 877 878 return NULL; 879} 880 881static struct crtc *pipe_find_crtc(struct device *dev, struct pipe_arg *pipe) 882{ 883 uint32_t possible_crtcs = ~0; 884 uint32_t active_crtcs = 0; 885 unsigned int crtc_idx; 886 unsigned int i; 887 int j; 888 889 for (i = 0; i < pipe->num_cons; ++i) { 890 uint32_t crtcs_for_connector = 0; 891 drmModeConnector *connector; 892 drmModeEncoder *encoder; 893 struct crtc *crtc; 894 895 connector = get_connector_by_id(dev, pipe->con_ids[i]); 896 if (!connector) 897 return NULL; 898 899 for (j = 0; j < connector->count_encoders; ++j) { 900 encoder = get_encoder_by_id(dev, connector->encoders[j]); 901 if (!encoder) 902 continue; 903 904 crtcs_for_connector |= encoder->possible_crtcs; 905 crtc = get_crtc_by_id(dev, encoder->crtc_id); 906 if (!crtc) 907 continue; 908 active_crtcs |= get_crtc_mask(dev, crtc); 909 } 910 911 possible_crtcs &= crtcs_for_connector; 912 } 913 914 if (!possible_crtcs) 915 return NULL; 916 917 /* Return the first possible and active CRTC if one exists, or the first 918 * possible CRTC otherwise. 919 */ 920 if (possible_crtcs & active_crtcs) 921 crtc_idx = ffs(possible_crtcs & active_crtcs); 922 else 923 crtc_idx = ffs(possible_crtcs); 924 925 return &dev->resources->crtcs[crtc_idx - 1]; 926} 927 928static int pipe_find_crtc_and_mode(struct device *dev, struct pipe_arg *pipe) 929{ 930 drmModeModeInfo *mode = NULL; 931 int i; 932 933 pipe->mode = NULL; 934 935 for (i = 0; i < (int)pipe->num_cons; i++) { 936 mode = connector_find_mode(dev, pipe->con_ids[i], 937 pipe->mode_str, pipe->vrefresh); 938 if (mode == NULL) { 939 if (pipe->vrefresh) 940 fprintf(stderr, 941 "failed to find mode " 942 "\"%s-%.2fHz\" for connector %s\n", 943 pipe->mode_str, pipe->vrefresh, pipe->cons[i]); 944 else 945 fprintf(stderr, 946 "failed to find mode \"%s\" for connector %s\n", 947 pipe->mode_str, pipe->cons[i]); 948 return -EINVAL; 949 } 950 } 951 952 /* If the CRTC ID was specified, get the corresponding CRTC. Otherwise 953 * locate a CRTC that can be attached to all the connectors. 954 */ 955 if (pipe->crtc_id != (uint32_t)-1) { 956 pipe->crtc = get_crtc_by_id(dev, pipe->crtc_id); 957 } else { 958 pipe->crtc = pipe_find_crtc(dev, pipe); 959 pipe->crtc_id = pipe->crtc->crtc->crtc_id; 960 } 961 962 if (!pipe->crtc) { 963 fprintf(stderr, "failed to find CRTC for pipe\n"); 964 return -EINVAL; 965 } 966 967 pipe->mode = mode; 968 pipe->crtc->mode = mode; 969 970 return 0; 971} 972 973/* ----------------------------------------------------------------------------- 974 * Properties 975 */ 976 977struct property_arg { 978 uint32_t obj_id; 979 uint32_t obj_type; 980 char name[DRM_PROP_NAME_LEN+1]; 981 uint32_t prop_id; 982 uint64_t value; 983 bool optional; 984}; 985 986static bool set_property(struct device *dev, struct property_arg *p) 987{ 988 drmModeObjectProperties *props = NULL; 989 drmModePropertyRes **props_info = NULL; 990 const char *obj_type; 991 int ret; 992 int i; 993 994 p->obj_type = 0; 995 p->prop_id = 0; 996 997#define find_object(_res, type, Type) \ 998 do { \ 999 for (i = 0; i < (int)(_res)->count_##type##s; ++i) { \ 1000 struct type *obj = &(_res)->type##s[i]; \ 1001 if (obj->type->type##_id != p->obj_id) \ 1002 continue; \ 1003 p->obj_type = DRM_MODE_OBJECT_##Type; \ 1004 obj_type = #Type; \ 1005 props = obj->props; \ 1006 props_info = obj->props_info; \ 1007 } \ 1008 } while(0) \ 1009 1010 find_object(dev->resources, crtc, CRTC); 1011 if (p->obj_type == 0) 1012 find_object(dev->resources, connector, CONNECTOR); 1013 if (p->obj_type == 0) 1014 find_object(dev->resources, plane, PLANE); 1015 if (p->obj_type == 0) { 1016 fprintf(stderr, "Object %i not found, can't set property\n", 1017 p->obj_id); 1018 return false; 1019 } 1020 1021 if (!props) { 1022 fprintf(stderr, "%s %i has no properties\n", 1023 obj_type, p->obj_id); 1024 return false; 1025 } 1026 1027 for (i = 0; i < (int)props->count_props; ++i) { 1028 if (!props_info[i]) 1029 continue; 1030 if (strcmp(props_info[i]->name, p->name) == 0) 1031 break; 1032 } 1033 1034 if (i == (int)props->count_props) { 1035 if (!p->optional) 1036 fprintf(stderr, "%s %i has no %s property\n", 1037 obj_type, p->obj_id, p->name); 1038 return false; 1039 } 1040 1041 p->prop_id = props->props[i]; 1042 1043 if (!dev->use_atomic) 1044 ret = drmModeObjectSetProperty(dev->fd, p->obj_id, p->obj_type, 1045 p->prop_id, p->value); 1046 else 1047 ret = drmModeAtomicAddProperty(dev->req, p->obj_id, p->prop_id, p->value); 1048 1049 if (ret < 0) 1050 fprintf(stderr, "failed to set %s %i property %s to %" PRIu64 ": %s\n", 1051 obj_type, p->obj_id, p->name, p->value, strerror(errno)); 1052 1053 return true; 1054} 1055 1056/* -------------------------------------------------------------------------- */ 1057 1058static void 1059page_flip_handler(int fd, unsigned int frame, 1060 unsigned int sec, unsigned int usec, void *data) 1061{ 1062 struct pipe_arg *pipe; 1063 unsigned int new_fb_id; 1064 struct timeval end; 1065 double t; 1066 1067 pipe = data; 1068 if (pipe->current_fb_id == pipe->fb_id[0]) 1069 new_fb_id = pipe->fb_id[1]; 1070 else 1071 new_fb_id = pipe->fb_id[0]; 1072 1073 drmModePageFlip(fd, pipe->crtc_id, new_fb_id, 1074 DRM_MODE_PAGE_FLIP_EVENT, pipe); 1075 pipe->current_fb_id = new_fb_id; 1076 pipe->swap_count++; 1077 if (pipe->swap_count == 60) { 1078 gettimeofday(&end, NULL); 1079 t = end.tv_sec + end.tv_usec * 1e-6 - 1080 (pipe->start.tv_sec + pipe->start.tv_usec * 1e-6); 1081 fprintf(stderr, "freq: %.02fHz\n", pipe->swap_count / t); 1082 pipe->swap_count = 0; 1083 pipe->start = end; 1084 } 1085} 1086 1087static bool format_support(const drmModePlanePtr ovr, uint32_t fmt) 1088{ 1089 unsigned int i; 1090 1091 for (i = 0; i < ovr->count_formats; ++i) { 1092 if (ovr->formats[i] == fmt) 1093 return true; 1094 } 1095 1096 return false; 1097} 1098 1099static void add_property(struct device *dev, uint32_t obj_id, 1100 const char *name, uint64_t value) 1101{ 1102 struct property_arg p; 1103 1104 p.obj_id = obj_id; 1105 strcpy(p.name, name); 1106 p.value = value; 1107 1108 set_property(dev, &p); 1109} 1110 1111static bool add_property_optional(struct device *dev, uint32_t obj_id, 1112 const char *name, uint64_t value) 1113{ 1114 struct property_arg p; 1115 1116 p.obj_id = obj_id; 1117 strcpy(p.name, name); 1118 p.value = value; 1119 p.optional = true; 1120 1121 return set_property(dev, &p); 1122} 1123 1124static void set_gamma(struct device *dev, unsigned crtc_id, unsigned fourcc) 1125{ 1126 unsigned blob_id = 0; 1127 /* TODO: support 1024-sized LUTs, when the use-case arises */ 1128 struct drm_color_lut gamma_lut[256]; 1129 int i, ret; 1130 1131 if (fourcc == DRM_FORMAT_C8) { 1132 /* TODO: Add C8 support for more patterns */ 1133 util_smpte_c8_gamma(256, gamma_lut); 1134 drmModeCreatePropertyBlob(dev->fd, gamma_lut, sizeof(gamma_lut), &blob_id); 1135 } else { 1136 for (i = 0; i < 256; i++) { 1137 gamma_lut[i].red = 1138 gamma_lut[i].green = 1139 gamma_lut[i].blue = i << 8; 1140 } 1141 } 1142 1143 add_property_optional(dev, crtc_id, "DEGAMMA_LUT", 0); 1144 add_property_optional(dev, crtc_id, "CTM", 0); 1145 if (!add_property_optional(dev, crtc_id, "GAMMA_LUT", blob_id)) { 1146 uint16_t r[256], g[256], b[256]; 1147 1148 for (i = 0; i < 256; i++) { 1149 r[i] = gamma_lut[i].red; 1150 g[i] = gamma_lut[i].green; 1151 b[i] = gamma_lut[i].blue; 1152 } 1153 1154 ret = drmModeCrtcSetGamma(dev->fd, crtc_id, 256, r, g, b); 1155 if (ret) 1156 fprintf(stderr, "failed to set gamma: %s\n", strerror(errno)); 1157 } 1158} 1159 1160static int 1161bo_fb_create(int fd, unsigned int fourcc, const uint32_t w, const uint32_t h, 1162 enum util_fill_pattern pat, struct bo **out_bo, unsigned int *out_fb_id) 1163{ 1164 uint32_t handles[4] = {0}, pitches[4] = {0}, offsets[4] = {0}; 1165 struct bo *bo; 1166 unsigned int fb_id; 1167 1168 bo = bo_create(fd, fourcc, w, h, handles, pitches, offsets, pat); 1169 1170 if (bo == NULL) 1171 return -1; 1172 1173 if (drmModeAddFB2(fd, w, h, fourcc, handles, pitches, offsets, &fb_id, 0)) { 1174 fprintf(stderr, "failed to add fb (%ux%u): %s\n", w, h, strerror(errno)); 1175 bo_destroy(bo); 1176 return -1; 1177 } 1178 *out_bo = bo; 1179 *out_fb_id = fb_id; 1180 return 0; 1181} 1182 1183static int atomic_set_plane(struct device *dev, struct plane_arg *p, 1184 int pattern, bool update) 1185{ 1186 struct bo *plane_bo; 1187 int crtc_x, crtc_y, crtc_w, crtc_h; 1188 struct crtc *crtc = NULL; 1189 unsigned int old_fb_id; 1190 1191 /* Find an unused plane which can be connected to our CRTC. Find the 1192 * CRTC index first, then iterate over available planes. 1193 */ 1194 crtc = get_crtc_by_id(dev, p->crtc_id); 1195 if (!crtc) { 1196 fprintf(stderr, "CRTC %u not found\n", p->crtc_id); 1197 return -1; 1198 } 1199 1200 if (!update) 1201 fprintf(stderr, "testing %dx%d@%s on plane %u, crtc %u\n", 1202 p->w, p->h, p->format_str, p->plane_id, p->crtc_id); 1203 1204 plane_bo = p->old_bo; 1205 p->old_bo = p->bo; 1206 1207 if (!plane_bo) { 1208 if (bo_fb_create(dev->fd, p->fourcc, p->w, p->h, 1209 pattern, &plane_bo, &p->fb_id)) 1210 return -1; 1211 } 1212 1213 p->bo = plane_bo; 1214 1215 old_fb_id = p->fb_id; 1216 p->old_fb_id = old_fb_id; 1217 1218 crtc_w = p->w * p->scale; 1219 crtc_h = p->h * p->scale; 1220 if (!p->has_position) { 1221 /* Default to the middle of the screen */ 1222 crtc_x = (crtc->mode->hdisplay - crtc_w) / 2; 1223 crtc_y = (crtc->mode->vdisplay - crtc_h) / 2; 1224 } else { 1225 crtc_x = p->x; 1226 crtc_y = p->y; 1227 } 1228 1229 add_property(dev, p->plane_id, "FB_ID", p->fb_id); 1230 add_property(dev, p->plane_id, "CRTC_ID", p->crtc_id); 1231 add_property(dev, p->plane_id, "SRC_X", 0); 1232 add_property(dev, p->plane_id, "SRC_Y", 0); 1233 add_property(dev, p->plane_id, "SRC_W", p->w << 16); 1234 add_property(dev, p->plane_id, "SRC_H", p->h << 16); 1235 add_property(dev, p->plane_id, "CRTC_X", crtc_x); 1236 add_property(dev, p->plane_id, "CRTC_Y", crtc_y); 1237 add_property(dev, p->plane_id, "CRTC_W", crtc_w); 1238 add_property(dev, p->plane_id, "CRTC_H", crtc_h); 1239 1240 return 0; 1241} 1242 1243static int set_plane(struct device *dev, struct plane_arg *p) 1244{ 1245 drmModePlane *ovr; 1246 uint32_t plane_id; 1247 int crtc_x, crtc_y, crtc_w, crtc_h; 1248 struct crtc *crtc = NULL; 1249 unsigned int i, crtc_mask; 1250 1251 /* Find an unused plane which can be connected to our CRTC. Find the 1252 * CRTC index first, then iterate over available planes. 1253 */ 1254 crtc = get_crtc_by_id(dev, p->crtc_id); 1255 if (!crtc) { 1256 fprintf(stderr, "CRTC %u not found\n", p->crtc_id); 1257 return -1; 1258 } 1259 crtc_mask = get_crtc_mask(dev, crtc); 1260 plane_id = p->plane_id; 1261 1262 for (i = 0; i < dev->resources->count_planes; i++) { 1263 ovr = dev->resources->planes[i].plane; 1264 if (!ovr) 1265 continue; 1266 1267 if (plane_id && plane_id != ovr->plane_id) 1268 continue; 1269 1270 if (!format_support(ovr, p->fourcc)) 1271 continue; 1272 1273 if ((ovr->possible_crtcs & crtc_mask) && 1274 (ovr->crtc_id == 0 || ovr->crtc_id == p->crtc_id)) { 1275 plane_id = ovr->plane_id; 1276 break; 1277 } 1278 } 1279 1280 if (i == dev->resources->count_planes) { 1281 fprintf(stderr, "no unused plane available for CRTC %u\n", 1282 p->crtc_id); 1283 return -1; 1284 } 1285 1286 fprintf(stderr, "testing %dx%d@%s overlay plane %u\n", 1287 p->w, p->h, p->format_str, plane_id); 1288 1289 /* just use single plane format for now.. */ 1290 if (bo_fb_create(dev->fd, p->fourcc, p->w, p->h, 1291 secondary_fill, &p->bo, &p->fb_id)) 1292 return -1; 1293 1294 crtc_w = p->w * p->scale; 1295 crtc_h = p->h * p->scale; 1296 if (!p->has_position) { 1297 /* Default to the middle of the screen */ 1298 crtc_x = (crtc->mode->hdisplay - crtc_w) / 2; 1299 crtc_y = (crtc->mode->vdisplay - crtc_h) / 2; 1300 } else { 1301 crtc_x = p->x; 1302 crtc_y = p->y; 1303 } 1304 1305 /* note src coords (last 4 args) are in Q16 format */ 1306 if (drmModeSetPlane(dev->fd, plane_id, p->crtc_id, p->fb_id, 1307 0, crtc_x, crtc_y, crtc_w, crtc_h, 1308 0, 0, p->w << 16, p->h << 16)) { 1309 fprintf(stderr, "failed to enable plane: %s\n", 1310 strerror(errno)); 1311 return -1; 1312 } 1313 1314 ovr->crtc_id = p->crtc_id; 1315 1316 return 0; 1317} 1318 1319static void atomic_set_planes(struct device *dev, struct plane_arg *p, 1320 unsigned int count, bool update) 1321{ 1322 unsigned int i, pattern = primary_fill; 1323 1324 /* set up planes */ 1325 for (i = 0; i < count; i++) { 1326 if (i > 0) 1327 pattern = secondary_fill; 1328 else 1329 set_gamma(dev, p[i].crtc_id, p[i].fourcc); 1330 1331 if (atomic_set_plane(dev, &p[i], pattern, update)) 1332 return; 1333 } 1334} 1335 1336static void 1337atomic_test_page_flip(struct device *dev, struct pipe_arg *pipe_args, 1338 struct plane_arg *plane_args, unsigned int plane_count) 1339{ 1340 int ret; 1341 1342 gettimeofday(&pipe_args->start, NULL); 1343 pipe_args->swap_count = 0; 1344 1345 while (true) { 1346 drmModeAtomicFree(dev->req); 1347 dev->req = drmModeAtomicAlloc(); 1348 atomic_set_planes(dev, plane_args, plane_count, true); 1349 1350 ret = drmModeAtomicCommit(dev->fd, dev->req, DRM_MODE_ATOMIC_ALLOW_MODESET, NULL); 1351 if (ret) { 1352 fprintf(stderr, "Atomic Commit failed [2]\n"); 1353 return; 1354 } 1355 1356 pipe_args->swap_count++; 1357 if (pipe_args->swap_count == 60) { 1358 struct timeval end; 1359 double t; 1360 1361 gettimeofday(&end, NULL); 1362 t = end.tv_sec + end.tv_usec * 1e-6 - 1363 (pipe_args->start.tv_sec + pipe_args->start.tv_usec * 1e-6); 1364 fprintf(stderr, "freq: %.02fHz\n", pipe_args->swap_count / t); 1365 pipe_args->swap_count = 0; 1366 pipe_args->start = end; 1367 } 1368 } 1369} 1370 1371static void atomic_clear_planes(struct device *dev, struct plane_arg *p, unsigned int count) 1372{ 1373 unsigned int i; 1374 1375 for (i = 0; i < count; i++) { 1376 add_property(dev, p[i].plane_id, "FB_ID", 0); 1377 add_property(dev, p[i].plane_id, "CRTC_ID", 0); 1378 add_property(dev, p[i].plane_id, "SRC_X", 0); 1379 add_property(dev, p[i].plane_id, "SRC_Y", 0); 1380 add_property(dev, p[i].plane_id, "SRC_W", 0); 1381 add_property(dev, p[i].plane_id, "SRC_H", 0); 1382 add_property(dev, p[i].plane_id, "CRTC_X", 0); 1383 add_property(dev, p[i].plane_id, "CRTC_Y", 0); 1384 add_property(dev, p[i].plane_id, "CRTC_W", 0); 1385 add_property(dev, p[i].plane_id, "CRTC_H", 0); 1386 } 1387} 1388 1389static void atomic_clear_FB(struct device *dev, struct plane_arg *p, unsigned int count) 1390{ 1391 unsigned int i; 1392 1393 for (i = 0; i < count; i++) { 1394 if (p[i].fb_id) { 1395 drmModeRmFB(dev->fd, p[i].fb_id); 1396 p[i].fb_id = 0; 1397 } 1398 if (p[i].old_fb_id) { 1399 drmModeRmFB(dev->fd, p[i].old_fb_id); 1400 p[i].old_fb_id = 0; 1401 } 1402 if (p[i].bo) { 1403 bo_destroy(p[i].bo); 1404 p[i].bo = NULL; 1405 } 1406 if (p[i].old_bo) { 1407 bo_destroy(p[i].old_bo); 1408 p[i].old_bo = NULL; 1409 } 1410 1411 } 1412} 1413 1414static void clear_planes(struct device *dev, struct plane_arg *p, unsigned int count) 1415{ 1416 unsigned int i; 1417 1418 for (i = 0; i < count; i++) { 1419 if (p[i].fb_id) 1420 drmModeRmFB(dev->fd, p[i].fb_id); 1421 if (p[i].bo) 1422 bo_destroy(p[i].bo); 1423 } 1424} 1425 1426static int pipe_resolve_connectors(struct device *dev, struct pipe_arg *pipe) 1427{ 1428 drmModeConnector *connector; 1429 unsigned int i; 1430 uint32_t id; 1431 char *endp; 1432 1433 for (i = 0; i < pipe->num_cons; i++) { 1434 id = strtoul(pipe->cons[i], &endp, 10); 1435 if (endp == pipe->cons[i]) { 1436 connector = get_connector_by_name(dev, pipe->cons[i]); 1437 if (!connector) { 1438 fprintf(stderr, "no connector named '%s'\n", 1439 pipe->cons[i]); 1440 return -ENODEV; 1441 } 1442 1443 id = connector->connector_id; 1444 } 1445 1446 pipe->con_ids[i] = id; 1447 } 1448 1449 return 0; 1450} 1451 1452static int pipe_attempt_connector(struct device *dev, drmModeConnector *con, 1453 struct pipe_arg *pipe) 1454{ 1455 char *con_str; 1456 int i; 1457 1458 con_str = calloc(8, sizeof(char)); 1459 if (!con_str) 1460 return -1; 1461 1462 sprintf(con_str, "%d", con->connector_id); 1463 strcpy(pipe->format_str, "XR24"); 1464 pipe->fourcc = util_format_fourcc(pipe->format_str); 1465 pipe->num_cons = 1; 1466 pipe->con_ids = calloc(1, sizeof(*pipe->con_ids)); 1467 pipe->cons = calloc(1, sizeof(*pipe->cons)); 1468 1469 if (!pipe->con_ids || !pipe->cons) 1470 goto free_con_str; 1471 1472 pipe->con_ids[0] = con->connector_id; 1473 pipe->cons[0] = (const char*)con_str; 1474 1475 pipe->crtc = pipe_find_crtc(dev, pipe); 1476 if (!pipe->crtc) 1477 goto free_all; 1478 1479 pipe->crtc_id = pipe->crtc->crtc->crtc_id; 1480 1481 /* Return the first mode if no preferred. */ 1482 pipe->mode = &con->modes[0]; 1483 1484 for (i = 0; i < con->count_modes; i++) { 1485 drmModeModeInfo *current_mode = &con->modes[i]; 1486 1487 if (current_mode->type & DRM_MODE_TYPE_PREFERRED) { 1488 pipe->mode = current_mode; 1489 break; 1490 } 1491 } 1492 1493 sprintf(pipe->mode_str, "%dx%d", pipe->mode->hdisplay, pipe->mode->vdisplay); 1494 1495 return 0; 1496 1497free_all: 1498 free(pipe->cons); 1499 free(pipe->con_ids); 1500free_con_str: 1501 free(con_str); 1502 return -1; 1503} 1504 1505static int pipe_find_preferred(struct device *dev, struct pipe_arg **out_pipes) 1506{ 1507 struct pipe_arg *pipes; 1508 struct resources *res = dev->resources; 1509 drmModeConnector *con = NULL; 1510 int i, connected = 0, attempted = 0; 1511 1512 for (i = 0; i < res->count_connectors; i++) { 1513 con = res->connectors[i].connector; 1514 if (!con || con->connection != DRM_MODE_CONNECTED) 1515 continue; 1516 connected++; 1517 } 1518 if (!connected) { 1519 printf("no connected connector!\n"); 1520 return 0; 1521 } 1522 1523 pipes = calloc(connected, sizeof(struct pipe_arg)); 1524 if (!pipes) 1525 return 0; 1526 1527 for (i = 0; i < res->count_connectors && attempted < connected; i++) { 1528 con = res->connectors[i].connector; 1529 if (!con || con->connection != DRM_MODE_CONNECTED) 1530 continue; 1531 1532 if (pipe_attempt_connector(dev, con, &pipes[attempted]) < 0) { 1533 printf("failed fetching preferred mode for connector\n"); 1534 continue; 1535 } 1536 attempted++; 1537 } 1538 1539 *out_pipes = pipes; 1540 return attempted; 1541} 1542 1543static struct plane *get_primary_plane_by_crtc(struct device *dev, struct crtc *crtc) 1544{ 1545 unsigned int i; 1546 1547 for (i = 0; i < dev->resources->count_planes; i++) { 1548 struct plane *plane = &dev->resources->planes[i]; 1549 drmModePlane *ovr = plane->plane; 1550 if (!ovr) 1551 continue; 1552 1553 // XXX: add is_primary_plane and (?) format checks 1554 1555 if (ovr->possible_crtcs & get_crtc_mask(dev, crtc)) 1556 return plane; 1557 } 1558 return NULL; 1559} 1560 1561static void set_mode(struct device *dev, struct pipe_arg *pipes, unsigned int count) 1562{ 1563 unsigned int i, j; 1564 int ret, x = 0; 1565 int preferred = count == 0; 1566 1567 for (i = 0; i < count; i++) { 1568 struct pipe_arg *pipe = &pipes[i]; 1569 1570 ret = pipe_resolve_connectors(dev, pipe); 1571 if (ret < 0) 1572 return; 1573 1574 ret = pipe_find_crtc_and_mode(dev, pipe); 1575 if (ret < 0) 1576 continue; 1577 } 1578 if (preferred) { 1579 struct pipe_arg *pipe_args; 1580 1581 count = pipe_find_preferred(dev, &pipe_args); 1582 if (!count) { 1583 fprintf(stderr, "can't find any preferred connector/mode.\n"); 1584 return; 1585 } 1586 pipes = pipe_args; 1587 } 1588 1589 if (!dev->use_atomic) { 1590 for (i = 0; i < count; i++) { 1591 struct pipe_arg *pipe = &pipes[i]; 1592 1593 if (pipe->mode == NULL) 1594 continue; 1595 1596 if (!preferred) { 1597 dev->mode.width += pipe->mode->hdisplay; 1598 if (dev->mode.height < pipe->mode->vdisplay) 1599 dev->mode.height = pipe->mode->vdisplay; 1600 } else { 1601 /* XXX: Use a clone mode, more like atomic. We could do per 1602 * connector bo/fb, so we don't have the stretched image. 1603 */ 1604 if (dev->mode.width < pipe->mode->hdisplay) 1605 dev->mode.width = pipe->mode->hdisplay; 1606 if (dev->mode.height < pipe->mode->vdisplay) 1607 dev->mode.height = pipe->mode->vdisplay; 1608 } 1609 } 1610 1611 if (bo_fb_create(dev->fd, pipes[0].fourcc, dev->mode.width, dev->mode.height, 1612 primary_fill, &dev->mode.bo, &dev->mode.fb_id)) 1613 return; 1614 } 1615 1616 for (i = 0; i < count; i++) { 1617 struct pipe_arg *pipe = &pipes[i]; 1618 uint32_t blob_id; 1619 1620 if (pipe->mode == NULL) 1621 continue; 1622 1623 printf("setting mode %s-%.2fHz on connectors ", 1624 pipe->mode->name, mode_vrefresh(pipe->mode)); 1625 for (j = 0; j < pipe->num_cons; ++j) { 1626 printf("%s, ", pipe->cons[j]); 1627 if (dev->use_atomic) 1628 add_property(dev, pipe->con_ids[j], "CRTC_ID", pipe->crtc_id); 1629 } 1630 printf("crtc %d\n", pipe->crtc_id); 1631 1632 if (!dev->use_atomic) { 1633 ret = drmModeSetCrtc(dev->fd, pipe->crtc_id, dev->mode.fb_id, 1634 x, 0, pipe->con_ids, pipe->num_cons, 1635 pipe->mode); 1636 1637 /* XXX: Actually check if this is needed */ 1638 drmModeDirtyFB(dev->fd, dev->mode.fb_id, NULL, 0); 1639 1640 if (!preferred) 1641 x += pipe->mode->hdisplay; 1642 1643 if (ret) { 1644 fprintf(stderr, "failed to set mode: %s\n", strerror(errno)); 1645 return; 1646 } 1647 1648 set_gamma(dev, pipe->crtc_id, pipe->fourcc); 1649 } else { 1650 drmModeCreatePropertyBlob(dev->fd, pipe->mode, sizeof(*pipe->mode), &blob_id); 1651 add_property(dev, pipe->crtc_id, "MODE_ID", blob_id); 1652 add_property(dev, pipe->crtc_id, "ACTIVE", 1); 1653 1654 /* By default atomic modeset does not set a primary plane, shrug */ 1655 if (preferred) { 1656 struct plane *plane = get_primary_plane_by_crtc(dev, pipe->crtc); 1657 struct plane_arg plane_args = { 1658 .plane_id = plane->plane->plane_id, 1659 .crtc_id = pipe->crtc_id, 1660 .w = pipe->mode->hdisplay, 1661 .h = pipe->mode->vdisplay, 1662 .scale = 1.0, 1663 .format_str = "XR24", 1664 .fourcc = util_format_fourcc(pipe->format_str), 1665 }; 1666 1667 atomic_set_planes(dev, &plane_args, 1, false); 1668 } 1669 } 1670 } 1671} 1672 1673static void atomic_clear_mode(struct device *dev, struct pipe_arg *pipes, unsigned int count) 1674{ 1675 unsigned int i; 1676 unsigned int j; 1677 1678 for (i = 0; i < count; i++) { 1679 struct pipe_arg *pipe = &pipes[i]; 1680 1681 if (pipe->mode == NULL) 1682 continue; 1683 1684 for (j = 0; j < pipe->num_cons; ++j) 1685 add_property(dev, pipe->con_ids[j], "CRTC_ID",0); 1686 1687 add_property(dev, pipe->crtc_id, "MODE_ID", 0); 1688 add_property(dev, pipe->crtc_id, "ACTIVE", 0); 1689 } 1690} 1691 1692static void clear_mode(struct device *dev) 1693{ 1694 if (dev->mode.fb_id) 1695 drmModeRmFB(dev->fd, dev->mode.fb_id); 1696 if (dev->mode.bo) 1697 bo_destroy(dev->mode.bo); 1698} 1699 1700static void set_planes(struct device *dev, struct plane_arg *p, unsigned int count) 1701{ 1702 unsigned int i; 1703 1704 /* set up planes/overlays */ 1705 for (i = 0; i < count; i++) 1706 if (set_plane(dev, &p[i])) 1707 return; 1708} 1709 1710static void set_cursors(struct device *dev, struct pipe_arg *pipes, unsigned int count) 1711{ 1712 uint32_t handles[4] = {0}, pitches[4] = {0}, offsets[4] = {0}; 1713 struct bo *bo; 1714 unsigned int i; 1715 int ret; 1716 1717 /* maybe make cursor width/height configurable some day */ 1718 uint32_t cw = 64; 1719 uint32_t ch = 64; 1720 1721 /* create cursor bo.. just using PATTERN_PLAIN as it has 1722 * translucent alpha 1723 */ 1724 bo = bo_create(dev->fd, DRM_FORMAT_ARGB8888, cw, ch, handles, pitches, 1725 offsets, UTIL_PATTERN_PLAIN); 1726 if (bo == NULL) 1727 return; 1728 1729 dev->mode.cursor_bo = bo; 1730 1731 for (i = 0; i < count; i++) { 1732 struct pipe_arg *pipe = &pipes[i]; 1733 ret = cursor_init(dev->fd, handles[0], 1734 pipe->crtc_id, 1735 pipe->mode->hdisplay, pipe->mode->vdisplay, 1736 cw, ch); 1737 if (ret) { 1738 fprintf(stderr, "failed to init cursor for CRTC[%u]\n", 1739 pipe->crtc_id); 1740 return; 1741 } 1742 } 1743 1744 cursor_start(); 1745} 1746 1747static void clear_cursors(struct device *dev) 1748{ 1749 cursor_stop(); 1750 1751 if (dev->mode.cursor_bo) 1752 bo_destroy(dev->mode.cursor_bo); 1753} 1754 1755static void test_page_flip(struct device *dev, struct pipe_arg *pipes, unsigned int count) 1756{ 1757 unsigned int other_fb_id; 1758 struct bo *other_bo; 1759 drmEventContext evctx; 1760 unsigned int i; 1761 int ret; 1762 1763 if (bo_fb_create(dev->fd, pipes[0].fourcc, dev->mode.width, dev->mode.height, 1764 UTIL_PATTERN_PLAIN, &other_bo, &other_fb_id)) 1765 return; 1766 1767 for (i = 0; i < count; i++) { 1768 struct pipe_arg *pipe = &pipes[i]; 1769 1770 if (pipe->mode == NULL) 1771 continue; 1772 1773 ret = drmModePageFlip(dev->fd, pipe->crtc_id, 1774 other_fb_id, DRM_MODE_PAGE_FLIP_EVENT, 1775 pipe); 1776 if (ret) { 1777 fprintf(stderr, "failed to page flip: %s\n", strerror(errno)); 1778 goto err_rmfb; 1779 } 1780 gettimeofday(&pipe->start, NULL); 1781 pipe->swap_count = 0; 1782 pipe->fb_id[0] = dev->mode.fb_id; 1783 pipe->fb_id[1] = other_fb_id; 1784 pipe->current_fb_id = other_fb_id; 1785 } 1786 1787 memset(&evctx, 0, sizeof evctx); 1788 evctx.version = DRM_EVENT_CONTEXT_VERSION; 1789 evctx.vblank_handler = NULL; 1790 evctx.page_flip_handler = page_flip_handler; 1791 1792 while (1) { 1793#if 0 1794 struct pollfd pfd[2]; 1795 1796 pfd[0].fd = 0; 1797 pfd[0].events = POLLIN; 1798 pfd[1].fd = fd; 1799 pfd[1].events = POLLIN; 1800 1801 if (poll(pfd, 2, -1) < 0) { 1802 fprintf(stderr, "poll error\n"); 1803 break; 1804 } 1805 1806 if (pfd[0].revents) 1807 break; 1808#else 1809 struct timeval timeout = { .tv_sec = 3, .tv_usec = 0 }; 1810 fd_set fds; 1811 1812 FD_ZERO(&fds); 1813 FD_SET(0, &fds); 1814 FD_SET(dev->fd, &fds); 1815 ret = select(dev->fd + 1, &fds, NULL, NULL, &timeout); 1816 1817 if (ret <= 0) { 1818 fprintf(stderr, "select timed out or error (ret %d)\n", 1819 ret); 1820 continue; 1821 } else if (FD_ISSET(0, &fds)) { 1822 break; 1823 } 1824#endif 1825 1826 drmHandleEvent(dev->fd, &evctx); 1827 } 1828 1829err_rmfb: 1830 drmModeRmFB(dev->fd, other_fb_id); 1831 bo_destroy(other_bo); 1832} 1833 1834#define min(a, b) ((a) < (b) ? (a) : (b)) 1835 1836static int parse_connector(struct pipe_arg *pipe, const char *arg) 1837{ 1838 unsigned int len; 1839 unsigned int i; 1840 const char *p; 1841 char *endp; 1842 1843 pipe->vrefresh = 0; 1844 pipe->crtc_id = (uint32_t)-1; 1845 strcpy(pipe->format_str, "XR24"); 1846 1847 /* Count the number of connectors and allocate them. */ 1848 pipe->num_cons = 1; 1849 for (p = arg; *p && *p != ':' && *p != '@'; ++p) { 1850 if (*p == ',') 1851 pipe->num_cons++; 1852 } 1853 1854 pipe->con_ids = calloc(pipe->num_cons, sizeof(*pipe->con_ids)); 1855 pipe->cons = calloc(pipe->num_cons, sizeof(*pipe->cons)); 1856 if (pipe->con_ids == NULL || pipe->cons == NULL) 1857 return -1; 1858 1859 /* Parse the connectors. */ 1860 for (i = 0, p = arg; i < pipe->num_cons; ++i, p = endp + 1) { 1861 endp = strpbrk(p, ",@:"); 1862 if (!endp) 1863 break; 1864 1865 pipe->cons[i] = strndup(p, endp - p); 1866 1867 if (*endp != ',') 1868 break; 1869 } 1870 1871 if (i != pipe->num_cons - 1) 1872 return -1; 1873 1874 /* Parse the remaining parameters. */ 1875 if (!endp) 1876 return -1; 1877 if (*endp == '@') { 1878 arg = endp + 1; 1879 pipe->crtc_id = strtoul(arg, &endp, 10); 1880 } 1881 if (*endp != ':') 1882 return -1; 1883 1884 arg = endp + 1; 1885 1886 /* Search for the vertical refresh or the format. */ 1887 p = strpbrk(arg, "-@"); 1888 if (p == NULL) 1889 p = arg + strlen(arg); 1890 len = min(sizeof pipe->mode_str - 1, (unsigned int)(p - arg)); 1891 strncpy(pipe->mode_str, arg, len); 1892 pipe->mode_str[len] = '\0'; 1893 1894 if (*p == '-') { 1895 pipe->vrefresh = strtof(p + 1, &endp); 1896 p = endp; 1897 } 1898 1899 if (*p == '@') { 1900 strncpy(pipe->format_str, p + 1, 4); 1901 pipe->format_str[4] = '\0'; 1902 } 1903 1904 pipe->fourcc = util_format_fourcc(pipe->format_str); 1905 if (pipe->fourcc == 0) { 1906 fprintf(stderr, "unknown format %s\n", pipe->format_str); 1907 return -1; 1908 } 1909 1910 return 0; 1911} 1912 1913static int parse_plane(struct plane_arg *plane, const char *p) 1914{ 1915 char *end; 1916 1917 plane->plane_id = strtoul(p, &end, 10); 1918 if (*end != '@') 1919 return -EINVAL; 1920 1921 p = end + 1; 1922 plane->crtc_id = strtoul(p, &end, 10); 1923 if (*end != ':') 1924 return -EINVAL; 1925 1926 p = end + 1; 1927 plane->w = strtoul(p, &end, 10); 1928 if (*end != 'x') 1929 return -EINVAL; 1930 1931 p = end + 1; 1932 plane->h = strtoul(p, &end, 10); 1933 1934 if (*end == '+' || *end == '-') { 1935 plane->x = strtol(end, &end, 10); 1936 if (*end != '+' && *end != '-') 1937 return -EINVAL; 1938 plane->y = strtol(end, &end, 10); 1939 1940 plane->has_position = true; 1941 } 1942 1943 if (*end == '*') { 1944 p = end + 1; 1945 plane->scale = strtod(p, &end); 1946 if (plane->scale <= 0.0) 1947 return -EINVAL; 1948 } else { 1949 plane->scale = 1.0; 1950 } 1951 1952 if (*end == '@') { 1953 strncpy(plane->format_str, end + 1, 4); 1954 plane->format_str[4] = '\0'; 1955 } else { 1956 strcpy(plane->format_str, "XR24"); 1957 } 1958 1959 plane->fourcc = util_format_fourcc(plane->format_str); 1960 if (plane->fourcc == 0) { 1961 fprintf(stderr, "unknown format %s\n", plane->format_str); 1962 return -EINVAL; 1963 } 1964 1965 return 0; 1966} 1967 1968static int parse_property(struct property_arg *p, const char *arg) 1969{ 1970 if (sscanf(arg, "%d:%32[^:]:%" SCNu64, &p->obj_id, p->name, &p->value) != 3) 1971 return -1; 1972 1973 p->obj_type = 0; 1974 p->name[DRM_PROP_NAME_LEN] = '\0'; 1975 1976 return 0; 1977} 1978 1979static void parse_fill_patterns(char *arg) 1980{ 1981 char *fill = strtok(arg, ","); 1982 if (!fill) 1983 return; 1984 primary_fill = util_pattern_enum(fill); 1985 fill = strtok(NULL, ","); 1986 if (!fill) 1987 return; 1988 secondary_fill = util_pattern_enum(fill); 1989} 1990 1991static void usage(char *name) 1992{ 1993 fprintf(stderr, "usage: %s [-acDdefMPpsCvrw]\n", name); 1994 1995 fprintf(stderr, "\n Query options:\n\n"); 1996 fprintf(stderr, "\t-c\tlist connectors\n"); 1997 fprintf(stderr, "\t-e\tlist encoders\n"); 1998 fprintf(stderr, "\t-f\tlist framebuffers\n"); 1999 fprintf(stderr, "\t-p\tlist CRTCs and planes (pipes)\n"); 2000 2001 fprintf(stderr, "\n Test options:\n\n"); 2002 fprintf(stderr, "\t-P <plane_id>@<crtc_id>:<w>x<h>[+<x>+<y>][*<scale>][@<format>]\tset a plane\n"); 2003 fprintf(stderr, "\t-s <connector_id>[,<connector_id>][@<crtc_id>]:[#<mode index>]<mode>[-<vrefresh>][@<format>]\tset a mode\n"); 2004 fprintf(stderr, "\t-C\ttest hw cursor\n"); 2005 fprintf(stderr, "\t-v\ttest vsynced page flipping\n"); 2006 fprintf(stderr, "\t-r\tset the preferred mode for all connectors\n"); 2007 fprintf(stderr, "\t-w <obj_id>:<prop_name>:<value>\tset property\n"); 2008 fprintf(stderr, "\t-a \tuse atomic API\n"); 2009 fprintf(stderr, "\t-F pattern1,pattern2\tspecify fill patterns\n"); 2010 2011 fprintf(stderr, "\n Generic options:\n\n"); 2012 fprintf(stderr, "\t-d\tdrop master after mode set\n"); 2013 fprintf(stderr, "\t-M module\tuse the given driver\n"); 2014 fprintf(stderr, "\t-D device\tuse the given device\n"); 2015 2016 fprintf(stderr, "\n\tDefault is to dump all info.\n"); 2017 exit(0); 2018} 2019 2020static char optstr[] = "acdD:efF:M:P:ps:Cvrw:"; 2021 2022int main(int argc, char **argv) 2023{ 2024 struct device dev; 2025 2026 int c; 2027 int encoders = 0, connectors = 0, crtcs = 0, planes = 0, framebuffers = 0; 2028 int drop_master = 0; 2029 int test_vsync = 0; 2030 int test_cursor = 0; 2031 int set_preferred = 0; 2032 int use_atomic = 0; 2033 char *device = NULL; 2034 char *module = NULL; 2035 unsigned int i; 2036 unsigned int count = 0, plane_count = 0; 2037 unsigned int prop_count = 0; 2038 struct pipe_arg *pipe_args = NULL; 2039 struct plane_arg *plane_args = NULL; 2040 struct property_arg *prop_args = NULL; 2041 unsigned int args = 0; 2042 int ret; 2043 2044 memset(&dev, 0, sizeof dev); 2045 2046 opterr = 0; 2047 while ((c = getopt(argc, argv, optstr)) != -1) { 2048 args++; 2049 2050 switch (c) { 2051 case 'a': 2052 use_atomic = 1; 2053 /* Preserve the default behaviour of dumping all information. */ 2054 args--; 2055 break; 2056 case 'c': 2057 connectors = 1; 2058 break; 2059 case 'D': 2060 device = optarg; 2061 /* Preserve the default behaviour of dumping all information. */ 2062 args--; 2063 break; 2064 case 'd': 2065 drop_master = 1; 2066 break; 2067 case 'e': 2068 encoders = 1; 2069 break; 2070 case 'f': 2071 framebuffers = 1; 2072 break; 2073 case 'F': 2074 parse_fill_patterns(optarg); 2075 break; 2076 case 'M': 2077 module = optarg; 2078 /* Preserve the default behaviour of dumping all information. */ 2079 args--; 2080 break; 2081 case 'P': 2082 plane_args = realloc(plane_args, 2083 (plane_count + 1) * sizeof *plane_args); 2084 if (plane_args == NULL) { 2085 fprintf(stderr, "memory allocation failed\n"); 2086 return 1; 2087 } 2088 memset(&plane_args[plane_count], 0, sizeof(*plane_args)); 2089 2090 if (parse_plane(&plane_args[plane_count], optarg) < 0) 2091 usage(argv[0]); 2092 2093 plane_count++; 2094 break; 2095 case 'p': 2096 crtcs = 1; 2097 planes = 1; 2098 break; 2099 case 's': 2100 pipe_args = realloc(pipe_args, 2101 (count + 1) * sizeof *pipe_args); 2102 if (pipe_args == NULL) { 2103 fprintf(stderr, "memory allocation failed\n"); 2104 return 1; 2105 } 2106 memset(&pipe_args[count], 0, sizeof(*pipe_args)); 2107 2108 if (parse_connector(&pipe_args[count], optarg) < 0) 2109 usage(argv[0]); 2110 2111 count++; 2112 break; 2113 case 'C': 2114 test_cursor = 1; 2115 break; 2116 case 'v': 2117 test_vsync = 1; 2118 break; 2119 case 'r': 2120 set_preferred = 1; 2121 break; 2122 case 'w': 2123 prop_args = realloc(prop_args, 2124 (prop_count + 1) * sizeof *prop_args); 2125 if (prop_args == NULL) { 2126 fprintf(stderr, "memory allocation failed\n"); 2127 return 1; 2128 } 2129 memset(&prop_args[prop_count], 0, sizeof(*prop_args)); 2130 2131 if (parse_property(&prop_args[prop_count], optarg) < 0) 2132 usage(argv[0]); 2133 2134 prop_count++; 2135 break; 2136 default: 2137 usage(argv[0]); 2138 break; 2139 } 2140 } 2141 2142 /* Dump all the details when no* arguments are provided. */ 2143 if (!args) 2144 encoders = connectors = crtcs = planes = framebuffers = 1; 2145 2146 if (test_vsync && !count) { 2147 fprintf(stderr, "page flipping requires at least one -s option.\n"); 2148 return -1; 2149 } 2150 if (set_preferred && count) { 2151 fprintf(stderr, "cannot use -r (preferred) when -s (mode) is set\n"); 2152 return -1; 2153 } 2154 2155 if (set_preferred && plane_count) { 2156 fprintf(stderr, "cannot use -r (preferred) when -P (plane) is set\n"); 2157 return -1; 2158 } 2159 2160 dev.fd = util_open(device, module); 2161 if (dev.fd < 0) 2162 return -1; 2163 2164 if (use_atomic) { 2165 ret = drmSetClientCap(dev.fd, DRM_CLIENT_CAP_ATOMIC, 1); 2166 if (ret) { 2167 fprintf(stderr, "no atomic modesetting support: %s\n", strerror(errno)); 2168 drmClose(dev.fd); 2169 return -1; 2170 } 2171 } 2172 2173 dev.use_atomic = use_atomic; 2174 2175 dev.resources = get_resources(&dev); 2176 if (!dev.resources) { 2177 drmClose(dev.fd); 2178 return 1; 2179 } 2180 2181#define dump_resource(dev, res) if (res) dump_##res(dev) 2182 2183 dump_resource(&dev, encoders); 2184 dump_resource(&dev, connectors); 2185 dump_resource(&dev, crtcs); 2186 dump_resource(&dev, planes); 2187 dump_resource(&dev, framebuffers); 2188 2189 for (i = 0; i < prop_count; ++i) 2190 set_property(&dev, &prop_args[i]); 2191 2192 if (dev.use_atomic) { 2193 dev.req = drmModeAtomicAlloc(); 2194 2195 if (set_preferred || (count && plane_count)) { 2196 uint64_t cap = 0; 2197 2198 ret = drmGetCap(dev.fd, DRM_CAP_DUMB_BUFFER, &cap); 2199 if (ret || cap == 0) { 2200 fprintf(stderr, "driver doesn't support the dumb buffer API\n"); 2201 return 1; 2202 } 2203 2204 if (set_preferred || count) 2205 set_mode(&dev, pipe_args, count); 2206 2207 if (plane_count) 2208 atomic_set_planes(&dev, plane_args, plane_count, false); 2209 2210 ret = drmModeAtomicCommit(dev.fd, dev.req, DRM_MODE_ATOMIC_ALLOW_MODESET, NULL); 2211 if (ret) { 2212 fprintf(stderr, "Atomic Commit failed [1]\n"); 2213 return 1; 2214 } 2215 2216 if (test_vsync) 2217 atomic_test_page_flip(&dev, pipe_args, plane_args, plane_count); 2218 2219 if (drop_master) 2220 drmDropMaster(dev.fd); 2221 2222 getchar(); 2223 2224 drmModeAtomicFree(dev.req); 2225 dev.req = drmModeAtomicAlloc(); 2226 2227 /* XXX: properly teardown the preferred mode/plane state */ 2228 if (plane_count) 2229 atomic_clear_planes(&dev, plane_args, plane_count); 2230 2231 if (count) 2232 atomic_clear_mode(&dev, pipe_args, count); 2233 2234 ret = drmModeAtomicCommit(dev.fd, dev.req, DRM_MODE_ATOMIC_ALLOW_MODESET, NULL); 2235 if (ret) 2236 fprintf(stderr, "Atomic Commit failed\n"); 2237 2238 if (plane_count) 2239 atomic_clear_FB(&dev, plane_args, plane_count); 2240 } 2241 2242 drmModeAtomicFree(dev.req); 2243 } else { 2244 if (set_preferred || count || plane_count) { 2245 uint64_t cap = 0; 2246 2247 ret = drmGetCap(dev.fd, DRM_CAP_DUMB_BUFFER, &cap); 2248 if (ret || cap == 0) { 2249 fprintf(stderr, "driver doesn't support the dumb buffer API\n"); 2250 return 1; 2251 } 2252 2253 if (set_preferred || count) 2254 set_mode(&dev, pipe_args, count); 2255 2256 if (plane_count) 2257 set_planes(&dev, plane_args, plane_count); 2258 2259 if (test_cursor) 2260 set_cursors(&dev, pipe_args, count); 2261 2262 if (test_vsync) 2263 test_page_flip(&dev, pipe_args, count); 2264 2265 if (drop_master) 2266 drmDropMaster(dev.fd); 2267 2268 getchar(); 2269 2270 if (test_cursor) 2271 clear_cursors(&dev); 2272 2273 if (plane_count) 2274 clear_planes(&dev, plane_args, plane_count); 2275 2276 if (set_preferred || count) 2277 clear_mode(&dev); 2278 } 2279 } 2280 2281 free_resources(dev.resources); 2282 drmClose(dev.fd); 2283 2284 return 0; 2285} 2286