hwc.cpp revision 44a6d427028d87ddda7f2e50df675964f33f2d80
1/* 2 * Copyright (C) 2012 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#include <errno.h> 17#include <fcntl.h> 18#include <poll.h> 19#include <pthread.h> 20#include <stdio.h> 21#include <stdlib.h> 22 23#include <sys/ioctl.h> 24#include <sys/mman.h> 25#include <sys/time.h> 26#include <sys/resource.h> 27 28#include <s3c-fb.h> 29 30#include <EGL/egl.h> 31 32#define HWC_REMOVE_DEPRECATED_VERSIONS 1 33 34#include <cutils/log.h> 35#include <hardware/gralloc.h> 36#include <hardware/hardware.h> 37#include <hardware/hwcomposer.h> 38#include <hardware_legacy/uevent.h> 39#include <utils/String8.h> 40#include <utils/Vector.h> 41 42#include <sync/sync.h> 43 44#include "ion.h" 45#include "gralloc_priv.h" 46#include "exynos_gscaler.h" 47#include "exynos_format.h" 48#include "exynos_v4l2.h" 49#include "s5p_tvout_v4l2.h" 50 51struct hwc_callback_entry { 52 void (*callback)(void *, private_handle_t *); 53 void *data; 54}; 55typedef android::Vector<struct hwc_callback_entry> hwc_callback_queue_t; 56 57const size_t NUM_HW_WINDOWS = 5; 58const size_t NO_FB_NEEDED = NUM_HW_WINDOWS + 1; 59const size_t MAX_PIXELS = 2560 * 1600 * 2; 60const size_t GSC_W_ALIGNMENT = 16; 61const size_t GSC_H_ALIGNMENT = 16; 62const int AVAILABLE_GSC_UNITS[] = { 0, 3 }; 63const size_t NUM_GSC_UNITS = sizeof(AVAILABLE_GSC_UNITS) / 64 sizeof(AVAILABLE_GSC_UNITS[0]); 65 66struct exynos5_hwc_composer_device_1_t; 67 68struct exynos5_gsc_map_t { 69 enum { 70 GSC_NONE = 0, 71 GSC_M2M, 72 // TODO: GSC_LOCAL_PATH 73 } mode; 74 int idx; 75}; 76 77struct exynos5_hwc_post_data_t { 78 exynos5_hwc_composer_device_1_t *pdev; 79 int overlay_map[NUM_HW_WINDOWS]; 80 exynos5_gsc_map_t gsc_map[NUM_HW_WINDOWS]; 81 hwc_layer_1_t overlays[NUM_HW_WINDOWS]; 82 int num_overlays; 83 size_t fb_window; 84 int fence; 85 pthread_mutex_t completion_lock; 86 pthread_cond_t completion; 87}; 88 89const size_t NUM_GSC_DST_BUFS = 3; 90struct exynos5_gsc_data_t { 91 void *gsc; 92 exynos_gsc_img src_cfg; 93 exynos_gsc_img dst_cfg; 94 buffer_handle_t dst_buf[NUM_GSC_DST_BUFS]; 95 size_t current_buf; 96}; 97 98struct exynos5_hwc_composer_device_1_t { 99 hwc_composer_device_1_t base; 100 101 int fd; 102 int vsync_fd; 103 exynos5_hwc_post_data_t bufs; 104 105 const private_module_t *gralloc_module; 106 alloc_device_t *alloc_device; 107 const hwc_procs_t *procs; 108 pthread_t vsync_thread; 109 110 int hdmi_mixer0; 111 int hdmi_layer0; 112 int hdmi_layer1; 113 bool hdmi_hpd; 114 bool hdmi_enabled; 115 bool hdmi_blanked; 116 void *hdmi_gsc; 117 int hdmi_w; 118 int hdmi_h; 119 exynos_gsc_img hdmi_src; 120 exynos_gsc_img hdmi_dst; 121 122 exynos5_gsc_data_t gsc[NUM_GSC_UNITS]; 123 124 struct s3c_fb_win_config last_config[NUM_HW_WINDOWS]; 125 const void *last_handles[NUM_HW_WINDOWS]; 126 exynos5_gsc_map_t last_gsc_map[NUM_HW_WINDOWS]; 127}; 128 129static void dump_handle(private_handle_t *h) 130{ 131 ALOGV("\t\tformat = %d, width = %u, height = %u, stride = %u, vstride = %u", 132 h->format, h->width, h->height, h->stride, h->vstride); 133} 134 135static void dump_layer(hwc_layer_1_t const *l) 136{ 137 ALOGV("\ttype=%d, flags=%08x, handle=%p, tr=%02x, blend=%04x, " 138 "{%d,%d,%d,%d}, {%d,%d,%d,%d}", 139 l->compositionType, l->flags, l->handle, l->transform, 140 l->blending, 141 l->sourceCrop.left, 142 l->sourceCrop.top, 143 l->sourceCrop.right, 144 l->sourceCrop.bottom, 145 l->displayFrame.left, 146 l->displayFrame.top, 147 l->displayFrame.right, 148 l->displayFrame.bottom); 149 150 if(l->handle && !(l->flags & HWC_SKIP_LAYER)) 151 dump_handle(private_handle_t::dynamicCast(l->handle)); 152} 153 154static void dump_config(s3c_fb_win_config &c) 155{ 156 ALOGV("\tstate = %u", c.state); 157 if (c.state == c.S3C_FB_WIN_STATE_BUFFER) { 158 ALOGV("\t\tfd = %d, offset = %u, stride = %u, " 159 "x = %d, y = %d, w = %u, h = %u, " 160 "format = %u, blending = %u", 161 c.fd, c.offset, c.stride, 162 c.x, c.y, c.w, c.h, 163 c.format, c.blending); 164 } 165 else if (c.state == c.S3C_FB_WIN_STATE_COLOR) { 166 ALOGV("\t\tcolor = %u", c.color); 167 } 168} 169 170static void dump_gsc_img(exynos_gsc_img &c) 171{ 172 ALOGV("\tx = %u, y = %u, w = %u, h = %u, fw = %u, fh = %u", 173 c.x, c.y, c.w, c.h, c.fw, c.fh); 174 ALOGV("\taddr = {%u, %u, %u}, rot = %u, cacheable = %u, drmMode = %u", 175 c.yaddr, c.uaddr, c.vaddr, c.rot, c.cacheable, c.drmMode); 176} 177 178inline int WIDTH(const hwc_rect &rect) { return rect.right - rect.left; } 179inline int HEIGHT(const hwc_rect &rect) { return rect.bottom - rect.top; } 180template<typename T> inline T max(T a, T b) { return (a > b) ? a : b; } 181template<typename T> inline T min(T a, T b) { return (a < b) ? a : b; } 182 183static bool is_transformed(const hwc_layer_1_t &layer) 184{ 185 return layer.transform != 0; 186} 187 188static bool is_rotated(const hwc_layer_1_t &layer) 189{ 190 return (layer.transform & HAL_TRANSFORM_ROT_90) || 191 (layer.transform & HAL_TRANSFORM_ROT_180); 192} 193 194static bool is_scaled(const hwc_layer_1_t &layer) 195{ 196 return WIDTH(layer.displayFrame) != WIDTH(layer.sourceCrop) || 197 HEIGHT(layer.displayFrame) != HEIGHT(layer.sourceCrop); 198} 199 200static inline bool gsc_dst_cfg_changed(exynos_gsc_img &c1, exynos_gsc_img &c2) 201{ 202 return c1.x != c2.x || 203 c1.y != c2.y || 204 c1.w != c2.w || 205 c1.h != c2.h || 206 c1.format != c2.format || 207 c1.rot != c2.rot || 208 c1.cacheable != c2.cacheable || 209 c1.drmMode != c2.drmMode; 210} 211 212static inline bool gsc_src_cfg_changed(exynos_gsc_img &c1, exynos_gsc_img &c2) 213{ 214 return gsc_dst_cfg_changed(c1, c2) || 215 c1.fw != c2.fw || 216 c1.fh != c2.fh; 217} 218 219static enum s3c_fb_pixel_format exynos5_format_to_s3c_format(int format) 220{ 221 switch (format) { 222 case HAL_PIXEL_FORMAT_RGBA_8888: 223 return S3C_FB_PIXEL_FORMAT_RGBA_8888; 224 case HAL_PIXEL_FORMAT_RGBX_8888: 225 return S3C_FB_PIXEL_FORMAT_RGBX_8888; 226 case HAL_PIXEL_FORMAT_RGBA_5551: 227 return S3C_FB_PIXEL_FORMAT_RGBA_5551; 228 229 default: 230 return S3C_FB_PIXEL_FORMAT_MAX; 231 } 232} 233 234static bool exynos5_format_is_supported(int format) 235{ 236 return exynos5_format_to_s3c_format(format) < S3C_FB_PIXEL_FORMAT_MAX; 237} 238 239static bool exynos5_format_is_rgb(int format) 240{ 241 switch (format) { 242 case HAL_PIXEL_FORMAT_RGBA_8888: 243 case HAL_PIXEL_FORMAT_RGBX_8888: 244 case HAL_PIXEL_FORMAT_RGB_888: 245 case HAL_PIXEL_FORMAT_RGB_565: 246 case HAL_PIXEL_FORMAT_BGRA_8888: 247 case HAL_PIXEL_FORMAT_RGBA_5551: 248 case HAL_PIXEL_FORMAT_RGBA_4444: 249 return true; 250 251 default: 252 return false; 253 } 254} 255 256static bool exynos5_format_is_supported_by_gscaler(int format) 257{ 258 switch (format) { 259 case HAL_PIXEL_FORMAT_RGBX_8888: 260 case HAL_PIXEL_FORMAT_RGB_565: 261 case HAL_PIXEL_FORMAT_EXYNOS_YV12: 262 case HAL_PIXEL_FORMAT_YCbCr_420_SP: 263 case HAL_PIXEL_FORMAT_YCbCr_420_SP_TILED: 264 return true; 265 266 default: 267 return false; 268 } 269} 270 271static bool exynos5_format_is_ycrcb(int format) 272{ 273 return format == HAL_PIXEL_FORMAT_EXYNOS_YV12; 274} 275 276static bool exynos5_format_requires_gscaler(int format) 277{ 278 return exynos5_format_is_supported_by_gscaler(format) && 279 format != HAL_PIXEL_FORMAT_RGBX_8888; 280} 281 282static uint8_t exynos5_format_to_bpp(int format) 283{ 284 switch (format) { 285 case HAL_PIXEL_FORMAT_RGBA_8888: 286 case HAL_PIXEL_FORMAT_RGBX_8888: 287 return 32; 288 289 case HAL_PIXEL_FORMAT_RGBA_5551: 290 case HAL_PIXEL_FORMAT_RGBA_4444: 291 return 16; 292 293 default: 294 ALOGW("unrecognized pixel format %u", format); 295 return 0; 296 } 297} 298 299static bool exynos5_supports_gscaler(hwc_layer_1_t &layer, int format, 300 bool local_path) 301{ 302 private_handle_t *handle = private_handle_t::dynamicCast(layer.handle); 303 304 int max_w = is_rotated(layer) ? 2048 : 4800; 305 int max_h = is_rotated(layer) ? 2048 : 3344; 306 307 bool rot90or270 = !!(layer.transform & HAL_TRANSFORM_ROT_90); 308 // n.b.: HAL_TRANSFORM_ROT_270 = HAL_TRANSFORM_ROT_90 | 309 // HAL_TRANSFORM_ROT_180 310 311 int src_w = WIDTH(layer.sourceCrop), src_h = HEIGHT(layer.sourceCrop); 312 int dest_w, dest_h; 313 if (rot90or270) { 314 dest_w = HEIGHT(layer.displayFrame); 315 dest_h = WIDTH(layer.displayFrame); 316 } else { 317 dest_w = WIDTH(layer.displayFrame); 318 dest_h = HEIGHT(layer.displayFrame); 319 } 320 int max_downscale = local_path ? 4 : 16; 321 const int max_upscale = 8; 322 323 return exynos5_format_is_supported_by_gscaler(format) && 324 handle->stride <= max_w && 325 handle->stride % GSC_W_ALIGNMENT == 0 && 326 src_w <= dest_w * max_downscale && 327 dest_w <= src_w * max_upscale && 328 handle->vstride <= max_h && 329 handle->vstride % GSC_H_ALIGNMENT == 0 && 330 src_h <= dest_h * max_downscale && 331 dest_h <= src_h * max_upscale && 332 // per 46.2 333 (!rot90or270 || layer.sourceCrop.top % 2 == 0) && 334 (!rot90or270 || layer.sourceCrop.left % 2 == 0); 335 // per 46.3.1.6 336} 337 338int hdmi_get_config(struct exynos5_hwc_composer_device_1_t *dev) 339{ 340 struct v4l2_dv_preset preset; 341 struct v4l2_dv_enum_preset enum_preset; 342 int index = 0; 343 bool found = false; 344 int ret; 345 346 if (ioctl(dev->hdmi_layer0, VIDIOC_G_DV_PRESET, &preset) < 0) { 347 ALOGE("%s: g_dv_preset error, %d", __func__, errno); 348 return -1; 349 } 350 351 while (true) { 352 enum_preset.index = index++; 353 ret = ioctl(dev->hdmi_layer0, VIDIOC_ENUM_DV_PRESETS, &enum_preset); 354 355 if (ret < 0) { 356 if (errno == EINVAL) 357 break; 358 ALOGE("%s: enum_dv_presets error, %d", __func__, errno); 359 return -1; 360 } 361 362 ALOGV("%s: %d preset=%02d width=%d height=%d name=%s", 363 __func__, enum_preset.index, enum_preset.preset, 364 enum_preset.width, enum_preset.height, enum_preset.name); 365 366 if (preset.preset == enum_preset.preset) { 367 dev->hdmi_w = enum_preset.width; 368 dev->hdmi_h = enum_preset.height; 369 found = true; 370 } 371 } 372 373 return found ? 0 : -1; 374} 375 376static enum s3c_fb_blending exynos5_blending_to_s3c_blending(int32_t blending) 377{ 378 switch (blending) { 379 case HWC_BLENDING_NONE: 380 return S3C_FB_BLENDING_NONE; 381 case HWC_BLENDING_PREMULT: 382 return S3C_FB_BLENDING_PREMULT; 383 case HWC_BLENDING_COVERAGE: 384 return S3C_FB_BLENDING_COVERAGE; 385 386 default: 387 return S3C_FB_BLENDING_MAX; 388 } 389} 390 391static bool exynos5_blending_is_supported(int32_t blending) 392{ 393 return exynos5_blending_to_s3c_blending(blending) < S3C_FB_BLENDING_MAX; 394} 395 396static int hdmi_start_background(struct exynos5_hwc_composer_device_1_t *dev) 397{ 398 struct v4l2_requestbuffers reqbuf; 399 struct v4l2_subdev_format sd_fmt; 400 struct v4l2_subdev_crop sd_crop; 401 struct v4l2_format fmt; 402 struct v4l2_buffer buffer; 403 struct v4l2_plane planes[1]; 404 405 memset(&reqbuf, 0, sizeof(reqbuf)); 406 memset(&sd_fmt, 0, sizeof(sd_fmt)); 407 memset(&sd_crop, 0, sizeof(sd_crop)); 408 memset(&fmt, 0, sizeof(fmt)); 409 memset(&buffer, 0, sizeof(buffer)); 410 memset(planes, 0, sizeof(planes)); 411 412 sd_fmt.pad = MIXER_G1_SUBDEV_PAD_SINK; 413 sd_fmt.which = V4L2_SUBDEV_FORMAT_ACTIVE; 414 sd_fmt.format.width = 1; 415 sd_fmt.format.height = 1; 416 sd_fmt.format.code = V4L2_MBUS_FMT_XRGB8888_4X8_LE; 417 if (exynos_subdev_s_fmt(dev->hdmi_mixer0, &sd_fmt) < 0) { 418 ALOGE("%s: s_fmt failed pad=%d", __func__, sd_fmt.pad); 419 return -1; 420 } 421 422 sd_crop.pad = MIXER_G1_SUBDEV_PAD_SINK; 423 sd_crop.which = V4L2_SUBDEV_FORMAT_ACTIVE; 424 sd_crop.rect.left = 0; 425 sd_crop.rect.top = 0; 426 sd_crop.rect.width = 1; 427 sd_crop.rect.height = 1; 428 if (exynos_subdev_s_crop(dev->hdmi_mixer0, &sd_crop) < 0) { 429 ALOGE("%s: set_crop failed pad=%d", __func__, sd_crop.pad); 430 return -1; 431 } 432 433 sd_fmt.pad = MIXER_G1_SUBDEV_PAD_SOURCE; 434 sd_fmt.which = V4L2_SUBDEV_FORMAT_ACTIVE; 435 sd_fmt.format.width = dev->hdmi_w; 436 sd_fmt.format.height = dev->hdmi_h; 437 sd_fmt.format.code = V4L2_MBUS_FMT_XRGB8888_4X8_LE; 438 if (exynos_subdev_s_fmt(dev->hdmi_mixer0, &sd_fmt) < 0) { 439 ALOGE("%s: s_fmt failed pad=%d", __func__, sd_fmt.pad); 440 return -1; 441 } 442 443 sd_crop.pad = MIXER_G1_SUBDEV_PAD_SOURCE; 444 sd_crop.which = V4L2_SUBDEV_FORMAT_ACTIVE; 445 sd_crop.rect.left = 0; 446 sd_crop.rect.top = 0; 447 sd_crop.rect.width = 1; 448 sd_crop.rect.height = 1; 449 if (exynos_subdev_s_crop(dev->hdmi_mixer0, &sd_crop) < 0) { 450 ALOGE("%s: s_crop failed pad=%d", __func__, sd_crop.pad); 451 return -1; 452 } 453 454 fmt.type = V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE; 455 fmt.fmt.pix_mp.width = 1; 456 fmt.fmt.pix_mp.height = 1; 457 fmt.fmt.pix_mp.pixelformat = V4L2_PIX_FMT_BGR32; 458 fmt.fmt.pix_mp.field = V4L2_FIELD_ANY; 459 fmt.fmt.pix_mp.num_planes = 1; 460 if (exynos_v4l2_s_fmt(dev->hdmi_layer1, &fmt) < 0) { 461 ALOGE("%s::videodev set format failed", __func__); 462 return -1; 463 } 464 465 reqbuf.count = 1; 466 reqbuf.type = V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE; 467 reqbuf.memory = V4L2_MEMORY_MMAP; 468 469 if (exynos_v4l2_reqbufs(dev->hdmi_layer1, &reqbuf) < 0) { 470 ALOGE("%s: exynos_v4l2_reqbufs failed %d", __func__, errno); 471 return -1; 472 } 473 474 if (reqbuf.count != 1) { 475 ALOGE("%s: didn't get buffer", __func__); 476 return -1; 477 } 478 479 memset(&buffer, 0, sizeof(buffer)); 480 buffer.type = reqbuf.type; 481 buffer.memory = V4L2_MEMORY_MMAP; 482 buffer.length = 1; 483 buffer.m.planes = planes; 484 if (exynos_v4l2_querybuf(dev->hdmi_layer1, &buffer) < 0) { 485 ALOGE("%s: exynos_v4l2_querybuf failed %d", __func__, errno); 486 return -1; 487 } 488 489 void *start = mmap(NULL, planes[0].length, PROT_READ | PROT_WRITE, 490 MAP_SHARED, dev->hdmi_layer1, planes[0].m.mem_offset); 491 if (start == MAP_FAILED) { 492 ALOGE("%s: mmap failed %d", __func__, errno); 493 return -1; 494 } 495 496 memset(start, 0, planes[0].length); 497 498 munmap(start, planes[0].length); 499 500 if (exynos_v4l2_qbuf(dev->hdmi_layer1, &buffer) < 0) { 501 ALOGE("%s: exynos_v4l2_qbuf failed %d", __func__, errno); 502 return -1; 503 } 504 505 if (exynos_v4l2_streamon(dev->hdmi_layer1, buffer.type) < 0) { 506 ALOGE("%s:stream on failed", __func__); 507 return -1; 508 } 509 510 if (exynos_v4l2_s_ctrl(dev->hdmi_layer1, V4L2_CID_TV_LAYER_PRIO, 0) < 0) { 511 ALOGE("%s: s_ctrl LAYER_PRIO failed", __func__); 512 return -1; 513 } 514 515 return 0; 516} 517 518static int hdmi_stop_background(struct exynos5_hwc_composer_device_1_t *dev) 519{ 520 struct v4l2_requestbuffers reqbuf; 521 522 if (exynos_v4l2_streamoff(dev->hdmi_layer1, V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE) < 0) { 523 ALOGE("%s:stream off failed", __func__); 524 return -1; 525 } 526 527 memset(&reqbuf, 0, sizeof(reqbuf)); 528 reqbuf.count = 0; 529 reqbuf.type = V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE; 530 reqbuf.memory = V4L2_MEMORY_MMAP; 531 if (exynos_v4l2_reqbufs(dev->hdmi_layer1, &reqbuf) < 0) { 532 ALOGE("%s: exynos_v4l2_reqbufs failed %d", __func__, errno); 533 return -1; 534 } 535 536 return 0; 537} 538 539static int hdmi_enable(struct exynos5_hwc_composer_device_1_t *dev) 540{ 541 if (dev->hdmi_enabled) 542 return 0; 543 544 if (dev->hdmi_blanked) 545 return 0; 546 547 dev->hdmi_gsc = exynos_gsc_create_exclusive(3, GSC_OUTPUT_MODE, GSC_OUT_TV); 548 if (!dev->hdmi_gsc) { 549 ALOGE("%s: exynos_gsc_create_exclusive failed", __func__); 550 return -ENODEV; 551 } 552 553 memset(&dev->hdmi_src, 0, sizeof(dev->hdmi_src)); 554 555 if (hdmi_start_background(dev) < 0) { 556 ALOGE("%s: hdmi_start_background failed", __func__); 557 return -1; 558 } 559 560 dev->hdmi_enabled = true; 561 return 0; 562} 563 564static void hdmi_disable(struct exynos5_hwc_composer_device_1_t *dev) 565{ 566 if (!dev->hdmi_enabled) 567 return; 568 exynos_gsc_destroy(dev->hdmi_gsc); 569 hdmi_stop_background(dev); 570 dev->hdmi_gsc = NULL; 571 dev->hdmi_enabled = false; 572} 573 574static int hdmi_configure(struct exynos5_hwc_composer_device_1_t *dev, 575 exynos_gsc_img &src_cfg, 576 exynos_gsc_img &dst_cfg) 577{ 578 if (!gsc_src_cfg_changed(src_cfg, dev->hdmi_src) 579 && !gsc_dst_cfg_changed(dst_cfg, dev->hdmi_dst)) 580 return 0; 581 582 ALOGV("HDMI source config:"); 583 dump_gsc_img(src_cfg); 584 ALOGV("HDMI dest config:"); 585 dump_gsc_img(dst_cfg); 586 587 exynos_gsc_stop_exclusive(dev->hdmi_gsc); 588 589 int ret = exynos_gsc_config_exclusive(dev->hdmi_gsc, &src_cfg, &dst_cfg); 590 if (ret < 0) { 591 ALOGE("%s: exynos_gsc_config_exclusive failed %d", __func__, ret); 592 return ret; 593 } 594 595 dev->hdmi_src = src_cfg; 596 dev->hdmi_dst = dst_cfg; 597 return ret; 598} 599 600static int hdmi_configure_handle(struct exynos5_hwc_composer_device_1_t *dev, private_handle_t *h) 601{ 602 exynos_gsc_img src_cfg, dst_cfg; 603 memset(&src_cfg, 0, sizeof(src_cfg)); 604 memset(&dst_cfg, 0, sizeof(dst_cfg)); 605 606 src_cfg.w = src_cfg.fw = h->width; 607 src_cfg.h = src_cfg.fh = h->height; 608 src_cfg.format = HAL_PIXEL_FORMAT_BGRA_8888; 609 610 dst_cfg.w = dst_cfg.fw = dev->hdmi_w; 611 dst_cfg.h = dst_cfg.fh = dev->hdmi_h; 612 dst_cfg.format = HAL_PIXEL_FORMAT_EXYNOS_YV12; 613 614 return hdmi_configure(dev, src_cfg, dst_cfg); 615} 616 617static int hdmi_configure_layer(struct exynos5_hwc_composer_device_1_t *dev, hwc_layer_1_t &layer) 618{ 619 exynos_gsc_img src_cfg, dst_cfg; 620 memset(&src_cfg, 0, sizeof(src_cfg)); 621 memset(&dst_cfg, 0, sizeof(dst_cfg)); 622 private_handle_t *src_handle = private_handle_t::dynamicCast(layer.handle); 623 624 src_cfg.x = layer.sourceCrop.left; 625 src_cfg.y = layer.sourceCrop.top; 626 src_cfg.w = WIDTH(layer.sourceCrop); 627 src_cfg.fw = src_handle->stride; 628 src_cfg.h = HEIGHT(layer.sourceCrop); 629 src_cfg.fh = src_handle->vstride; 630 src_cfg.format = src_handle->format; 631 632 if (dev->hdmi_w * src_cfg.h < dev->hdmi_h * src_cfg.w) { 633 dst_cfg.w = dev->hdmi_w; 634 dst_cfg.fw = dev->hdmi_w; 635 dst_cfg.fh = dev->hdmi_h; 636 dst_cfg.h = dev->hdmi_w * src_cfg.h / src_cfg.w; 637 dst_cfg.y = (dev->hdmi_h - dst_cfg.h) / 2; 638 } 639 else { 640 dst_cfg.w = dev->hdmi_h * src_cfg.w / src_cfg.h; 641 dst_cfg.fw = dev->hdmi_w; 642 dst_cfg.h = dev->hdmi_h; 643 dst_cfg.fh = dev->hdmi_h; 644 dst_cfg.x = (dev->hdmi_w - dst_cfg.w) / 2; 645 } 646 dst_cfg.format = HAL_PIXEL_FORMAT_EXYNOS_YV12; 647 dst_cfg.rot = layer.transform; 648 649 return hdmi_configure(dev, src_cfg, dst_cfg); 650} 651 652static int hdmi_output(struct exynos5_hwc_composer_device_1_t *dev, private_handle_t *h) 653{ 654 exynos_gsc_img src_info; 655 exynos_gsc_img dst_info; 656 657 memset(&src_info, 0, sizeof(src_info)); 658 memset(&dst_info, 0, sizeof(dst_info)); 659 660 src_info.yaddr = h->fd; 661 if (exynos5_format_is_ycrcb(h->format)) { 662 src_info.uaddr = h->fd2; 663 src_info.vaddr = h->fd1; 664 } else { 665 src_info.uaddr = h->fd1; 666 src_info.vaddr = h->fd2; 667 } 668 669 int ret = exynos_gsc_run_exclusive(dev->hdmi_gsc, &src_info, &dst_info); 670 if (ret < 0) { 671 ALOGE("%s: exynos_gsc_run_exclusive failed %d", __func__, ret); 672 return ret; 673 } 674 675 return 0; 676} 677 678bool exynos5_supports_overlay(hwc_layer_1_t &layer, size_t i) 679{ 680 if (layer.flags & HWC_SKIP_LAYER) { 681 ALOGV("\tlayer %u: skipping", i); 682 return false; 683 } 684 685 private_handle_t *handle = private_handle_t::dynamicCast(layer.handle); 686 687 if (!handle) { 688 ALOGV("\tlayer %u: handle is NULL", i); 689 return false; 690 } 691 if (!exynos5_format_is_rgb(handle->format) && 692 !exynos5_format_is_supported_by_gscaler(handle->format)) { 693 ALOGW("\tlayer %u: unexpected format %u", i, handle->format); 694 return false; 695 } 696 697 if (exynos5_format_requires_gscaler(handle->format)) { 698 if (!exynos5_supports_gscaler(layer, handle->format, false)) { 699 ALOGV("\tlayer %u: gscaler required but not supported", i); 700 return false; 701 } 702 } else { 703 if (!exynos5_format_is_supported(handle->format)) { 704 ALOGV("\tlayer %u: pixel format %u not supported", i, handle->format); 705 return false; 706 } 707 if (is_scaled(layer)) { 708 ALOGV("\tlayer %u: scaling not supported", i); 709 return false; 710 } 711 if (is_transformed(layer)) { 712 ALOGV("\tlayer %u: transformations not supported", i); 713 return false; 714 } 715 } 716 if (!exynos5_blending_is_supported(layer.blending)) { 717 ALOGV("\tlayer %u: blending %d not supported", i, layer.blending); 718 return false; 719 } 720 721 return true; 722} 723 724inline bool intersect(const hwc_rect &r1, const hwc_rect &r2) 725{ 726 return !(r1.left > r2.right || 727 r1.right < r2.left || 728 r1.top > r2.bottom || 729 r1.bottom < r2.top); 730} 731 732inline hwc_rect intersection(const hwc_rect &r1, const hwc_rect &r2) 733{ 734 hwc_rect i; 735 i.top = max(r1.top, r2.top); 736 i.bottom = min(r1.bottom, r2.bottom); 737 i.left = max(r1.left, r2.left); 738 i.right = min(r1.right, r2.right); 739 return i; 740} 741 742static int exynos5_prepare(hwc_composer_device_1_t *dev, 743 size_t numDisplays, hwc_display_contents_1_t** displays) 744{ 745 if (!numDisplays || !displays) 746 return 0; 747 748 ALOGV("preparing %u layers", displays[0]->numHwLayers); 749 750 exynos5_hwc_composer_device_1_t *pdev = 751 (exynos5_hwc_composer_device_1_t *)dev; 752 memset(pdev->bufs.overlays, 0, sizeof(pdev->bufs.overlays)); 753 memset(pdev->bufs.gsc_map, 0, sizeof(pdev->bufs.gsc_map)); 754 755 bool force_fb = false; 756 if (pdev->hdmi_hpd) { 757 hdmi_enable(pdev); 758 force_fb = true; 759 for (size_t i = 0; i < displays[0]->numHwLayers; i++) { 760 hwc_layer_1_t &layer = displays[0]->hwLayers[i]; 761 if (layer.flags & HWC_SKIP_LAYER) 762 continue; 763 private_handle_t *handle = private_handle_t::dynamicCast(layer.handle); 764 if (handle->flags & GRALLOC_USAGE_EXTERNAL_DISP) { 765 force_fb = false; 766 break; 767 } 768 } 769 } else { 770 hdmi_disable(pdev); 771 } 772 773 for (size_t i = 0; i < NUM_HW_WINDOWS; i++) 774 pdev->bufs.overlay_map[i] = -1; 775 776 bool fb_needed = false; 777 size_t first_fb = 0, last_fb = 0; 778 779 // find unsupported overlays 780 for (size_t i = 0; i < displays[0]->numHwLayers; i++) { 781 hwc_layer_1_t &layer = displays[0]->hwLayers[i]; 782 783 if (layer.compositionType == HWC_BACKGROUND && !force_fb) { 784 ALOGV("\tlayer %u: background supported", i); 785 dump_layer(&displays[0]->hwLayers[i]); 786 continue; 787 } 788 789 if (exynos5_supports_overlay(displays[0]->hwLayers[i], i) && !force_fb) { 790 ALOGV("\tlayer %u: overlay supported", i); 791 layer.compositionType = HWC_OVERLAY; 792 dump_layer(&displays[0]->hwLayers[i]); 793 continue; 794 } 795 796 if (!fb_needed) { 797 first_fb = i; 798 fb_needed = true; 799 } 800 last_fb = i; 801 layer.compositionType = HWC_FRAMEBUFFER; 802 803 dump_layer(&displays[0]->hwLayers[i]); 804 } 805 806 // can't composite overlays sandwiched between framebuffers 807 if (fb_needed) 808 for (size_t i = first_fb; i < last_fb; i++) 809 displays[0]->hwLayers[i].compositionType = HWC_FRAMEBUFFER; 810 811 // Incrementally try to add our supported layers to hardware windows. 812 // If adding a layer would violate a hardware constraint, force it 813 // into the framebuffer and try again. (Revisiting the entire list is 814 // necessary because adding a layer to the framebuffer can cause other 815 // windows to retroactively violate constraints.) 816 bool changed; 817 do { 818 android::Vector<hwc_rect> rects; 819 android::Vector<hwc_rect> overlaps; 820 size_t pixels_left, windows_left, gsc_left = NUM_GSC_UNITS; 821 822 if (fb_needed) { 823 hwc_rect_t fb_rect; 824 fb_rect.top = fb_rect.left = 0; 825 fb_rect.right = pdev->gralloc_module->xres - 1; 826 fb_rect.bottom = pdev->gralloc_module->yres - 1; 827 pixels_left = MAX_PIXELS - pdev->gralloc_module->xres * 828 pdev->gralloc_module->yres; 829 windows_left = NUM_HW_WINDOWS - 1; 830 rects.push_back(fb_rect); 831 } 832 else { 833 pixels_left = MAX_PIXELS; 834 windows_left = NUM_HW_WINDOWS; 835 } 836 if (pdev->hdmi_enabled) 837 gsc_left--; 838 839 changed = false; 840 841 for (size_t i = 0; i < displays[0]->numHwLayers; i++) { 842 hwc_layer_1_t &layer = displays[0]->hwLayers[i]; 843 if (layer.flags & HWC_SKIP_LAYER) 844 continue; 845 846 private_handle_t *handle = private_handle_t::dynamicCast( 847 layer.handle); 848 849 // we've already accounted for the framebuffer above 850 if (layer.compositionType == HWC_FRAMEBUFFER) 851 continue; 852 853 // only layer 0 can be HWC_BACKGROUND, so we can 854 // unconditionally allow it without extra checks 855 if (layer.compositionType == HWC_BACKGROUND) { 856 windows_left--; 857 continue; 858 } 859 860 size_t pixels_needed = WIDTH(layer.displayFrame) * 861 HEIGHT(layer.displayFrame); 862 bool can_compose = windows_left && pixels_needed <= pixels_left; 863 bool gsc_required = exynos5_format_requires_gscaler(handle->format); 864 if (gsc_required) 865 can_compose = can_compose && gsc_left; 866 867 // hwc_rect_t right and bottom values are normally exclusive; 868 // the intersection logic is simpler if we make them inclusive 869 hwc_rect_t visible_rect = layer.displayFrame; 870 visible_rect.right--; visible_rect.bottom--; 871 872 // no more than 2 layers can overlap on a given pixel 873 for (size_t j = 0; can_compose && j < overlaps.size(); j++) { 874 if (intersect(visible_rect, overlaps.itemAt(j))) 875 can_compose = false; 876 } 877 878 if (!can_compose) { 879 layer.compositionType = HWC_FRAMEBUFFER; 880 if (!fb_needed) { 881 first_fb = last_fb = i; 882 fb_needed = true; 883 } 884 else { 885 first_fb = min(i, first_fb); 886 last_fb = max(i, last_fb); 887 } 888 changed = true; 889 break; 890 } 891 892 for (size_t j = 0; j < rects.size(); j++) { 893 const hwc_rect_t &other_rect = rects.itemAt(j); 894 if (intersect(visible_rect, other_rect)) 895 overlaps.push_back(intersection(visible_rect, other_rect)); 896 } 897 rects.push_back(visible_rect); 898 pixels_left -= pixels_needed; 899 windows_left--; 900 if (gsc_required) 901 gsc_left--; 902 } 903 904 if (changed) 905 for (size_t i = first_fb; i < last_fb; i++) 906 displays[0]->hwLayers[i].compositionType = HWC_FRAMEBUFFER; 907 } while(changed); 908 909 unsigned int nextWindow = 0; 910 int nextGsc = 0; 911 912 for (size_t i = 0; i < displays[0]->numHwLayers; i++) { 913 hwc_layer_1_t &layer = displays[0]->hwLayers[i]; 914 915 if (fb_needed && i == first_fb) { 916 ALOGV("assigning framebuffer to window %u\n", 917 nextWindow); 918 nextWindow++; 919 continue; 920 } 921 922 if (layer.compositionType != HWC_FRAMEBUFFER) { 923 ALOGV("assigning layer %u to window %u", i, nextWindow); 924 pdev->bufs.overlay_map[nextWindow] = i; 925 if (layer.compositionType == HWC_OVERLAY) { 926 private_handle_t *handle = 927 private_handle_t::dynamicCast(layer.handle); 928 if (exynos5_format_requires_gscaler(handle->format)) { 929 ALOGV("\tusing gscaler %u", AVAILABLE_GSC_UNITS[nextGsc]); 930 pdev->bufs.gsc_map[nextWindow].mode = 931 exynos5_gsc_map_t::GSC_M2M; 932 pdev->bufs.gsc_map[nextWindow].idx = nextGsc++; 933 } 934 } 935 nextWindow++; 936 } 937 } 938 939 for (size_t i = nextGsc; i < NUM_GSC_UNITS; i++) { 940 for (size_t j = 0; j < NUM_GSC_DST_BUFS; j++) 941 if (pdev->gsc[i].dst_buf[j]) 942 pdev->alloc_device->free(pdev->alloc_device, 943 pdev->gsc[i].dst_buf[j]); 944 memset(&pdev->gsc[i], 0, sizeof(pdev->gsc[i])); 945 } 946 947 if (fb_needed) 948 pdev->bufs.fb_window = first_fb; 949 else 950 pdev->bufs.fb_window = NO_FB_NEEDED; 951 952 return 0; 953} 954 955static int exynos5_config_gsc_m2m(hwc_layer_1_t &layer, 956 alloc_device_t* alloc_device, exynos5_gsc_data_t *gsc_data, 957 int gsc_idx) 958{ 959 ALOGV("configuring gscaler %u for memory-to-memory", gsc_idx); 960 961 private_handle_t *src_handle = private_handle_t::dynamicCast(layer.handle); 962 buffer_handle_t dst_buf; 963 private_handle_t *dst_handle; 964 int ret = 0; 965 966 exynos_gsc_img src_cfg, dst_cfg; 967 memset(&src_cfg, 0, sizeof(src_cfg)); 968 memset(&dst_cfg, 0, sizeof(dst_cfg)); 969 970 src_cfg.x = layer.sourceCrop.left; 971 src_cfg.y = layer.sourceCrop.top; 972 src_cfg.w = WIDTH(layer.sourceCrop); 973 src_cfg.fw = src_handle->stride; 974 src_cfg.h = HEIGHT(layer.sourceCrop); 975 src_cfg.fh = src_handle->vstride; 976 src_cfg.yaddr = src_handle->fd; 977 if (exynos5_format_is_ycrcb(src_handle->format)) { 978 src_cfg.uaddr = src_handle->fd2; 979 src_cfg.vaddr = src_handle->fd1; 980 } else { 981 src_cfg.uaddr = src_handle->fd1; 982 src_cfg.vaddr = src_handle->fd2; 983 } 984 src_cfg.format = src_handle->format; 985 src_cfg.drmMode = !!(src_handle->flags & GRALLOC_USAGE_PROTECTED); 986 987 dst_cfg.x = 0; 988 dst_cfg.y = 0; 989 dst_cfg.w = WIDTH(layer.displayFrame); 990 dst_cfg.h = HEIGHT(layer.displayFrame); 991 dst_cfg.format = HAL_PIXEL_FORMAT_BGRA_8888; 992 dst_cfg.rot = layer.transform; 993 dst_cfg.drmMode = src_cfg.drmMode; 994 995 ALOGV("source configuration:"); 996 dump_gsc_img(src_cfg); 997 998 if (gsc_src_cfg_changed(src_cfg, gsc_data->src_cfg) || 999 gsc_dst_cfg_changed(dst_cfg, gsc_data->dst_cfg)) { 1000 int dst_stride; 1001 int usage = GRALLOC_USAGE_SW_READ_NEVER | 1002 GRALLOC_USAGE_SW_WRITE_NEVER | 1003 GRALLOC_USAGE_HW_COMPOSER; 1004 1005 if (src_handle->flags & GRALLOC_USAGE_PROTECTED) 1006 usage |= GRALLOC_USAGE_PROTECTED; 1007 1008 int w = ALIGN(WIDTH(layer.displayFrame), GSC_W_ALIGNMENT); 1009 int h = ALIGN(HEIGHT(layer.displayFrame), GSC_H_ALIGNMENT); 1010 1011 for (size_t i = 0; i < NUM_GSC_DST_BUFS; i++) { 1012 if (gsc_data->dst_buf[i]) { 1013 alloc_device->free(alloc_device, gsc_data->dst_buf[i]); 1014 gsc_data->dst_buf[i] = NULL; 1015 } 1016 1017 int ret = alloc_device->alloc(alloc_device, w, h, 1018 HAL_PIXEL_FORMAT_RGBX_8888, usage, &gsc_data->dst_buf[i], 1019 &dst_stride); 1020 if (ret < 0) { 1021 ALOGE("failed to allocate destination buffer: %s", 1022 strerror(-ret)); 1023 goto err_alloc; 1024 } 1025 } 1026 1027 gsc_data->current_buf = 0; 1028 } 1029 1030 dst_buf = gsc_data->dst_buf[gsc_data->current_buf]; 1031 dst_handle = private_handle_t::dynamicCast(dst_buf); 1032 1033 dst_cfg.fw = dst_handle->stride; 1034 dst_cfg.fh = dst_handle->vstride; 1035 dst_cfg.yaddr = dst_handle->fd; 1036 1037 ALOGV("destination configuration:"); 1038 dump_gsc_img(dst_cfg); 1039 1040 gsc_data->gsc = exynos_gsc_create_exclusive(AVAILABLE_GSC_UNITS[gsc_idx], 1041 GSC_M2M_MODE, GSC_DUMMY); 1042 if (!gsc_data->gsc) { 1043 ALOGE("failed to create gscaler handle"); 1044 ret = -1; 1045 goto err_alloc; 1046 } 1047 1048 ret = exynos_gsc_config_exclusive(gsc_data->gsc, &src_cfg, &dst_cfg); 1049 if (ret < 0) { 1050 ALOGE("failed to configure gscaler %u", gsc_idx); 1051 goto err_gsc_config; 1052 } 1053 1054 ret = exynos_gsc_run_exclusive(gsc_data->gsc, &src_cfg, &dst_cfg); 1055 if (ret < 0) { 1056 ALOGE("failed to run gscaler %u", gsc_idx); 1057 goto err_gsc_config; 1058 } 1059 1060 gsc_data->src_cfg = src_cfg; 1061 gsc_data->dst_cfg = dst_cfg; 1062 1063 return 0; 1064 1065err_gsc_config: 1066 exynos_gsc_destroy(gsc_data->gsc); 1067 gsc_data->gsc = NULL; 1068err_alloc: 1069 for (size_t i = 0; i < NUM_GSC_DST_BUFS; i++) { 1070 if (gsc_data->dst_buf[i]) { 1071 alloc_device->free(alloc_device, gsc_data->dst_buf[i]); 1072 gsc_data->dst_buf[i] = NULL; 1073 } 1074 } 1075 memset(&gsc_data->src_cfg, 0, sizeof(gsc_data->src_cfg)); 1076 memset(&gsc_data->dst_cfg, 0, sizeof(gsc_data->dst_cfg)); 1077 return ret; 1078} 1079 1080static void exynos5_config_handle(private_handle_t *handle, 1081 hwc_rect_t &sourceCrop, hwc_rect_t &displayFrame, 1082 int32_t blending, s3c_fb_win_config &cfg) 1083{ 1084 cfg.state = cfg.S3C_FB_WIN_STATE_BUFFER; 1085 cfg.fd = handle->fd; 1086 cfg.x = displayFrame.left; 1087 cfg.y = displayFrame.top; 1088 cfg.w = WIDTH(displayFrame); 1089 cfg.h = HEIGHT(displayFrame); 1090 cfg.format = exynos5_format_to_s3c_format(handle->format); 1091 uint8_t bpp = exynos5_format_to_bpp(handle->format); 1092 cfg.offset = (sourceCrop.top * handle->stride + sourceCrop.left) * bpp / 8; 1093 cfg.stride = handle->stride * bpp / 8; 1094 cfg.blending = exynos5_blending_to_s3c_blending(blending); 1095} 1096 1097static void exynos5_config_overlay(hwc_layer_1_t *layer, s3c_fb_win_config &cfg, 1098 const private_module_t *gralloc_module) 1099{ 1100 if (layer->compositionType == HWC_BACKGROUND) { 1101 hwc_color_t color = layer->backgroundColor; 1102 cfg.state = cfg.S3C_FB_WIN_STATE_COLOR; 1103 cfg.color = (color.r << 16) | (color.g << 8) | color.b; 1104 cfg.x = 0; 1105 cfg.y = 0; 1106 cfg.w = gralloc_module->xres; 1107 cfg.h = gralloc_module->yres; 1108 return; 1109 } 1110 1111 private_handle_t *handle = private_handle_t::dynamicCast(layer->handle); 1112 exynos5_config_handle(handle, layer->sourceCrop, layer->displayFrame, 1113 layer->blending, cfg); 1114} 1115 1116static void exynos5_post_callback(void *data, private_handle_t *fb) 1117{ 1118 hwc_layer_1_t *hdmi_layer = NULL; 1119 exynos5_hwc_post_data_t *pdata = (exynos5_hwc_post_data_t *)data; 1120 1121 struct s3c_fb_win_config_data win_data; 1122 struct s3c_fb_win_config *config = win_data.config; 1123 memset(config, 0, sizeof(win_data.config)); 1124 1125 for (size_t i = 0; i < NUM_HW_WINDOWS; i++) { 1126 if ( pdata->overlay_map[i] != -1) { 1127 hwc_layer_1_t &layer = pdata->overlays[i]; 1128 private_handle_t *handle = 1129 private_handle_t::dynamicCast(layer.handle); 1130 1131 if (layer.acquireFenceFd != -1) { 1132 int err = sync_wait(layer.acquireFenceFd, 100); 1133 if (err != 0) 1134 ALOGW("fence for layer %zu didn't signal in 100 ms: %s", 1135 i, strerror(errno)); 1136 close(layer.acquireFenceFd); 1137 } 1138 1139 if (pdata->gsc_map[i].mode == exynos5_gsc_map_t::GSC_M2M) { 1140 int gsc_idx = pdata->gsc_map[i].idx; 1141 exynos5_config_gsc_m2m(layer, pdata->pdev->alloc_device, 1142 &pdata->pdev->gsc[gsc_idx], gsc_idx); 1143 } 1144 } 1145 } 1146 1147 for (size_t i = 0; i < NUM_HW_WINDOWS; i++) { 1148 if (i == pdata->fb_window) { 1149 hwc_rect_t rect = { 0, 0, fb->width, fb->height }; 1150 int32_t blending = (i == 0) ? HWC_BLENDING_NONE : 1151 HWC_BLENDING_PREMULT; 1152 exynos5_config_handle(fb, rect, rect, blending, config[i]); 1153 } else if ( pdata->overlay_map[i] != -1) { 1154 hwc_layer_1_t &layer = pdata->overlays[i]; 1155 private_handle_t *handle = 1156 private_handle_t::dynamicCast(layer.handle); 1157 1158 if (pdata->gsc_map[i].mode == exynos5_gsc_map_t::GSC_M2M) { 1159 int gsc_idx = pdata->gsc_map[i].idx; 1160 exynos5_gsc_data_t &gsc = pdata->pdev->gsc[gsc_idx]; 1161 1162 if (!gsc.gsc) { 1163 ALOGE("failed to queue gscaler %u input for layer %u", 1164 gsc_idx, i); 1165 continue; 1166 } 1167 1168 int err = exynos_gsc_stop_exclusive(gsc.gsc); 1169 exynos_gsc_destroy(gsc.gsc); 1170 gsc.gsc = NULL; 1171 if (err < 0) { 1172 ALOGE("failed to dequeue gscaler output for layer %u", i); 1173 continue; 1174 } 1175 1176 buffer_handle_t dst_buf = gsc.dst_buf[gsc.current_buf]; 1177 gsc.current_buf = (gsc.current_buf + 1) % NUM_GSC_DST_BUFS; 1178 private_handle_t *dst_handle = 1179 private_handle_t::dynamicCast(dst_buf); 1180 hwc_rect_t sourceCrop = { 0, 0, 1181 WIDTH(layer.displayFrame), HEIGHT(layer.displayFrame) }; 1182 exynos5_config_handle(dst_handle, sourceCrop, 1183 layer.displayFrame, layer.blending, config[i]); 1184 1185 if (handle->flags & GRALLOC_USAGE_EXTERNAL_DISP) 1186 hdmi_layer = &layer; 1187 } 1188 else { 1189 exynos5_config_overlay(&layer, config[i], 1190 pdata->pdev->gralloc_module); 1191 } 1192 } 1193 if (i == 0 && config[i].blending != S3C_FB_BLENDING_NONE) { 1194 ALOGV("blending not supported on window 0; forcing BLENDING_NONE"); 1195 config[i].blending = S3C_FB_BLENDING_NONE; 1196 } 1197 1198 ALOGV("window %u configuration:", i); 1199 dump_config(config[i]); 1200 } 1201 1202 int ret = ioctl(pdata->pdev->fd, S3CFB_WIN_CONFIG, &win_data); 1203 if (ret < 0) 1204 ALOGE("ioctl S3CFB_WIN_CONFIG failed: %d", errno); 1205 else { 1206 memcpy(pdata->pdev->last_config, &win_data.config, 1207 sizeof(win_data.config)); 1208 memcpy(pdata->pdev->last_gsc_map, pdata->gsc_map, 1209 sizeof(pdata->gsc_map)); 1210 for (size_t i = 0; i < NUM_HW_WINDOWS; i++) { 1211 if (i == pdata->fb_window) { 1212 pdata->pdev->last_handles[i] = NULL; 1213 } else if (pdata->overlay_map[i] != -1) { 1214 hwc_layer_1_t &layer = pdata->overlays[i]; 1215 pdata->pdev->last_handles[i] = layer.handle; 1216 } 1217 } 1218 } 1219 1220 if (pdata->pdev->hdmi_enabled) { 1221 if (hdmi_layer) { 1222 private_handle_t *handle = 1223 private_handle_t::dynamicCast(hdmi_layer->handle); 1224 hdmi_configure_layer(pdata->pdev, *hdmi_layer); 1225 hdmi_output(pdata->pdev, handle); 1226 } else { 1227 hdmi_configure_handle(pdata->pdev, fb); 1228 hdmi_output(pdata->pdev, fb); 1229 } 1230 } 1231 1232 pthread_mutex_lock(&pdata->completion_lock); 1233 pdata->fence = win_data.fence; 1234 pthread_cond_signal(&pdata->completion); 1235 pthread_mutex_unlock(&pdata->completion_lock); 1236} 1237 1238static int exynos5_set(struct hwc_composer_device_1 *dev, 1239 size_t numDisplays, hwc_display_contents_1_t** displays) 1240{ 1241 exynos5_hwc_composer_device_1_t *pdev = 1242 (exynos5_hwc_composer_device_1_t *)dev; 1243 1244 if (!numDisplays || !displays || !displays[0] || !displays[0]->dpy || !displays[0]->sur) 1245 return 0; 1246 1247 hwc_callback_queue_t *queue = NULL; 1248 pthread_mutex_t *lock = NULL; 1249 exynos5_hwc_post_data_t *data = NULL; 1250 1251 for (size_t i = 0; i < NUM_HW_WINDOWS; i++) { 1252 if (pdev->bufs.overlay_map[i] != -1) { 1253 pdev->bufs.overlays[i] = 1254 displays[0]->hwLayers[pdev->bufs.overlay_map[i]]; 1255 } 1256 } 1257 1258 data = (exynos5_hwc_post_data_t *) 1259 malloc(sizeof(exynos5_hwc_post_data_t)); 1260 memcpy(data, &pdev->bufs, sizeof(pdev->bufs)); 1261 1262 data->fence = -1; 1263 pthread_mutex_init(&data->completion_lock, NULL); 1264 pthread_cond_init(&data->completion, NULL); 1265 1266 if (displays[0]->numHwLayers && pdev->bufs.fb_window == NO_FB_NEEDED) { 1267 exynos5_post_callback(data, NULL); 1268 } else { 1269 1270 struct hwc_callback_entry entry; 1271 entry.callback = exynos5_post_callback; 1272 entry.data = data; 1273 1274 queue = reinterpret_cast<hwc_callback_queue_t *>( 1275 pdev->gralloc_module->queue); 1276 lock = const_cast<pthread_mutex_t *>( 1277 &pdev->gralloc_module->queue_lock); 1278 1279 pthread_mutex_lock(lock); 1280 queue->push_front(entry); 1281 pthread_mutex_unlock(lock); 1282 1283 EGLBoolean success = eglSwapBuffers((EGLDisplay)displays[0]->dpy, 1284 (EGLSurface)displays[0]->sur); 1285 if (!success) { 1286 ALOGE("HWC_EGL_ERROR"); 1287 if (displays[0]) { 1288 pthread_mutex_lock(lock); 1289 queue->removeAt(0); 1290 pthread_mutex_unlock(lock); 1291 free(data); 1292 } 1293 return HWC_EGL_ERROR; 1294 } 1295 } 1296 1297 1298 pthread_mutex_lock(&data->completion_lock); 1299 while (data->fence == -1) 1300 pthread_cond_wait(&data->completion, &data->completion_lock); 1301 pthread_mutex_unlock(&data->completion_lock); 1302 1303 for (size_t i = 0; i < NUM_HW_WINDOWS; i++) { 1304 if (pdev->bufs.overlay_map[i] != -1) { 1305 int dup_fd = dup(data->fence); 1306 if (dup_fd < 0) 1307 ALOGW("release fence dup failed: %s", strerror(errno)); 1308 displays[0]->hwLayers[pdev->bufs.overlay_map[i]].releaseFenceFd = dup_fd; 1309 } 1310 } 1311 close(data->fence); 1312 free(data); 1313 return 0; 1314} 1315 1316static void exynos5_registerProcs(struct hwc_composer_device_1* dev, 1317 hwc_procs_t const* procs) 1318{ 1319 struct exynos5_hwc_composer_device_1_t* pdev = 1320 (struct exynos5_hwc_composer_device_1_t*)dev; 1321 pdev->procs = procs; 1322} 1323 1324static int exynos5_query(struct hwc_composer_device_1* dev, int what, int *value) 1325{ 1326 struct exynos5_hwc_composer_device_1_t *pdev = 1327 (struct exynos5_hwc_composer_device_1_t *)dev; 1328 1329 switch (what) { 1330 case HWC_BACKGROUND_LAYER_SUPPORTED: 1331 // we support the background layer 1332 value[0] = 1; 1333 break; 1334 case HWC_VSYNC_PERIOD: 1335 // vsync period in nanosecond 1336 value[0] = 1000000000.0 / pdev->gralloc_module->fps; 1337 break; 1338 default: 1339 // unsupported query 1340 return -EINVAL; 1341 } 1342 return 0; 1343} 1344 1345static int exynos5_eventControl(struct hwc_composer_device_1 *dev, int dpy, 1346 int event, int enabled) 1347{ 1348 struct exynos5_hwc_composer_device_1_t *pdev = 1349 (struct exynos5_hwc_composer_device_1_t *)dev; 1350 1351 switch (event) { 1352 case HWC_EVENT_VSYNC: 1353 __u32 val = !!enabled; 1354 int err = ioctl(pdev->fd, S3CFB_SET_VSYNC_INT, &val); 1355 if (err < 0) { 1356 ALOGE("vsync ioctl failed"); 1357 return -errno; 1358 } 1359 1360 return 0; 1361 } 1362 1363 return -EINVAL; 1364} 1365 1366static void handle_hdmi_uevent(struct exynos5_hwc_composer_device_1_t *pdev, 1367 const char *buff, int len) 1368{ 1369 const char *s = buff; 1370 s += strlen(s) + 1; 1371 1372 while (*s) { 1373 if (!strncmp(s, "SWITCH_STATE=", strlen("SWITCH_STATE="))) 1374 pdev->hdmi_hpd = atoi(s + strlen("SWITCH_STATE=")) == 1; 1375 1376 s += strlen(s) + 1; 1377 if (s - buff >= len) 1378 break; 1379 } 1380 1381 if (pdev->hdmi_hpd) { 1382 if (hdmi_get_config(pdev)) { 1383 ALOGE("Error reading HDMI configuration"); 1384 pdev->hdmi_hpd = false; 1385 return; 1386 } 1387 } 1388 1389 ALOGV("HDMI HPD changed to %s", pdev->hdmi_hpd ? "enabled" : "disabled"); 1390 if (pdev->hdmi_hpd) 1391 ALOGI("HDMI Resolution changed to %dx%d", pdev->hdmi_h, pdev->hdmi_w); 1392 1393 /* hwc_dev->procs is set right after the device is opened, but there is 1394 * still a race condition where a hotplug event might occur after the open 1395 * but before the procs are registered. */ 1396 if (pdev->procs) 1397 pdev->procs->invalidate(pdev->procs); 1398} 1399 1400static void handle_vsync_event(struct exynos5_hwc_composer_device_1_t *pdev) 1401{ 1402 if (!pdev->procs) 1403 return; 1404 1405 int err = lseek(pdev->vsync_fd, 0, SEEK_SET); 1406 if (err < 0) { 1407 ALOGE("error seeking to vsync timestamp: %s", strerror(errno)); 1408 return; 1409 } 1410 1411 char buf[4096]; 1412 err = read(pdev->vsync_fd, buf, sizeof(buf)); 1413 if (err < 0) { 1414 ALOGE("error reading vsync timestamp: %s", strerror(errno)); 1415 return; 1416 } 1417 buf[sizeof(buf) - 1] = '\0'; 1418 1419 errno = 0; 1420 uint64_t timestamp = strtoull(buf, NULL, 0); 1421 if (!errno) 1422 pdev->procs->vsync(pdev->procs, 0, timestamp); 1423} 1424 1425static void *hwc_vsync_thread(void *data) 1426{ 1427 struct exynos5_hwc_composer_device_1_t *pdev = 1428 (struct exynos5_hwc_composer_device_1_t *)data; 1429 char uevent_desc[4096]; 1430 memset(uevent_desc, 0, sizeof(uevent_desc)); 1431 1432 setpriority(PRIO_PROCESS, 0, HAL_PRIORITY_URGENT_DISPLAY); 1433 1434 uevent_init(); 1435 1436 char temp[4096]; 1437 int err = read(pdev->vsync_fd, temp, sizeof(temp)); 1438 if (err < 0) { 1439 ALOGE("error reading vsync timestamp: %s", strerror(errno)); 1440 return NULL; 1441 } 1442 1443 struct pollfd fds[2]; 1444 fds[0].fd = pdev->vsync_fd; 1445 fds[0].events = POLLPRI; 1446 fds[1].fd = uevent_get_fd(); 1447 fds[1].events = POLLIN; 1448 1449 while (true) { 1450 int err = poll(fds, 2, -1); 1451 1452 if (err > 0) { 1453 if (fds[0].revents & POLLPRI) { 1454 handle_vsync_event(pdev); 1455 } 1456 else if (fds[1].revents & POLLIN) { 1457 int len = uevent_next_event(uevent_desc, 1458 sizeof(uevent_desc) - 2); 1459 1460 bool hdmi = !strcmp(uevent_desc, 1461 "change@/devices/virtual/switch/hdmi"); 1462 if (hdmi) 1463 handle_hdmi_uevent(pdev, uevent_desc, len); 1464 } 1465 } 1466 else if (err == -1) { 1467 if (errno == EINTR) 1468 break; 1469 ALOGE("error in vsync thread: %s", strerror(errno)); 1470 } 1471 } 1472 1473 return NULL; 1474} 1475 1476static int exynos5_blank(struct hwc_composer_device_1 *dev, int dpy, int blank) 1477{ 1478 struct exynos5_hwc_composer_device_1_t *pdev = 1479 (struct exynos5_hwc_composer_device_1_t *)dev; 1480 1481 int fb_blank = blank ? FB_BLANK_POWERDOWN : FB_BLANK_UNBLANK; 1482 int err = ioctl(pdev->fd, FBIOBLANK, fb_blank); 1483 if (err < 0) { 1484 ALOGE("%sblank ioctl failed", blank ? "" : "un"); 1485 return -errno; 1486 } 1487 1488 if (pdev->hdmi_hpd) { 1489 if (blank && !pdev->hdmi_blanked) 1490 hdmi_disable(pdev); 1491 pdev->hdmi_blanked = !!blank; 1492 } 1493 1494 return 0; 1495} 1496 1497static void exynos5_dump(hwc_composer_device_1* dev, char *buff, int buff_len) 1498{ 1499 if (buff_len <= 0) 1500 return; 1501 1502 struct exynos5_hwc_composer_device_1_t *pdev = 1503 (struct exynos5_hwc_composer_device_1_t *)dev; 1504 1505 android::String8 result; 1506 1507 result.appendFormat(" hdmi_enabled=%u\n", pdev->hdmi_enabled); 1508 if (pdev->hdmi_enabled) 1509 result.appendFormat(" w=%u, h=%u\n", pdev->hdmi_w, pdev->hdmi_h); 1510 result.append( 1511 " type | handle | color | blend | format | position | size | gsc \n" 1512 "----------+----------|----------+-------+--------+---------------+---------------------\n"); 1513 // 8_______ | 8_______ | 8_______ | 5____ | 6_____ | [5____,5____] | [5____,5____] | 3__ \n" 1514 1515 for (size_t i = 0; i < NUM_HW_WINDOWS; i++) { 1516 struct s3c_fb_win_config &config = pdev->last_config[i]; 1517 if (config.state == config.S3C_FB_WIN_STATE_DISABLED) { 1518 result.appendFormat(" %8s | %8s | %8s | %5s | %6s | %13s | %13s", 1519 "DISABLED", "-", "-", "-", "-", "-", "-"); 1520 } 1521 else { 1522 if (config.state == config.S3C_FB_WIN_STATE_COLOR) 1523 result.appendFormat(" %8s | %8s | %8x | %5s | %6s", "COLOR", 1524 "-", config.color, "-", "-"); 1525 else { 1526 if (pdev->last_handles[i]) 1527 result.appendFormat(" %8s | %8x", "OVERLAY", intptr_t(pdev->last_handles[i])); 1528 else 1529 result.appendFormat(" %8s | %8s", "FB", "-"); 1530 1531 result.appendFormat(" | %8s | %5x | %6x", "-", config.blending, 1532 config.format); 1533 } 1534 1535 result.appendFormat(" | [%5d,%5d] | [%5u,%5u]", config.x, config.y, 1536 config.w, config.h); 1537 } 1538 if (pdev->last_gsc_map[i].mode == exynos5_gsc_map_t::GSC_NONE) 1539 result.appendFormat(" | %3s", "-"); 1540 else 1541 result.appendFormat(" | %3d", 1542 AVAILABLE_GSC_UNITS[pdev->last_gsc_map[i].idx]); 1543 result.append("\n"); 1544 } 1545 1546 strlcpy(buff, result.string(), buff_len); 1547} 1548 1549static int exynos5_close(hw_device_t* device); 1550 1551static int exynos5_open(const struct hw_module_t *module, const char *name, 1552 struct hw_device_t **device) 1553{ 1554 int ret; 1555 int sw_fd; 1556 1557 if (strcmp(name, HWC_HARDWARE_COMPOSER)) { 1558 return -EINVAL; 1559 } 1560 1561 struct exynos5_hwc_composer_device_1_t *dev; 1562 dev = (struct exynos5_hwc_composer_device_1_t *)malloc(sizeof(*dev)); 1563 memset(dev, 0, sizeof(*dev)); 1564 1565 if (hw_get_module(GRALLOC_HARDWARE_MODULE_ID, 1566 (const struct hw_module_t **)&dev->gralloc_module)) { 1567 ALOGE("failed to get gralloc hw module"); 1568 ret = -EINVAL; 1569 goto err_get_module; 1570 } 1571 1572 if (gralloc_open((const hw_module_t *)dev->gralloc_module, 1573 &dev->alloc_device)) { 1574 ALOGE("failed to open gralloc"); 1575 ret = -EINVAL; 1576 goto err_get_module; 1577 } 1578 1579 dev->fd = open("/dev/graphics/fb0", O_RDWR); 1580 if (dev->fd < 0) { 1581 ALOGE("failed to open framebuffer"); 1582 ret = dev->fd; 1583 goto err_open_fb; 1584 } 1585 1586 dev->hdmi_mixer0 = open("/dev/v4l-subdev7", O_RDWR); 1587 if (dev->hdmi_layer0 < 0) { 1588 ALOGE("failed to open hdmi mixer0 subdev"); 1589 ret = dev->hdmi_layer0; 1590 goto err_ioctl; 1591 } 1592 1593 dev->hdmi_layer0 = open("/dev/video16", O_RDWR); 1594 if (dev->hdmi_layer0 < 0) { 1595 ALOGE("failed to open hdmi layer0 device"); 1596 ret = dev->hdmi_layer0; 1597 goto err_mixer0; 1598 } 1599 1600 dev->hdmi_layer1 = open("/dev/video17", O_RDWR); 1601 if (dev->hdmi_layer1 < 0) { 1602 ALOGE("failed to open hdmi layer1 device"); 1603 ret = dev->hdmi_layer1; 1604 goto err_hdmi0; 1605 } 1606 1607 dev->vsync_fd = open("/sys/devices/platform/exynos5-fb.1/vsync", O_RDONLY); 1608 if (dev->vsync_fd < 0) { 1609 ALOGE("failed to open vsync attribute"); 1610 ret = dev->vsync_fd; 1611 goto err_hdmi1; 1612 } 1613 1614 sw_fd = open("/sys/class/switch/hdmi/state", O_RDONLY); 1615 if (sw_fd) { 1616 char val; 1617 if (read(sw_fd, &val, 1) == 1 && val == '1') { 1618 dev->hdmi_hpd = true; 1619 if (hdmi_get_config(dev)) { 1620 ALOGE("Error reading HDMI configuration"); 1621 dev->hdmi_hpd = false; 1622 } 1623 } 1624 } 1625 1626 dev->base.common.tag = HARDWARE_DEVICE_TAG; 1627 dev->base.common.version = HWC_DEVICE_API_VERSION_1_0; 1628 dev->base.common.module = const_cast<hw_module_t *>(module); 1629 dev->base.common.close = exynos5_close; 1630 1631 dev->base.prepare = exynos5_prepare; 1632 dev->base.set = exynos5_set; 1633 dev->base.eventControl = exynos5_eventControl; 1634 dev->base.blank = exynos5_blank; 1635 dev->base.query = exynos5_query; 1636 dev->base.registerProcs = exynos5_registerProcs; 1637 dev->base.dump = exynos5_dump; 1638 1639 dev->bufs.pdev = dev; 1640 1641 *device = &dev->base.common; 1642 1643 ret = pthread_create(&dev->vsync_thread, NULL, hwc_vsync_thread, dev); 1644 if (ret) { 1645 ALOGE("failed to start vsync thread: %s", strerror(ret)); 1646 ret = -ret; 1647 goto err_vsync; 1648 } 1649 1650 return 0; 1651 1652err_vsync: 1653 close(dev->vsync_fd); 1654err_mixer0: 1655 close(dev->hdmi_mixer0); 1656err_hdmi1: 1657 close(dev->hdmi_layer0); 1658err_hdmi0: 1659 close(dev->hdmi_layer1); 1660err_ioctl: 1661 close(dev->fd); 1662err_open_fb: 1663 gralloc_close(dev->alloc_device); 1664err_get_module: 1665 free(dev); 1666 return ret; 1667} 1668 1669static int exynos5_close(hw_device_t *device) 1670{ 1671 struct exynos5_hwc_composer_device_1_t *dev = 1672 (struct exynos5_hwc_composer_device_1_t *)device; 1673 pthread_kill(dev->vsync_thread, SIGTERM); 1674 pthread_join(dev->vsync_thread, NULL); 1675 for (size_t i = 0; i < NUM_GSC_UNITS; i++) { 1676 if (dev->gsc[i].gsc) 1677 exynos_gsc_destroy(dev->gsc[i].gsc); 1678 for (size_t j = 0; i < NUM_GSC_DST_BUFS; j++) 1679 if (dev->gsc[i].dst_buf[j]) 1680 dev->alloc_device->free(dev->alloc_device, dev->gsc[i].dst_buf[j]); 1681 } 1682 gralloc_close(dev->alloc_device); 1683 close(dev->vsync_fd); 1684 close(dev->hdmi_mixer0); 1685 close(dev->hdmi_layer0); 1686 close(dev->hdmi_layer1); 1687 close(dev->fd); 1688 return 0; 1689} 1690 1691static struct hw_module_methods_t exynos5_hwc_module_methods = { 1692 open: exynos5_open, 1693}; 1694 1695hwc_module_t HAL_MODULE_INFO_SYM = { 1696 common: { 1697 tag: HARDWARE_MODULE_TAG, 1698 module_api_version: HWC_MODULE_API_VERSION_0_1, 1699 hal_api_version: HARDWARE_HAL_API_VERSION, 1700 id: HWC_HARDWARE_MODULE_ID, 1701 name: "Samsung exynos5 hwcomposer module", 1702 author: "Google", 1703 methods: &exynos5_hwc_module_methods, 1704 } 1705}; 1706