blob: a50a448f7dc266818adfb78060167adeb44f69bd [file] [log] [blame]
Greg Hackmann86eb1c62012-05-30 09:25:51 -07001/*
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 */
Greg Hackmann86eb1c62012-05-30 09:25:51 -070016#include <errno.h>
17#include <fcntl.h>
Greg Hackmann92b0aad2012-10-18 10:37:59 -070018#include <math.h>
Greg Hackmann29724852012-07-23 15:31:10 -070019#include <poll.h>
Greg Hackmann86eb1c62012-05-30 09:25:51 -070020#include <pthread.h>
21#include <stdio.h>
22#include <stdlib.h>
23
24#include <sys/ioctl.h>
25#include <sys/mman.h>
26#include <sys/time.h>
27#include <sys/resource.h>
28
29#include <s3c-fb.h>
30
31#include <EGL/egl.h>
32
Erik Gilling87e707e2012-06-29 17:35:13 -070033#define HWC_REMOVE_DEPRECATED_VERSIONS 1
34
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -070035#include <cutils/compiler.h>
Greg Hackmann86eb1c62012-05-30 09:25:51 -070036#include <cutils/log.h>
Greg Hackmann6e0f76d2012-09-17 17:47:09 -070037#include <cutils/properties.h>
Greg Hackmann86eb1c62012-05-30 09:25:51 -070038#include <hardware/gralloc.h>
39#include <hardware/hardware.h>
40#include <hardware/hwcomposer.h>
41#include <hardware_legacy/uevent.h>
Greg Hackmann600867e2012-08-23 12:58:02 -070042#include <utils/String8.h>
Greg Hackmann86eb1c62012-05-30 09:25:51 -070043#include <utils/Vector.h>
44
Greg Hackmannf4cc0c32012-05-30 09:28:52 -070045#include <sync/sync.h>
46
Greg Hackmann86eb1c62012-05-30 09:25:51 -070047#include "ion.h"
48#include "gralloc_priv.h"
Benoit Gobycdd61b32012-07-09 12:09:59 -070049#include "exynos_gscaler.h"
Greg Hackmann9130e702012-07-30 14:53:04 -070050#include "exynos_format.h"
Benoit Goby8bad7e32012-08-16 14:17:14 -070051#include "exynos_v4l2.h"
52#include "s5p_tvout_v4l2.h"
Greg Hackmann86eb1c62012-05-30 09:25:51 -070053
Greg Hackmannf9509d32012-09-12 09:49:29 -070054const size_t NUM_HW_WINDOWS = 5;
Greg Hackmann86eb1c62012-05-30 09:25:51 -070055const size_t NO_FB_NEEDED = NUM_HW_WINDOWS + 1;
Greg Hackmannf9509d32012-09-12 09:49:29 -070056const size_t MAX_PIXELS = 2560 * 1600 * 2;
Greg Hackmann9130e702012-07-30 14:53:04 -070057const size_t GSC_W_ALIGNMENT = 16;
58const size_t GSC_H_ALIGNMENT = 16;
Greg Hackmann92b0aad2012-10-18 10:37:59 -070059const size_t GSC_DST_CROP_W_ALIGNMENT_RGB888 = 32;
Sanghee Kim7b4c1322012-10-04 18:44:36 -070060const size_t GSC_DST_W_ALIGNMENT_RGB888 = 32;
61const size_t GSC_DST_H_ALIGNMENT_RGB888 = 1;
Greg Hackmannd6743822012-10-02 17:27:25 -070062const size_t FIMD_GSC_IDX = 0;
63const size_t HDMI_GSC_IDX = 1;
Greg Hackmann2ddbc742012-08-17 15:41:29 -070064const int AVAILABLE_GSC_UNITS[] = { 0, 3 };
65const size_t NUM_GSC_UNITS = sizeof(AVAILABLE_GSC_UNITS) /
66 sizeof(AVAILABLE_GSC_UNITS[0]);
Greg Hackmann67b2c312012-10-01 13:31:26 -070067const size_t BURSTLEN_BYTES = 16 * 8;
Benoit Goby93f9f5d2012-09-28 20:37:17 -070068const size_t NUM_HDMI_BUFFERS = 3;
Greg Hackmann86eb1c62012-05-30 09:25:51 -070069
Erik Gilling87e707e2012-06-29 17:35:13 -070070struct exynos5_hwc_composer_device_1_t;
Greg Hackmann86eb1c62012-05-30 09:25:51 -070071
Greg Hackmann9130e702012-07-30 14:53:04 -070072struct exynos5_gsc_map_t {
73 enum {
74 GSC_NONE = 0,
75 GSC_M2M,
76 // TODO: GSC_LOCAL_PATH
77 } mode;
78 int idx;
79};
80
Greg Hackmann86eb1c62012-05-30 09:25:51 -070081struct exynos5_hwc_post_data_t {
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -070082 int overlay_map[NUM_HW_WINDOWS];
83 exynos5_gsc_map_t gsc_map[NUM_HW_WINDOWS];
84 size_t fb_window;
Greg Hackmann86eb1c62012-05-30 09:25:51 -070085};
86
Greg Hackmann44a6d422012-09-17 17:31:30 -070087const size_t NUM_GSC_DST_BUFS = 3;
Greg Hackmann9130e702012-07-30 14:53:04 -070088struct exynos5_gsc_data_t {
89 void *gsc;
90 exynos_gsc_img src_cfg;
91 exynos_gsc_img dst_cfg;
92 buffer_handle_t dst_buf[NUM_GSC_DST_BUFS];
Greg Hackmannde6a0872012-10-10 16:57:24 -070093 int dst_buf_fence[NUM_GSC_DST_BUFS];
Greg Hackmann9130e702012-07-30 14:53:04 -070094 size_t current_buf;
95};
96
Benoit Goby93f9f5d2012-09-28 20:37:17 -070097struct hdmi_layer_t {
98 int id;
99 int fd;
100 bool enabled;
101 exynos_gsc_img cfg;
102
103 bool streaming;
104 size_t current_buf;
105 size_t queued_buf;
106};
107
Erik Gilling87e707e2012-06-29 17:35:13 -0700108struct exynos5_hwc_composer_device_1_t {
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700109 hwc_composer_device_1_t base;
Greg Hackmann86eb1c62012-05-30 09:25:51 -0700110
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700111 int fd;
Greg Hackmann29724852012-07-23 15:31:10 -0700112 int vsync_fd;
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700113 exynos5_hwc_post_data_t bufs;
Greg Hackmann86eb1c62012-05-30 09:25:51 -0700114
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700115 const private_module_t *gralloc_module;
Greg Hackmann9130e702012-07-30 14:53:04 -0700116 alloc_device_t *alloc_device;
Jesse Hallda5a71d2012-08-21 12:12:55 -0700117 const hwc_procs_t *procs;
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700118 pthread_t vsync_thread;
Greg Hackmann6e0f76d2012-09-17 17:47:09 -0700119 int force_gpu;
Benoit Gobycdd61b32012-07-09 12:09:59 -0700120
Greg Hackmannd92fe212012-09-11 14:28:41 -0700121 int32_t xres;
122 int32_t yres;
123 int32_t xdpi;
124 int32_t ydpi;
125 int32_t vsync_period;
126
Benoit Goby8bad7e32012-08-16 14:17:14 -0700127 int hdmi_mixer0;
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700128 bool hdmi_hpd;
Benoit Goby8bad7e32012-08-16 14:17:14 -0700129 bool hdmi_enabled;
Benoit Gobyad4e3582012-08-30 17:17:34 -0700130 bool hdmi_blanked;
Benoit Goby18893a32012-10-30 16:05:34 -0700131 bool hdmi_fb_needed;
Benoit Goby8bad7e32012-08-16 14:17:14 -0700132 int hdmi_w;
133 int hdmi_h;
Benoit Gobyb5501902012-10-01 00:29:01 -0700134
Benoit Gobyb5501902012-10-01 00:29:01 -0700135 hdmi_layer_t hdmi_layers[2];
Greg Hackmann9130e702012-07-30 14:53:04 -0700136
137 exynos5_gsc_data_t gsc[NUM_GSC_UNITS];
Greg Hackmann600867e2012-08-23 12:58:02 -0700138
139 struct s3c_fb_win_config last_config[NUM_HW_WINDOWS];
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -0700140 size_t last_fb_window;
Greg Hackmann600867e2012-08-23 12:58:02 -0700141 const void *last_handles[NUM_HW_WINDOWS];
142 exynos5_gsc_map_t last_gsc_map[NUM_HW_WINDOWS];
Greg Hackmann86eb1c62012-05-30 09:25:51 -0700143};
144
Greg Hackmannefd98532012-10-02 12:00:42 -0700145static void exynos5_cleanup_gsc_m2m(exynos5_hwc_composer_device_1_t *pdev,
146 size_t gsc_idx);
147
Greg Hackmann9130e702012-07-30 14:53:04 -0700148static void dump_handle(private_handle_t *h)
149{
Greg Hackmanneba34a92012-08-14 16:10:05 -0700150 ALOGV("\t\tformat = %d, width = %u, height = %u, stride = %u, vstride = %u",
151 h->format, h->width, h->height, h->stride, h->vstride);
Greg Hackmann9130e702012-07-30 14:53:04 -0700152}
153
Erik Gilling87e707e2012-06-29 17:35:13 -0700154static void dump_layer(hwc_layer_1_t const *l)
Greg Hackmann86eb1c62012-05-30 09:25:51 -0700155{
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700156 ALOGV("\ttype=%d, flags=%08x, handle=%p, tr=%02x, blend=%04x, "
157 "{%d,%d,%d,%d}, {%d,%d,%d,%d}",
158 l->compositionType, l->flags, l->handle, l->transform,
159 l->blending,
160 l->sourceCrop.left,
161 l->sourceCrop.top,
162 l->sourceCrop.right,
163 l->sourceCrop.bottom,
164 l->displayFrame.left,
165 l->displayFrame.top,
166 l->displayFrame.right,
167 l->displayFrame.bottom);
Greg Hackmann86eb1c62012-05-30 09:25:51 -0700168
Greg Hackmann9130e702012-07-30 14:53:04 -0700169 if(l->handle && !(l->flags & HWC_SKIP_LAYER))
170 dump_handle(private_handle_t::dynamicCast(l->handle));
Greg Hackmann86eb1c62012-05-30 09:25:51 -0700171}
172
173static void dump_config(s3c_fb_win_config &c)
174{
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700175 ALOGV("\tstate = %u", c.state);
176 if (c.state == c.S3C_FB_WIN_STATE_BUFFER) {
177 ALOGV("\t\tfd = %d, offset = %u, stride = %u, "
178 "x = %d, y = %d, w = %u, h = %u, "
Greg Hackmann93cc5e72012-08-03 13:29:33 -0700179 "format = %u, blending = %u",
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700180 c.fd, c.offset, c.stride,
181 c.x, c.y, c.w, c.h,
Greg Hackmann93cc5e72012-08-03 13:29:33 -0700182 c.format, c.blending);
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700183 }
184 else if (c.state == c.S3C_FB_WIN_STATE_COLOR) {
185 ALOGV("\t\tcolor = %u", c.color);
186 }
Greg Hackmann86eb1c62012-05-30 09:25:51 -0700187}
188
Greg Hackmann9130e702012-07-30 14:53:04 -0700189static void dump_gsc_img(exynos_gsc_img &c)
190{
191 ALOGV("\tx = %u, y = %u, w = %u, h = %u, fw = %u, fh = %u",
192 c.x, c.y, c.w, c.h, c.fw, c.fh);
193 ALOGV("\taddr = {%u, %u, %u}, rot = %u, cacheable = %u, drmMode = %u",
194 c.yaddr, c.uaddr, c.vaddr, c.rot, c.cacheable, c.drmMode);
195}
196
Greg Hackmann86eb1c62012-05-30 09:25:51 -0700197inline int WIDTH(const hwc_rect &rect) { return rect.right - rect.left; }
198inline int HEIGHT(const hwc_rect &rect) { return rect.bottom - rect.top; }
Greg Hackmann31991d52012-07-13 13:23:11 -0700199template<typename T> inline T max(T a, T b) { return (a > b) ? a : b; }
200template<typename T> inline T min(T a, T b) { return (a < b) ? a : b; }
201
Greg Hackmann02893a42012-10-02 11:39:13 -0700202static int dup_or_warn(int fence)
203{
204 int dup_fd = dup(fence);
205 if (dup_fd < 0)
206 ALOGW("fence dup failed: %s", strerror(errno));
207 return dup_fd;
208}
209
210static int merge_or_warn(const char *name, int f1, int f2)
211{
212 int merge_fd = sync_merge(name, f1, f2);
213 if (merge_fd < 0)
214 ALOGW("fence merge failed: %s", strerror(errno));
215 return merge_fd;
216}
217
Greg Hackmann92b0aad2012-10-18 10:37:59 -0700218template<typename T> void align_crop_and_center(T &w, T &h,
219 hwc_rect_t *crop, size_t alignment)
220{
221 double aspect = 1.0 * h / w;
222 T w_orig = w, h_orig = h;
223
224 w = ALIGN(w, alignment);
225 h = round(aspect * w);
226 if (crop) {
227 crop->left = (w - w_orig) / 2;
228 crop->top = (h - h_orig) / 2;
229 crop->right = crop->left + w_orig;
230 crop->bottom = crop->top + h_orig;
231 }
232}
233
Greg Hackmann31991d52012-07-13 13:23:11 -0700234static bool is_transformed(const hwc_layer_1_t &layer)
235{
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700236 return layer.transform != 0;
Greg Hackmann31991d52012-07-13 13:23:11 -0700237}
Greg Hackmann86eb1c62012-05-30 09:25:51 -0700238
Greg Hackmann9130e702012-07-30 14:53:04 -0700239static bool is_rotated(const hwc_layer_1_t &layer)
240{
241 return (layer.transform & HAL_TRANSFORM_ROT_90) ||
242 (layer.transform & HAL_TRANSFORM_ROT_180);
243}
244
Erik Gilling87e707e2012-06-29 17:35:13 -0700245static bool is_scaled(const hwc_layer_1_t &layer)
Greg Hackmann86eb1c62012-05-30 09:25:51 -0700246{
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700247 return WIDTH(layer.displayFrame) != WIDTH(layer.sourceCrop) ||
248 HEIGHT(layer.displayFrame) != HEIGHT(layer.sourceCrop);
Greg Hackmann86eb1c62012-05-30 09:25:51 -0700249}
250
Benoit Goby8bad7e32012-08-16 14:17:14 -0700251static inline bool gsc_dst_cfg_changed(exynos_gsc_img &c1, exynos_gsc_img &c2)
252{
253 return c1.x != c2.x ||
254 c1.y != c2.y ||
255 c1.w != c2.w ||
256 c1.h != c2.h ||
257 c1.format != c2.format ||
258 c1.rot != c2.rot ||
259 c1.cacheable != c2.cacheable ||
260 c1.drmMode != c2.drmMode;
261}
262
263static inline bool gsc_src_cfg_changed(exynos_gsc_img &c1, exynos_gsc_img &c2)
264{
265 return gsc_dst_cfg_changed(c1, c2) ||
266 c1.fw != c2.fw ||
267 c1.fh != c2.fh;
268}
269
Greg Hackmann86eb1c62012-05-30 09:25:51 -0700270static enum s3c_fb_pixel_format exynos5_format_to_s3c_format(int format)
271{
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700272 switch (format) {
273 case HAL_PIXEL_FORMAT_RGBA_8888:
274 return S3C_FB_PIXEL_FORMAT_RGBA_8888;
275 case HAL_PIXEL_FORMAT_RGBX_8888:
276 return S3C_FB_PIXEL_FORMAT_RGBX_8888;
277 case HAL_PIXEL_FORMAT_RGBA_5551:
278 return S3C_FB_PIXEL_FORMAT_RGBA_5551;
Sanghee Kim05cbd792012-09-14 23:58:28 -0700279 case HAL_PIXEL_FORMAT_RGB_565:
280 return S3C_FB_PIXEL_FORMAT_RGB_565;
Greg Hackmann9eb2a022012-09-26 09:37:12 -0700281 case HAL_PIXEL_FORMAT_BGRA_8888:
282 return S3C_FB_PIXEL_FORMAT_BGRA_8888;
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700283 default:
284 return S3C_FB_PIXEL_FORMAT_MAX;
285 }
Greg Hackmann86eb1c62012-05-30 09:25:51 -0700286}
287
288static bool exynos5_format_is_supported(int format)
289{
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700290 return exynos5_format_to_s3c_format(format) < S3C_FB_PIXEL_FORMAT_MAX;
Greg Hackmann86eb1c62012-05-30 09:25:51 -0700291}
292
Greg Hackmannf8c24e52012-08-14 15:50:51 -0700293static bool exynos5_format_is_rgb(int format)
294{
295 switch (format) {
296 case HAL_PIXEL_FORMAT_RGBA_8888:
297 case HAL_PIXEL_FORMAT_RGBX_8888:
298 case HAL_PIXEL_FORMAT_RGB_888:
299 case HAL_PIXEL_FORMAT_RGB_565:
300 case HAL_PIXEL_FORMAT_BGRA_8888:
301 case HAL_PIXEL_FORMAT_RGBA_5551:
302 case HAL_PIXEL_FORMAT_RGBA_4444:
303 return true;
304
305 default:
306 return false;
307 }
308}
309
Greg Hackmann86eb1c62012-05-30 09:25:51 -0700310static bool exynos5_format_is_supported_by_gscaler(int format)
311{
Greg Hackmann9130e702012-07-30 14:53:04 -0700312 switch (format) {
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700313 case HAL_PIXEL_FORMAT_RGBX_8888:
314 case HAL_PIXEL_FORMAT_RGB_565:
Rebecca Schultz Zavinc853be72012-08-23 00:03:05 -0700315 case HAL_PIXEL_FORMAT_EXYNOS_YV12:
Greg Hackmann9130e702012-07-30 14:53:04 -0700316 case HAL_PIXEL_FORMAT_YCbCr_420_SP:
Greg Hackmann9130e702012-07-30 14:53:04 -0700317 case HAL_PIXEL_FORMAT_YCbCr_420_SP_TILED:
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700318 return true;
Greg Hackmann86eb1c62012-05-30 09:25:51 -0700319
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700320 default:
321 return false;
322 }
Greg Hackmann86eb1c62012-05-30 09:25:51 -0700323}
324
Greg Hackmann296668e2012-08-14 15:51:40 -0700325static bool exynos5_format_is_ycrcb(int format)
326{
Rebecca Schultz Zavinc853be72012-08-23 00:03:05 -0700327 return format == HAL_PIXEL_FORMAT_EXYNOS_YV12;
Greg Hackmann296668e2012-08-14 15:51:40 -0700328}
329
Greg Hackmann9130e702012-07-30 14:53:04 -0700330static bool exynos5_format_requires_gscaler(int format)
331{
Sanghee Kim05cbd792012-09-14 23:58:28 -0700332 return (exynos5_format_is_supported_by_gscaler(format) &&
333 (format != HAL_PIXEL_FORMAT_RGBX_8888) && (format != HAL_PIXEL_FORMAT_RGB_565));
Greg Hackmann9130e702012-07-30 14:53:04 -0700334}
335
Greg Hackmann86eb1c62012-05-30 09:25:51 -0700336static uint8_t exynos5_format_to_bpp(int format)
337{
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700338 switch (format) {
339 case HAL_PIXEL_FORMAT_RGBA_8888:
340 case HAL_PIXEL_FORMAT_RGBX_8888:
Greg Hackmann9eb2a022012-09-26 09:37:12 -0700341 case HAL_PIXEL_FORMAT_BGRA_8888:
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700342 return 32;
Greg Hackmann86eb1c62012-05-30 09:25:51 -0700343
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700344 case HAL_PIXEL_FORMAT_RGBA_5551:
345 case HAL_PIXEL_FORMAT_RGBA_4444:
Sanghee Kim05cbd792012-09-14 23:58:28 -0700346 case HAL_PIXEL_FORMAT_RGB_565:
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700347 return 16;
Greg Hackmann86eb1c62012-05-30 09:25:51 -0700348
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700349 default:
350 ALOGW("unrecognized pixel format %u", format);
351 return 0;
352 }
Greg Hackmann86eb1c62012-05-30 09:25:51 -0700353}
354
Greg Hackmann2a19eb12012-09-27 14:09:18 -0700355static bool is_x_aligned(const hwc_layer_1_t &layer, int format)
356{
357 if (!exynos5_format_is_supported(format))
358 return true;
359
360 uint8_t bpp = exynos5_format_to_bpp(format);
361 uint8_t pixel_alignment = 32 / bpp;
362
363 return (layer.displayFrame.left % pixel_alignment) == 0 &&
364 (layer.displayFrame.right % pixel_alignment) == 0;
365}
366
Greg Hackmann92b0aad2012-10-18 10:37:59 -0700367static bool dst_crop_w_aligned(int dest_w)
Sanghee Kim3f32ce52012-10-09 20:04:23 -0700368{
Sanghee Kim3f32ce52012-10-09 20:04:23 -0700369 int dst_crop_w_alignement;
370
Sanghee Kim3f32ce52012-10-09 20:04:23 -0700371 /* GSC's dst crop size should be aligned 128Bytes */
Greg Hackmann92b0aad2012-10-18 10:37:59 -0700372 dst_crop_w_alignement = GSC_DST_CROP_W_ALIGNMENT_RGB888;
Sanghee Kim3f32ce52012-10-09 20:04:23 -0700373
374 return (dest_w % dst_crop_w_alignement) == 0;
375}
376
Greg Hackmann227ae8a2012-08-03 16:16:58 -0700377static bool exynos5_supports_gscaler(hwc_layer_1_t &layer, int format,
378 bool local_path)
Greg Hackmann9130e702012-07-30 14:53:04 -0700379{
380 private_handle_t *handle = private_handle_t::dynamicCast(layer.handle);
381
Rebecca Schultz Zavin23cd5952012-09-12 00:30:52 -0700382 int max_w = is_rotated(layer) ? 2048 : 4800;
383 int max_h = is_rotated(layer) ? 2048 : 3344;
Greg Hackmann9130e702012-07-30 14:53:04 -0700384
Rebecca Schultz Zavin23cd5952012-09-12 00:30:52 -0700385 bool rot90or270 = !!(layer.transform & HAL_TRANSFORM_ROT_90);
386 // n.b.: HAL_TRANSFORM_ROT_270 = HAL_TRANSFORM_ROT_90 |
387 // HAL_TRANSFORM_ROT_180
Greg Hackmann9130e702012-07-30 14:53:04 -0700388
Rebecca Schultz Zavin23cd5952012-09-12 00:30:52 -0700389 int src_w = WIDTH(layer.sourceCrop), src_h = HEIGHT(layer.sourceCrop);
390 int dest_w, dest_h;
391 if (rot90or270) {
392 dest_w = HEIGHT(layer.displayFrame);
393 dest_h = WIDTH(layer.displayFrame);
394 } else {
395 dest_w = WIDTH(layer.displayFrame);
396 dest_h = HEIGHT(layer.displayFrame);
397 }
Greg Hackmann92b0aad2012-10-18 10:37:59 -0700398
399 if (handle->flags & GRALLOC_USAGE_PROTECTED)
400 align_crop_and_center(dest_w, dest_h, NULL,
401 GSC_DST_CROP_W_ALIGNMENT_RGB888);
402
Rebecca Schultz Zavin23cd5952012-09-12 00:30:52 -0700403 int max_downscale = local_path ? 4 : 16;
404 const int max_upscale = 8;
Greg Hackmann227ae8a2012-08-03 16:16:58 -0700405
Rebecca Schultz Zavin23cd5952012-09-12 00:30:52 -0700406 return exynos5_format_is_supported_by_gscaler(format) &&
Greg Hackmann92b0aad2012-10-18 10:37:59 -0700407 dst_crop_w_aligned(dest_w) &&
Rebecca Schultz Zavin23cd5952012-09-12 00:30:52 -0700408 handle->stride <= max_w &&
409 handle->stride % GSC_W_ALIGNMENT == 0 &&
410 src_w <= dest_w * max_downscale &&
411 dest_w <= src_w * max_upscale &&
412 handle->vstride <= max_h &&
413 handle->vstride % GSC_H_ALIGNMENT == 0 &&
414 src_h <= dest_h * max_downscale &&
415 dest_h <= src_h * max_upscale &&
416 // per 46.2
417 (!rot90or270 || layer.sourceCrop.top % 2 == 0) &&
418 (!rot90or270 || layer.sourceCrop.left % 2 == 0);
419 // per 46.3.1.6
Greg Hackmann9130e702012-07-30 14:53:04 -0700420}
421
Greg Hackmann09c45c22012-09-20 09:35:37 -0700422static bool exynos5_requires_gscaler(hwc_layer_1_t &layer, int format)
423{
424 return exynos5_format_requires_gscaler(format) || is_scaled(layer)
Greg Hackmann2a19eb12012-09-27 14:09:18 -0700425 || is_transformed(layer) || !is_x_aligned(layer, format);
Greg Hackmann09c45c22012-09-20 09:35:37 -0700426}
427
Benoit Gobyd6bb7ce2012-08-09 16:11:22 -0700428int hdmi_get_config(struct exynos5_hwc_composer_device_1_t *dev)
429{
430 struct v4l2_dv_preset preset;
431 struct v4l2_dv_enum_preset enum_preset;
Benoit Gobyd6bb7ce2012-08-09 16:11:22 -0700432 int index = 0;
433 bool found = false;
434 int ret;
435
Benoit Goby93f9f5d2012-09-28 20:37:17 -0700436 if (ioctl(dev->hdmi_layers[0].fd, VIDIOC_G_DV_PRESET, &preset) < 0) {
Benoit Gobyd6bb7ce2012-08-09 16:11:22 -0700437 ALOGE("%s: g_dv_preset error, %d", __func__, errno);
438 return -1;
439 }
440
441 while (true) {
442 enum_preset.index = index++;
Benoit Goby93f9f5d2012-09-28 20:37:17 -0700443 ret = ioctl(dev->hdmi_layers[0].fd, VIDIOC_ENUM_DV_PRESETS, &enum_preset);
Benoit Gobyd6bb7ce2012-08-09 16:11:22 -0700444
445 if (ret < 0) {
446 if (errno == EINVAL)
447 break;
448 ALOGE("%s: enum_dv_presets error, %d", __func__, errno);
449 return -1;
450 }
451
452 ALOGV("%s: %d preset=%02d width=%d height=%d name=%s",
453 __func__, enum_preset.index, enum_preset.preset,
454 enum_preset.width, enum_preset.height, enum_preset.name);
455
456 if (preset.preset == enum_preset.preset) {
Benoit Goby8bad7e32012-08-16 14:17:14 -0700457 dev->hdmi_w = enum_preset.width;
458 dev->hdmi_h = enum_preset.height;
Benoit Gobyd6bb7ce2012-08-09 16:11:22 -0700459 found = true;
460 }
461 }
462
463 return found ? 0 : -1;
464}
465
Greg Hackmann93cc5e72012-08-03 13:29:33 -0700466static enum s3c_fb_blending exynos5_blending_to_s3c_blending(int32_t blending)
467{
468 switch (blending) {
469 case HWC_BLENDING_NONE:
470 return S3C_FB_BLENDING_NONE;
471 case HWC_BLENDING_PREMULT:
472 return S3C_FB_BLENDING_PREMULT;
473 case HWC_BLENDING_COVERAGE:
474 return S3C_FB_BLENDING_COVERAGE;
475
476 default:
477 return S3C_FB_BLENDING_MAX;
478 }
479}
480
481static bool exynos5_blending_is_supported(int32_t blending)
482{
483 return exynos5_blending_to_s3c_blending(blending) < S3C_FB_BLENDING_MAX;
484}
485
Benoit Goby93f9f5d2012-09-28 20:37:17 -0700486
487static int hdmi_enable_layer(struct exynos5_hwc_composer_device_1_t *dev,
488 hdmi_layer_t &hl)
Benoit Goby8bad7e32012-08-16 14:17:14 -0700489{
Benoit Goby93f9f5d2012-09-28 20:37:17 -0700490 if (hl.enabled)
491 return 0;
492
Benoit Goby8bad7e32012-08-16 14:17:14 -0700493 struct v4l2_requestbuffers reqbuf;
Benoit Goby8bad7e32012-08-16 14:17:14 -0700494 memset(&reqbuf, 0, sizeof(reqbuf));
Benoit Goby93f9f5d2012-09-28 20:37:17 -0700495 reqbuf.count = NUM_HDMI_BUFFERS;
Benoit Goby8bad7e32012-08-16 14:17:14 -0700496 reqbuf.type = V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE;
Benoit Goby93f9f5d2012-09-28 20:37:17 -0700497 reqbuf.memory = V4L2_MEMORY_DMABUF;
498 if (exynos_v4l2_reqbufs(hl.fd, &reqbuf) < 0) {
499 ALOGE("%s: layer%d: reqbufs failed %d", __func__, hl.id, errno);
Benoit Goby8bad7e32012-08-16 14:17:14 -0700500 return -1;
501 }
502
Benoit Goby93f9f5d2012-09-28 20:37:17 -0700503 if (reqbuf.count != NUM_HDMI_BUFFERS) {
504 ALOGE("%s: layer%d: didn't get buffer", __func__, hl.id);
Benoit Goby8bad7e32012-08-16 14:17:14 -0700505 return -1;
506 }
507
Benoit Gobyb5501902012-10-01 00:29:01 -0700508 if (hl.id == 1) {
509 if (exynos_v4l2_s_ctrl(hl.fd, V4L2_CID_TV_PIXEL_BLEND_ENABLE, 1) < 0) {
510 ALOGE("%s: layer%d: PIXEL_BLEND_ENABLE failed %d", __func__,
511 hl.id, errno);
512 return -1;
513 }
514 }
515
Benoit Goby93f9f5d2012-09-28 20:37:17 -0700516 ALOGV("%s: layer%d enabled", __func__, hl.id);
517 hl.enabled = true;
Benoit Goby8bad7e32012-08-16 14:17:14 -0700518 return 0;
519}
520
Benoit Goby93f9f5d2012-09-28 20:37:17 -0700521static void hdmi_disable_layer(struct exynos5_hwc_composer_device_1_t *dev,
522 hdmi_layer_t &hl)
Benoit Goby8bad7e32012-08-16 14:17:14 -0700523{
Benoit Goby93f9f5d2012-09-28 20:37:17 -0700524 if (!hl.enabled)
525 return;
526
527 if (hl.streaming) {
528 if (exynos_v4l2_streamoff(hl.fd, V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE) < 0)
529 ALOGE("%s: layer%d: streamoff failed %d", __func__, hl.id, errno);
530 hl.streaming = false;
531 }
532
Benoit Goby8bad7e32012-08-16 14:17:14 -0700533 struct v4l2_requestbuffers reqbuf;
Benoit Goby8bad7e32012-08-16 14:17:14 -0700534 memset(&reqbuf, 0, sizeof(reqbuf));
Benoit Goby8bad7e32012-08-16 14:17:14 -0700535 reqbuf.type = V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE;
Benoit Goby93f9f5d2012-09-28 20:37:17 -0700536 reqbuf.memory = V4L2_MEMORY_DMABUF;
537 if (exynos_v4l2_reqbufs(hl.fd, &reqbuf) < 0)
538 ALOGE("%s: layer%d: reqbufs failed %d", __func__, hl.id, errno);
Benoit Goby8bad7e32012-08-16 14:17:14 -0700539
Benoit Goby93f9f5d2012-09-28 20:37:17 -0700540 memset(&hl.cfg, 0, sizeof(hl.cfg));
541 hl.current_buf = 0;
542 hl.queued_buf = 0;
543 hl.enabled = false;
544
545 ALOGV("%s: layer%d disabled", __func__, hl.id);
Benoit Goby8bad7e32012-08-16 14:17:14 -0700546}
547
Benoit Goby18893a32012-10-30 16:05:34 -0700548static void hdmi_hide_layer(struct exynos5_hwc_composer_device_1_t *dev,
549 hdmi_layer_t &hl)
550{
551 if (exynos_v4l2_s_ctrl(hl.fd, V4L2_CID_TV_LAYER_PRIO, 0) < 0)
552 ALOGE("%s: layer%d: LAYER_PRIO failed %d", __func__,
553 hl.id, errno);
554}
555
556static void hdmi_show_layer(struct exynos5_hwc_composer_device_1_t *dev,
557 hdmi_layer_t &hl)
558{
559 int prio = hl.id ? 3 : 2;
560
561 if (exynos_v4l2_s_ctrl(hl.fd, V4L2_CID_TV_LAYER_PRIO, prio) < 0)
562 ALOGE("%s: layer%d: LAYER_PRIO failed %d", __func__,
563 hl.id, errno);
564}
565
Benoit Gobycdd61b32012-07-09 12:09:59 -0700566static int hdmi_enable(struct exynos5_hwc_composer_device_1_t *dev)
567{
Benoit Goby8bad7e32012-08-16 14:17:14 -0700568 if (dev->hdmi_enabled)
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700569 return 0;
Benoit Gobycdd61b32012-07-09 12:09:59 -0700570
Benoit Gobyad4e3582012-08-30 17:17:34 -0700571 if (dev->hdmi_blanked)
572 return 0;
573
Benoit Goby93f9f5d2012-09-28 20:37:17 -0700574 struct v4l2_subdev_format sd_fmt;
575 memset(&sd_fmt, 0, sizeof(sd_fmt));
576 sd_fmt.pad = MIXER_G0_SUBDEV_PAD_SINK;
577 sd_fmt.which = V4L2_SUBDEV_FORMAT_ACTIVE;
578 sd_fmt.format.width = dev->hdmi_w;
579 sd_fmt.format.height = dev->hdmi_h;
580 sd_fmt.format.code = V4L2_MBUS_FMT_XRGB8888_4X8_LE;
581 if (exynos_subdev_s_fmt(dev->hdmi_mixer0, &sd_fmt) < 0) {
582 ALOGE("%s: s_fmt failed pad=%d", __func__, sd_fmt.pad);
Benoit Goby8bad7e32012-08-16 14:17:14 -0700583 return -1;
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700584 }
Benoit Gobycdd61b32012-07-09 12:09:59 -0700585
Benoit Goby93f9f5d2012-09-28 20:37:17 -0700586 struct v4l2_subdev_crop sd_crop;
587 memset(&sd_crop, 0, sizeof(sd_crop));
588 sd_crop.pad = MIXER_G0_SUBDEV_PAD_SINK;
589 sd_crop.which = V4L2_SUBDEV_FORMAT_ACTIVE;
590 sd_crop.rect.width = dev->hdmi_w;
591 sd_crop.rect.height = dev->hdmi_h;
592 if (exynos_subdev_s_crop(dev->hdmi_mixer0, &sd_crop) < 0) {
593 ALOGE("%s: s_crop failed pad=%d", __func__, sd_crop.pad);
594 return -1;
595 }
596
597 memset(&sd_fmt, 0, sizeof(sd_fmt));
598 sd_fmt.pad = MIXER_G0_SUBDEV_PAD_SOURCE;
599 sd_fmt.which = V4L2_SUBDEV_FORMAT_ACTIVE;
600 sd_fmt.format.width = dev->hdmi_w;
601 sd_fmt.format.height = dev->hdmi_h;
602 sd_fmt.format.code = V4L2_MBUS_FMT_XRGB8888_4X8_LE;
603 if (exynos_subdev_s_fmt(dev->hdmi_mixer0, &sd_fmt) < 0) {
604 ALOGE("%s: s_fmt failed pad=%d", __func__, sd_fmt.pad);
605 return -1;
606 }
607
608 memset(&sd_crop, 0, sizeof(sd_crop));
609 sd_crop.pad = MIXER_G0_SUBDEV_PAD_SOURCE;
610 sd_crop.which = V4L2_SUBDEV_FORMAT_ACTIVE;
611 sd_crop.rect.width = dev->hdmi_w;
612 sd_crop.rect.height = dev->hdmi_h;
613 if (exynos_subdev_s_crop(dev->hdmi_mixer0, &sd_crop) < 0) {
614 ALOGE("%s: s_crop failed pad=%d", __func__, sd_crop.pad);
615 return -1;
616 }
617
Benoit Goby56208452012-10-23 17:49:52 -0700618 char value[PROPERTY_VALUE_MAX];
619 property_get("persist.hdmi.hdcp_enabled", value, "1");
620 int hdcp_enabled = atoi(value);
621
622 if (exynos_v4l2_s_ctrl(dev->hdmi_layers[1].fd, V4L2_CID_TV_HDCP_ENABLE,
623 hdcp_enabled) < 0)
624 ALOGE("%s: s_ctrl(CID_TV_HDCP_ENABLE) failed %d", __func__, errno);
625
626 /* "3" is RGB709_16_235 */
627 property_get("persist.hdmi.color_range", value, "3");
628 int color_range = atoi(value);
629
630 if (exynos_v4l2_s_ctrl(dev->hdmi_layers[1].fd, V4L2_CID_TV_SET_COLOR_RANGE,
631 color_range) < 0)
632 ALOGE("%s: s_ctrl(CID_TV_COLOR_RANGE) failed %d", __func__, errno);
633
Benoit Gobyb5501902012-10-01 00:29:01 -0700634 hdmi_enable_layer(dev, dev->hdmi_layers[1]);
Benoit Goby93f9f5d2012-09-28 20:37:17 -0700635
Benoit Goby8bad7e32012-08-16 14:17:14 -0700636 dev->hdmi_enabled = true;
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700637 return 0;
Benoit Gobycdd61b32012-07-09 12:09:59 -0700638}
639
640static void hdmi_disable(struct exynos5_hwc_composer_device_1_t *dev)
641{
Benoit Goby8bad7e32012-08-16 14:17:14 -0700642 if (!dev->hdmi_enabled)
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700643 return;
Benoit Goby93f9f5d2012-09-28 20:37:17 -0700644
645 hdmi_disable_layer(dev, dev->hdmi_layers[0]);
Benoit Gobyb5501902012-10-01 00:29:01 -0700646 hdmi_disable_layer(dev, dev->hdmi_layers[1]);
647
Greg Hackmannefd98532012-10-02 12:00:42 -0700648 exynos5_cleanup_gsc_m2m(dev, HDMI_GSC_IDX);
Benoit Goby8bad7e32012-08-16 14:17:14 -0700649 dev->hdmi_enabled = false;
Benoit Gobycdd61b32012-07-09 12:09:59 -0700650}
651
Benoit Goby93f9f5d2012-09-28 20:37:17 -0700652static int hdmi_output(struct exynos5_hwc_composer_device_1_t *dev,
653 hdmi_layer_t &hl,
Benoit Gobyb5501902012-10-01 00:29:01 -0700654 hwc_layer_1_t &layer,
Benoit Goby181e92b2012-10-04 16:35:57 -0700655 private_handle_t *h,
656 int acquireFenceFd,
657 int *releaseFenceFd)
Benoit Goby8bad7e32012-08-16 14:17:14 -0700658{
Benoit Goby93f9f5d2012-09-28 20:37:17 -0700659 int ret = 0;
Benoit Goby8bad7e32012-08-16 14:17:14 -0700660
Benoit Goby93f9f5d2012-09-28 20:37:17 -0700661 exynos_gsc_img cfg;
662 memset(&cfg, 0, sizeof(cfg));
663 cfg.x = layer.displayFrame.left;
664 cfg.y = layer.displayFrame.top;
665 cfg.w = WIDTH(layer.displayFrame);
666 cfg.h = HEIGHT(layer.displayFrame);
667
668 if (gsc_src_cfg_changed(hl.cfg, cfg)) {
Benoit Gobyb5501902012-10-01 00:29:01 -0700669 hdmi_disable_layer(dev, hl);
670
Benoit Goby93f9f5d2012-09-28 20:37:17 -0700671 struct v4l2_format fmt;
672 memset(&fmt, 0, sizeof(fmt));
673 fmt.type = V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE;
Greg Hackmann92b0aad2012-10-18 10:37:59 -0700674 fmt.fmt.pix_mp.width = h->stride;
Benoit Goby93f9f5d2012-09-28 20:37:17 -0700675 fmt.fmt.pix_mp.height = cfg.h;
676 fmt.fmt.pix_mp.pixelformat = V4L2_PIX_FMT_BGR32;
677 fmt.fmt.pix_mp.field = V4L2_FIELD_ANY;
678 fmt.fmt.pix_mp.num_planes = 1;
679 ret = exynos_v4l2_s_fmt(hl.fd, &fmt);
680 if (ret < 0) {
681 ALOGE("%s: layer%d: s_fmt failed %d", __func__, hl.id, errno);
682 goto err;
683 }
684
Benoit Gobyb5501902012-10-01 00:29:01 -0700685 struct v4l2_subdev_crop sd_crop;
686 memset(&sd_crop, 0, sizeof(sd_crop));
687 if (hl.id == 0)
688 sd_crop.pad = MIXER_G0_SUBDEV_PAD_SOURCE;
689 else
690 sd_crop.pad = MIXER_G1_SUBDEV_PAD_SOURCE;
691 sd_crop.which = V4L2_SUBDEV_FORMAT_ACTIVE;
692 sd_crop.rect.left = cfg.x;
693 sd_crop.rect.top = cfg.y;
694 sd_crop.rect.width = cfg.w;
695 sd_crop.rect.height = cfg.h;
696 if (exynos_subdev_s_crop(dev->hdmi_mixer0, &sd_crop) < 0) {
697 ALOGE("%s: s_crop failed pad=%d", __func__, sd_crop.pad);
698 goto err;
699 }
700
701 hdmi_enable_layer(dev, hl);
702
Benoit Goby93f9f5d2012-09-28 20:37:17 -0700703 ALOGV("HDMI layer%d configuration:", hl.id);
704 dump_gsc_img(cfg);
705 hl.cfg = cfg;
706 }
707
708 struct v4l2_buffer buffer;
709 struct v4l2_plane planes[1];
710
711 if (hl.queued_buf == NUM_HDMI_BUFFERS) {
712 memset(&buffer, 0, sizeof(buffer));
713 memset(planes, 0, sizeof(planes));
714 buffer.type = V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE;
715 buffer.memory = V4L2_MEMORY_DMABUF;
716 buffer.length = 1;
717 buffer.m.planes = planes;
718 ret = exynos_v4l2_dqbuf(hl.fd, &buffer);
719 if (ret < 0) {
720 ALOGE("%s: layer%d: dqbuf failed %d", __func__, hl.id, errno);
721 goto err;
722 }
723 hl.queued_buf--;
724 }
725
726 memset(&buffer, 0, sizeof(buffer));
727 memset(planes, 0, sizeof(planes));
728 buffer.index = hl.current_buf;
729 buffer.type = V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE;
730 buffer.memory = V4L2_MEMORY_DMABUF;
731 buffer.flags = V4L2_BUF_FLAG_USE_SYNC;
Benoit Goby181e92b2012-10-04 16:35:57 -0700732 buffer.reserved = acquireFenceFd;
Benoit Goby93f9f5d2012-09-28 20:37:17 -0700733 buffer.length = 1;
734 buffer.m.planes = planes;
735 buffer.m.planes[0].m.fd = h->fd;
736 if (exynos_v4l2_qbuf(hl.fd, &buffer) < 0) {
737 ALOGE("%s: layer%d: qbuf failed %d", __func__, hl.id, errno);
738 ret = -1;
739 goto err;
740 }
741
Benoit Goby181e92b2012-10-04 16:35:57 -0700742 if (releaseFenceFd)
743 *releaseFenceFd = buffer.reserved;
744 else
745 close(buffer.reserved);
Benoit Goby93f9f5d2012-09-28 20:37:17 -0700746
747 hl.queued_buf++;
748 hl.current_buf = (hl.current_buf + 1) % NUM_HDMI_BUFFERS;
749
750 if (!hl.streaming) {
751 if (exynos_v4l2_streamon(hl.fd, buffer.type) < 0) {
752 ALOGE("%s: layer%d: streamon failed %d", __func__, hl.id, errno);
753 ret = -1;
754 goto err;
755 }
756 hl.streaming = true;
757 }
Benoit Goby105be0b2012-09-21 13:19:30 -0700758
759err:
Benoit Goby181e92b2012-10-04 16:35:57 -0700760 if (acquireFenceFd >= 0)
761 close(acquireFenceFd);
Benoit Goby93f9f5d2012-09-28 20:37:17 -0700762
Benoit Goby105be0b2012-09-21 13:19:30 -0700763 return ret;
Benoit Gobycdd61b32012-07-09 12:09:59 -0700764}
765
Greg Hackmann81575142012-09-19 15:09:04 -0700766bool exynos5_is_offscreen(hwc_layer_1_t &layer,
767 struct exynos5_hwc_composer_device_1_t *pdev)
768{
769 return layer.sourceCrop.left > pdev->xres ||
770 layer.sourceCrop.right < 0 ||
771 layer.sourceCrop.top > pdev->yres ||
772 layer.sourceCrop.bottom < 0;
773}
774
Greg Hackmann67b2c312012-10-01 13:31:26 -0700775size_t exynos5_visible_width(hwc_layer_1_t &layer, int format,
776 struct exynos5_hwc_composer_device_1_t *pdev)
777{
778 int bpp;
779 if (exynos5_requires_gscaler(layer, format))
780 bpp = 32;
781 else
782 bpp = exynos5_format_to_bpp(format);
783 int left = max(layer.displayFrame.left, 0);
784 int right = min(layer.displayFrame.right, pdev->xres);
785
786 return (right - left) * bpp / 8;
787}
788
Greg Hackmann81575142012-09-19 15:09:04 -0700789bool exynos5_supports_overlay(hwc_layer_1_t &layer, size_t i,
790 struct exynos5_hwc_composer_device_1_t *pdev)
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700791{
Greg Hackmannd82ad202012-07-24 13:49:47 -0700792 if (layer.flags & HWC_SKIP_LAYER) {
793 ALOGV("\tlayer %u: skipping", i);
794 return false;
795 }
796
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700797 private_handle_t *handle = private_handle_t::dynamicCast(layer.handle);
Greg Hackmann86eb1c62012-05-30 09:25:51 -0700798
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700799 if (!handle) {
800 ALOGV("\tlayer %u: handle is NULL", i);
801 return false;
802 }
Greg Hackmannf8c24e52012-08-14 15:50:51 -0700803
Greg Hackmann92b0aad2012-10-18 10:37:59 -0700804 if (exynos5_visible_width(layer, handle->format, pdev) < BURSTLEN_BYTES) {
805 ALOGV("\tlayer %u: visible area is too narrow", i);
806 return false;
807 }
Greg Hackmann09c45c22012-09-20 09:35:37 -0700808 if (exynos5_requires_gscaler(layer, handle->format)) {
Greg Hackmann227ae8a2012-08-03 16:16:58 -0700809 if (!exynos5_supports_gscaler(layer, handle->format, false)) {
Greg Hackmann9130e702012-07-30 14:53:04 -0700810 ALOGV("\tlayer %u: gscaler required but not supported", i);
811 return false;
812 }
813 } else {
814 if (!exynos5_format_is_supported(handle->format)) {
815 ALOGV("\tlayer %u: pixel format %u not supported", i, handle->format);
816 return false;
817 }
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700818 }
Greg Hackmann93cc5e72012-08-03 13:29:33 -0700819 if (!exynos5_blending_is_supported(layer.blending)) {
820 ALOGV("\tlayer %u: blending %d not supported", i, layer.blending);
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700821 return false;
822 }
Greg Hackmann81575142012-09-19 15:09:04 -0700823 if (CC_UNLIKELY(exynos5_is_offscreen(layer, pdev))) {
824 ALOGW("\tlayer %u: off-screen", i);
825 return false;
826 }
Greg Hackmann86eb1c62012-05-30 09:25:51 -0700827
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700828 return true;
Greg Hackmann86eb1c62012-05-30 09:25:51 -0700829}
830
Greg Hackmann31991d52012-07-13 13:23:11 -0700831inline bool intersect(const hwc_rect &r1, const hwc_rect &r2)
832{
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700833 return !(r1.left > r2.right ||
834 r1.right < r2.left ||
835 r1.top > r2.bottom ||
836 r1.bottom < r2.top);
Greg Hackmann31991d52012-07-13 13:23:11 -0700837}
838
839inline hwc_rect intersection(const hwc_rect &r1, const hwc_rect &r2)
840{
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700841 hwc_rect i;
842 i.top = max(r1.top, r2.top);
843 i.bottom = min(r1.bottom, r2.bottom);
844 i.left = max(r1.left, r2.left);
845 i.right = min(r1.right, r2.right);
846 return i;
Greg Hackmann31991d52012-07-13 13:23:11 -0700847}
848
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -0700849static int exynos5_prepare_fimd(exynos5_hwc_composer_device_1_t *pdev,
Benoit Goby4f439962012-09-21 17:16:45 -0700850 hwc_display_contents_1_t* contents)
Greg Hackmann86eb1c62012-05-30 09:25:51 -0700851{
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -0700852 ALOGV("preparing %u layers for FIMD", contents->numHwLayers);
Greg Hackmann86eb1c62012-05-30 09:25:51 -0700853
Greg Hackmann9130e702012-07-30 14:53:04 -0700854 memset(pdev->bufs.gsc_map, 0, sizeof(pdev->bufs.gsc_map));
Greg Hackmann86eb1c62012-05-30 09:25:51 -0700855
Benoit Goby4f439962012-09-21 17:16:45 -0700856 bool force_fb = pdev->force_gpu;
Erik Gilling87e707e2012-06-29 17:35:13 -0700857 for (size_t i = 0; i < NUM_HW_WINDOWS; i++)
858 pdev->bufs.overlay_map[i] = -1;
859
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700860 bool fb_needed = false;
861 size_t first_fb = 0, last_fb = 0;
Greg Hackmann86eb1c62012-05-30 09:25:51 -0700862
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700863 // find unsupported overlays
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -0700864 for (size_t i = 0; i < contents->numHwLayers; i++) {
865 hwc_layer_1_t &layer = contents->hwLayers[i];
Greg Hackmann86eb1c62012-05-30 09:25:51 -0700866
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -0700867 if (layer.compositionType == HWC_FRAMEBUFFER_TARGET) {
868 ALOGV("\tlayer %u: framebuffer target", i);
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700869 continue;
870 }
Greg Hackmann86eb1c62012-05-30 09:25:51 -0700871
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -0700872 if (layer.compositionType == HWC_BACKGROUND && !force_fb) {
873 ALOGV("\tlayer %u: background supported", i);
874 dump_layer(&contents->hwLayers[i]);
875 continue;
876 }
877
Greg Hackmann81575142012-09-19 15:09:04 -0700878 if (exynos5_supports_overlay(contents->hwLayers[i], i, pdev) &&
879 !force_fb) {
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700880 ALOGV("\tlayer %u: overlay supported", i);
881 layer.compositionType = HWC_OVERLAY;
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -0700882 dump_layer(&contents->hwLayers[i]);
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700883 continue;
884 }
Greg Hackmann86eb1c62012-05-30 09:25:51 -0700885
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700886 if (!fb_needed) {
887 first_fb = i;
888 fb_needed = true;
889 }
890 last_fb = i;
891 layer.compositionType = HWC_FRAMEBUFFER;
Greg Hackmann9130e702012-07-30 14:53:04 -0700892
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -0700893 dump_layer(&contents->hwLayers[i]);
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700894 }
Greg Hackmann86eb1c62012-05-30 09:25:51 -0700895
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700896 // can't composite overlays sandwiched between framebuffers
897 if (fb_needed)
898 for (size_t i = first_fb; i < last_fb; i++)
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -0700899 contents->hwLayers[i].compositionType = HWC_FRAMEBUFFER;
Greg Hackmann86eb1c62012-05-30 09:25:51 -0700900
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700901 // Incrementally try to add our supported layers to hardware windows.
902 // If adding a layer would violate a hardware constraint, force it
903 // into the framebuffer and try again. (Revisiting the entire list is
904 // necessary because adding a layer to the framebuffer can cause other
905 // windows to retroactively violate constraints.)
906 bool changed;
Greg Hackmannd6743822012-10-02 17:27:25 -0700907 bool gsc_used;
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700908 do {
909 android::Vector<hwc_rect> rects;
910 android::Vector<hwc_rect> overlaps;
Greg Hackmannd6743822012-10-02 17:27:25 -0700911 size_t pixels_left, windows_left;
912
913 gsc_used = false;
Greg Hackmann31991d52012-07-13 13:23:11 -0700914
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700915 if (fb_needed) {
916 hwc_rect_t fb_rect;
917 fb_rect.top = fb_rect.left = 0;
Greg Hackmannd92fe212012-09-11 14:28:41 -0700918 fb_rect.right = pdev->xres - 1;
919 fb_rect.bottom = pdev->yres - 1;
920 pixels_left = MAX_PIXELS - pdev->xres * pdev->yres;
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700921 windows_left = NUM_HW_WINDOWS - 1;
922 rects.push_back(fb_rect);
923 }
924 else {
925 pixels_left = MAX_PIXELS;
926 windows_left = NUM_HW_WINDOWS;
927 }
Greg Hackmann9130e702012-07-30 14:53:04 -0700928
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700929 changed = false;
Greg Hackmann31991d52012-07-13 13:23:11 -0700930
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -0700931 for (size_t i = 0; i < contents->numHwLayers; i++) {
932 hwc_layer_1_t &layer = contents->hwLayers[i];
933 if ((layer.flags & HWC_SKIP_LAYER) ||
934 layer.compositionType == HWC_FRAMEBUFFER_TARGET)
Greg Hackmann9130e702012-07-30 14:53:04 -0700935 continue;
936
937 private_handle_t *handle = private_handle_t::dynamicCast(
938 layer.handle);
Greg Hackmann31991d52012-07-13 13:23:11 -0700939
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700940 // we've already accounted for the framebuffer above
941 if (layer.compositionType == HWC_FRAMEBUFFER)
942 continue;
Greg Hackmann31991d52012-07-13 13:23:11 -0700943
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700944 // only layer 0 can be HWC_BACKGROUND, so we can
945 // unconditionally allow it without extra checks
946 if (layer.compositionType == HWC_BACKGROUND) {
947 windows_left--;
948 continue;
949 }
Greg Hackmann31991d52012-07-13 13:23:11 -0700950
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700951 size_t pixels_needed = WIDTH(layer.displayFrame) *
952 HEIGHT(layer.displayFrame);
953 bool can_compose = windows_left && pixels_needed <= pixels_left;
Greg Hackmann09c45c22012-09-20 09:35:37 -0700954 bool gsc_required = exynos5_requires_gscaler(layer, handle->format);
Greg Hackmann9130e702012-07-30 14:53:04 -0700955 if (gsc_required)
Greg Hackmannd6743822012-10-02 17:27:25 -0700956 can_compose = can_compose && !gsc_used;
Greg Hackmann31991d52012-07-13 13:23:11 -0700957
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700958 // hwc_rect_t right and bottom values are normally exclusive;
959 // the intersection logic is simpler if we make them inclusive
960 hwc_rect_t visible_rect = layer.displayFrame;
961 visible_rect.right--; visible_rect.bottom--;
Greg Hackmann31991d52012-07-13 13:23:11 -0700962
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700963 // no more than 2 layers can overlap on a given pixel
964 for (size_t j = 0; can_compose && j < overlaps.size(); j++) {
965 if (intersect(visible_rect, overlaps.itemAt(j)))
966 can_compose = false;
967 }
Greg Hackmann31991d52012-07-13 13:23:11 -0700968
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700969 if (!can_compose) {
970 layer.compositionType = HWC_FRAMEBUFFER;
971 if (!fb_needed) {
972 first_fb = last_fb = i;
973 fb_needed = true;
974 }
975 else {
976 first_fb = min(i, first_fb);
977 last_fb = max(i, last_fb);
978 }
979 changed = true;
980 break;
981 }
Greg Hackmann31991d52012-07-13 13:23:11 -0700982
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700983 for (size_t j = 0; j < rects.size(); j++) {
984 const hwc_rect_t &other_rect = rects.itemAt(j);
985 if (intersect(visible_rect, other_rect))
986 overlaps.push_back(intersection(visible_rect, other_rect));
987 }
988 rects.push_back(visible_rect);
989 pixels_left -= pixels_needed;
990 windows_left--;
Greg Hackmann9130e702012-07-30 14:53:04 -0700991 if (gsc_required)
Greg Hackmannd6743822012-10-02 17:27:25 -0700992 gsc_used = true;
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700993 }
Greg Hackmann31991d52012-07-13 13:23:11 -0700994
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700995 if (changed)
996 for (size_t i = first_fb; i < last_fb; i++)
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -0700997 contents->hwLayers[i].compositionType = HWC_FRAMEBUFFER;
Greg Hackmannf6f2e542012-07-16 16:10:27 -0700998 } while(changed);
Greg Hackmann86eb1c62012-05-30 09:25:51 -0700999
Greg Hackmannf6f2e542012-07-16 16:10:27 -07001000 unsigned int nextWindow = 0;
Greg Hackmann86eb1c62012-05-30 09:25:51 -07001001
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -07001002 for (size_t i = 0; i < contents->numHwLayers; i++) {
1003 hwc_layer_1_t &layer = contents->hwLayers[i];
Greg Hackmann86eb1c62012-05-30 09:25:51 -07001004
Greg Hackmannf6f2e542012-07-16 16:10:27 -07001005 if (fb_needed && i == first_fb) {
1006 ALOGV("assigning framebuffer to window %u\n",
1007 nextWindow);
1008 nextWindow++;
1009 continue;
1010 }
Greg Hackmann86eb1c62012-05-30 09:25:51 -07001011
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -07001012 if (layer.compositionType != HWC_FRAMEBUFFER &&
1013 layer.compositionType != HWC_FRAMEBUFFER_TARGET) {
Greg Hackmannf6f2e542012-07-16 16:10:27 -07001014 ALOGV("assigning layer %u to window %u", i, nextWindow);
1015 pdev->bufs.overlay_map[nextWindow] = i;
Greg Hackmann9130e702012-07-30 14:53:04 -07001016 if (layer.compositionType == HWC_OVERLAY) {
1017 private_handle_t *handle =
1018 private_handle_t::dynamicCast(layer.handle);
Greg Hackmann09c45c22012-09-20 09:35:37 -07001019 if (exynos5_requires_gscaler(layer, handle->format)) {
Greg Hackmannd6743822012-10-02 17:27:25 -07001020 ALOGV("\tusing gscaler %u", AVAILABLE_GSC_UNITS[FIMD_GSC_IDX]);
Greg Hackmann3088b972012-09-12 15:07:23 -07001021 pdev->bufs.gsc_map[nextWindow].mode =
Greg Hackmann9130e702012-07-30 14:53:04 -07001022 exynos5_gsc_map_t::GSC_M2M;
Greg Hackmannd6743822012-10-02 17:27:25 -07001023 pdev->bufs.gsc_map[nextWindow].idx = FIMD_GSC_IDX;
Greg Hackmann9130e702012-07-30 14:53:04 -07001024 }
1025 }
Greg Hackmannf6f2e542012-07-16 16:10:27 -07001026 nextWindow++;
1027 }
1028 }
Greg Hackmann86eb1c62012-05-30 09:25:51 -07001029
Greg Hackmannefd98532012-10-02 12:00:42 -07001030 if (!gsc_used)
1031 exynos5_cleanup_gsc_m2m(pdev, FIMD_GSC_IDX);
Greg Hackmann9130e702012-07-30 14:53:04 -07001032
Greg Hackmannf6f2e542012-07-16 16:10:27 -07001033 if (fb_needed)
1034 pdev->bufs.fb_window = first_fb;
1035 else
1036 pdev->bufs.fb_window = NO_FB_NEEDED;
Greg Hackmann86eb1c62012-05-30 09:25:51 -07001037
Greg Hackmann9130e702012-07-30 14:53:04 -07001038 return 0;
1039}
1040
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -07001041static int exynos5_prepare_hdmi(exynos5_hwc_composer_device_1_t *pdev,
1042 hwc_display_contents_1_t* contents)
1043{
Benoit Goby922abbf2012-09-19 19:24:19 -07001044 ALOGV("preparing %u layers for HDMI", contents->numHwLayers);
Benoit Gobyb5501902012-10-01 00:29:01 -07001045 hwc_layer_1_t *video_layer = NULL;
Benoit Goby922abbf2012-09-19 19:24:19 -07001046
Benoit Goby18893a32012-10-30 16:05:34 -07001047 pdev->hdmi_fb_needed = false;
1048
Benoit Goby922abbf2012-09-19 19:24:19 -07001049 for (size_t i = 0; i < contents->numHwLayers; i++) {
1050 hwc_layer_1_t &layer = contents->hwLayers[i];
1051
1052 if (layer.compositionType == HWC_FRAMEBUFFER_TARGET) {
1053 ALOGV("\tlayer %u: framebuffer target", i);
Benoit Goby922abbf2012-09-19 19:24:19 -07001054 continue;
1055 }
1056
1057 if (layer.compositionType == HWC_BACKGROUND) {
1058 ALOGV("\tlayer %u: background layer", i);
1059 dump_layer(&layer);
1060 continue;
1061 }
1062
Benoit Gobyb5501902012-10-01 00:29:01 -07001063 if (layer.handle) {
1064 private_handle_t *h = private_handle_t::dynamicCast(layer.handle);
1065 if (h->flags & GRALLOC_USAGE_PROTECTED) {
1066 if (!video_layer) {
1067 video_layer = &layer;
1068 layer.compositionType = HWC_OVERLAY;
1069 ALOGV("\tlayer %u: video layer", i);
1070 dump_layer(&layer);
1071 continue;
1072 }
1073 }
1074 }
1075
Benoit Goby18893a32012-10-30 16:05:34 -07001076 pdev->hdmi_fb_needed = true;
Benoit Goby922abbf2012-09-19 19:24:19 -07001077 layer.compositionType = HWC_FRAMEBUFFER;
1078 dump_layer(&layer);
1079 }
1080
1081 return 0;
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -07001082}
1083
1084static int exynos5_prepare(hwc_composer_device_1_t *dev,
1085 size_t numDisplays, hwc_display_contents_1_t** displays)
1086{
1087 if (!numDisplays || !displays)
1088 return 0;
1089
1090 exynos5_hwc_composer_device_1_t *pdev =
1091 (exynos5_hwc_composer_device_1_t *)dev;
1092 hwc_display_contents_1_t *fimd_contents = displays[HWC_DISPLAY_PRIMARY];
1093 hwc_display_contents_1_t *hdmi_contents = displays[HWC_DISPLAY_EXTERNAL];
1094
1095 if (pdev->hdmi_hpd) {
1096 hdmi_enable(pdev);
1097 } else {
1098 hdmi_disable(pdev);
1099 }
1100
1101 if (fimd_contents) {
Benoit Goby4f439962012-09-21 17:16:45 -07001102 int err = exynos5_prepare_fimd(pdev, fimd_contents);
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -07001103 if (err)
1104 return err;
1105 }
1106
1107 if (hdmi_contents) {
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -07001108 int err = exynos5_prepare_hdmi(pdev, hdmi_contents);
1109 if (err)
1110 return err;
1111 }
1112
1113 return 0;
1114}
1115
Greg Hackmann9130e702012-07-30 14:53:04 -07001116static int exynos5_config_gsc_m2m(hwc_layer_1_t &layer,
1117 alloc_device_t* alloc_device, exynos5_gsc_data_t *gsc_data,
Greg Hackmann92b0aad2012-10-18 10:37:59 -07001118 int gsc_idx, int dst_format, hwc_rect_t *sourceCrop)
Greg Hackmann9130e702012-07-30 14:53:04 -07001119{
Benoit Gobyb5501902012-10-01 00:29:01 -07001120 ALOGV("configuring gscaler %u for memory-to-memory", AVAILABLE_GSC_UNITS[gsc_idx]);
Greg Hackmann9130e702012-07-30 14:53:04 -07001121
1122 private_handle_t *src_handle = private_handle_t::dynamicCast(layer.handle);
1123 buffer_handle_t dst_buf;
1124 private_handle_t *dst_handle;
1125 int ret = 0;
1126
1127 exynos_gsc_img src_cfg, dst_cfg;
1128 memset(&src_cfg, 0, sizeof(src_cfg));
1129 memset(&dst_cfg, 0, sizeof(dst_cfg));
1130
Greg Hackmann92b0aad2012-10-18 10:37:59 -07001131 hwc_rect_t sourceCropTemp;
1132 if (!sourceCrop)
1133 sourceCrop = &sourceCropTemp;
1134
Greg Hackmann9130e702012-07-30 14:53:04 -07001135 src_cfg.x = layer.sourceCrop.left;
1136 src_cfg.y = layer.sourceCrop.top;
1137 src_cfg.w = WIDTH(layer.sourceCrop);
1138 src_cfg.fw = src_handle->stride;
1139 src_cfg.h = HEIGHT(layer.sourceCrop);
Greg Hackmanneba34a92012-08-14 16:10:05 -07001140 src_cfg.fh = src_handle->vstride;
Greg Hackmann9130e702012-07-30 14:53:04 -07001141 src_cfg.yaddr = src_handle->fd;
Greg Hackmann296668e2012-08-14 15:51:40 -07001142 if (exynos5_format_is_ycrcb(src_handle->format)) {
1143 src_cfg.uaddr = src_handle->fd2;
1144 src_cfg.vaddr = src_handle->fd1;
1145 } else {
1146 src_cfg.uaddr = src_handle->fd1;
1147 src_cfg.vaddr = src_handle->fd2;
1148 }
Greg Hackmann9130e702012-07-30 14:53:04 -07001149 src_cfg.format = src_handle->format;
Sanghee Kim7bd58622012-08-08 23:31:10 -07001150 src_cfg.drmMode = !!(src_handle->flags & GRALLOC_USAGE_PROTECTED);
Benoit Goby181e92b2012-10-04 16:35:57 -07001151 src_cfg.acquireFenceFd = layer.acquireFenceFd;
1152 layer.acquireFenceFd = -1;
Greg Hackmann9130e702012-07-30 14:53:04 -07001153
1154 dst_cfg.x = 0;
1155 dst_cfg.y = 0;
1156 dst_cfg.w = WIDTH(layer.displayFrame);
1157 dst_cfg.h = HEIGHT(layer.displayFrame);
Greg Hackmann9130e702012-07-30 14:53:04 -07001158 dst_cfg.rot = layer.transform;
Sanghee Kim6c195c52012-08-30 22:59:43 -07001159 dst_cfg.drmMode = src_cfg.drmMode;
Benoit Gobyd60d7b72012-10-01 21:52:29 -07001160 dst_cfg.format = dst_format;
Greg Hackmann5d99ec52012-10-11 14:26:13 -07001161 dst_cfg.narrowRgb = !exynos5_format_is_rgb(src_handle->format);
Greg Hackmann92b0aad2012-10-18 10:37:59 -07001162 if (dst_cfg.drmMode)
1163 align_crop_and_center(dst_cfg.w, dst_cfg.h, sourceCrop,
1164 GSC_DST_CROP_W_ALIGNMENT_RGB888);
Greg Hackmann9130e702012-07-30 14:53:04 -07001165
1166 ALOGV("source configuration:");
1167 dump_gsc_img(src_cfg);
1168
Greg Hackmann4eaff152012-10-03 16:28:19 -07001169 bool reconfigure = gsc_src_cfg_changed(src_cfg, gsc_data->src_cfg) ||
1170 gsc_dst_cfg_changed(dst_cfg, gsc_data->dst_cfg);
1171 if (reconfigure) {
Greg Hackmann9130e702012-07-30 14:53:04 -07001172 int dst_stride;
1173 int usage = GRALLOC_USAGE_SW_READ_NEVER |
1174 GRALLOC_USAGE_SW_WRITE_NEVER |
1175 GRALLOC_USAGE_HW_COMPOSER;
Sanghee Kim7bd58622012-08-08 23:31:10 -07001176
1177 if (src_handle->flags & GRALLOC_USAGE_PROTECTED)
1178 usage |= GRALLOC_USAGE_PROTECTED;
Greg Hackmann9130e702012-07-30 14:53:04 -07001179
Greg Hackmann92b0aad2012-10-18 10:37:59 -07001180 int w = ALIGN(dst_cfg.w, GSC_DST_W_ALIGNMENT_RGB888);
1181 int h = ALIGN(dst_cfg.h, GSC_DST_H_ALIGNMENT_RGB888);
Greg Hackmann9130e702012-07-30 14:53:04 -07001182
1183 for (size_t i = 0; i < NUM_GSC_DST_BUFS; i++) {
1184 if (gsc_data->dst_buf[i]) {
1185 alloc_device->free(alloc_device, gsc_data->dst_buf[i]);
1186 gsc_data->dst_buf[i] = NULL;
1187 }
1188
Greg Hackmannde6a0872012-10-10 16:57:24 -07001189 if (gsc_data->dst_buf_fence[i] >= 0) {
1190 close(gsc_data->dst_buf_fence[i]);
1191 gsc_data->dst_buf_fence[i] = -1;
1192 }
1193
Greg Hackmann9130e702012-07-30 14:53:04 -07001194 int ret = alloc_device->alloc(alloc_device, w, h,
1195 HAL_PIXEL_FORMAT_RGBX_8888, usage, &gsc_data->dst_buf[i],
1196 &dst_stride);
1197 if (ret < 0) {
1198 ALOGE("failed to allocate destination buffer: %s",
1199 strerror(-ret));
1200 goto err_alloc;
1201 }
1202 }
1203
1204 gsc_data->current_buf = 0;
Greg Hackmannf6f2e542012-07-16 16:10:27 -07001205 }
Greg Hackmann86eb1c62012-05-30 09:25:51 -07001206
Greg Hackmann9130e702012-07-30 14:53:04 -07001207 dst_buf = gsc_data->dst_buf[gsc_data->current_buf];
1208 dst_handle = private_handle_t::dynamicCast(dst_buf);
1209
1210 dst_cfg.fw = dst_handle->stride;
Greg Hackmanneba34a92012-08-14 16:10:05 -07001211 dst_cfg.fh = dst_handle->vstride;
Greg Hackmann9130e702012-07-30 14:53:04 -07001212 dst_cfg.yaddr = dst_handle->fd;
Greg Hackmannde6a0872012-10-10 16:57:24 -07001213 dst_cfg.acquireFenceFd = gsc_data->dst_buf_fence[gsc_data->current_buf];
1214 gsc_data->dst_buf_fence[gsc_data->current_buf] = -1;
Greg Hackmann9130e702012-07-30 14:53:04 -07001215
1216 ALOGV("destination configuration:");
1217 dump_gsc_img(dst_cfg);
1218
Greg Hackmann92b0aad2012-10-18 10:37:59 -07001219 if ((int)dst_cfg.w != WIDTH(layer.displayFrame))
1220 ALOGV("padding %u x %u output to %u x %u and cropping to {%u,%u,%u,%u}",
1221 WIDTH(layer.displayFrame), HEIGHT(layer.displayFrame),
1222 dst_cfg.w, dst_cfg.h, sourceCrop->left, sourceCrop->top,
1223 sourceCrop->right, sourceCrop->bottom);
1224
Greg Hackmannefd98532012-10-02 12:00:42 -07001225 if (gsc_data->gsc) {
1226 ALOGV("reusing open gscaler %u", AVAILABLE_GSC_UNITS[gsc_idx]);
1227 } else {
1228 ALOGV("opening gscaler %u", AVAILABLE_GSC_UNITS[gsc_idx]);
1229 gsc_data->gsc = exynos_gsc_create_exclusive(
Dima Zavin33aa35f2012-10-05 16:04:52 -07001230 AVAILABLE_GSC_UNITS[gsc_idx], GSC_M2M_MODE, GSC_DUMMY, true);
Greg Hackmannefd98532012-10-02 12:00:42 -07001231 if (!gsc_data->gsc) {
1232 ALOGE("failed to create gscaler handle");
1233 ret = -1;
1234 goto err_alloc;
1235 }
Greg Hackmann9130e702012-07-30 14:53:04 -07001236 }
1237
Greg Hackmann4eaff152012-10-03 16:28:19 -07001238 if (reconfigure) {
Dima Zavin33aa35f2012-10-05 16:04:52 -07001239 ret = exynos_gsc_stop_exclusive(gsc_data->gsc);
1240 if (ret < 0) {
1241 ALOGE("failed to stop gscaler %u", gsc_idx);
1242 goto err_gsc_config;
1243 }
1244
Greg Hackmann4eaff152012-10-03 16:28:19 -07001245 ret = exynos_gsc_config_exclusive(gsc_data->gsc, &src_cfg, &dst_cfg);
1246 if (ret < 0) {
1247 ALOGE("failed to configure gscaler %u", gsc_idx);
1248 goto err_gsc_config;
1249 }
Greg Hackmann9130e702012-07-30 14:53:04 -07001250 }
1251
1252 ret = exynos_gsc_run_exclusive(gsc_data->gsc, &src_cfg, &dst_cfg);
1253 if (ret < 0) {
1254 ALOGE("failed to run gscaler %u", gsc_idx);
1255 goto err_gsc_config;
1256 }
1257
1258 gsc_data->src_cfg = src_cfg;
1259 gsc_data->dst_cfg = dst_cfg;
1260
Benoit Goby181e92b2012-10-04 16:35:57 -07001261 layer.releaseFenceFd = src_cfg.releaseFenceFd;
1262
Greg Hackmannf6f2e542012-07-16 16:10:27 -07001263 return 0;
Greg Hackmann9130e702012-07-30 14:53:04 -07001264
1265err_gsc_config:
1266 exynos_gsc_destroy(gsc_data->gsc);
1267 gsc_data->gsc = NULL;
1268err_alloc:
Benoit Goby181e92b2012-10-04 16:35:57 -07001269 if (src_cfg.acquireFenceFd >= 0)
1270 close(src_cfg.acquireFenceFd);
Greg Hackmann9130e702012-07-30 14:53:04 -07001271 for (size_t i = 0; i < NUM_GSC_DST_BUFS; i++) {
Greg Hackmannde6a0872012-10-10 16:57:24 -07001272 if (gsc_data->dst_buf[i]) {
Greg Hackmann9130e702012-07-30 14:53:04 -07001273 alloc_device->free(alloc_device, gsc_data->dst_buf[i]);
1274 gsc_data->dst_buf[i] = NULL;
1275 }
Greg Hackmannde6a0872012-10-10 16:57:24 -07001276 if (gsc_data->dst_buf_fence[i] >= 0) {
1277 close(gsc_data->dst_buf_fence[i]);
1278 gsc_data->dst_buf_fence[i] = -1;
1279 }
Greg Hackmann9130e702012-07-30 14:53:04 -07001280 }
Greg Hackmann7dddd2a2012-09-12 15:11:07 -07001281 memset(&gsc_data->src_cfg, 0, sizeof(gsc_data->src_cfg));
1282 memset(&gsc_data->dst_cfg, 0, sizeof(gsc_data->dst_cfg));
Greg Hackmann9130e702012-07-30 14:53:04 -07001283 return ret;
Greg Hackmann86eb1c62012-05-30 09:25:51 -07001284}
1285
Greg Hackmannefd98532012-10-02 12:00:42 -07001286
1287static void exynos5_cleanup_gsc_m2m(exynos5_hwc_composer_device_1_t *pdev,
1288 size_t gsc_idx)
1289{
1290 exynos5_gsc_data_t &gsc_data = pdev->gsc[gsc_idx];
1291 if (!gsc_data.gsc)
1292 return;
1293
1294 ALOGV("closing gscaler %u", AVAILABLE_GSC_UNITS[gsc_idx]);
1295
Greg Hackmann4eaff152012-10-03 16:28:19 -07001296 exynos_gsc_stop_exclusive(gsc_data.gsc);
Greg Hackmannefd98532012-10-02 12:00:42 -07001297 exynos_gsc_destroy(gsc_data.gsc);
Greg Hackmannde6a0872012-10-10 16:57:24 -07001298 for (size_t i = 0; i < NUM_GSC_DST_BUFS; i++) {
Greg Hackmannefd98532012-10-02 12:00:42 -07001299 if (gsc_data.dst_buf[i])
1300 pdev->alloc_device->free(pdev->alloc_device, gsc_data.dst_buf[i]);
Greg Hackmannde6a0872012-10-10 16:57:24 -07001301 if (gsc_data.dst_buf_fence[i] >= 0)
1302 close(gsc_data.dst_buf_fence[i]);
1303 }
Greg Hackmannefd98532012-10-02 12:00:42 -07001304
1305 memset(&gsc_data, 0, sizeof(gsc_data));
Greg Hackmannde6a0872012-10-10 16:57:24 -07001306 for (size_t i = 0; i < NUM_GSC_DST_BUFS; i++)
1307 gsc_data.dst_buf_fence[i] = -1;
Greg Hackmannefd98532012-10-02 12:00:42 -07001308}
1309
Greg Hackmann86eb1c62012-05-30 09:25:51 -07001310static void exynos5_config_handle(private_handle_t *handle,
Greg Hackmannf6f2e542012-07-16 16:10:27 -07001311 hwc_rect_t &sourceCrop, hwc_rect_t &displayFrame,
Greg Hackmannbb3bd9e2012-09-18 13:10:33 -07001312 int32_t blending, int fence_fd, s3c_fb_win_config &cfg,
Greg Hackmann81575142012-09-19 15:09:04 -07001313 exynos5_hwc_composer_device_1_t *pdev)
Greg Hackmannf6f2e542012-07-16 16:10:27 -07001314{
Greg Hackmann81575142012-09-19 15:09:04 -07001315 uint32_t x, y;
1316 uint32_t w = WIDTH(displayFrame);
1317 uint32_t h = HEIGHT(displayFrame);
1318 uint8_t bpp = exynos5_format_to_bpp(handle->format);
1319 uint32_t offset = (sourceCrop.top * handle->stride + sourceCrop.left) * bpp / 8;
1320
1321 if (displayFrame.left < 0) {
1322 unsigned int crop = -displayFrame.left;
1323 ALOGV("layer off left side of screen; cropping %u pixels from left edge",
1324 crop);
1325 x = 0;
1326 w -= crop;
1327 offset += crop * bpp / 8;
1328 } else {
1329 x = displayFrame.left;
1330 }
1331
1332 if (displayFrame.right > pdev->xres) {
1333 unsigned int crop = displayFrame.right - pdev->xres;
1334 ALOGV("layer off right side of screen; cropping %u pixels from right edge",
1335 crop);
1336 w -= crop;
1337 }
1338
1339 if (displayFrame.top < 0) {
1340 unsigned int crop = -displayFrame.top;
1341 ALOGV("layer off top side of screen; cropping %u pixels from top edge",
1342 crop);
1343 y = 0;
1344 h -= crop;
1345 offset += handle->stride * crop * bpp / 8;
1346 } else {
1347 y = displayFrame.top;
1348 }
1349
1350 if (displayFrame.bottom > pdev->yres) {
1351 int crop = displayFrame.bottom - pdev->yres;
1352 ALOGV("layer off bottom side of screen; cropping %u pixels from bottom edge",
1353 crop);
1354 h -= crop;
1355 }
1356
Greg Hackmannf6f2e542012-07-16 16:10:27 -07001357 cfg.state = cfg.S3C_FB_WIN_STATE_BUFFER;
1358 cfg.fd = handle->fd;
Greg Hackmann81575142012-09-19 15:09:04 -07001359 cfg.x = x;
1360 cfg.y = y;
1361 cfg.w = w;
1362 cfg.h = h;
Greg Hackmannf6f2e542012-07-16 16:10:27 -07001363 cfg.format = exynos5_format_to_s3c_format(handle->format);
Greg Hackmann81575142012-09-19 15:09:04 -07001364 cfg.offset = offset;
Greg Hackmannf6f2e542012-07-16 16:10:27 -07001365 cfg.stride = handle->stride * bpp / 8;
Greg Hackmann93cc5e72012-08-03 13:29:33 -07001366 cfg.blending = exynos5_blending_to_s3c_blending(blending);
Greg Hackmannbb3bd9e2012-09-18 13:10:33 -07001367 cfg.fence_fd = fence_fd;
Greg Hackmann86eb1c62012-05-30 09:25:51 -07001368}
1369
Erik Gilling87e707e2012-06-29 17:35:13 -07001370static void exynos5_config_overlay(hwc_layer_1_t *layer, s3c_fb_win_config &cfg,
Greg Hackmannd92fe212012-09-11 14:28:41 -07001371 exynos5_hwc_composer_device_1_t *pdev)
Greg Hackmann86eb1c62012-05-30 09:25:51 -07001372{
Greg Hackmannf6f2e542012-07-16 16:10:27 -07001373 if (layer->compositionType == HWC_BACKGROUND) {
1374 hwc_color_t color = layer->backgroundColor;
1375 cfg.state = cfg.S3C_FB_WIN_STATE_COLOR;
1376 cfg.color = (color.r << 16) | (color.g << 8) | color.b;
1377 cfg.x = 0;
1378 cfg.y = 0;
Greg Hackmannd92fe212012-09-11 14:28:41 -07001379 cfg.w = pdev->xres;
1380 cfg.h = pdev->yres;
Greg Hackmannf6f2e542012-07-16 16:10:27 -07001381 return;
1382 }
Greg Hackmann86eb1c62012-05-30 09:25:51 -07001383
Greg Hackmannf6f2e542012-07-16 16:10:27 -07001384 private_handle_t *handle = private_handle_t::dynamicCast(layer->handle);
Greg Hackmann93cc5e72012-08-03 13:29:33 -07001385 exynos5_config_handle(handle, layer->sourceCrop, layer->displayFrame,
Greg Hackmannbb3bd9e2012-09-18 13:10:33 -07001386 layer->blending, layer->acquireFenceFd, cfg, pdev);
Greg Hackmann86eb1c62012-05-30 09:25:51 -07001387}
1388
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -07001389static int exynos5_post_fimd(exynos5_hwc_composer_device_1_t *pdev,
Benoit Goby922abbf2012-09-19 19:24:19 -07001390 hwc_display_contents_1_t* contents)
Greg Hackmann86eb1c62012-05-30 09:25:51 -07001391{
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -07001392 exynos5_hwc_post_data_t *pdata = &pdev->bufs;
Greg Hackmannf6f2e542012-07-16 16:10:27 -07001393 struct s3c_fb_win_config_data win_data;
1394 struct s3c_fb_win_config *config = win_data.config;
Greg Hackmannbb3bd9e2012-09-18 13:10:33 -07001395
Greg Hackmannf6f2e542012-07-16 16:10:27 -07001396 memset(config, 0, sizeof(win_data.config));
Greg Hackmannbb3bd9e2012-09-18 13:10:33 -07001397 for (size_t i = 0; i < NUM_HW_WINDOWS; i++)
1398 config[i].fence_fd = -1;
Greg Hackmann9130e702012-07-30 14:53:04 -07001399
Greg Hackmannf6f2e542012-07-16 16:10:27 -07001400 for (size_t i = 0; i < NUM_HW_WINDOWS; i++) {
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -07001401 int layer_idx = pdata->overlay_map[i];
1402 if (layer_idx != -1) {
1403 hwc_layer_1_t &layer = contents->hwLayers[layer_idx];
Greg Hackmann9130e702012-07-30 14:53:04 -07001404 private_handle_t *handle =
1405 private_handle_t::dynamicCast(layer.handle);
1406
1407 if (pdata->gsc_map[i].mode == exynos5_gsc_map_t::GSC_M2M) {
1408 int gsc_idx = pdata->gsc_map[i].idx;
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -07001409 exynos5_gsc_data_t &gsc = pdev->gsc[gsc_idx];
Greg Hackmann9130e702012-07-30 14:53:04 -07001410
Benoit Gobyd60d7b72012-10-01 21:52:29 -07001411 // RGBX8888 surfaces are already in the right color order from the GPU,
1412 // RGB565 and YUV surfaces need the Gscaler to swap R & B
1413 int dst_format = HAL_PIXEL_FORMAT_BGRA_8888;
1414 if (exynos5_format_is_rgb(handle->format) &&
1415 handle->format != HAL_PIXEL_FORMAT_RGB_565)
1416 dst_format = HAL_PIXEL_FORMAT_RGBX_8888;
1417
Greg Hackmann92b0aad2012-10-18 10:37:59 -07001418 hwc_rect_t sourceCrop = { 0, 0,
1419 WIDTH(layer.displayFrame), HEIGHT(layer.displayFrame) };
Greg Hackmannbb3bd9e2012-09-18 13:10:33 -07001420 int err = exynos5_config_gsc_m2m(layer, pdev->alloc_device, &gsc,
Greg Hackmann92b0aad2012-10-18 10:37:59 -07001421 gsc_idx, dst_format, &sourceCrop);
Greg Hackmannbb3bd9e2012-09-18 13:10:33 -07001422 if (err < 0) {
Greg Hackmann4eaff152012-10-03 16:28:19 -07001423 ALOGE("failed to configure gscaler %u for layer %u",
Greg Hackmann9130e702012-07-30 14:53:04 -07001424 gsc_idx, i);
Greg Hackmannde6a0872012-10-10 16:57:24 -07001425 pdata->gsc_map[i].mode = exynos5_gsc_map_t::GSC_NONE;
Greg Hackmann9130e702012-07-30 14:53:04 -07001426 continue;
1427 }
1428
Greg Hackmann9130e702012-07-30 14:53:04 -07001429 buffer_handle_t dst_buf = gsc.dst_buf[gsc.current_buf];
Greg Hackmann9130e702012-07-30 14:53:04 -07001430 private_handle_t *dst_handle =
1431 private_handle_t::dynamicCast(dst_buf);
Benoit Goby181e92b2012-10-04 16:35:57 -07001432 int fence = gsc.dst_cfg.releaseFenceFd;
Greg Hackmann90219f32012-08-16 17:28:57 -07001433 exynos5_config_handle(dst_handle, sourceCrop,
Benoit Goby181e92b2012-10-04 16:35:57 -07001434 layer.displayFrame, layer.blending, fence, config[i],
Greg Hackmannbb3bd9e2012-09-18 13:10:33 -07001435 pdev);
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -07001436 } else {
1437 exynos5_config_overlay(&layer, config[i], pdev);
Erik Gilling87e707e2012-06-29 17:35:13 -07001438 }
1439 }
Greg Hackmann93cc5e72012-08-03 13:29:33 -07001440 if (i == 0 && config[i].blending != S3C_FB_BLENDING_NONE) {
1441 ALOGV("blending not supported on window 0; forcing BLENDING_NONE");
1442 config[i].blending = S3C_FB_BLENDING_NONE;
1443 }
1444
Greg Hackmann9130e702012-07-30 14:53:04 -07001445 ALOGV("window %u configuration:", i);
Greg Hackmannf6f2e542012-07-16 16:10:27 -07001446 dump_config(config[i]);
1447 }
Greg Hackmann86eb1c62012-05-30 09:25:51 -07001448
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -07001449 int ret = ioctl(pdev->fd, S3CFB_WIN_CONFIG, &win_data);
Greg Hackmannbb3bd9e2012-09-18 13:10:33 -07001450 for (size_t i = 0; i < NUM_HW_WINDOWS; i++)
1451 if (config[i].fence_fd != -1)
1452 close(config[i].fence_fd);
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -07001453 if (ret < 0) {
1454 ALOGE("ioctl S3CFB_WIN_CONFIG failed: %s", strerror(errno));
1455 return ret;
1456 }
1457
1458 memcpy(pdev->last_config, &win_data.config, sizeof(win_data.config));
1459 memcpy(pdev->last_gsc_map, pdata->gsc_map, sizeof(pdata->gsc_map));
1460 pdev->last_fb_window = pdata->fb_window;
1461 for (size_t i = 0; i < NUM_HW_WINDOWS; i++) {
1462 int layer_idx = pdata->overlay_map[i];
1463 if (layer_idx != -1) {
1464 hwc_layer_1_t &layer = contents->hwLayers[layer_idx];
1465 pdev->last_handles[i] = layer.handle;
1466 }
1467 }
1468
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -07001469 return win_data.fence;
1470}
1471
Greg Hackmannec13dea2012-10-08 14:54:45 -07001472static int exynos5_clear_fimd(exynos5_hwc_composer_device_1_t *pdev)
1473{
1474 struct s3c_fb_win_config_data win_data;
1475 memset(&win_data, 0, sizeof(win_data));
1476
1477 int ret = ioctl(pdev->fd, S3CFB_WIN_CONFIG, &win_data);
1478 LOG_ALWAYS_FATAL_IF(ret < 0,
1479 "ioctl S3CFB_WIN_CONFIG failed to clear screen: %s",
1480 strerror(errno));
1481 // the causes of an empty config failing are all unrecoverable
1482
1483 return win_data.fence;
1484}
1485
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -07001486static int exynos5_set_fimd(exynos5_hwc_composer_device_1_t *pdev,
Benoit Goby922abbf2012-09-19 19:24:19 -07001487 hwc_display_contents_1_t* contents)
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -07001488{
1489 if (!contents->dpy || !contents->sur)
1490 return 0;
1491
1492 hwc_layer_1_t *fb_layer = NULL;
Greg Hackmannec13dea2012-10-08 14:54:45 -07001493 int err = 0;
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -07001494
1495 if (pdev->bufs.fb_window != NO_FB_NEEDED) {
1496 for (size_t i = 0; i < contents->numHwLayers; i++) {
1497 if (contents->hwLayers[i].compositionType ==
1498 HWC_FRAMEBUFFER_TARGET) {
1499 pdev->bufs.overlay_map[pdev->bufs.fb_window] = i;
1500 fb_layer = &contents->hwLayers[i];
1501 break;
Greg Hackmann600867e2012-08-23 12:58:02 -07001502 }
1503 }
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -07001504
1505 if (CC_UNLIKELY(!fb_layer)) {
1506 ALOGE("framebuffer target expected, but not provided");
Greg Hackmannec13dea2012-10-08 14:54:45 -07001507 err = -EINVAL;
1508 } else {
1509 ALOGV("framebuffer target buffer:");
1510 dump_layer(fb_layer);
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -07001511 }
Greg Hackmann600867e2012-08-23 12:58:02 -07001512 }
Greg Hackmann86eb1c62012-05-30 09:25:51 -07001513
Greg Hackmannec13dea2012-10-08 14:54:45 -07001514 int fence;
1515 if (!err) {
1516 fence = exynos5_post_fimd(pdev, contents);
1517 if (fence < 0)
1518 err = fence;
1519 }
1520
1521 if (err)
1522 fence = exynos5_clear_fimd(pdev);
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -07001523
1524 for (size_t i = 0; i < NUM_HW_WINDOWS; i++) {
Greg Hackmannde6a0872012-10-10 16:57:24 -07001525 if (pdev->bufs.overlay_map[i] != -1) {
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -07001526 hwc_layer_1_t &layer =
1527 contents->hwLayers[pdev->bufs.overlay_map[i]];
Greg Hackmann02893a42012-10-02 11:39:13 -07001528 int dup_fd = dup_or_warn(fence);
Greg Hackmannde6a0872012-10-10 16:57:24 -07001529 if (pdev->bufs.gsc_map[i].mode == exynos5_gsc_map_t::GSC_M2M) {
1530 int gsc_idx = pdev->bufs.gsc_map[i].idx;
1531 exynos5_gsc_data_t &gsc = pdev->gsc[gsc_idx];
1532 gsc.dst_buf_fence[gsc.current_buf] = dup_fd;
1533 gsc.current_buf = (gsc.current_buf + 1) % NUM_GSC_DST_BUFS;
1534 } else {
1535 layer.releaseFenceFd = dup_fd;
1536 }
Benoit Goby8bad7e32012-08-16 14:17:14 -07001537 }
1538 }
Greg Hackmann02893a42012-10-02 11:39:13 -07001539 contents->retireFenceFd = fence;
Benoit Gobycdd61b32012-07-09 12:09:59 -07001540
Greg Hackmannec13dea2012-10-08 14:54:45 -07001541 return err;
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -07001542}
1543
1544static int exynos5_set_hdmi(exynos5_hwc_composer_device_1_t *pdev,
1545 hwc_display_contents_1_t* contents)
1546{
Benoit Gobyb5501902012-10-01 00:29:01 -07001547 hwc_layer_1_t *video_layer = NULL;
1548
Benoit Goby105be0b2012-09-21 13:19:30 -07001549 if (!pdev->hdmi_enabled) {
1550 for (size_t i = 0; i < contents->numHwLayers; i++) {
1551 hwc_layer_1_t &layer = contents->hwLayers[i];
Benoit Goby181e92b2012-10-04 16:35:57 -07001552 if (layer.acquireFenceFd != -1) {
Benoit Goby105be0b2012-09-21 13:19:30 -07001553 close(layer.acquireFenceFd);
Benoit Goby181e92b2012-10-04 16:35:57 -07001554 layer.acquireFenceFd = -1;
1555 }
Benoit Goby922abbf2012-09-19 19:24:19 -07001556 }
Benoit Goby48a69542012-09-21 17:12:28 -07001557 return 0;
Benoit Goby105be0b2012-09-21 13:19:30 -07001558 }
Benoit Goby48a69542012-09-21 17:12:28 -07001559
1560 for (size_t i = 0; i < contents->numHwLayers; i++) {
1561 hwc_layer_1_t &layer = contents->hwLayers[i];
Benoit Goby922abbf2012-09-19 19:24:19 -07001562
Benoit Goby93f9f5d2012-09-28 20:37:17 -07001563 if (layer.flags & HWC_SKIP_LAYER) {
1564 ALOGV("HDMI skipping layer %d", i);
1565 continue;
1566 }
1567
Benoit Gobyb5501902012-10-01 00:29:01 -07001568 if (layer.compositionType == HWC_OVERLAY) {
1569 if (!layer.handle)
1570 continue;
1571
1572 ALOGV("HDMI video layer:");
1573 dump_layer(&layer);
1574
Greg Hackmannd6743822012-10-02 17:27:25 -07001575 exynos5_gsc_data_t &gsc = pdev->gsc[HDMI_GSC_IDX];
Benoit Goby181e92b2012-10-04 16:35:57 -07001576 int ret = exynos5_config_gsc_m2m(layer, pdev->alloc_device, &gsc, 1,
Greg Hackmann92b0aad2012-10-18 10:37:59 -07001577 HAL_PIXEL_FORMAT_RGBX_8888, NULL);
Benoit Goby181e92b2012-10-04 16:35:57 -07001578 if (ret < 0) {
1579 ALOGE("failed to configure gscaler for video layer");
1580 continue;
1581 }
Benoit Gobyb5501902012-10-01 00:29:01 -07001582
Benoit Gobyb5501902012-10-01 00:29:01 -07001583 buffer_handle_t dst_buf = gsc.dst_buf[gsc.current_buf];
Benoit Gobyb5501902012-10-01 00:29:01 -07001584 private_handle_t *h = private_handle_t::dynamicCast(dst_buf);
1585
Benoit Goby181e92b2012-10-04 16:35:57 -07001586 int acquireFenceFd = gsc.dst_cfg.releaseFenceFd;
Greg Hackmannde6a0872012-10-10 16:57:24 -07001587 int releaseFenceFd = -1;
Benoit Goby181e92b2012-10-04 16:35:57 -07001588
Greg Hackmannde6a0872012-10-10 16:57:24 -07001589 hdmi_output(pdev, pdev->hdmi_layers[0], layer, h, acquireFenceFd,
1590 &releaseFenceFd);
Benoit Gobyb5501902012-10-01 00:29:01 -07001591 video_layer = &layer;
Greg Hackmannde6a0872012-10-10 16:57:24 -07001592
1593 gsc.dst_buf_fence[gsc.current_buf] = releaseFenceFd;
1594 gsc.current_buf = (gsc.current_buf + 1) % NUM_GSC_DST_BUFS;
Greg Hackmann02893a42012-10-02 11:39:13 -07001595 if (contents->retireFenceFd < 0)
1596 contents->retireFenceFd = dup_or_warn(releaseFenceFd);
1597 else {
1598 int merged = merge_or_warn("hdmi",
1599 contents->retireFenceFd, layer.releaseFenceFd);
1600 close(contents->retireFenceFd);
1601 contents->retireFenceFd = merged;
1602 }
Benoit Gobyb5501902012-10-01 00:29:01 -07001603 }
1604
Benoit Goby922abbf2012-09-19 19:24:19 -07001605 if (layer.compositionType == HWC_FRAMEBUFFER_TARGET) {
Benoit Goby18893a32012-10-30 16:05:34 -07001606 if (pdev->hdmi_fb_needed && layer.handle) {
1607 ALOGV("HDMI FB layer:");
1608 dump_layer(&layer);
Benoit Goby922abbf2012-09-19 19:24:19 -07001609
Benoit Goby18893a32012-10-30 16:05:34 -07001610 private_handle_t *h = private_handle_t::dynamicCast(layer.handle);
1611 hdmi_show_layer(pdev, pdev->hdmi_layers[1]);
1612 hdmi_output(pdev, pdev->hdmi_layers[1], layer, h, layer.acquireFenceFd,
1613 &layer.releaseFenceFd);
Benoit Goby922abbf2012-09-19 19:24:19 -07001614
Benoit Gobyc8a99132012-11-27 18:36:12 -08001615 if (contents->retireFenceFd < 0)
1616 contents->retireFenceFd = dup_or_warn(layer.releaseFenceFd);
1617 else {
1618 int merged = merge_or_warn("hdmi",
1619 contents->retireFenceFd, layer.releaseFenceFd);
1620 close(contents->retireFenceFd);
1621 contents->retireFenceFd = merged;
1622 }
Benoit Goby18893a32012-10-30 16:05:34 -07001623 } else {
1624 hdmi_hide_layer(pdev, pdev->hdmi_layers[1]);
Greg Hackmann02893a42012-10-02 11:39:13 -07001625 }
Benoit Goby922abbf2012-09-19 19:24:19 -07001626 }
1627 }
1628
Greg Hackmannefd98532012-10-02 12:00:42 -07001629 if (!video_layer) {
Benoit Gobyb5501902012-10-01 00:29:01 -07001630 hdmi_disable_layer(pdev, pdev->hdmi_layers[0]);
Greg Hackmannefd98532012-10-02 12:00:42 -07001631 exynos5_cleanup_gsc_m2m(pdev, HDMI_GSC_IDX);
1632 }
Benoit Gobyb5501902012-10-01 00:29:01 -07001633
Benoit Gobya37db022012-10-08 11:06:01 -07001634 if (exynos_v4l2_s_ctrl(pdev->hdmi_layers[1].fd, V4L2_CID_TV_UPDATE, 1) < 0) {
1635 ALOGE("%s: s_ctrl(CID_TV_UPDATE) failed %d", __func__, errno);
1636 return -1;
1637 }
1638
Benoit Goby922abbf2012-09-19 19:24:19 -07001639 return 0;
Greg Hackmann86eb1c62012-05-30 09:25:51 -07001640}
1641
Jesse Halle94046d2012-07-31 14:34:08 -07001642static int exynos5_set(struct hwc_composer_device_1 *dev,
1643 size_t numDisplays, hwc_display_contents_1_t** displays)
Greg Hackmann86eb1c62012-05-30 09:25:51 -07001644{
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -07001645 if (!numDisplays || !displays)
Greg Hackmannf6f2e542012-07-16 16:10:27 -07001646 return 0;
Greg Hackmann86eb1c62012-05-30 09:25:51 -07001647
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -07001648 exynos5_hwc_composer_device_1_t *pdev =
1649 (exynos5_hwc_composer_device_1_t *)dev;
1650 hwc_display_contents_1_t *fimd_contents = displays[HWC_DISPLAY_PRIMARY];
1651 hwc_display_contents_1_t *hdmi_contents = displays[HWC_DISPLAY_EXTERNAL];
Greg Hackmannec13dea2012-10-08 14:54:45 -07001652 int fimd_err = 0, hdmi_err = 0;
Greg Hackmann86eb1c62012-05-30 09:25:51 -07001653
Greg Hackmannec13dea2012-10-08 14:54:45 -07001654 if (fimd_contents)
1655 fimd_err = exynos5_set_fimd(pdev, fimd_contents);
Erik Gilling87e707e2012-06-29 17:35:13 -07001656
Greg Hackmannec13dea2012-10-08 14:54:45 -07001657 if (hdmi_contents)
1658 hdmi_err = exynos5_set_hdmi(pdev, hdmi_contents);
Greg Hackmann86eb1c62012-05-30 09:25:51 -07001659
Greg Hackmannec13dea2012-10-08 14:54:45 -07001660 if (fimd_err)
1661 return fimd_err;
1662
1663 return hdmi_err;
Greg Hackmann86eb1c62012-05-30 09:25:51 -07001664}
1665
Erik Gilling87e707e2012-06-29 17:35:13 -07001666static void exynos5_registerProcs(struct hwc_composer_device_1* dev,
Greg Hackmannf6f2e542012-07-16 16:10:27 -07001667 hwc_procs_t const* procs)
Greg Hackmann86eb1c62012-05-30 09:25:51 -07001668{
Greg Hackmannf6f2e542012-07-16 16:10:27 -07001669 struct exynos5_hwc_composer_device_1_t* pdev =
1670 (struct exynos5_hwc_composer_device_1_t*)dev;
Jesse Hallda5a71d2012-08-21 12:12:55 -07001671 pdev->procs = procs;
Greg Hackmann86eb1c62012-05-30 09:25:51 -07001672}
1673
Erik Gilling87e707e2012-06-29 17:35:13 -07001674static int exynos5_query(struct hwc_composer_device_1* dev, int what, int *value)
Greg Hackmann86eb1c62012-05-30 09:25:51 -07001675{
Greg Hackmannf6f2e542012-07-16 16:10:27 -07001676 struct exynos5_hwc_composer_device_1_t *pdev =
1677 (struct exynos5_hwc_composer_device_1_t *)dev;
Greg Hackmann86eb1c62012-05-30 09:25:51 -07001678
Greg Hackmannf6f2e542012-07-16 16:10:27 -07001679 switch (what) {
1680 case HWC_BACKGROUND_LAYER_SUPPORTED:
1681 // we support the background layer
1682 value[0] = 1;
1683 break;
1684 case HWC_VSYNC_PERIOD:
1685 // vsync period in nanosecond
Greg Hackmannd92fe212012-09-11 14:28:41 -07001686 value[0] = pdev->vsync_period;
Greg Hackmannf6f2e542012-07-16 16:10:27 -07001687 break;
1688 default:
1689 // unsupported query
1690 return -EINVAL;
1691 }
1692 return 0;
Greg Hackmann86eb1c62012-05-30 09:25:51 -07001693}
1694
Jesse Halle94046d2012-07-31 14:34:08 -07001695static int exynos5_eventControl(struct hwc_composer_device_1 *dev, int dpy,
1696 int event, int enabled)
Greg Hackmann86eb1c62012-05-30 09:25:51 -07001697{
Greg Hackmannf6f2e542012-07-16 16:10:27 -07001698 struct exynos5_hwc_composer_device_1_t *pdev =
1699 (struct exynos5_hwc_composer_device_1_t *)dev;
Greg Hackmann86eb1c62012-05-30 09:25:51 -07001700
Greg Hackmannf6f2e542012-07-16 16:10:27 -07001701 switch (event) {
1702 case HWC_EVENT_VSYNC:
1703 __u32 val = !!enabled;
1704 int err = ioctl(pdev->fd, S3CFB_SET_VSYNC_INT, &val);
1705 if (err < 0) {
1706 ALOGE("vsync ioctl failed");
1707 return -errno;
1708 }
Greg Hackmann86eb1c62012-05-30 09:25:51 -07001709
Greg Hackmannf6f2e542012-07-16 16:10:27 -07001710 return 0;
1711 }
Greg Hackmann86eb1c62012-05-30 09:25:51 -07001712
Greg Hackmannf6f2e542012-07-16 16:10:27 -07001713 return -EINVAL;
Greg Hackmann86eb1c62012-05-30 09:25:51 -07001714}
1715
Benoit Gobycdd61b32012-07-09 12:09:59 -07001716static void handle_hdmi_uevent(struct exynos5_hwc_composer_device_1_t *pdev,
Greg Hackmannf6f2e542012-07-16 16:10:27 -07001717 const char *buff, int len)
Benoit Gobycdd61b32012-07-09 12:09:59 -07001718{
Greg Hackmannf6f2e542012-07-16 16:10:27 -07001719 const char *s = buff;
1720 s += strlen(s) + 1;
Benoit Gobycdd61b32012-07-09 12:09:59 -07001721
Greg Hackmannf6f2e542012-07-16 16:10:27 -07001722 while (*s) {
1723 if (!strncmp(s, "SWITCH_STATE=", strlen("SWITCH_STATE=")))
1724 pdev->hdmi_hpd = atoi(s + strlen("SWITCH_STATE=")) == 1;
Benoit Gobycdd61b32012-07-09 12:09:59 -07001725
Greg Hackmannf6f2e542012-07-16 16:10:27 -07001726 s += strlen(s) + 1;
1727 if (s - buff >= len)
1728 break;
1729 }
Benoit Gobycdd61b32012-07-09 12:09:59 -07001730
Benoit Gobyd6bb7ce2012-08-09 16:11:22 -07001731 if (pdev->hdmi_hpd) {
1732 if (hdmi_get_config(pdev)) {
1733 ALOGE("Error reading HDMI configuration");
1734 pdev->hdmi_hpd = false;
1735 return;
1736 }
Benoit Gobycb4ed2f2012-09-21 19:14:08 -07001737
1738 pdev->hdmi_blanked = false;
Benoit Gobyd6bb7ce2012-08-09 16:11:22 -07001739 }
1740
Greg Hackmannf6f2e542012-07-16 16:10:27 -07001741 ALOGV("HDMI HPD changed to %s", pdev->hdmi_hpd ? "enabled" : "disabled");
Benoit Gobyd6bb7ce2012-08-09 16:11:22 -07001742 if (pdev->hdmi_hpd)
Benoit Goby8bad7e32012-08-16 14:17:14 -07001743 ALOGI("HDMI Resolution changed to %dx%d", pdev->hdmi_h, pdev->hdmi_w);
Benoit Gobycdd61b32012-07-09 12:09:59 -07001744
Jesse Hallda5a71d2012-08-21 12:12:55 -07001745 /* hwc_dev->procs is set right after the device is opened, but there is
1746 * still a race condition where a hotplug event might occur after the open
1747 * but before the procs are registered. */
1748 if (pdev->procs)
Benoit Gobya93919c2012-09-20 22:36:09 -07001749 pdev->procs->hotplug(pdev->procs, HWC_DISPLAY_EXTERNAL, pdev->hdmi_hpd);
Benoit Gobycdd61b32012-07-09 12:09:59 -07001750}
1751
Greg Hackmann29724852012-07-23 15:31:10 -07001752static void handle_vsync_event(struct exynos5_hwc_composer_device_1_t *pdev)
Greg Hackmann86eb1c62012-05-30 09:25:51 -07001753{
Jesse Hallda5a71d2012-08-21 12:12:55 -07001754 if (!pdev->procs)
Greg Hackmannf6f2e542012-07-16 16:10:27 -07001755 return;
Greg Hackmann86eb1c62012-05-30 09:25:51 -07001756
Greg Hackmannfbeb8532012-07-26 14:21:16 -07001757 int err = lseek(pdev->vsync_fd, 0, SEEK_SET);
1758 if (err < 0) {
1759 ALOGE("error seeking to vsync timestamp: %s", strerror(errno));
1760 return;
1761 }
1762
Greg Hackmann29724852012-07-23 15:31:10 -07001763 char buf[4096];
Greg Hackmannfbeb8532012-07-26 14:21:16 -07001764 err = read(pdev->vsync_fd, buf, sizeof(buf));
Greg Hackmann29724852012-07-23 15:31:10 -07001765 if (err < 0) {
1766 ALOGE("error reading vsync timestamp: %s", strerror(errno));
1767 return;
Greg Hackmann3464b1d2012-07-24 09:46:23 -07001768 }
Greg Hackmann29724852012-07-23 15:31:10 -07001769 buf[sizeof(buf) - 1] = '\0';
Greg Hackmann3464b1d2012-07-24 09:46:23 -07001770
Greg Hackmann29724852012-07-23 15:31:10 -07001771 errno = 0;
1772 uint64_t timestamp = strtoull(buf, NULL, 0);
1773 if (!errno)
1774 pdev->procs->vsync(pdev->procs, 0, timestamp);
Greg Hackmann86eb1c62012-05-30 09:25:51 -07001775}
1776
1777static void *hwc_vsync_thread(void *data)
1778{
Greg Hackmannf6f2e542012-07-16 16:10:27 -07001779 struct exynos5_hwc_composer_device_1_t *pdev =
1780 (struct exynos5_hwc_composer_device_1_t *)data;
1781 char uevent_desc[4096];
1782 memset(uevent_desc, 0, sizeof(uevent_desc));
Greg Hackmann86eb1c62012-05-30 09:25:51 -07001783
Greg Hackmannf6f2e542012-07-16 16:10:27 -07001784 setpriority(PRIO_PROCESS, 0, HAL_PRIORITY_URGENT_DISPLAY);
Greg Hackmann86eb1c62012-05-30 09:25:51 -07001785
Greg Hackmannf6f2e542012-07-16 16:10:27 -07001786 uevent_init();
Greg Hackmann29724852012-07-23 15:31:10 -07001787
Greg Hackmannfbeb8532012-07-26 14:21:16 -07001788 char temp[4096];
1789 int err = read(pdev->vsync_fd, temp, sizeof(temp));
1790 if (err < 0) {
1791 ALOGE("error reading vsync timestamp: %s", strerror(errno));
1792 return NULL;
1793 }
1794
Greg Hackmann29724852012-07-23 15:31:10 -07001795 struct pollfd fds[2];
1796 fds[0].fd = pdev->vsync_fd;
1797 fds[0].events = POLLPRI;
1798 fds[1].fd = uevent_get_fd();
1799 fds[1].events = POLLIN;
1800
Greg Hackmannf6f2e542012-07-16 16:10:27 -07001801 while (true) {
Greg Hackmann29724852012-07-23 15:31:10 -07001802 int err = poll(fds, 2, -1);
Greg Hackmann86eb1c62012-05-30 09:25:51 -07001803
Greg Hackmann29724852012-07-23 15:31:10 -07001804 if (err > 0) {
1805 if (fds[0].revents & POLLPRI) {
1806 handle_vsync_event(pdev);
1807 }
1808 else if (fds[1].revents & POLLIN) {
1809 int len = uevent_next_event(uevent_desc,
1810 sizeof(uevent_desc) - 2);
Benoit Gobycdd61b32012-07-09 12:09:59 -07001811
Greg Hackmann29724852012-07-23 15:31:10 -07001812 bool hdmi = !strcmp(uevent_desc,
1813 "change@/devices/virtual/switch/hdmi");
1814 if (hdmi)
1815 handle_hdmi_uevent(pdev, uevent_desc, len);
1816 }
1817 }
1818 else if (err == -1) {
1819 if (errno == EINTR)
1820 break;
1821 ALOGE("error in vsync thread: %s", strerror(errno));
1822 }
Greg Hackmannf6f2e542012-07-16 16:10:27 -07001823 }
Greg Hackmann86eb1c62012-05-30 09:25:51 -07001824
Greg Hackmannf6f2e542012-07-16 16:10:27 -07001825 return NULL;
Greg Hackmann86eb1c62012-05-30 09:25:51 -07001826}
1827
Benoit Gobycb4ed2f2012-09-21 19:14:08 -07001828static int exynos5_blank(struct hwc_composer_device_1 *dev, int disp, int blank)
Colin Cross00359a82012-07-12 17:54:17 -07001829{
1830 struct exynos5_hwc_composer_device_1_t *pdev =
1831 (struct exynos5_hwc_composer_device_1_t *)dev;
1832
Benoit Gobycb4ed2f2012-09-21 19:14:08 -07001833 switch (disp) {
1834 case HWC_DISPLAY_PRIMARY: {
1835 int fb_blank = blank ? FB_BLANK_POWERDOWN : FB_BLANK_UNBLANK;
1836 int err = ioctl(pdev->fd, FBIOBLANK, fb_blank);
1837 if (err < 0) {
1838 if (errno == EBUSY)
1839 ALOGI("%sblank ioctl failed (display already %sblanked)",
1840 blank ? "" : "un", blank ? "" : "un");
1841 else
1842 ALOGE("%sblank ioctl failed: %s", blank ? "" : "un",
1843 strerror(errno));
1844 return -errno;
1845 }
1846 break;
Colin Cross00359a82012-07-12 17:54:17 -07001847 }
1848
Benoit Gobycb4ed2f2012-09-21 19:14:08 -07001849 case HWC_DISPLAY_EXTERNAL:
1850 if (pdev->hdmi_hpd) {
1851 if (blank && !pdev->hdmi_blanked)
1852 hdmi_disable(pdev);
1853 pdev->hdmi_blanked = !!blank;
1854 }
1855 break;
1856
1857 default:
1858 return -EINVAL;
1859
Benoit Gobyad4e3582012-08-30 17:17:34 -07001860 }
1861
Colin Cross00359a82012-07-12 17:54:17 -07001862 return 0;
1863}
1864
Greg Hackmann600867e2012-08-23 12:58:02 -07001865static void exynos5_dump(hwc_composer_device_1* dev, char *buff, int buff_len)
1866{
1867 if (buff_len <= 0)
1868 return;
1869
1870 struct exynos5_hwc_composer_device_1_t *pdev =
1871 (struct exynos5_hwc_composer_device_1_t *)dev;
1872
1873 android::String8 result;
1874
Benoit Goby8bad7e32012-08-16 14:17:14 -07001875 result.appendFormat(" hdmi_enabled=%u\n", pdev->hdmi_enabled);
1876 if (pdev->hdmi_enabled)
1877 result.appendFormat(" w=%u, h=%u\n", pdev->hdmi_w, pdev->hdmi_h);
Greg Hackmann600867e2012-08-23 12:58:02 -07001878 result.append(
1879 " type | handle | color | blend | format | position | size | gsc \n"
1880 "----------+----------|----------+-------+--------+---------------+---------------------\n");
1881 // 8_______ | 8_______ | 8_______ | 5____ | 6_____ | [5____,5____] | [5____,5____] | 3__ \n"
1882
1883 for (size_t i = 0; i < NUM_HW_WINDOWS; i++) {
1884 struct s3c_fb_win_config &config = pdev->last_config[i];
1885 if (config.state == config.S3C_FB_WIN_STATE_DISABLED) {
1886 result.appendFormat(" %8s | %8s | %8s | %5s | %6s | %13s | %13s",
1887 "DISABLED", "-", "-", "-", "-", "-", "-");
1888 }
1889 else {
1890 if (config.state == config.S3C_FB_WIN_STATE_COLOR)
1891 result.appendFormat(" %8s | %8s | %8x | %5s | %6s", "COLOR",
1892 "-", config.color, "-", "-");
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -07001893 else
1894 result.appendFormat(" %8s | %8x | %8s | %5x | %6x",
1895 pdev->last_fb_window == i ? "FB" : "OVERLAY",
1896 intptr_t(pdev->last_handles[i]),
1897 "-", config.blending, config.format);
Greg Hackmann600867e2012-08-23 12:58:02 -07001898
1899 result.appendFormat(" | [%5d,%5d] | [%5u,%5u]", config.x, config.y,
1900 config.w, config.h);
1901 }
1902 if (pdev->last_gsc_map[i].mode == exynos5_gsc_map_t::GSC_NONE)
1903 result.appendFormat(" | %3s", "-");
1904 else
1905 result.appendFormat(" | %3d",
1906 AVAILABLE_GSC_UNITS[pdev->last_gsc_map[i].idx]);
1907 result.append("\n");
1908 }
1909
1910 strlcpy(buff, result.string(), buff_len);
1911}
1912
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -07001913static int exynos5_getDisplayConfigs(struct hwc_composer_device_1 *dev,
1914 int disp, uint32_t *configs, size_t *numConfigs)
1915{
1916 struct exynos5_hwc_composer_device_1_t *pdev =
1917 (struct exynos5_hwc_composer_device_1_t *)dev;
1918
1919 if (*numConfigs == 0)
1920 return 0;
1921
1922 if (disp == HWC_DISPLAY_PRIMARY) {
1923 configs[0] = 0;
1924 *numConfigs = 1;
1925 return 0;
1926 } else if (disp == HWC_DISPLAY_EXTERNAL) {
Benoit Goby922abbf2012-09-19 19:24:19 -07001927 if (!pdev->hdmi_hpd) {
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -07001928 return -EINVAL;
1929 }
1930
1931 int err = hdmi_get_config(pdev);
1932 if (err) {
1933 return -EINVAL;
1934 }
1935
1936 configs[0] = 0;
1937 *numConfigs = 1;
1938 return 0;
1939 }
1940
1941 return -EINVAL;
1942}
1943
1944static int32_t exynos5_fimd_attribute(struct exynos5_hwc_composer_device_1_t *pdev,
1945 const uint32_t attribute)
1946{
1947 switch(attribute) {
1948 case HWC_DISPLAY_VSYNC_PERIOD:
1949 return pdev->vsync_period;
1950
1951 case HWC_DISPLAY_WIDTH:
1952 return pdev->xres;
1953
1954 case HWC_DISPLAY_HEIGHT:
1955 return pdev->yres;
1956
1957 case HWC_DISPLAY_DPI_X:
1958 return pdev->xdpi;
1959
1960 case HWC_DISPLAY_DPI_Y:
1961 return pdev->ydpi;
1962
1963 default:
1964 ALOGE("unknown display attribute %u", attribute);
1965 return -EINVAL;
1966 }
1967}
1968
1969static int32_t exynos5_hdmi_attribute(struct exynos5_hwc_composer_device_1_t *pdev,
1970 const uint32_t attribute)
1971{
1972 switch(attribute) {
1973 case HWC_DISPLAY_VSYNC_PERIOD:
1974 return pdev->vsync_period;
1975
1976 case HWC_DISPLAY_WIDTH:
1977 return pdev->hdmi_w;
1978
1979 case HWC_DISPLAY_HEIGHT:
1980 return pdev->hdmi_h;
1981
1982 case HWC_DISPLAY_DPI_X:
1983 case HWC_DISPLAY_DPI_Y:
1984 return 0; // unknown
1985
1986 default:
1987 ALOGE("unknown display attribute %u", attribute);
1988 return -EINVAL;
1989 }
1990}
1991
Jesse Hall54aa0d22012-09-20 11:43:49 -07001992static int exynos5_getDisplayAttributes(struct hwc_composer_device_1 *dev,
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -07001993 int disp, uint32_t config, const uint32_t *attributes, int32_t *values)
1994{
1995 struct exynos5_hwc_composer_device_1_t *pdev =
1996 (struct exynos5_hwc_composer_device_1_t *)dev;
1997
1998 for (int i = 0; attributes[i] != HWC_DISPLAY_NO_ATTRIBUTE; i++) {
1999 if (disp == HWC_DISPLAY_PRIMARY)
2000 values[i] = exynos5_fimd_attribute(pdev, attributes[i]);
2001 else if (disp == HWC_DISPLAY_EXTERNAL)
2002 values[i] = exynos5_hdmi_attribute(pdev, attributes[i]);
Jesse Hall54aa0d22012-09-20 11:43:49 -07002003 else {
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -07002004 ALOGE("unknown display type %u", disp);
Jesse Hall54aa0d22012-09-20 11:43:49 -07002005 return -EINVAL;
2006 }
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -07002007 }
Jesse Hall54aa0d22012-09-20 11:43:49 -07002008
2009 return 0;
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -07002010}
2011
Greg Hackmann86eb1c62012-05-30 09:25:51 -07002012static int exynos5_close(hw_device_t* device);
2013
2014static int exynos5_open(const struct hw_module_t *module, const char *name,
Greg Hackmannf6f2e542012-07-16 16:10:27 -07002015 struct hw_device_t **device)
Greg Hackmann86eb1c62012-05-30 09:25:51 -07002016{
Greg Hackmannf6f2e542012-07-16 16:10:27 -07002017 int ret;
Greg Hackmannd92fe212012-09-11 14:28:41 -07002018 int refreshRate;
Greg Hackmannf6f2e542012-07-16 16:10:27 -07002019 int sw_fd;
Greg Hackmann86eb1c62012-05-30 09:25:51 -07002020
Greg Hackmannf6f2e542012-07-16 16:10:27 -07002021 if (strcmp(name, HWC_HARDWARE_COMPOSER)) {
2022 return -EINVAL;
2023 }
Greg Hackmann86eb1c62012-05-30 09:25:51 -07002024
Greg Hackmannf6f2e542012-07-16 16:10:27 -07002025 struct exynos5_hwc_composer_device_1_t *dev;
2026 dev = (struct exynos5_hwc_composer_device_1_t *)malloc(sizeof(*dev));
2027 memset(dev, 0, sizeof(*dev));
Greg Hackmann86eb1c62012-05-30 09:25:51 -07002028
Greg Hackmannf6f2e542012-07-16 16:10:27 -07002029 if (hw_get_module(GRALLOC_HARDWARE_MODULE_ID,
2030 (const struct hw_module_t **)&dev->gralloc_module)) {
2031 ALOGE("failed to get gralloc hw module");
2032 ret = -EINVAL;
2033 goto err_get_module;
2034 }
Greg Hackmann86eb1c62012-05-30 09:25:51 -07002035
Greg Hackmann9130e702012-07-30 14:53:04 -07002036 if (gralloc_open((const hw_module_t *)dev->gralloc_module,
2037 &dev->alloc_device)) {
2038 ALOGE("failed to open gralloc");
2039 ret = -EINVAL;
2040 goto err_get_module;
2041 }
2042
Greg Hackmannf6f2e542012-07-16 16:10:27 -07002043 dev->fd = open("/dev/graphics/fb0", O_RDWR);
2044 if (dev->fd < 0) {
2045 ALOGE("failed to open framebuffer");
2046 ret = dev->fd;
Greg Hackmann9130e702012-07-30 14:53:04 -07002047 goto err_open_fb;
Greg Hackmannf6f2e542012-07-16 16:10:27 -07002048 }
Greg Hackmann86eb1c62012-05-30 09:25:51 -07002049
Greg Hackmannd92fe212012-09-11 14:28:41 -07002050 struct fb_var_screeninfo info;
2051 if (ioctl(dev->fd, FBIOGET_VSCREENINFO, &info) == -1) {
2052 ALOGE("FBIOGET_VSCREENINFO ioctl failed: %s", strerror(errno));
2053 ret = -errno;
2054 goto err_ioctl;
2055 }
2056
2057 refreshRate = 1000000000000LLU /
2058 (
2059 uint64_t( info.upper_margin + info.lower_margin + info.yres )
2060 * ( info.left_margin + info.right_margin + info.xres )
2061 * info.pixclock
2062 );
2063
2064 if (refreshRate == 0) {
2065 ALOGW("invalid refresh rate, assuming 60 Hz");
2066 refreshRate = 60;
2067 }
2068
Greg Hackmann0c1ba822012-09-13 13:38:12 -07002069 dev->xres = 2560;
2070 dev->yres = 1600;
Greg Hackmannd92fe212012-09-11 14:28:41 -07002071 dev->xdpi = 1000 * (info.xres * 25.4f) / info.width;
2072 dev->ydpi = 1000 * (info.yres * 25.4f) / info.height;
2073 dev->vsync_period = 1000000000 / refreshRate;
2074
2075 ALOGV("using\n"
2076 "xres = %d px\n"
2077 "yres = %d px\n"
2078 "width = %d mm (%f dpi)\n"
2079 "height = %d mm (%f dpi)\n"
2080 "refresh rate = %d Hz\n",
2081 dev->xres, dev->yres, info.width, dev->xdpi / 1000.0,
2082 info.height, dev->ydpi / 1000.0, refreshRate);
2083
Greg Hackmannde6a0872012-10-10 16:57:24 -07002084 for (size_t i = 0; i < NUM_GSC_UNITS; i++)
2085 for (size_t j = 0; j < NUM_GSC_DST_BUFS; j++)
2086 dev->gsc[i].dst_buf_fence[j] = -1;
2087
Benoit Goby8bad7e32012-08-16 14:17:14 -07002088 dev->hdmi_mixer0 = open("/dev/v4l-subdev7", O_RDWR);
Benoit Goby93f9f5d2012-09-28 20:37:17 -07002089 if (dev->hdmi_mixer0 < 0) {
Benoit Goby8bad7e32012-08-16 14:17:14 -07002090 ALOGE("failed to open hdmi mixer0 subdev");
Benoit Goby93f9f5d2012-09-28 20:37:17 -07002091 ret = dev->hdmi_mixer0;
Benoit Gobyd6bb7ce2012-08-09 16:11:22 -07002092 goto err_ioctl;
2093 }
2094
Benoit Goby93f9f5d2012-09-28 20:37:17 -07002095 dev->hdmi_layers[0].id = 0;
2096 dev->hdmi_layers[0].fd = open("/dev/video16", O_RDWR);
2097 if (dev->hdmi_layers[0].fd < 0) {
Benoit Goby8bad7e32012-08-16 14:17:14 -07002098 ALOGE("failed to open hdmi layer0 device");
Benoit Goby93f9f5d2012-09-28 20:37:17 -07002099 ret = dev->hdmi_layers[0].fd;
Benoit Goby8bad7e32012-08-16 14:17:14 -07002100 goto err_mixer0;
2101 }
2102
Benoit Goby93f9f5d2012-09-28 20:37:17 -07002103 dev->hdmi_layers[1].id = 1;
2104 dev->hdmi_layers[1].fd = open("/dev/video17", O_RDWR);
2105 if (dev->hdmi_layers[1].fd < 0) {
Benoit Goby8bad7e32012-08-16 14:17:14 -07002106 ALOGE("failed to open hdmi layer1 device");
Benoit Goby93f9f5d2012-09-28 20:37:17 -07002107 ret = dev->hdmi_layers[1].fd;
Benoit Goby8bad7e32012-08-16 14:17:14 -07002108 goto err_hdmi0;
2109 }
2110
Greg Hackmann29724852012-07-23 15:31:10 -07002111 dev->vsync_fd = open("/sys/devices/platform/exynos5-fb.1/vsync", O_RDONLY);
2112 if (dev->vsync_fd < 0) {
2113 ALOGE("failed to open vsync attribute");
2114 ret = dev->vsync_fd;
Benoit Goby8bad7e32012-08-16 14:17:14 -07002115 goto err_hdmi1;
Greg Hackmann29724852012-07-23 15:31:10 -07002116 }
2117
Greg Hackmannf6f2e542012-07-16 16:10:27 -07002118 sw_fd = open("/sys/class/switch/hdmi/state", O_RDONLY);
2119 if (sw_fd) {
2120 char val;
Benoit Goby4e0f1682012-08-30 17:42:41 -07002121 if (read(sw_fd, &val, 1) == 1 && val == '1') {
Greg Hackmannf6f2e542012-07-16 16:10:27 -07002122 dev->hdmi_hpd = true;
Benoit Goby4e0f1682012-08-30 17:42:41 -07002123 if (hdmi_get_config(dev)) {
2124 ALOGE("Error reading HDMI configuration");
2125 dev->hdmi_hpd = false;
2126 }
2127 }
Greg Hackmannf6f2e542012-07-16 16:10:27 -07002128 }
Benoit Gobycdd61b32012-07-09 12:09:59 -07002129
Greg Hackmannf6f2e542012-07-16 16:10:27 -07002130 dev->base.common.tag = HARDWARE_DEVICE_TAG;
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -07002131 dev->base.common.version = HWC_DEVICE_API_VERSION_1_1;
Greg Hackmannf6f2e542012-07-16 16:10:27 -07002132 dev->base.common.module = const_cast<hw_module_t *>(module);
2133 dev->base.common.close = exynos5_close;
Greg Hackmann86eb1c62012-05-30 09:25:51 -07002134
Greg Hackmannf6f2e542012-07-16 16:10:27 -07002135 dev->base.prepare = exynos5_prepare;
2136 dev->base.set = exynos5_set;
Jesse Hallda5a71d2012-08-21 12:12:55 -07002137 dev->base.eventControl = exynos5_eventControl;
2138 dev->base.blank = exynos5_blank;
Greg Hackmannf6f2e542012-07-16 16:10:27 -07002139 dev->base.query = exynos5_query;
Jesse Hallda5a71d2012-08-21 12:12:55 -07002140 dev->base.registerProcs = exynos5_registerProcs;
Greg Hackmann600867e2012-08-23 12:58:02 -07002141 dev->base.dump = exynos5_dump;
Greg Hackmannb0b3bdd2012-09-11 15:57:50 -07002142 dev->base.getDisplayConfigs = exynos5_getDisplayConfigs;
2143 dev->base.getDisplayAttributes = exynos5_getDisplayAttributes;
Greg Hackmann86eb1c62012-05-30 09:25:51 -07002144
Greg Hackmannf6f2e542012-07-16 16:10:27 -07002145 *device = &dev->base.common;
Greg Hackmann86eb1c62012-05-30 09:25:51 -07002146
Greg Hackmannf6f2e542012-07-16 16:10:27 -07002147 ret = pthread_create(&dev->vsync_thread, NULL, hwc_vsync_thread, dev);
2148 if (ret) {
2149 ALOGE("failed to start vsync thread: %s", strerror(ret));
2150 ret = -ret;
Greg Hackmann29724852012-07-23 15:31:10 -07002151 goto err_vsync;
Greg Hackmannf6f2e542012-07-16 16:10:27 -07002152 }
Greg Hackmann86eb1c62012-05-30 09:25:51 -07002153
Greg Hackmann6e0f76d2012-09-17 17:47:09 -07002154 char value[PROPERTY_VALUE_MAX];
2155 property_get("debug.hwc.force_gpu", value, "0");
2156 dev->force_gpu = atoi(value);
2157
Greg Hackmannf6f2e542012-07-16 16:10:27 -07002158 return 0;
Greg Hackmann86eb1c62012-05-30 09:25:51 -07002159
Greg Hackmann29724852012-07-23 15:31:10 -07002160err_vsync:
2161 close(dev->vsync_fd);
Benoit Goby8bad7e32012-08-16 14:17:14 -07002162err_mixer0:
2163 close(dev->hdmi_mixer0);
2164err_hdmi1:
Benoit Goby93f9f5d2012-09-28 20:37:17 -07002165 close(dev->hdmi_layers[0].fd);
Benoit Goby8bad7e32012-08-16 14:17:14 -07002166err_hdmi0:
Benoit Goby93f9f5d2012-09-28 20:37:17 -07002167 close(dev->hdmi_layers[1].fd);
Greg Hackmann86eb1c62012-05-30 09:25:51 -07002168err_ioctl:
Greg Hackmannf6f2e542012-07-16 16:10:27 -07002169 close(dev->fd);
Greg Hackmann9130e702012-07-30 14:53:04 -07002170err_open_fb:
2171 gralloc_close(dev->alloc_device);
Greg Hackmann86eb1c62012-05-30 09:25:51 -07002172err_get_module:
Greg Hackmannf6f2e542012-07-16 16:10:27 -07002173 free(dev);
2174 return ret;
Greg Hackmann86eb1c62012-05-30 09:25:51 -07002175}
2176
2177static int exynos5_close(hw_device_t *device)
2178{
Greg Hackmannf6f2e542012-07-16 16:10:27 -07002179 struct exynos5_hwc_composer_device_1_t *dev =
2180 (struct exynos5_hwc_composer_device_1_t *)device;
Greg Hackmann29724852012-07-23 15:31:10 -07002181 pthread_kill(dev->vsync_thread, SIGTERM);
2182 pthread_join(dev->vsync_thread, NULL);
Greg Hackmannefd98532012-10-02 12:00:42 -07002183 for (size_t i = 0; i < NUM_GSC_UNITS; i++)
2184 exynos5_cleanup_gsc_m2m(dev, i);
Greg Hackmann9130e702012-07-30 14:53:04 -07002185 gralloc_close(dev->alloc_device);
Greg Hackmann29724852012-07-23 15:31:10 -07002186 close(dev->vsync_fd);
Benoit Goby8bad7e32012-08-16 14:17:14 -07002187 close(dev->hdmi_mixer0);
Benoit Goby93f9f5d2012-09-28 20:37:17 -07002188 close(dev->hdmi_layers[0].fd);
2189 close(dev->hdmi_layers[1].fd);
Greg Hackmannf6f2e542012-07-16 16:10:27 -07002190 close(dev->fd);
2191 return 0;
Greg Hackmann86eb1c62012-05-30 09:25:51 -07002192}
2193
2194static struct hw_module_methods_t exynos5_hwc_module_methods = {
Greg Hackmannf6f2e542012-07-16 16:10:27 -07002195 open: exynos5_open,
Greg Hackmann86eb1c62012-05-30 09:25:51 -07002196};
2197
2198hwc_module_t HAL_MODULE_INFO_SYM = {
Greg Hackmannf6f2e542012-07-16 16:10:27 -07002199 common: {
2200 tag: HARDWARE_MODULE_TAG,
2201 module_api_version: HWC_MODULE_API_VERSION_0_1,
2202 hal_api_version: HARDWARE_HAL_API_VERSION,
2203 id: HWC_HARDWARE_MODULE_ID,
2204 name: "Samsung exynos5 hwcomposer module",
2205 author: "Google",
2206 methods: &exynos5_hwc_module_methods,
2207 }
Greg Hackmann86eb1c62012-05-30 09:25:51 -07002208};