hwcomposer.cpp

   1 /*
   2  * Copyright (C) 2015 The Android Open Source Project
   3  *
   4  * Licensed under the Apache License, Version 2.0 (the "License");
   5  * you may not use this file except in compliance with the License.
   6  * You may obtain a copy of the License at
   7  *
   8  *      http://www.apache.org/licenses/LICENSE-2.0
   9  *
  10  * Unless required by applicable law or agreed to in writing, software
  11  * distributed under the License is distributed on an "AS IS" BASIS,
  12  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
  13  * See the License for the specific language governing permissions and
  14  * limitations under the License.
  15  */
  16
  17 #define ATRACE_TAG ATRACE_TAG_GRAPHICS
  18 #define LOG_TAG "hwcomposer-drm"
  19
  20 #include "drmhwcomposer.h"
  21 #include "drmeventlistener.h"
  22 #include "drmresources.h"
  23 #include "platform.h"
  24 #include "virtualcompositorworker.h"
  25 #include "vsyncworker.h"
  26
  27 #include <stdlib.h>
  28
  29 #include <cinttypes>
  30 #include <map>
  31 #include <vector>
  32 #include <sstream>
  33
  34 #include <errno.h>
  35 #include <fcntl.h>
  36 #include <pthread.h>
  37 #include <sys/param.h>
  38 #include <sys/resource.h>
  39 #include <xf86drm.h>
  40 #include <xf86drmMode.h>
  41
  42 #include <cutils/log.h>
  43 #include <cutils/properties.h>
  44 #include <hardware/hardware.h>
  45 #include <hardware/hwcomposer.h>
  46 #include <sw_sync.h>
  47 #include <sync/sync.h>
  48 #include <utils/Trace.h>
  49
  50 #define UM_PER_INCH 25400
  51
  52 namespace android {
  53
  54 class DummySwSyncTimeline {
  55  public:
  56   int Init() {
  57     int ret = timeline_fd_.Set(sw_sync_timeline_create());
  58     if (ret < 0)
  59       return ret;
  60     return 0;
  61   }
  62
  63   UniqueFd CreateDummyFence() {
  64     int ret = sw_sync_fence_create(timeline_fd_.get(), "dummy fence",
  65                                    timeline_pt_ + 1);
  66     if (ret < 0) {
  67       ALOGE("Failed to create dummy fence %d", ret);
  68       return ret;
  69     }
  70
  71     UniqueFd ret_fd(ret);
  72
  73     ret = sw_sync_timeline_inc(timeline_fd_.get(), 1);
  74     if (ret) {
  75       ALOGE("Failed to increment dummy sync timeline %d", ret);
  76       return ret;
  77     }
  78
  79     ++timeline_pt_;
  80     return ret_fd;
  81   }
  82
  83  private:
  84   UniqueFd timeline_fd_;
  85   int timeline_pt_ = 0;
  86 };
  87
  88 struct CheckedOutputFd {
  89   CheckedOutputFd(int *fd, const char *description,
  90                   DummySwSyncTimeline &timeline)
  91       : fd_(fd), description_(description), timeline_(timeline) {
  92   }
  93   CheckedOutputFd(CheckedOutputFd &&rhs)
  94       : description_(rhs.description_), timeline_(rhs.timeline_) {
  95     std::swap(fd_, rhs.fd_);
  96   }
  97
  98   CheckedOutputFd &operator=(const CheckedOutputFd &rhs) = delete;
  99
 100   ~CheckedOutputFd() {
 101     if (fd_ == NULL)
 102       return;
 103
 104     if (*fd_ >= 0)
 105       return;
 106
 107     *fd_ = timeline_.CreateDummyFence().Release();
 108
 109     if (*fd_ < 0)
 110       ALOGE("Failed to fill %s (%p == %d) before destruction",
 111             description_.c_str(), fd_, *fd_);
 112   }
 113
 114  private:
 115   int *fd_ = NULL;
 116   std::string description_;
 117   DummySwSyncTimeline &timeline_;
 118 };
 119
 120 typedef struct hwc_drm_display {
 121   struct hwc_context_t *ctx;
 122   int display;
 123
 124   std::vector<uint32_t> config_ids;
 125
 126   VSyncWorker vsync_worker;
 127 } hwc_drm_display_t;
 128
 129 class DrmHotplugHandler : public DrmEventHandler {
 130  public:
 131   void Init(DrmResources *drm, const struct hwc_procs *procs) {
 132     drm_ = drm;
 133     procs_ = procs;
 134   }
 135
 136   void HandleEvent(uint64_t timestamp_us) {
 137     for (auto &conn : drm_->connectors()) {
 138       drmModeConnection old_state = conn->state();
 139
 140       conn->UpdateModes();
 141
 142       drmModeConnection cur_state = conn->state();
 143
 144       if (cur_state == old_state)
 145         continue;
 146
 147       ALOGI("%s event @%" PRIu64 " for connector %u\n",
 148             cur_state == DRM_MODE_CONNECTED ? "Plug" : "Unplug", timestamp_us,
 149             conn->id());
 150
 151       if (cur_state == DRM_MODE_CONNECTED) {
 152         // Take the first one, then look for the preferred
 153         DrmMode mode = *(conn->modes().begin());
 154         for (auto &m : conn->modes()) {
 155           if (m.type() & DRM_MODE_TYPE_PREFERRED) {
 156             mode = m;
 157             break;
 158           }
 159         }
 160         ALOGI("Setting mode %dx%d for connector %d\n", mode.h_display(),
 161               mode.v_display(), conn->id());
 162         int ret = drm_->SetDisplayActiveMode(conn->display(), mode);
 163         if (ret) {
 164           ALOGE("Failed to set active config %d", ret);
 165           return;
 166         }
 167       } else {
 168         int ret = drm_->SetDpmsMode(conn->display(), DRM_MODE_DPMS_OFF);
 169         if (ret) {
 170           ALOGE("Failed to set dpms mode off %d", ret);
 171           return;
 172         }
 173       }
 174
 175       procs_->hotplug(procs_, conn->display(),
 176                       cur_state == DRM_MODE_CONNECTED ? 1 : 0);
 177     }
 178   }
 179
 180  private:
 181   DrmResources *drm_ = NULL;
 182   const struct hwc_procs *procs_ = NULL;
 183 };
 184
 185 struct hwc_context_t {
 186   // map of display:hwc_drm_display_t
 187   typedef std::map<int, hwc_drm_display_t> DisplayMap;
 188
 189   ~hwc_context_t() {
 190     virtual_compositor_worker.Exit();
 191   }
 192
 193   hwc_composer_device_1_t device;
 194   hwc_procs_t const *procs = NULL;
 195
 196   DisplayMap displays;
 197   DrmResources drm;
 198   std::unique_ptr<Importer> importer;
 199   const gralloc_module_t *gralloc;
 200   DummySwSyncTimeline dummy_timeline;
 201   VirtualCompositorWorker virtual_compositor_worker;
 202   DrmHotplugHandler hotplug_handler;
 203 };
 204
 205 static native_handle_t *dup_buffer_handle(buffer_handle_t handle) {
 206   native_handle_t *new_handle =
 207       native_handle_create(handle->numFds, handle->numInts);
 208   if (new_handle == NULL)
 209     return NULL;
 210
 211   const int *old_data = handle->data;
 212   int *new_data = new_handle->data;
 213   for (int i = 0; i < handle->numFds; i++) {
 214     *new_data = dup(*old_data);
 215     old_data++;
 216     new_data++;
 217   }
 218   memcpy(new_data, old_data, sizeof(int) * handle->numInts);
 219
 220   return new_handle;
 221 }
 222
 223 static void free_buffer_handle(native_handle_t *handle) {
 224   int ret = native_handle_close(handle);
 225   if (ret)
 226     ALOGE("Failed to close native handle %d", ret);
 227   ret = native_handle_delete(handle);
 228   if (ret)
 229     ALOGE("Failed to delete native handle %d", ret);
 230 }
 231
 232 const hwc_drm_bo *DrmHwcBuffer::operator->() const {
 233   if (importer_ == NULL) {
 234     ALOGE("Access of non-existent BO");
 235     exit(1);
 236     return NULL;
 237   }
 238   return &bo_;
 239 }
 240
 241 void DrmHwcBuffer::Clear() {
 242   if (importer_ != NULL) {
 243     importer_->ReleaseBuffer(&bo_);
 244     importer_ = NULL;
 245   }
 246 }
 247
 248 int DrmHwcBuffer::ImportBuffer(buffer_handle_t handle, Importer *importer) {
 249   hwc_drm_bo tmp_bo;
 250
 251   int ret = importer->ImportBuffer(handle, &tmp_bo);
 252   if (ret)
 253     return ret;
 254
 255   if (importer_ != NULL) {
 256     importer_->ReleaseBuffer(&bo_);
 257   }
 258
 259   importer_ = importer;
 260
 261   bo_ = tmp_bo;
 262
 263   return 0;
 264 }
 265
 266 int DrmHwcNativeHandle::CopyBufferHandle(buffer_handle_t handle,
 267                                          const gralloc_module_t *gralloc) {
 268   native_handle_t *handle_copy = dup_buffer_handle(handle);
 269   if (handle_copy == NULL) {
 270     ALOGE("Failed to duplicate handle");
 271     return -ENOMEM;
 272   }
 273
 274   int ret = gralloc->registerBuffer(gralloc, handle_copy);
 275   if (ret) {
 276     ALOGE("Failed to register buffer handle %d", ret);
 277     free_buffer_handle(handle_copy);
 278     return ret;
 279   }
 280
 281   Clear();
 282
 283   gralloc_ = gralloc;
 284   handle_ = handle_copy;
 285
 286   return 0;
 287 }
 288
 289 DrmHwcNativeHandle::~DrmHwcNativeHandle() {
 290   Clear();
 291 }
 292
 293 void DrmHwcNativeHandle::Clear() {
 294   if (gralloc_ != NULL && handle_ != NULL) {
 295     gralloc_->unregisterBuffer(gralloc_, handle_);
 296     free_buffer_handle(handle_);
 297     gralloc_ = NULL;
 298     handle_ = NULL;
 299   }
 300 }
 301
 302 int DrmHwcLayer::InitFromHwcLayer(hwc_layer_1_t *sf_layer, Importer *importer,
 303                                   const gralloc_module_t *gralloc) {
 304   sf_handle = sf_layer->handle;
 305   alpha = sf_layer->planeAlpha;
 306
 307   source_crop = DrmHwcRect<float>(
 308       sf_layer->sourceCropf.left, sf_layer->sourceCropf.top,
 309       sf_layer->sourceCropf.right, sf_layer->sourceCropf.bottom);
 310   display_frame = DrmHwcRect<int>(
 311       sf_layer->displayFrame.left, sf_layer->displayFrame.top,
 312       sf_layer->displayFrame.right, sf_layer->displayFrame.bottom);
 313
 314   transform = 0;
 315   // 270* and 180* cannot be combined with flips. More specifically, they
 316   // already contain both horizontal and vertical flips, so those fields are
 317   // redundant in this case. 90* rotation can be combined with either horizontal
 318   // flip or vertical flip, so treat it differently
 319   if (sf_layer->transform == HWC_TRANSFORM_ROT_270) {
 320     transform = DrmHwcTransform::kRotate270;
 321   } else if (sf_layer->transform == HWC_TRANSFORM_ROT_180) {
 322     transform = DrmHwcTransform::kRotate180;
 323   } else {
 324     if (sf_layer->transform & HWC_TRANSFORM_FLIP_H)
 325       transform |= DrmHwcTransform::kFlipH;
 326     if (sf_layer->transform & HWC_TRANSFORM_FLIP_V)
 327       transform |= DrmHwcTransform::kFlipV;
 328     if (sf_layer->transform & HWC_TRANSFORM_ROT_90)
 329       transform |= DrmHwcTransform::kRotate90;
 330   }
 331
 332   switch (sf_layer->blending) {
 333     case HWC_BLENDING_NONE:
 334       blending = DrmHwcBlending::kNone;
 335       break;
 336     case HWC_BLENDING_PREMULT:
 337       blending = DrmHwcBlending::kPreMult;
 338       break;
 339     case HWC_BLENDING_COVERAGE:
 340       blending = DrmHwcBlending::kCoverage;
 341       break;
 342     default:
 343       ALOGE("Invalid blending in hwc_layer_1_t %d", sf_layer->blending);
 344       return -EINVAL;
 345   }
 346
 347   int ret = buffer.ImportBuffer(sf_layer->handle, importer);
 348   if (ret)
 349     return ret;
 350
 351   ret = handle.CopyBufferHandle(sf_layer->handle, gralloc);
 352   if (ret)
 353     return ret;
 354
 355   ret = gralloc->perform(gralloc, GRALLOC_MODULE_PERFORM_GET_USAGE,
 356                          handle.get(), &gralloc_buffer_usage);
 357   if (ret) {
 358     ALOGE("Failed to get usage for buffer %p (%d)", handle.get(), ret);
 359     return ret;
 360   }
 361
 362   return 0;
 363 }
 364
 365 static void hwc_dump(struct hwc_composer_device_1 *dev, char *buff,
 366                      int buff_len) {
 367   struct hwc_context_t *ctx = (struct hwc_context_t *)&dev->common;
 368   std::ostringstream out;
 369
 370   ctx->drm.compositor()->Dump(&out);
 371   std::string out_str = out.str();
 372   strncpy(buff, out_str.c_str(),
 373           std::min((size_t)buff_len, out_str.length() + 1));
 374   buff[buff_len - 1] = '\0';
 375 }
 376
 377 static bool hwc_skip_layer(const std::pair<int, int> &indices, int i) {
 378   return indices.first >= 0 && i >= indices.first && i <= indices.second;
 379 }
 380
 381 static int hwc_prepare(hwc_composer_device_1_t *dev, size_t num_displays,
 382                        hwc_display_contents_1_t **display_contents) {
 383   struct hwc_context_t *ctx = (struct hwc_context_t *)&dev->common;
 384
 385   for (int i = 0; i < (int)num_displays; ++i) {
 386     if (!display_contents[i])
 387       continue;
 388
 389     bool use_framebuffer_target = false;
 390     DrmMode mode;
 391     if (i == HWC_DISPLAY_VIRTUAL) {
 392       use_framebuffer_target = true;
 393     } else {
 394       DrmConnector *c = ctx->drm.GetConnectorForDisplay(i);
 395       if (!c) {
 396         ALOGE("Failed to get DrmConnector for display %d", i);
 397         return -ENODEV;
 398       }
 399       mode = c->active_mode();
 400     }
 401
 402     // Since we can't composite HWC_SKIP_LAYERs by ourselves, we'll let SF
 403     // handle all layers in between the first and last skip layers. So find the
 404     // outer indices and mark everything in between as HWC_FRAMEBUFFER
 405     std::pair<int, int> skip_layer_indices(-1, -1);
 406     int num_layers = display_contents[i]->numHwLayers;
 407     for (int j = 0; !use_framebuffer_target && j < num_layers; ++j) {
 408       hwc_layer_1_t *layer = &display_contents[i]->hwLayers[j];
 409
 410       if (!(layer->flags & HWC_SKIP_LAYER))
 411         continue;
 412
 413       if (skip_layer_indices.first == -1)
 414         skip_layer_indices.first = j;
 415       skip_layer_indices.second = j;
 416     }
 417
 418     for (int j = 0; j < num_layers; ++j) {
 419       hwc_layer_1_t *layer = &display_contents[i]->hwLayers[j];
 420
 421       if (!use_framebuffer_target && !hwc_skip_layer(skip_layer_indices, j)) {
 422         // If the layer is off the screen, don't earmark it for an overlay.
 423         // We'll leave it as-is, which effectively just drops it from the frame
 424         const hwc_rect_t *frame = &layer->displayFrame;
 425         if ((frame->right - frame->left) <= 0 ||
 426             (frame->bottom - frame->top) <= 0 ||
 427             frame->right <= 0 || frame->bottom <= 0 ||
 428             frame->left >= (int)mode.h_display() ||
 429             frame->top >= (int)mode.v_display())
 430             continue;
 431
 432         if (layer->compositionType == HWC_FRAMEBUFFER)
 433           layer->compositionType = HWC_OVERLAY;
 434       } else {
 435         switch (layer->compositionType) {
 436           case HWC_OVERLAY:
 437           case HWC_BACKGROUND:
 438           case HWC_SIDEBAND:
 439           case HWC_CURSOR_OVERLAY:
 440             layer->compositionType = HWC_FRAMEBUFFER;
 441             break;
 442         }
 443       }
 444     }
 445   }
 446
 447   return 0;
 448 }
 449
 450 static void hwc_add_layer_to_retire_fence(
 451     hwc_layer_1_t *layer, hwc_display_contents_1_t *display_contents) {
 452   if (layer->releaseFenceFd < 0)
 453     return;
 454
 455   if (display_contents->retireFenceFd >= 0) {
 456     int old_retire_fence = display_contents->retireFenceFd;
 457     display_contents->retireFenceFd =
 458         sync_merge("dc_retire", old_retire_fence, layer->releaseFenceFd);
 459     close(old_retire_fence);
 460   } else {
 461     display_contents->retireFenceFd = dup(layer->releaseFenceFd);
 462   }
 463 }
 464
 465 static int hwc_set(hwc_composer_device_1_t *dev, size_t num_displays,
 466                    hwc_display_contents_1_t **sf_display_contents) {
 467   ATRACE_CALL();
 468   struct hwc_context_t *ctx = (struct hwc_context_t *)&dev->common;
 469   int ret = 0;
 470
 471   std::vector<CheckedOutputFd> checked_output_fences;
 472   std::vector<DrmHwcDisplayContents> displays_contents;
 473   std::vector<DrmCompositionDisplayLayersMap> layers_map;
 474   std::vector<std::vector<size_t>> layers_indices;
 475   displays_contents.reserve(num_displays);
 476   // layers_map.reserve(num_displays);
 477   layers_indices.reserve(num_displays);
 478
 479   // Phase one does nothing that would cause errors. Only take ownership of FDs.
 480   for (size_t i = 0; i < num_displays; ++i) {
 481     hwc_display_contents_1_t *dc = sf_display_contents[i];
 482     displays_contents.emplace_back();
 483     DrmHwcDisplayContents &display_contents = displays_contents.back();
 484     layers_indices.emplace_back();
 485     std::vector<size_t> &indices_to_composite = layers_indices.back();
 486
 487     if (!sf_display_contents[i])
 488       continue;
 489
 490     if (i == HWC_DISPLAY_VIRTUAL) {
 491       ctx->virtual_compositor_worker.QueueComposite(dc);
 492       continue;
 493     }
 494
 495     std::ostringstream display_index_formatter;
 496     display_index_formatter << "retire fence for display " << i;
 497     std::string display_fence_description(display_index_formatter.str());
 498     checked_output_fences.emplace_back(&dc->retireFenceFd,
 499                                        display_fence_description.c_str(),
 500                                        ctx->dummy_timeline);
 501     display_contents.retire_fence = OutputFd(&dc->retireFenceFd);
 502
 503     size_t num_dc_layers = dc->numHwLayers;
 504     int framebuffer_target_index = -1;
 505     for (size_t j = 0; j < num_dc_layers; ++j) {
 506       hwc_layer_1_t *sf_layer = &dc->hwLayers[j];
 507       if (sf_layer->compositionType == HWC_FRAMEBUFFER_TARGET) {
 508         framebuffer_target_index = j;
 509         break;
 510       }
 511     }
 512
 513     for (size_t j = 0; j < num_dc_layers; ++j) {
 514       hwc_layer_1_t *sf_layer = &dc->hwLayers[j];
 515
 516       display_contents.layers.emplace_back();
 517       DrmHwcLayer &layer = display_contents.layers.back();
 518
 519       // In prepare() we marked all layers FRAMEBUFFER between SKIP_LAYER's.
 520       // This means we should insert the FB_TARGET layer in the composition
 521       // stack at the location of the first skip layer, and ignore the rest.
 522       if (sf_layer->flags & HWC_SKIP_LAYER) {
 523         if (framebuffer_target_index < 0)
 524           continue;
 525         int idx = framebuffer_target_index;
 526         framebuffer_target_index = -1;
 527         hwc_layer_1_t *fbt_layer = &dc->hwLayers[idx];
 528         if (!fbt_layer->handle || (fbt_layer->flags & HWC_SKIP_LAYER)) {
 529           ALOGE("Invalid HWC_FRAMEBUFFER_TARGET with HWC_SKIP_LAYER present");
 530           continue;
 531         }
 532         indices_to_composite.push_back(idx);
 533         continue;
 534       }
 535
 536       if (sf_layer->compositionType == HWC_OVERLAY)
 537         indices_to_composite.push_back(j);
 538
 539       layer.acquire_fence.Set(sf_layer->acquireFenceFd);
 540       sf_layer->acquireFenceFd = -1;
 541
 542       std::ostringstream layer_fence_formatter;
 543       layer_fence_formatter << "release fence for layer " << j << " of display "
 544                             << i;
 545       std::string layer_fence_description(layer_fence_formatter.str());
 546       checked_output_fences.emplace_back(&sf_layer->releaseFenceFd,
 547                                          layer_fence_description.c_str(),
 548                                          ctx->dummy_timeline);
 549       layer.release_fence = OutputFd(&sf_layer->releaseFenceFd);
 550     }
 551
 552     // This is a catch-all in case we get a frame without any overlay layers, or
 553     // skip layers, but with a value fb_target layer. This _shouldn't_ happen,
 554     // but it's not ruled out by the hwc specification
 555     if (indices_to_composite.empty() && framebuffer_target_index >= 0) {
 556       hwc_layer_1_t *sf_layer = &dc->hwLayers[framebuffer_target_index];
 557       if (!sf_layer->handle || (sf_layer->flags & HWC_SKIP_LAYER)) {
 558         ALOGE(
 559             "Expected valid layer with HWC_FRAMEBUFFER_TARGET when all "
 560             "HWC_OVERLAY layers are skipped.");
 561         ret = -EINVAL;
 562       }
 563       indices_to_composite.push_back(framebuffer_target_index);
 564     }
 565   }
 566
 567   if (ret)
 568     return ret;
 569
 570   for (size_t i = 0; i < num_displays; ++i) {
 571     hwc_display_contents_1_t *dc = sf_display_contents[i];
 572     DrmHwcDisplayContents &display_contents = displays_contents[i];
 573     if (!sf_display_contents[i] || i == HWC_DISPLAY_VIRTUAL)
 574       continue;
 575
 576     layers_map.emplace_back();
 577     DrmCompositionDisplayLayersMap &map = layers_map.back();
 578     map.display = i;
 579     map.geometry_changed =
 580         (dc->flags & HWC_GEOMETRY_CHANGED) == HWC_GEOMETRY_CHANGED;
 581     std::vector<size_t> &indices_to_composite = layers_indices[i];
 582     for (size_t j : indices_to_composite) {
 583       hwc_layer_1_t *sf_layer = &dc->hwLayers[j];
 584
 585       DrmHwcLayer &layer = display_contents.layers[j];
 586
 587       ret = layer.InitFromHwcLayer(sf_layer, ctx->importer.get(), ctx->gralloc);
 588       if (ret) {
 589         ALOGE("Failed to init composition from layer %d", ret);
 590         return ret;
 591       }
 592       map.layers.emplace_back(std::move(layer));
 593     }
 594   }
 595
 596   std::unique_ptr<DrmComposition> composition(
 597       ctx->drm.compositor()->CreateComposition(ctx->importer.get()));
 598   if (!composition) {
 599     ALOGE("Drm composition init failed");
 600     return -EINVAL;
 601   }
 602
 603   ret = composition->SetLayers(layers_map.size(), layers_map.data());
 604   if (ret) {
 605     return -EINVAL;
 606   }
 607
 608   ret = ctx->drm.compositor()->QueueComposition(std::move(composition));
 609   if (ret) {
 610     return -EINVAL;
 611   }
 612
 613   for (size_t i = 0; i < num_displays; ++i) {
 614     hwc_display_contents_1_t *dc = sf_display_contents[i];
 615     if (!dc)
 616       continue;
 617
 618     size_t num_dc_layers = dc->numHwLayers;
 619     for (size_t j = 0; j < num_dc_layers; ++j) {
 620       hwc_layer_1_t *layer = &dc->hwLayers[j];
 621       if (layer->flags & HWC_SKIP_LAYER)
 622         continue;
 623       hwc_add_layer_to_retire_fence(layer, dc);
 624     }
 625   }
 626
 627   composition.reset(NULL);
 628
 629   return ret;
 630 }
 631
 632 static int hwc_event_control(struct hwc_composer_device_1 *dev, int display,
 633                              int event, int enabled) {
 634   if (event != HWC_EVENT_VSYNC || (enabled != 0 && enabled != 1))
 635     return -EINVAL;
 636
 637   struct hwc_context_t *ctx = (struct hwc_context_t *)&dev->common;
 638   hwc_drm_display_t *hd = &ctx->displays[display];
 639   return hd->vsync_worker.VSyncControl(enabled);
 640 }
 641
 642 static int hwc_set_power_mode(struct hwc_composer_device_1 *dev, int display,
 643                               int mode) {
 644   struct hwc_context_t *ctx = (struct hwc_context_t *)&dev->common;
 645
 646   uint64_t dpmsValue = 0;
 647   switch (mode) {
 648     case HWC_POWER_MODE_OFF:
 649       dpmsValue = DRM_MODE_DPMS_OFF;
 650       break;
 651
 652     /* We can't support dozing right now, so go full on */
 653     case HWC_POWER_MODE_DOZE:
 654     case HWC_POWER_MODE_DOZE_SUSPEND:
 655     case HWC_POWER_MODE_NORMAL:
 656       dpmsValue = DRM_MODE_DPMS_ON;
 657       break;
 658   };
 659   return ctx->drm.SetDpmsMode(display, dpmsValue);
 660 }
 661
 662 static int hwc_query(struct hwc_composer_device_1 * /* dev */, int what,
 663                      int *value) {
 664   switch (what) {
 665     case HWC_BACKGROUND_LAYER_SUPPORTED:
 666       *value = 0; /* TODO: We should do this */
 667       break;
 668     case HWC_VSYNC_PERIOD:
 669       ALOGW("Query for deprecated vsync value, returning 60Hz");
 670       *value = 1000 * 1000 * 1000 / 60;
 671       break;
 672     case HWC_DISPLAY_TYPES_SUPPORTED:
 673       *value = HWC_DISPLAY_PRIMARY_BIT | HWC_DISPLAY_EXTERNAL_BIT |
 674                HWC_DISPLAY_VIRTUAL_BIT;
 675       break;
 676   }
 677   return 0;
 678 }
 679
 680 static void hwc_register_procs(struct hwc_composer_device_1 *dev,
 681                                hwc_procs_t const *procs) {
 682   struct hwc_context_t *ctx = (struct hwc_context_t *)&dev->common;
 683
 684   ctx->procs = procs;
 685
 686   for (std::pair<const int, hwc_drm_display> &display_entry : ctx->displays)
 687     display_entry.second.vsync_worker.SetProcs(procs);
 688
 689   ctx->hotplug_handler.Init(&ctx->drm, procs);
 690   ctx->drm.event_listener()->RegisterHotplugHandler(&ctx->hotplug_handler);
 691 }
 692
 693 static int hwc_get_display_configs(struct hwc_composer_device_1 *dev,
 694                                    int display, uint32_t *configs,
 695                                    size_t *num_configs) {
 696   if (!*num_configs)
 697     return 0;
 698
 699   struct hwc_context_t *ctx = (struct hwc_context_t *)&dev->common;
 700   hwc_drm_display_t *hd = &ctx->displays[display];
 701   hd->config_ids.clear();
 702
 703   DrmConnector *connector = ctx->drm.GetConnectorForDisplay(display);
 704   if (!connector) {
 705     ALOGE("Failed to get connector for display %d", display);
 706     return -ENODEV;
 707   }
 708
 709   int ret = connector->UpdateModes();
 710   if (ret) {
 711     ALOGE("Failed to update display modes %d", ret);
 712     return ret;
 713   }
 714
 715   for (const DrmMode &mode : connector->modes()) {
 716     size_t idx = hd->config_ids.size();
 717     if (idx == *num_configs)
 718       break;
 719     hd->config_ids.push_back(mode.id());
 720     configs[idx] = mode.id();
 721   }
 722   *num_configs = hd->config_ids.size();
 723   return *num_configs == 0 ? -1 : 0;
 724 }
 725
 726 static int hwc_get_display_attributes(struct hwc_composer_device_1 *dev,
 727                                       int display, uint32_t config,
 728                                       const uint32_t *attributes,
 729                                       int32_t *values) {
 730   struct hwc_context_t *ctx = (struct hwc_context_t *)&dev->common;
 731   DrmConnector *c = ctx->drm.GetConnectorForDisplay(display);
 732   if (!c) {
 733     ALOGE("Failed to get DrmConnector for display %d", display);
 734     return -ENODEV;
 735   }
 736   DrmMode mode;
 737   for (const DrmMode &conn_mode : c->modes()) {
 738     if (conn_mode.id() == config) {
 739       mode = conn_mode;
 740       break;
 741     }
 742   }
 743   if (mode.id() == 0) {
 744     ALOGE("Failed to find active mode for display %d", display);
 745     return -ENOENT;
 746   }
 747
 748   uint32_t mm_width = c->mm_width();
 749   uint32_t mm_height = c->mm_height();
 750   for (int i = 0; attributes[i] != HWC_DISPLAY_NO_ATTRIBUTE; ++i) {
 751     switch (attributes[i]) {
 752       case HWC_DISPLAY_VSYNC_PERIOD:
 753         values[i] = 1000 * 1000 * 1000 / mode.v_refresh();
 754         break;
 755       case HWC_DISPLAY_WIDTH:
 756         values[i] = mode.h_display();
 757         break;
 758       case HWC_DISPLAY_HEIGHT:
 759         values[i] = mode.v_display();
 760         break;
 761       case HWC_DISPLAY_DPI_X:
 762         /* Dots per 1000 inches */
 763         values[i] = mm_width ? (mode.h_display() * UM_PER_INCH) / mm_width : 0;
 764         break;
 765       case HWC_DISPLAY_DPI_Y:
 766         /* Dots per 1000 inches */
 767         values[i] =
 768             mm_height ? (mode.v_display() * UM_PER_INCH) / mm_height : 0;
 769         break;
 770     }
 771   }
 772   return 0;
 773 }
 774
 775 static int hwc_get_active_config(struct hwc_composer_device_1 *dev,
 776                                  int display) {
 777   struct hwc_context_t *ctx = (struct hwc_context_t *)&dev->common;
 778   DrmConnector *c = ctx->drm.GetConnectorForDisplay(display);
 779   if (!c) {
 780     ALOGE("Failed to get DrmConnector for display %d", display);
 781     return -ENODEV;
 782   }
 783
 784   DrmMode mode = c->active_mode();
 785   hwc_drm_display_t *hd = &ctx->displays[display];
 786   for (size_t i = 0; i < hd->config_ids.size(); ++i) {
 787     if (hd->config_ids[i] == mode.id())
 788       return i;
 789   }
 790   return -1;
 791 }
 792
 793 static int hwc_set_active_config(struct hwc_composer_device_1 *dev, int display,
 794                                  int index) {
 795   struct hwc_context_t *ctx = (struct hwc_context_t *)&dev->common;
 796   hwc_drm_display_t *hd = &ctx->displays[display];
 797   if (index >= (int)hd->config_ids.size()) {
 798     ALOGE("Invalid config index %d passed in", index);
 799     return -EINVAL;
 800   }
 801
 802   DrmConnector *c = ctx->drm.GetConnectorForDisplay(display);
 803   if (!c) {
 804     ALOGE("Failed to get connector for display %d", display);
 805     return -ENODEV;
 806   }
 807
 808   if (c->state() != DRM_MODE_CONNECTED)
 809     return -ENODEV;
 810
 811   DrmMode mode;
 812   for (const DrmMode &conn_mode : c->modes()) {
 813     if (conn_mode.id() == hd->config_ids[index]) {
 814       mode = conn_mode;
 815       break;
 816     }
 817   }
 818   if (mode.id() != hd->config_ids[index]) {
 819     ALOGE("Could not find active mode for %d/%d", index, hd->config_ids[index]);
 820     return -ENOENT;
 821   }
 822   int ret = ctx->drm.SetDisplayActiveMode(display, mode);
 823   if (ret) {
 824     ALOGE("Failed to set active config %d", ret);
 825     return ret;
 826   }
 827   ret = ctx->drm.SetDpmsMode(display, DRM_MODE_DPMS_ON);
 828   if (ret) {
 829     ALOGE("Failed to set dpms mode on %d", ret);
 830     return ret;
 831   }
 832   return ret;
 833 }
 834
 835 static int hwc_device_close(struct hw_device_t *dev) {
 836   struct hwc_context_t *ctx = (struct hwc_context_t *)dev;
 837   delete ctx;
 838   return 0;
 839 }
 840
 841 /*
 842  * TODO: This function sets the active config to the first one in the list. This
 843  * should be fixed such that it selects the preferred mode for the display, or
 844  * some other, saner, method of choosing the config.
 845  */
 846 static int hwc_set_initial_config(hwc_drm_display_t *hd) {
 847   uint32_t config;
 848   size_t num_configs = 1;
 849   int ret = hwc_get_display_configs(&hd->ctx->device, hd->display, &config,
 850                                     &num_configs);
 851   if (ret || !num_configs)
 852     return 0;
 853
 854   ret = hwc_set_active_config(&hd->ctx->device, hd->display, 0);
 855   if (ret) {
 856     ALOGE("Failed to set active config d=%d ret=%d", hd->display, ret);
 857     return ret;
 858   }
 859
 860   return ret;
 861 }
 862
 863 static int hwc_initialize_display(struct hwc_context_t *ctx, int display) {
 864   hwc_drm_display_t *hd = &ctx->displays[display];
 865   hd->ctx = ctx;
 866   hd->display = display;
 867
 868   int ret = hwc_set_initial_config(hd);
 869   if (ret) {
 870     ALOGE("Failed to set initial config for d=%d ret=%d", display, ret);
 871     return ret;
 872   }
 873
 874   ret = hd->vsync_worker.Init(&ctx->drm, display);
 875   if (ret) {
 876     ALOGE("Failed to create event worker for display %d %d\n", display, ret);
 877     return ret;
 878   }
 879
 880   return 0;
 881 }
 882
 883 static int hwc_enumerate_displays(struct hwc_context_t *ctx) {
 884   int ret;
 885   for (auto &conn : ctx->drm.connectors()) {
 886     ret = hwc_initialize_display(ctx, conn->display());
 887     if (ret) {
 888       ALOGE("Failed to initialize display %d", conn->display());
 889       return ret;
 890     }
 891   }
 892
 893   ret = ctx->virtual_compositor_worker.Init();
 894   if (ret) {
 895     ALOGE("Failed to initialize virtual compositor worker");
 896     return ret;
 897   }
 898   return 0;
 899 }
 900
 901 static int hwc_device_open(const struct hw_module_t *module, const char *name,
 902                            struct hw_device_t **dev) {
 903   if (strcmp(name, HWC_HARDWARE_COMPOSER)) {
 904     ALOGE("Invalid module name- %s", name);
 905     return -EINVAL;
 906   }
 907
 908   std::unique_ptr<hwc_context_t> ctx(new hwc_context_t());
 909   if (!ctx) {
 910     ALOGE("Failed to allocate hwc context");
 911     return -ENOMEM;
 912   }
 913
 914   int ret = ctx->drm.Init();
 915   if (ret) {
 916     ALOGE("Can't initialize Drm object %d", ret);
 917     return ret;
 918   }
 919
 920   ret = hw_get_module(GRALLOC_HARDWARE_MODULE_ID,
 921                       (const hw_module_t **)&ctx->gralloc);
 922   if (ret) {
 923     ALOGE("Failed to open gralloc module %d", ret);
 924     return ret;
 925   }
 926
 927   ret = ctx->dummy_timeline.Init();
 928   if (ret) {
 929     ALOGE("Failed to create dummy sw sync timeline %d", ret);
 930     return ret;
 931   }
 932
 933   ctx->importer.reset(Importer::CreateInstance(&ctx->drm));
 934   if (!ctx->importer) {
 935     ALOGE("Failed to create importer instance");
 936     return ret;
 937   }
 938
 939   ret = hwc_enumerate_displays(ctx.get());
 940   if (ret) {
 941     ALOGE("Failed to enumerate displays: %s", strerror(ret));
 942     return ret;
 943   }
 944
 945   ctx->device.common.tag = HARDWARE_DEVICE_TAG;
 946   ctx->device.common.version = HWC_DEVICE_API_VERSION_1_4;
 947   ctx->device.common.module = const_cast<hw_module_t *>(module);
 948   ctx->device.common.close = hwc_device_close;
 949
 950   ctx->device.dump = hwc_dump;
 951   ctx->device.prepare = hwc_prepare;
 952   ctx->device.set = hwc_set;
 953   ctx->device.eventControl = hwc_event_control;
 954   ctx->device.setPowerMode = hwc_set_power_mode;
 955   ctx->device.query = hwc_query;
 956   ctx->device.registerProcs = hwc_register_procs;
 957   ctx->device.getDisplayConfigs = hwc_get_display_configs;
 958   ctx->device.getDisplayAttributes = hwc_get_display_attributes;
 959   ctx->device.getActiveConfig = hwc_get_active_config;
 960   ctx->device.setActiveConfig = hwc_set_active_config;
 961   ctx->device.setCursorPositionAsync = NULL; /* TODO: Add cursor */
 962
 963   *dev = &ctx->device.common;
 964   ctx.release();
 965
 966   return 0;
 967 }
 968 }
 969
 970 static struct hw_module_methods_t hwc_module_methods = {
 971   .open = android::hwc_device_open
 972 };
 973
 974 hwc_module_t HAL_MODULE_INFO_SYM = {
 975   .common = {
 976     .tag = HARDWARE_MODULE_TAG,
 977     .version_major = 1,
 978     .version_minor = 0,
 979     .id = HWC_HARDWARE_MODULE_ID,
 980     .name = "DRM hwcomposer module",
 981     .author = "The Android Open Source Project",
 982     .methods = &hwc_module_methods,
 983     .dso = NULL,
 984     .reserved = {0},
 985   }
 986 };