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