hwc: Add support for FB scaling and cloning
[replicant:hardware_ti_omap4xxx.git] / hwc / hwc.c
1 /*
2  * Copyright (C) Texas Instruments - http://www.ti.com/
3  *
4  * Licensed under the Apache License, Version 2.0 (the "License");
5  * you may not use this file except in compliance with the License.
6  * You may obtain a copy of the License at
7  *
8  *      http://www.apache.org/licenses/LICENSE-2.0
9  *
10  * Unless required by applicable law or agreed to in writing, software
11  * distributed under the License is distributed on an "AS IS" BASIS,
12  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
13  * See the License for the specific language governing permissions and
14  * limitations under the License.
15  */
16
17 #include <errno.h>
18 #include <malloc.h>
19 #include <stdlib.h>
20 #include <stdarg.h>
21 #include <fcntl.h>
22 #include <poll.h>
23 #include <sys/ioctl.h>
24 #include <linux/fb.h>
25 #include <linux/omapfb.h>
26 #include <sys/mman.h>
27 #include <sys/resource.h>
28
29 #ifdef SYSFS_VSYNC_NOTIFICATION
30 #include <sys/prctl.h>
31 #endif
32
33 #include <cutils/properties.h>
34 #include <cutils/log.h>
35 #include <cutils/native_handle.h>
36 #define HWC_REMOVE_DEPRECATED_VERSIONS 1
37 #include <hardware/hardware.h>
38 #include <hardware/hwcomposer.h>
39 #include <EGL/egl.h>
40 #include <hardware_legacy/uevent.h>
41 #include <png.h>
42
43 #include <system/graphics.h>
44
45 #define ASPECT_RATIO_TOLERANCE 0.02f
46
47 #define min(a, b) ( { typeof(a) __a = (a), __b = (b); __a < __b ? __a : __b; } )
48 #define max(a, b) ( { typeof(a) __a = (a), __b = (b); __a > __b ? __a : __b; } )
49 #define swap(a, b) do { typeof(a) __a = (a); (a) = (b); (b) = __a; } while (0)
50
51 #define WIDTH(rect) ((rect).right - (rect).left)
52 #define HEIGHT(rect) ((rect).bottom - (rect).top)
53
54 #define DIV_ROUND_UP(a, b) (((a) + (b) - 1) / (b))
55
56 #include <video/dsscomp.h>
57
58 #include "hal_public.h"
59
60 #define MAX_HW_OVERLAYS 4
61 #define NUM_NONSCALING_OVERLAYS 1
62 #define HAL_PIXEL_FORMAT_BGRX_8888      0x1FF
63 #define HAL_PIXEL_FORMAT_TI_NV12        0x100
64 #define HAL_PIXEL_FORMAT_TI_NV12_PADDED 0x101
65 #define MAX_TILER_SLOT (16 << 20)
66
67 struct ext_transform_t {
68     __u8 rotation : 3;          /* 90-degree clockwise rotations */
69     __u8 hflip    : 1;          /* flip l-r (after rotation) */
70     __u8 enabled  : 1;          /* cloning enabled */
71     __u8 docking  : 1;          /* docking vs. mirroring - used for state */
72 };
73
74 /* cloning support and state */
75 struct omap4_hwc_ext {
76     /* support */
77     struct ext_transform_t mirror;      /* mirroring settings */
78     struct ext_transform_t dock;        /* docking settings */
79     float lcd_xpy;                      /* pixel ratio for UI */
80     __u8 avoid_mode_change;             /* use HDMI mode used for mirroring if possible */
81     __u8 force_dock;                     /* must dock */
82     __u8 hdmi_state;                     /* whether HDMI is connected */
83
84     /* state */
85     __u8 on_tv;                         /* using a tv */
86     struct ext_transform_t current;     /* current settings */
87     struct ext_transform_t last;        /* last-used settings */
88
89     /* configuration */
90     __u32 last_xres_used;               /* resolution and pixel ratio used for mode selection */
91     __u32 last_yres_used;
92     __u32 last_mode;                    /* 2-s complement of last HDMI mode set, 0 if none */
93     __u32 mirror_mode;                  /* 2-s complement of mode used when mirroring */
94     float last_xpy;
95     __u16 width;                        /* external screen dimensions */
96     __u16 height;
97     __u32 xres;                         /* external screen resolution */
98     __u32 yres;
99     float m[2][3];                      /* external transformation matrix */
100     hwc_rect_t mirror_region;           /* region of screen to mirror */
101 };
102 typedef struct omap4_hwc_ext omap4_hwc_ext_t;
103
104 /* used by property settings */
105 enum {
106     EXT_ROTATION    = 3,        /* rotation while mirroring */
107     EXT_HFLIP       = (1 << 2), /* flip l-r on output (after rotation) */
108 };
109
110 /* ARGB image */
111 struct omap4_hwc_img {
112     int width;
113     int height;
114     int rowbytes;
115     int size;
116     unsigned char *ptr;
117 } dock_image = { .rowbytes = 0 };
118
119 struct omap4_hwc_module {
120     hwc_module_t base;
121
122     IMG_framebuffer_device_public_t *fb_dev;
123 };
124 typedef struct omap4_hwc_module omap4_hwc_module_t;
125
126 struct omap4_hwc_device {
127     /* static data */
128     hwc_composer_device_1_t base;
129     hwc_procs_t *procs;
130     pthread_t hdmi_thread;
131 #ifdef SYSFS_VSYNC_NOTIFICATION
132     pthread_t vsync_thread;
133 #endif
134     pthread_mutex_t lock;
135
136     IMG_framebuffer_device_public_t *fb_dev;
137     struct dsscomp_display_info fb_dis;
138     int fb_fd;                  /* file descriptor for /dev/fb0 */
139     int dsscomp_fd;             /* file descriptor for /dev/dsscomp */
140     int hdmi_fb_fd;             /* file descriptor for /dev/fb1 */
141     int pipe_fds[2];            /* pipe to event thread */
142
143     int img_mem_size;           /* size of fb for hdmi */
144     void *img_mem_ptr;          /* start of fb for hdmi */
145
146     int flags_rgb_order;
147     int flags_nv12_only;
148
149     int force_sgx;
150     omap4_hwc_ext_t ext;        /* external mirroring data */
151     int idle;
152     int ovls_blending;
153
154     float primary_m[2][3];          /* internal transformation matrix */
155     int primary_transform;
156     int primary_rotation;
157     hwc_rect_t primary_region;
158
159     /* composition data */
160     struct dsscomp_setup_dispc_data dsscomp_data;
161     buffer_handle_t *buffers;
162     int use_sgx;
163     int swap_rb;
164     unsigned int post2_layers;
165     int ext_ovls;               /* # of overlays on external display for current composition */
166     int ext_ovls_wanted;        /* # of overlays that should be on external display for current composition */
167     int last_ext_ovls;          /* # of overlays on external/internal display for last composition */
168     int last_int_ovls;
169 };
170 typedef struct omap4_hwc_device omap4_hwc_device_t;
171
172 #define HAL_FMT(f) ((f) == HAL_PIXEL_FORMAT_TI_NV12 ? "NV12" : \
173                     (f) == HAL_PIXEL_FORMAT_YV12 ? "YV12" : \
174                     (f) == HAL_PIXEL_FORMAT_BGRX_8888 ? "xRGB32" : \
175                     (f) == HAL_PIXEL_FORMAT_RGBX_8888 ? "xBGR32" : \
176                     (f) == HAL_PIXEL_FORMAT_BGRA_8888 ? "ARGB32" : \
177                     (f) == HAL_PIXEL_FORMAT_RGBA_8888 ? "ABGR32" : \
178                     (f) == HAL_PIXEL_FORMAT_RGB_565 ? "RGB565" : "??")
179
180 #define DSS_FMT(f) ((f) == OMAP_DSS_COLOR_NV12 ? "NV12" : \
181                     (f) == OMAP_DSS_COLOR_RGB24U ? "xRGB32" : \
182                     (f) == OMAP_DSS_COLOR_ARGB32 ? "ARGB32" : \
183                     (f) == OMAP_DSS_COLOR_RGB16 ? "RGB565" : "??")
184
185 static int debug = 0;
186
187 static void dump_layer(hwc_layer_1_t const* l)
188 {
189     ALOGD("\ttype=%d, flags=%08x, handle=%p, tr=%02x, blend=%04x, {%d,%d,%d,%d}, {%d,%d,%d,%d}",
190          l->compositionType, l->flags, l->handle, l->transform, l->blending,
191          l->sourceCrop.left,
192          l->sourceCrop.top,
193          l->sourceCrop.right,
194          l->sourceCrop.bottom,
195          l->displayFrame.left,
196          l->displayFrame.top,
197          l->displayFrame.right,
198          l->displayFrame.bottom);
199 }
200
201 static void dump_dsscomp(struct dsscomp_setup_dispc_data *d)
202 {
203     unsigned i;
204
205     ALOGD("[%08x] set: %c%c%c %d ovls\n",
206          d->sync_id,
207          (d->mode & DSSCOMP_SETUP_MODE_APPLY) ? 'A' : '-',
208          (d->mode & DSSCOMP_SETUP_MODE_DISPLAY) ? 'D' : '-',
209          (d->mode & DSSCOMP_SETUP_MODE_CAPTURE) ? 'C' : '-',
210          d->num_ovls);
211
212     for (i = 0; i < d->num_mgrs; i++) {
213         struct dss2_mgr_info *mi = &d->mgrs[i];
214         ALOGD(" (dis%d alpha=%d col=%08x ilace=%d)\n",
215              mi->ix,
216              mi->alpha_blending, mi->default_color,
217              mi->interlaced);
218     }
219
220     for (i = 0; i < d->num_ovls; i++) {
221         struct dss2_ovl_info *oi = &d->ovls[i];
222         struct dss2_ovl_cfg *c = &oi->cfg;
223         if (c->zonly)
224             ALOGD("ovl%d(%s z%d)\n",
225                  c->ix, c->enabled ? "ON" : "off", c->zorder);
226         else
227             ALOGD("ovl%d(%s z%d %s%s *%d%% %d*%d:%d,%d+%d,%d rot%d%s => %d,%d+%d,%d %p/%p|%d)\n",
228                  c->ix, c->enabled ? "ON" : "off", c->zorder, DSS_FMT(c->color_mode),
229                  c->pre_mult_alpha ? " premult" : "",
230                  (c->global_alpha * 100 + 128) / 255,
231                  c->width, c->height, c->crop.x, c->crop.y,
232                  c->crop.w, c->crop.h,
233                  c->rotation, c->mirror ? "+mir" : "",
234                  c->win.x, c->win.y, c->win.w, c->win.h,
235                  (void *) oi->ba, (void *) oi->uv, c->stride);
236     }
237 }
238
239 struct dump_buf {
240     char *buf;
241     int buf_len;
242     int len;
243 };
244
245 static void dump_printf(struct dump_buf *buf, const char *fmt, ...)
246 {
247     va_list ap;
248
249     va_start(ap, fmt);
250     buf->len += vsnprintf(buf->buf + buf->len, buf->buf_len - buf->len, fmt, ap);
251     va_end(ap);
252 }
253
254 static void dump_set_info(omap4_hwc_device_t *hwc_dev, hwc_display_contents_1_t* list)
255 {
256     struct dsscomp_setup_dispc_data *dsscomp = &hwc_dev->dsscomp_data;
257     char logbuf[1024];
258     struct dump_buf log = {
259         .buf = logbuf,
260         .buf_len = sizeof(logbuf),
261     };
262     unsigned int i;
263
264     dump_printf(&log, "set H{");
265     for (i = 0; list && i < list->numHwLayers; i++) {
266         if (i)
267             dump_printf(&log, " ");
268         hwc_layer_1_t *layer = &list->hwLayers[i];
269         IMG_native_handle_t *handle = (IMG_native_handle_t *)layer->handle;
270         dump_printf(&log, "%p:%s,", handle, layer->compositionType == HWC_OVERLAY ? "DSS" : "SGX");
271         if ((layer->flags & HWC_SKIP_LAYER) || !handle) {
272             dump_printf(&log, "SKIP");
273             continue;
274         }
275         if (layer->flags & HWC_HINT_CLEAR_FB)
276             dump_printf(&log, "CLR,");
277         dump_printf(&log, "%d*%d(%s)", handle->iWidth, handle->iHeight, HAL_FMT(handle->iFormat));
278         if (layer->transform)
279             dump_printf(&log, "~%d", layer->transform);
280     }
281     dump_printf(&log, "} D{");
282     for (i = 0; i < dsscomp->num_ovls; i++) {
283         if (i)
284             dump_printf(&log, " ");
285         dump_printf(&log, "%d=", dsscomp->ovls[i].cfg.ix);
286         if (dsscomp->ovls[i].cfg.enabled)
287             dump_printf(&log, "%08x:%d*%d,%s",
288                         dsscomp->ovls[i].ba,
289                         dsscomp->ovls[i].cfg.width,
290                         dsscomp->ovls[i].cfg.height,
291                         DSS_FMT(dsscomp->ovls[i].cfg.color_mode));
292         else
293             dump_printf(&log, "-");
294     }
295     dump_printf(&log, "} L{");
296     for (i = 0; i < hwc_dev->post2_layers; i++) {
297         if (i)
298             dump_printf(&log, " ");
299         dump_printf(&log, "%p", hwc_dev->buffers[i]);
300     }
301     dump_printf(&log, "}%s\n", hwc_dev->use_sgx ? " swap" : "");
302
303     ALOGD("%s", log.buf);
304 }
305
306 static int sync_id = 0;
307
308 static int omap4_hwc_is_valid_format(int format)
309 {
310     switch(format) {
311     case HAL_PIXEL_FORMAT_RGB_565:
312     case HAL_PIXEL_FORMAT_RGBX_8888:
313     case HAL_PIXEL_FORMAT_RGBA_8888:
314     case HAL_PIXEL_FORMAT_BGRA_8888:
315     case HAL_PIXEL_FORMAT_BGRX_8888:
316     case HAL_PIXEL_FORMAT_TI_NV12:
317     case HAL_PIXEL_FORMAT_TI_NV12_PADDED:
318         return 1;
319
320     default:
321         return 0;
322     }
323 }
324
325 static int scaled(hwc_layer_1_t *layer)
326 {
327     int w = WIDTH(layer->sourceCrop);
328     int h = HEIGHT(layer->sourceCrop);
329
330     if (layer->transform & HWC_TRANSFORM_ROT_90)
331         swap(w, h);
332
333     return WIDTH(layer->displayFrame) != w || HEIGHT(layer->displayFrame) != h;
334 }
335
336 static int is_protected(hwc_layer_1_t *layer)
337 {
338     IMG_native_handle_t *handle = (IMG_native_handle_t *)layer->handle;
339
340     return (handle->usage & GRALLOC_USAGE_PROTECTED);
341 }
342
343 #define is_BLENDED(layer) ((layer)->blending != HWC_BLENDING_NONE)
344
345 static int is_RGB(IMG_native_handle_t *handle)
346 {
347     switch(handle->iFormat)
348     {
349     case HAL_PIXEL_FORMAT_BGRA_8888:
350     case HAL_PIXEL_FORMAT_BGRX_8888:
351     case HAL_PIXEL_FORMAT_RGB_565:
352         return 1;
353     default:
354         return 0;
355     }
356 }
357
358 static int is_BGR_format(int format)
359 {
360     switch (format) {
361     case HAL_PIXEL_FORMAT_RGBX_8888:
362     case HAL_PIXEL_FORMAT_RGBA_8888:
363         return 1;
364     default:
365         return 0;
366     }
367 }
368
369 static int is_BGR(IMG_native_handle_t *handle)
370 {
371     return is_BGR_format(handle->iFormat);
372 }
373
374 static int is_NV12(IMG_native_handle_t *handle)
375 {
376     switch(handle->iFormat)
377     {
378     case HAL_PIXEL_FORMAT_TI_NV12:
379     case HAL_PIXEL_FORMAT_TI_NV12_PADDED:
380         return 1;
381     default:
382         return 0;
383     }
384 }
385
386 static int dockable(hwc_layer_1_t *layer)
387 {
388     IMG_native_handle_t *handle = (IMG_native_handle_t *)layer->handle;
389
390     return (handle->usage & GRALLOC_USAGE_EXTERNAL_DISP);
391 }
392
393 static unsigned int mem1d(IMG_native_handle_t *handle)
394 {
395     if (handle == NULL || is_NV12(handle))
396         return 0;
397
398     int bpp = handle->iFormat == HAL_PIXEL_FORMAT_RGB_565 ? 2 : 4;
399     int stride = ALIGN(handle->iWidth, HW_ALIGN) * bpp;
400     return stride * handle->iHeight;
401 }
402
403 static void
404 omap4_hwc_setup_layer_base(struct dss2_ovl_cfg *oc, int index, int format, int blended, int width, int height)
405 {
406     unsigned int bits_per_pixel;
407
408     /* YUV2RGB conversion */
409     const struct omap_dss_cconv_coefs ctbl_bt601_5 = {
410         298,  409,    0,  298, -208, -100,  298,    0,  517, 0,
411     };
412
413     /* convert color format */
414     switch (format) {
415     case HAL_PIXEL_FORMAT_RGBA_8888:
416     case HAL_PIXEL_FORMAT_BGRA_8888:
417         oc->color_mode = OMAP_DSS_COLOR_ARGB32;
418         bits_per_pixel = 32;
419         if (blended)
420                 break;
421
422     case HAL_PIXEL_FORMAT_RGBX_8888:
423     case HAL_PIXEL_FORMAT_BGRX_8888:
424         oc->color_mode = OMAP_DSS_COLOR_RGB24U;
425         bits_per_pixel = 32;
426         break;
427
428     case HAL_PIXEL_FORMAT_RGB_565:
429         oc->color_mode = OMAP_DSS_COLOR_RGB16;
430         bits_per_pixel = 16;
431         break;
432
433     case HAL_PIXEL_FORMAT_TI_NV12:
434     case HAL_PIXEL_FORMAT_TI_NV12_PADDED:
435         oc->color_mode = OMAP_DSS_COLOR_NV12;
436         bits_per_pixel = 8;
437         oc->cconv = ctbl_bt601_5;
438         break;
439
440     default:
441         /* Should have been filtered out */
442         ALOGV("Unsupported pixel format");
443         return;
444     }
445
446     oc->width = width;
447     oc->height = height;
448     oc->stride = ALIGN(width, HW_ALIGN) * bits_per_pixel / 8;
449
450     oc->enabled = 1;
451     oc->global_alpha = 255;
452     oc->zorder = index;
453     oc->ix = 0;
454
455     /* defaults for SGX framebuffer renders */
456     oc->crop.w = oc->win.w = width;
457     oc->crop.h = oc->win.h = height;
458
459     /* for now interlacing and vc1 info is not supplied */
460     oc->ilace = OMAP_DSS_ILACE_NONE;
461     oc->vc1.enable = 0;
462 }
463
464 static void
465 omap4_hwc_setup_layer(omap4_hwc_device_t *hwc_dev, struct dss2_ovl_info *ovl,
466                       hwc_layer_1_t *layer, int index,
467                       int format, int width, int height)
468 {
469     struct dss2_ovl_cfg *oc = &ovl->cfg;
470
471     //dump_layer(layer);
472
473     omap4_hwc_setup_layer_base(oc, index, format, is_BLENDED(layer), width, height);
474
475     /* convert transformation - assuming 0-set config */
476     if (layer->transform & HWC_TRANSFORM_FLIP_H)
477         oc->mirror = 1;
478     if (layer->transform & HWC_TRANSFORM_FLIP_V) {
479         oc->rotation = 2;
480         oc->mirror = !oc->mirror;
481     }
482     if (layer->transform & HWC_TRANSFORM_ROT_90) {
483         oc->rotation += oc->mirror ? -1 : 1;
484         oc->rotation &= 3;
485     }
486
487     oc->pre_mult_alpha = layer->blending == HWC_BLENDING_PREMULT;
488
489     /* display position */
490     oc->win.x = layer->displayFrame.left;
491     oc->win.y = layer->displayFrame.top;
492     oc->win.w = WIDTH(layer->displayFrame);
493     oc->win.h = HEIGHT(layer->displayFrame);
494
495     /* crop */
496     oc->crop.x = layer->sourceCrop.left;
497     oc->crop.y = layer->sourceCrop.top;
498     oc->crop.w = WIDTH(layer->sourceCrop);
499     oc->crop.h = HEIGHT(layer->sourceCrop);
500 }
501
502 const float m_unit[2][3] = { { 1., 0., 0. }, { 0., 1., 0. } };
503
504 static inline void m_translate(float m[2][3], int dx, int dy)
505 {
506     m[0][2] += dx;
507     m[1][2] += dy;
508 }
509
510 static inline void m_scale1(float m[3], int from, int to)
511 {
512     m[0] = m[0] * to / from;
513     m[1] = m[1] * to / from;
514     m[2] = m[2] * to / from;
515 }
516
517 static inline void m_scale(float m[2][3], int x_from, int x_to, int y_from, int y_to)
518 {
519     m_scale1(m[0], x_from, x_to);
520     m_scale1(m[1], y_from, y_to);
521 }
522
523 static void m_rotate(float m[2][3], int quarter_turns)
524 {
525     if (quarter_turns & 2)
526         m_scale(m, 1, -1, 1, -1);
527     if (quarter_turns & 1) {
528         int q;
529         q = m[0][0]; m[0][0] = -m[1][0]; m[1][0] = q;
530         q = m[0][1]; m[0][1] = -m[1][1]; m[1][1] = q;
531         q = m[0][2]; m[0][2] = -m[1][2]; m[1][2] = q;
532     }
533 }
534
535 static inline int m_round(float x)
536 {
537     /* int truncates towards 0 */
538     return (int) (x < 0 ? x - 0.5 : x + 0.5);
539 }
540
541 /*
542  * assuming xpy (xratio:yratio) original pixel ratio, calculate the adjusted width
543  * and height for a screen of xres/yres and physical size of width/height.
544  * The adjusted size is the largest that fits into the screen.
545  */
546 static void get_max_dimensions(__u32 orig_xres, __u32 orig_yres,
547                                float xpy,
548                                __u32 scr_xres, __u32 scr_yres,
549                                __u32 scr_width, __u32 scr_height,
550                                __u32 *adj_xres, __u32 *adj_yres)
551 {
552     /* assume full screen (largest size)*/
553     *adj_xres = scr_xres;
554     *adj_yres = scr_yres;
555
556     /* assume 1:1 pixel ratios if none supplied */
557     if (!scr_width || !scr_height) {
558         scr_width = scr_xres;
559         scr_height = scr_yres;
560     }
561
562     /* trim to keep aspect ratio */
563     float x_factor = orig_xres * xpy * scr_height;
564     float y_factor = orig_yres *       scr_width;
565
566     /* allow for tolerance so we avoid scaling if framebuffer is standard size */
567     if (x_factor < y_factor * (1.f - ASPECT_RATIO_TOLERANCE))
568         *adj_xres = (__u32) (x_factor * *adj_xres / y_factor + 0.5);
569     else if (x_factor * (1.f - ASPECT_RATIO_TOLERANCE) > y_factor)
570         *adj_yres = (__u32) (y_factor * *adj_yres / x_factor + 0.5);
571 }
572
573 static void set_ext_matrix(omap4_hwc_ext_t *ext, struct hwc_rect region)
574 {
575     int orig_w = WIDTH(region);
576     int orig_h = HEIGHT(region);
577     float xpy = ext->lcd_xpy;
578
579     /* reorientation matrix is:
580        m = (center-from-target-center) * (scale-to-target) * (mirror) * (rotate) * (center-to-original-center) */
581
582     memcpy(ext->m, m_unit, sizeof(m_unit));
583     m_translate(ext->m, -(orig_w >> 1) - region.left, -(orig_h >> 1) - region.top);
584     m_rotate(ext->m, ext->current.rotation);
585     if (ext->current.hflip)
586         m_scale(ext->m, 1, -1, 1, 1);
587
588     if (ext->current.rotation & 1) {
589         swap(orig_w, orig_h);
590         xpy = 1. / xpy;
591     }
592
593     /* get target size */
594     __u32 adj_xres, adj_yres;
595     get_max_dimensions(orig_w, orig_h, xpy,
596                        ext->xres, ext->yres, ext->width, ext->height,
597                        &adj_xres, &adj_yres);
598
599     m_scale(ext->m, orig_w, adj_xres, orig_h, adj_yres);
600     m_translate(ext->m, ext->xres >> 1, ext->yres >> 1);
601 }
602
603 static int
604 crop_to_rect(struct dss2_ovl_cfg *cfg, struct hwc_rect vis_rect)
605 {
606     struct {
607         int xy[2];
608         int wh[2];
609     } crop, win;
610     struct {
611         int lt[2];
612         int rb[2];
613     } vis;
614     win.xy[0] = cfg->win.x; win.xy[1] = cfg->win.y;
615     win.wh[0] = cfg->win.w; win.wh[1] = cfg->win.h;
616     crop.xy[0] = cfg->crop.x; crop.xy[1] = cfg->crop.y;
617     crop.wh[0] = cfg->crop.w; crop.wh[1] = cfg->crop.h;
618     vis.lt[0] = vis_rect.left; vis.lt[1] = vis_rect.top;
619     vis.rb[0] = vis_rect.right; vis.rb[1] = vis_rect.bottom;
620
621     int c, swap = cfg->rotation & 1;
622
623     /* align crop window with display coordinates */
624     if (swap)
625         crop.xy[1] -= (crop.wh[1] = -crop.wh[1]);
626     if (cfg->rotation & 2)
627         crop.xy[!swap] -= (crop.wh[!swap] = -crop.wh[!swap]);
628     if ((!cfg->mirror) ^ !(cfg->rotation & 2))
629         crop.xy[swap] -= (crop.wh[swap] = -crop.wh[swap]);
630
631     for (c = 0; c < 2; c++) {
632         /* see if complete buffer is outside the vis or it is
633           fully cropped or scaled to 0 */
634         if (win.wh[c] <= 0 || vis.rb[c] <= vis.lt[c] ||
635             win.xy[c] + win.wh[c] <= vis.lt[c] ||
636             win.xy[c] >= vis.rb[c] ||
637             !crop.wh[c ^ swap])
638             return -ENOENT;
639
640         /* crop left/top */
641         if (win.xy[c] < vis.lt[c]) {
642             /* correction term */
643             int a = (vis.lt[c] - win.xy[c]) * crop.wh[c ^ swap] / win.wh[c];
644             crop.xy[c ^ swap] += a;
645             crop.wh[c ^ swap] -= a;
646             win.wh[c] -= vis.lt[c] - win.xy[c];
647             win.xy[c] = vis.lt[c];
648         }
649         /* crop right/bottom */
650         if (win.xy[c] + win.wh[c] > vis.rb[c]) {
651             crop.wh[c ^ swap] = crop.wh[c ^ swap] * (vis.rb[c] - win.xy[c]) / win.wh[c];
652             win.wh[c] = vis.rb[c] - win.xy[c];
653         }
654
655         if (!crop.wh[c ^ swap] || !win.wh[c])
656             return -ENOENT;
657     }
658
659     /* realign crop window to buffer coordinates */
660     if (cfg->rotation & 2)
661         crop.xy[!swap] -= (crop.wh[!swap] = -crop.wh[!swap]);
662     if ((!cfg->mirror) ^ !(cfg->rotation & 2))
663         crop.xy[swap] -= (crop.wh[swap] = -crop.wh[swap]);
664     if (swap)
665         crop.xy[1] -= (crop.wh[1] = -crop.wh[1]);
666
667     cfg->win.x = win.xy[0]; cfg->win.y = win.xy[1];
668     cfg->win.w = win.wh[0]; cfg->win.h = win.wh[1];
669     cfg->crop.x = crop.xy[0]; cfg->crop.y = crop.xy[1];
670     cfg->crop.w = crop.wh[0]; cfg->crop.h = crop.wh[1];
671
672     return 0;
673 }
674
675 static void
676 omap4_hwc_apply_transform(float transform[2][3],struct dss2_ovl_cfg *oc)
677 {
678     float x, y, w, h;
679
680     /* display position */
681     x = transform[0][0] * oc->win.x + transform[0][1] * oc->win.y + transform[0][2];
682     y = transform[1][0] * oc->win.x + transform[1][1] * oc->win.y + transform[1][2];
683     w = transform[0][0] * oc->win.w + transform[0][1] * oc->win.h;
684     h = transform[1][0] * oc->win.w + transform[1][1] * oc->win.h;
685     oc->win.x = m_round(w > 0 ? x : x + w);
686     oc->win.y = m_round(h > 0 ? y : y + h);
687     oc->win.w = m_round(w > 0 ? w : -w);
688     oc->win.h = m_round(h > 0 ? h : -h);
689 }
690
691 static void
692 omap4_hwc_adjust_ext_layer(omap4_hwc_ext_t *ext, struct dss2_ovl_info *ovl)
693 {
694     struct dss2_ovl_cfg *oc = &ovl->cfg;
695
696     /* crop to clone region if mirroring */
697     if (!ext->current.docking &&
698         crop_to_rect(&ovl->cfg, ext->mirror_region) != 0) {
699         ovl->cfg.enabled = 0;
700         return;
701     }
702
703     omap4_hwc_apply_transform(ext->m, oc);
704
705     /* combining transformations: F^a*R^b*F^i*R^j = F^(a+b)*R^(j+b*(-1)^i), because F*R = R^(-1)*F */
706     oc->rotation += (oc->mirror ? -1 : 1) * ext->current.rotation;
707     oc->rotation &= 3;
708     if (ext->current.hflip)
709         oc->mirror = !oc->mirror;
710 }
711
712 static struct dsscomp_dispc_limitations {
713     __u8 max_xdecim_2d;
714     __u8 max_ydecim_2d;
715     __u8 max_xdecim_1d;
716     __u8 max_ydecim_1d;
717     __u32 fclk;
718     __u8 max_downscale;
719     __u8 min_width;
720     __u16 integer_scale_ratio_limit;
721     __u16 max_width;
722     __u16 max_height;
723 } limits = {
724     .max_xdecim_1d = 16,
725     .max_xdecim_2d = 16,
726     .max_ydecim_1d = 16,
727     .max_ydecim_2d = 2,
728     .fclk = 170666666,
729     .max_downscale = 4,
730     .min_width = 2,
731     .integer_scale_ratio_limit = 2048,
732     .max_width = 2048,
733     .max_height = 2048,
734 };
735
736 static void
737 omap4_hwc_adjust_primary_display_layer(omap4_hwc_device_t *hwc_dev, struct dss2_ovl_info *ovl)
738 {
739     struct dss2_ovl_cfg *oc = &ovl->cfg;
740
741     if (crop_to_rect(&ovl->cfg, hwc_dev->primary_region) != 0) {
742         ovl->cfg.enabled = 0;
743         return;
744     }
745
746     omap4_hwc_apply_transform(hwc_dev->primary_m, oc);
747
748     /* combining transformations: F^a*R^b*F^i*R^j = F^(a+b)*R^(j+b*(-1)^i), because F*R = R^(-1)*F */
749     oc->rotation += (oc->mirror ? -1 : 1) * hwc_dev->primary_rotation;
750     oc->rotation &= 3;
751 }
752
753 static int omap4_hwc_can_scale(__u32 src_w, __u32 src_h, __u32 dst_w, __u32 dst_h, int is_2d,
754                                struct dsscomp_display_info *dis, struct dsscomp_dispc_limitations *limits,
755                                __u32 pclk)
756 {
757     __u32 fclk = limits->fclk / 1000;
758     __u32 min_src_w = DIV_ROUND_UP(src_w, is_2d ? limits->max_xdecim_2d : limits->max_xdecim_1d);
759     __u32 min_src_h = DIV_ROUND_UP(src_h, is_2d ? limits->max_ydecim_2d : limits->max_ydecim_1d);
760
761     /* ERRATAs */
762     /* cannot render 1-width layers on DSI video mode panels - we just disallow all 1-width LCD layers */
763     if (dis->channel != OMAP_DSS_CHANNEL_DIGIT && dst_w < limits->min_width)
764         return 0;
765
766     /* NOTE: no support for checking YUV422 layers that are tricky to scale */
767
768     /* FIXME: limit vertical downscale well below theoretical limit as we saw display artifacts */
769     if (dst_h < src_h / 4)
770         return 0;
771
772     /* max downscale */
773     if (dst_h * limits->max_downscale < min_src_h)
774         return 0;
775
776     /* for manual panels pclk is 0, and there are no pclk based scaling limits */
777     if (!pclk)
778         return !(dst_w * limits->max_downscale < min_src_w);
779
780     /* :HACK: limit horizontal downscale well below theoretical limit as we saw display artifacts */
781     if (dst_w * 4 < src_w)
782         return 0;
783
784     /* max horizontal downscale is 4, or the fclk/pixclk */
785     if (fclk > pclk * limits->max_downscale)
786         fclk = pclk * limits->max_downscale;
787     /* for small parts, we need to use integer fclk/pixclk */
788     if (src_w < limits->integer_scale_ratio_limit)
789         fclk = fclk / pclk * pclk;
790     if ((__u32) dst_w * fclk < min_src_w * pclk)
791         return 0;
792
793     return 1;
794 }
795
796 static int omap4_hwc_can_scale_layer(omap4_hwc_device_t *hwc_dev, hwc_layer_1_t *layer, IMG_native_handle_t *handle)
797 {
798     int src_w = WIDTH(layer->sourceCrop);
799     int src_h = HEIGHT(layer->sourceCrop);
800     int dst_w = WIDTH(layer->displayFrame);
801     int dst_h = HEIGHT(layer->displayFrame);
802
803     /* account for 90-degree rotation */
804     if (layer->transform & HWC_TRANSFORM_ROT_90)
805         swap(src_w, src_h);
806
807     /* NOTE: layers should be able to be scaled externally since
808        framebuffer is able to be scaled on selected external resolution */
809     return omap4_hwc_can_scale(src_w, src_h, dst_w, dst_h, is_NV12(handle), &hwc_dev->fb_dis, &limits,
810                                hwc_dev->fb_dis.timings.pixel_clock);
811 }
812
813 static int omap4_hwc_is_valid_layer(omap4_hwc_device_t *hwc_dev,
814                                     hwc_layer_1_t *layer,
815                                     IMG_native_handle_t *handle)
816 {
817     /* Skip layers are handled by SF */
818     if ((layer->flags & HWC_SKIP_LAYER) || !handle)
819         return 0;
820
821     if (!omap4_hwc_is_valid_format(handle->iFormat))
822         return 0;
823
824     /* 1D buffers: no transform, must fit in TILER slot */
825     if (!is_NV12(handle)) {
826         if (layer->transform)
827             return 0;
828         if (mem1d(handle) > MAX_TILER_SLOT)
829             return 0;
830     }
831
832     return omap4_hwc_can_scale_layer(hwc_dev, layer, handle);
833 }
834
835 static __u32 add_scaling_score(__u32 score,
836                                __u32 xres, __u32 yres, __u32 refresh,
837                                __u32 ext_xres, __u32 ext_yres,
838                                __u32 mode_xres, __u32 mode_yres, __u32 mode_refresh)
839 {
840     __u32 area = xres * yres;
841     __u32 ext_area = ext_xres * ext_yres;
842     __u32 mode_area = mode_xres * mode_yres;
843
844     /* prefer to upscale (1% tolerance) [0..1] (insert after 1st bit) */
845     int upscale = (ext_xres >= xres * 99 / 100 && ext_yres >= yres * 99 / 100);
846     score = (((score & ~1) | upscale) << 1) | (score & 1);
847
848     /* pick minimum scaling [0..16] */
849     if (ext_area > area)
850         score = (score << 5) | (16 * area / ext_area);
851     else
852         score = (score << 5) | (16 * ext_area / area);
853
854     /* pick smallest leftover area [0..16] */
855     score = (score << 5) | ((16 * ext_area + (mode_area >> 1)) / mode_area);
856
857     /* adjust mode refresh rate */
858     mode_refresh += mode_refresh % 6 == 5;
859
860     /* prefer same or higher frame rate */
861     upscale = (mode_refresh >= refresh);
862     score = (score << 1) | upscale;
863
864     /* pick closest frame rate */
865     if (mode_refresh > refresh)
866         score = (score << 8) | (240 * refresh / mode_refresh);
867     else
868         score = (score << 8) | (240 * mode_refresh / refresh);
869
870     return score;
871 }
872
873 static int omap4_hwc_set_best_hdmi_mode(omap4_hwc_device_t *hwc_dev, __u32 xres, __u32 yres,
874                                         float xpy)
875 {
876     struct _qdis {
877         struct dsscomp_display_info dis;
878         struct dsscomp_videomode modedb[32];
879     } d = { .dis = { .ix = 1 } };
880     omap4_hwc_ext_t *ext = &hwc_dev->ext;
881
882     d.dis.modedb_len = sizeof(d.modedb) / sizeof(*d.modedb);
883     int ret = ioctl(hwc_dev->dsscomp_fd, DSSCIOC_QUERY_DISPLAY, &d);
884     if (ret)
885         return ret;
886
887     if (d.dis.timings.x_res * d.dis.timings.y_res == 0 ||
888         xres * yres == 0)
889         return -EINVAL;
890
891     __u32 i, best = ~0, best_score = 0;
892     ext->width = d.dis.width_in_mm;
893     ext->height = d.dis.height_in_mm;
894     ext->xres = d.dis.timings.x_res;
895     ext->yres = d.dis.timings.y_res;
896
897     /* use VGA external resolution as default */
898     if (!ext->xres || !ext->yres) {
899         ext->xres = 640;
900         ext->yres = 480;
901     }
902
903     __u32 ext_fb_xres, ext_fb_yres;
904     for (i = 0; i < d.dis.modedb_len; i++) {
905         __u32 score = 0;
906         __u32 mode_xres = d.modedb[i].xres;
907         __u32 mode_yres = d.modedb[i].yres;
908         __u32 ext_width = d.dis.width_in_mm;
909         __u32 ext_height = d.dis.height_in_mm;
910
911         if (d.modedb[i].flag & FB_FLAG_RATIO_4_3) {
912             ext_width = 4;
913             ext_height = 3;
914         } else if (d.modedb[i].flag & FB_FLAG_RATIO_16_9) {
915             ext_width = 16;
916             ext_height = 9;
917         }
918
919         if (!mode_xres || !mode_yres)
920             continue;
921
922         get_max_dimensions(xres, yres, xpy, mode_xres, mode_yres,
923                            ext_width, ext_height, &ext_fb_xres, &ext_fb_yres);
924
925         /* we need to ensure that even TILER2D buffers can be scaled */
926         if (!d.modedb[i].pixclock ||
927             d.modedb[i].vmode ||
928             !omap4_hwc_can_scale(xres, yres, ext_fb_xres, ext_fb_yres,
929                                  1, &d.dis, &limits,
930                                  1000000000 / d.modedb[i].pixclock))
931             continue;
932
933         /* prefer CEA modes */
934         if (d.modedb[i].flag & (FB_FLAG_RATIO_4_3 | FB_FLAG_RATIO_16_9))
935             score = 1;
936
937         /* prefer the same mode as we use for mirroring to avoid mode change */
938        score = (score << 1) | (i == ~ext->mirror_mode && ext->avoid_mode_change);
939
940         score = add_scaling_score(score, xres, yres, 60, ext_fb_xres, ext_fb_yres,
941                                   mode_xres, mode_yres, d.modedb[i].refresh ? : 1);
942
943         ALOGD("#%d: %dx%d %dHz", i, mode_xres, mode_yres, d.modedb[i].refresh);
944         if (debug)
945             ALOGD("  score=0x%x adj.res=%dx%d", score, ext_fb_xres, ext_fb_yres);
946         if (best_score < score) {
947             ext->width = ext_width;
948             ext->height = ext_height;
949             ext->xres = mode_xres;
950             ext->yres = mode_yres;
951             best = i;
952             best_score = score;
953         }
954     }
955     if (~best) {
956         struct dsscomp_setup_display_data sdis = { .ix = 1, };
957         sdis.mode = d.dis.modedb[best];
958         ALOGD("picking #%d", best);
959         /* only reconfigure on change */
960         if (ext->last_mode != ~best)
961             ioctl(hwc_dev->dsscomp_fd, DSSCIOC_SETUP_DISPLAY, &sdis);
962         ext->last_mode = ~best;
963     } else {
964         __u32 ext_width = d.dis.width_in_mm;
965         __u32 ext_height = d.dis.height_in_mm;
966         __u32 ext_fb_xres, ext_fb_yres;
967
968         get_max_dimensions(xres, yres, xpy, d.dis.timings.x_res, d.dis.timings.y_res,
969                            ext_width, ext_height, &ext_fb_xres, &ext_fb_yres);
970         if (!d.dis.timings.pixel_clock ||
971             d.dis.mgr.interlaced ||
972             !omap4_hwc_can_scale(xres, yres, ext_fb_xres, ext_fb_yres,
973                                  1, &d.dis, &limits,
974                                  d.dis.timings.pixel_clock)) {
975             ALOGW("DSS scaler cannot support HDMI cloning");
976             return -1;
977         }
978     }
979     ext->last_xres_used = xres;
980     ext->last_yres_used = yres;
981     ext->last_xpy = xpy;
982     if (d.dis.channel == OMAP_DSS_CHANNEL_DIGIT)
983         ext->on_tv = 1;
984     return 0;
985 }
986
987 struct counts {
988     unsigned int possible_overlay_layers;
989     unsigned int composited_layers;
990     unsigned int scaled_layers;
991     unsigned int RGB;
992     unsigned int BGR;
993     unsigned int NV12;
994     unsigned int dockable;
995     unsigned int protected;
996
997     unsigned int max_hw_overlays;
998     unsigned int max_scaling_overlays;
999     unsigned int mem;
1000 };
1001
1002 static void gather_layer_statistics(omap4_hwc_device_t *hwc_dev, struct counts *num, hwc_display_contents_1_t *list)
1003 {
1004     unsigned int i;
1005
1006     /* Figure out how many layers we can support via DSS */
1007     for (i = 0; list && i < list->numHwLayers; i++) {
1008         hwc_layer_1_t *layer = &list->hwLayers[i];
1009         IMG_native_handle_t *handle = (IMG_native_handle_t *)layer->handle;
1010
1011         layer->compositionType = HWC_FRAMEBUFFER;
1012
1013         if (omap4_hwc_is_valid_layer(hwc_dev, layer, handle)) {
1014             num->possible_overlay_layers++;
1015
1016             /* NV12 layers can only be rendered on scaling overlays */
1017             if (scaled(layer) || is_NV12(handle) || hwc_dev->primary_transform)
1018                 num->scaled_layers++;
1019
1020             if (is_BGR(handle))
1021                 num->BGR++;
1022             else if (is_RGB(handle))
1023                 num->RGB++;
1024             else if (is_NV12(handle))
1025                 num->NV12++;
1026
1027             if (dockable(layer))
1028                 num->dockable++;
1029
1030             if (is_protected(layer))
1031                 num->protected++;
1032
1033             num->mem += mem1d(handle);
1034         }
1035     }
1036 }
1037
1038 static void decide_supported_cloning(omap4_hwc_device_t *hwc_dev, struct counts *num)
1039 {
1040     omap4_hwc_ext_t *ext = &hwc_dev->ext;
1041     int nonscaling_ovls = NUM_NONSCALING_OVERLAYS;
1042     num->max_hw_overlays = MAX_HW_OVERLAYS;
1043
1044     /*
1045      * We cannot atomically switch overlays from one display to another.  First, they
1046      * have to be disabled, and the disabling has to take effect on the current display.
1047      * We keep track of the available number of overlays here.
1048      */
1049     if (ext->dock.enabled && !(ext->mirror.enabled && !(num->dockable || ext->force_dock))) {
1050         /* some overlays may already be used by the external display, so we account for this */
1051
1052         /* reserve just a video pipeline for HDMI if docking */
1053         hwc_dev->ext_ovls = (num->dockable || ext->force_dock) ? 1 : 0;
1054         num->max_hw_overlays -= max(hwc_dev->ext_ovls, hwc_dev->last_ext_ovls);
1055
1056         /* use mirroring transform if we are auto-switching to docking mode while mirroring*/
1057         if (ext->mirror.enabled) {
1058             ext->current = ext->mirror;
1059             ext->current.docking = 1;
1060         } else {
1061             ext->current = ext->dock;
1062         }
1063     } else if (ext->mirror.enabled) {
1064         /*
1065          * otherwise, manage just from half the pipelines.  NOTE: there is
1066          * no danger of having used too many overlays for external display here.
1067          */
1068         num->max_hw_overlays >>= 1;
1069         nonscaling_ovls >>= 1;
1070         hwc_dev->ext_ovls = MAX_HW_OVERLAYS - num->max_hw_overlays;
1071         ext->current = ext->mirror;
1072     } else {
1073         num->max_hw_overlays -= hwc_dev->last_ext_ovls;
1074         hwc_dev->ext_ovls = 0;
1075         ext->current.enabled = 0;
1076     }
1077
1078     /*
1079      * :TRICKY: We may not have enough overlays on the external display.  We "reserve" them
1080      * here to figure out if mirroring is supported, but may not do mirroring for the first
1081      * frame while the overlays required for it are cleared.
1082      */
1083     hwc_dev->ext_ovls_wanted = hwc_dev->ext_ovls;
1084     hwc_dev->ext_ovls = min(MAX_HW_OVERLAYS - hwc_dev->last_int_ovls, hwc_dev->ext_ovls);
1085
1086     /* if mirroring, we are limited by both internal and external overlays.  However,
1087        ext_ovls is always <= MAX_HW_OVERLAYS / 2 <= max_hw_overlays */
1088     if (hwc_dev->ext_ovls && ext->current.enabled && !ext->current.docking)
1089         num->max_hw_overlays = hwc_dev->ext_ovls;
1090
1091     /* If FB is not same resolution as LCD don't use GFX pipe line*/
1092     if (hwc_dev->primary_transform) {
1093         num->max_hw_overlays -= NUM_NONSCALING_OVERLAYS;
1094         num->max_scaling_overlays = num->max_hw_overlays;
1095     } else
1096         num->max_scaling_overlays = num->max_hw_overlays - nonscaling_ovls;
1097 }
1098
1099 static int can_dss_render_all(omap4_hwc_device_t *hwc_dev, struct counts *num)
1100 {
1101     omap4_hwc_ext_t *ext = &hwc_dev->ext;
1102     int on_tv = ext->on_tv && ext->current.enabled;
1103     int tform = ext->current.enabled && (ext->current.rotation || ext->current.hflip);
1104
1105     return  !hwc_dev->force_sgx &&
1106             /* must have at least one layer if using composition bypass to get sync object */
1107             num->possible_overlay_layers &&
1108             num->possible_overlay_layers <= num->max_hw_overlays &&
1109             num->possible_overlay_layers == num->composited_layers &&
1110             num->scaled_layers <= num->max_scaling_overlays &&
1111             num->NV12 <= num->max_scaling_overlays &&
1112             /* fits into TILER slot */
1113             num->mem <= MAX_TILER_SLOT &&
1114             /* we cannot clone non-NV12 transformed layers */
1115             (!tform || num->NV12 == num->possible_overlay_layers) &&
1116             /* HDMI cannot display BGR */
1117             (num->BGR == 0 || (num->RGB == 0 && !on_tv) || !hwc_dev->flags_rgb_order);
1118 }
1119
1120 static inline int can_dss_render_layer(omap4_hwc_device_t *hwc_dev,
1121             hwc_layer_1_t *layer)
1122 {
1123     IMG_native_handle_t *handle = (IMG_native_handle_t *)layer->handle;
1124
1125     omap4_hwc_ext_t *ext = &hwc_dev->ext;
1126     int on_tv = ext->on_tv && ext->current.enabled;
1127     int tform = ext->current.enabled && (ext->current.rotation || ext->current.hflip);
1128
1129     return omap4_hwc_is_valid_layer(hwc_dev, layer, handle) &&
1130            /* cannot rotate non-NV12 layers on external display */
1131            (!tform || is_NV12(handle)) &&
1132            /* skip non-NV12 layers if also using SGX (if nv12_only flag is set) */
1133            (!hwc_dev->flags_nv12_only || (!hwc_dev->use_sgx || is_NV12(handle))) &&
1134            /* make sure RGB ordering is consistent (if rgb_order flag is set) */
1135            (!(hwc_dev->swap_rb ? is_RGB(handle) : is_BGR(handle)) ||
1136             !hwc_dev->flags_rgb_order) &&
1137            /* TV can only render RGB */
1138            !(on_tv && is_BGR(handle));
1139 }
1140
1141 static inline int display_area(struct dss2_ovl_info *o)
1142 {
1143     return o->cfg.win.w * o->cfg.win.h;
1144 }
1145
1146 static int clone_layer(omap4_hwc_device_t *hwc_dev, int ix) {
1147     struct dsscomp_setup_dispc_data *dsscomp = &hwc_dev->dsscomp_data;
1148     omap4_hwc_ext_t *ext = &hwc_dev->ext;
1149     int ext_ovl_ix = dsscomp->num_ovls - hwc_dev->post2_layers;
1150     struct dss2_ovl_info *o = &dsscomp->ovls[dsscomp->num_ovls];
1151
1152     if (dsscomp->num_ovls >= MAX_HW_OVERLAYS) {
1153         ALOGE("**** cannot clone layer #%d. using all %d overlays.", ix, dsscomp->num_ovls);
1154         return -EBUSY;
1155     }
1156
1157     memcpy(o, dsscomp->ovls + ix, sizeof(*o));
1158
1159     /* reserve overlays at end for other display */
1160     o->cfg.ix = MAX_HW_OVERLAYS - 1 - ext_ovl_ix;
1161     o->cfg.mgr_ix = 1;
1162     o->addressing = OMAP_DSS_BUFADDR_OVL_IX;
1163     o->ba = ix;
1164
1165     /* use distinct z values (to simplify z-order checking) */
1166     o->cfg.zorder += hwc_dev->post2_layers;
1167
1168     omap4_hwc_adjust_ext_layer(&hwc_dev->ext, o);
1169     dsscomp->num_ovls++;
1170     return 0;
1171 }
1172
1173 static int clone_external_layer(omap4_hwc_device_t *hwc_dev, int ix) {
1174     struct dsscomp_setup_dispc_data *dsscomp = &hwc_dev->dsscomp_data;
1175     omap4_hwc_ext_t *ext = &hwc_dev->ext;
1176
1177     /* mirror only 1 external layer */
1178     struct dss2_ovl_info *o = &dsscomp->ovls[ix];
1179
1180     /* full screen video after transformation */
1181     __u32 xres = o->cfg.crop.w, yres = o->cfg.crop.h;
1182     if ((ext->current.rotation + o->cfg.rotation) & 1)
1183         swap(xres, yres);
1184     float xpy = ext->lcd_xpy * o->cfg.win.w / o->cfg.win.h;
1185     if (o->cfg.rotation & 1)
1186         xpy = o->cfg.crop.h / xpy / o->cfg.crop.w;
1187     else
1188         xpy = o->cfg.crop.h * xpy / o->cfg.crop.w;
1189     if (ext->current.rotation & 1)
1190         xpy = 1. / xpy;
1191
1192     /* adjust hdmi mode based on resolution */
1193     if (xres != ext->last_xres_used ||
1194         yres != ext->last_yres_used ||
1195         xpy < ext->last_xpy * (1.f - ASPECT_RATIO_TOLERANCE) ||
1196         xpy * (1.f - ASPECT_RATIO_TOLERANCE) > ext->last_xpy) {
1197         ALOGD("set up HDMI for %d*%d\n", xres, yres);
1198         if (omap4_hwc_set_best_hdmi_mode(hwc_dev, xres, yres, xpy)) {
1199             ext->current.enabled = 0;
1200             return -ENODEV;
1201         }
1202     }
1203
1204     struct hwc_rect region = {
1205         .left = o->cfg.win.x, .top = o->cfg.win.y,
1206         .right = o->cfg.win.x + o->cfg.win.w,
1207         .bottom = o->cfg.win.y + o->cfg.win.h
1208     };
1209     set_ext_matrix(&hwc_dev->ext, region);
1210
1211     return clone_layer(hwc_dev, ix);
1212 }
1213
1214 static int setup_mirroring(omap4_hwc_device_t *hwc_dev)
1215 {
1216     omap4_hwc_ext_t *ext = &hwc_dev->ext;
1217
1218     __u32 xres = WIDTH(ext->mirror_region);
1219     __u32 yres = HEIGHT(ext->mirror_region);
1220     if (ext->current.rotation & 1)
1221        swap(xres, yres);
1222     if (omap4_hwc_set_best_hdmi_mode(hwc_dev, xres, yres, ext->lcd_xpy))
1223         return -ENODEV;
1224     set_ext_matrix(ext, ext->mirror_region);
1225     return 0;
1226 }
1227
1228 /*
1229  * We're using "implicit" synchronization, so make sure we aren't passing any
1230  * sync object descriptors around.
1231  */
1232 static void check_sync_fds(size_t numDisplays, hwc_display_contents_1_t** displays)
1233 {
1234     //ALOGD("checking sync FDs");
1235     unsigned int i, j;
1236     for (i = 0; i < numDisplays; i++) {
1237         hwc_display_contents_1_t* list = displays[i];
1238         if (list->retireFenceFd >= 0) {
1239             ALOGW("retireFenceFd[%u] was %d", i, list->retireFenceFd);
1240             list->retireFenceFd = -1;
1241         }
1242
1243         for (j = 0; j < list->numHwLayers; j++) {
1244             hwc_layer_1_t* layer = &list->hwLayers[j];
1245             if (layer->acquireFenceFd >= 0) {
1246                 ALOGW("acquireFenceFd[%u][%u] was %d, closing", i, j, layer->acquireFenceFd);
1247                 close(layer->acquireFenceFd);
1248                 layer->acquireFenceFd = -1;
1249             }
1250             if (layer->releaseFenceFd >= 0) {
1251                 ALOGW("releaseFenceFd[%u][%u] was %d", i, j, layer->releaseFenceFd);
1252                 layer->releaseFenceFd = -1;
1253             }
1254         }
1255     }
1256 }
1257
1258 static int omap4_hwc_prepare(struct hwc_composer_device_1 *dev, size_t numDisplays,
1259         hwc_display_contents_1_t** displays)
1260 {
1261     if (!numDisplays || displays == NULL) {
1262         return 0;
1263     }
1264
1265     hwc_display_contents_1_t* list = displays[0];  // ignore displays beyond the first
1266     omap4_hwc_device_t *hwc_dev = (omap4_hwc_device_t *)dev;
1267     struct dsscomp_setup_dispc_data *dsscomp = &hwc_dev->dsscomp_data;
1268     struct counts num = { .composited_layers = list ? list->numHwLayers : 0 };
1269     unsigned int i, ix;
1270
1271     pthread_mutex_lock(&hwc_dev->lock);
1272     memset(dsscomp, 0x0, sizeof(*dsscomp));
1273     dsscomp->sync_id = sync_id++;
1274
1275     gather_layer_statistics(hwc_dev, &num, list);
1276
1277     decide_supported_cloning(hwc_dev, &num);
1278
1279     /* Disable the forced SGX rendering if there is only one layer */
1280     if (hwc_dev->force_sgx && num.composited_layers <= 1)
1281         hwc_dev->force_sgx = 0;
1282
1283     /* phase 3 logic */
1284     if (can_dss_render_all(hwc_dev, &num)) {
1285         /* All layers can be handled by the DSS -- don't use SGX for composition */
1286         hwc_dev->use_sgx = 0;
1287         hwc_dev->swap_rb = num.BGR != 0;
1288     } else {
1289         /* Use SGX for composition plus first 3 layers that are DSS renderable */
1290         hwc_dev->use_sgx = 1;
1291         hwc_dev->swap_rb = is_BGR_format(hwc_dev->fb_dev->base.format);
1292     }
1293
1294     /* setup pipes */
1295     dsscomp->num_ovls = hwc_dev->use_sgx;
1296     int z = 0;
1297     int fb_z = -1;
1298     int scaled_gfx = 0;
1299     int ix_docking = -1;
1300
1301     /* set up if DSS layers */
1302     unsigned int mem_used = 0;
1303     hwc_dev->ovls_blending = 0;
1304     for (i = 0; list && i < list->numHwLayers; i++) {
1305         hwc_layer_1_t *layer = &list->hwLayers[i];
1306         IMG_native_handle_t *handle = (IMG_native_handle_t *)layer->handle;
1307
1308         if (dsscomp->num_ovls < num.max_hw_overlays &&
1309             can_dss_render_layer(hwc_dev, layer) &&
1310             (!hwc_dev->force_sgx ||
1311              /* render protected and dockable layers via DSS */
1312              is_protected(layer) ||
1313              (hwc_dev->ext.current.docking && hwc_dev->ext.current.enabled && dockable(layer))) &&
1314             mem_used + mem1d(handle) < MAX_TILER_SLOT &&
1315             /* can't have a transparent overlay in the middle of the framebuffer stack */
1316             !(is_BLENDED(layer) && fb_z >= 0)) {
1317
1318             /* render via DSS overlay */
1319             mem_used += mem1d(handle);
1320             layer->compositionType = HWC_OVERLAY;
1321
1322             /* clear FB above all opaque layers if rendering via SGX */
1323             if (hwc_dev->use_sgx && !is_BLENDED(layer))
1324                 layer->hints |= HWC_HINT_CLEAR_FB;
1325             /* see if any of the (non-backmost) overlays are doing blending */
1326             else if (is_BLENDED(layer) && i > 0)
1327                 hwc_dev->ovls_blending = 1;
1328
1329             hwc_dev->buffers[dsscomp->num_ovls] = layer->handle;
1330
1331             omap4_hwc_setup_layer(hwc_dev,
1332                                   &dsscomp->ovls[dsscomp->num_ovls],
1333                                   layer,
1334                                   z,
1335                                   handle->iFormat,
1336                                   handle->iWidth,
1337                                   handle->iHeight);
1338
1339             dsscomp->ovls[dsscomp->num_ovls].cfg.ix = dsscomp->num_ovls + hwc_dev->primary_transform;
1340             dsscomp->ovls[dsscomp->num_ovls].addressing = OMAP_DSS_BUFADDR_LAYER_IX;
1341             dsscomp->ovls[dsscomp->num_ovls].ba = dsscomp->num_ovls;
1342
1343             /* ensure GFX layer is never scaled */
1344             if ((dsscomp->num_ovls == 0) && (!hwc_dev->primary_transform)) {
1345                 scaled_gfx = scaled(layer) || is_NV12(handle);
1346             } else if (scaled_gfx && !scaled(layer) && !is_NV12(handle)) {
1347                 /* swap GFX layer with this one */
1348                 dsscomp->ovls[dsscomp->num_ovls].cfg.ix = 0;
1349                 dsscomp->ovls[0].cfg.ix = dsscomp->num_ovls;
1350                 scaled_gfx = 0;
1351             }
1352
1353             /* remember largest dockable layer */
1354             if (dockable(layer) &&
1355                 (ix_docking < 0 ||
1356                  display_area(&dsscomp->ovls[dsscomp->num_ovls]) > display_area(&dsscomp->ovls[ix_docking])))
1357                 ix_docking = dsscomp->num_ovls;
1358
1359             dsscomp->num_ovls++;
1360             z++;
1361         } else if (hwc_dev->use_sgx) {
1362             if (fb_z < 0) {
1363                 /* NOTE: we are not handling transparent cutout for now */
1364                 fb_z = z;
1365                 z++;
1366             } else {
1367                 /* move fb z-order up (by lowering dss layers) */
1368                 while (fb_z < z - 1)
1369                     dsscomp->ovls[1 + fb_z++].cfg.zorder--;
1370             }
1371         }
1372     }
1373
1374     /* if scaling GFX (e.g. only 1 scaled surface) use a VID pipe */
1375     if (scaled_gfx)
1376         dsscomp->ovls[0].cfg.ix = dsscomp->num_ovls;
1377
1378     if (hwc_dev->use_sgx) {
1379         /* assign a z-layer for fb */
1380         if (fb_z < 0) {
1381             if (num.composited_layers)
1382                 ALOGE("**** should have assigned z-layer for fb");
1383             fb_z = z++;
1384         }
1385
1386         hwc_dev->buffers[0] = NULL;
1387         omap4_hwc_setup_layer_base(&dsscomp->ovls[0].cfg, fb_z,
1388                                    hwc_dev->fb_dev->base.format,
1389                                    1,   /* FB is always premultiplied */
1390                                    hwc_dev->fb_dev->base.width,
1391                                    hwc_dev->fb_dev->base.height);
1392         dsscomp->ovls[0].cfg.pre_mult_alpha = 1;
1393         dsscomp->ovls[0].addressing = OMAP_DSS_BUFADDR_LAYER_IX;
1394         dsscomp->ovls[0].ba = 0;
1395         dsscomp->ovls[0].cfg.ix = hwc_dev->primary_transform;
1396     }
1397
1398     /* mirror layers */
1399     hwc_dev->post2_layers = dsscomp->num_ovls;
1400
1401     omap4_hwc_ext_t *ext = &hwc_dev->ext;
1402     if (ext->current.enabled && hwc_dev->ext_ovls) {
1403         if (ext->current.docking && ix_docking >= 0) {
1404             if (clone_external_layer(hwc_dev, ix_docking) == 0)
1405                 dsscomp->ovls[dsscomp->num_ovls - 1].cfg.zorder = z++;
1406         } else if (ext->current.docking && ix_docking < 0 && ext->force_dock) {
1407             ix_docking = dsscomp->num_ovls;
1408             struct dss2_ovl_info *oi = &dsscomp->ovls[ix_docking];
1409             omap4_hwc_setup_layer_base(&oi->cfg, 0, HAL_PIXEL_FORMAT_BGRA_8888, 1,
1410                                        dock_image.width, dock_image.height);
1411             oi->cfg.stride = dock_image.rowbytes;
1412             if (clone_external_layer(hwc_dev, ix_docking) == 0) {
1413                 oi->addressing = OMAP_DSS_BUFADDR_FB;
1414                 oi->ba = 0;
1415                 z++;
1416             }
1417         } else if (!ext->current.docking) {
1418             int res = 0;
1419
1420             /* reset mode if we are coming from docking */
1421             if (ext->last.docking)
1422                 res = setup_mirroring(hwc_dev);
1423
1424             /* mirror all layers */
1425             for (ix = 0; res == 0 && ix < hwc_dev->post2_layers; ix++) {
1426                 if (clone_layer(hwc_dev, ix))
1427                     break;
1428                 z++;
1429             }
1430         }
1431     }
1432
1433     /* Apply transform for primary display */
1434     if (hwc_dev->primary_transform)
1435         for (i = 0; i < dsscomp->num_ovls; i++) {
1436             if(dsscomp->ovls[i].cfg.mgr_ix == 0)
1437                 omap4_hwc_adjust_primary_display_layer(hwc_dev, &dsscomp->ovls[i]);
1438         }
1439
1440     ext->last = ext->current;
1441
1442     if (z != dsscomp->num_ovls || dsscomp->num_ovls > MAX_HW_OVERLAYS)
1443         ALOGE("**** used %d z-layers for %d overlays\n", z, dsscomp->num_ovls);
1444
1445     /* verify all z-orders and overlay indices are distinct */
1446     for (i = z = ix = 0; i < dsscomp->num_ovls; i++) {
1447         struct dss2_ovl_cfg *c = &dsscomp->ovls[i].cfg;
1448
1449         if (z & (1 << c->zorder))
1450             ALOGE("**** used z-order #%d multiple times", c->zorder);
1451         if (ix & (1 << c->ix))
1452             ALOGE("**** used ovl index #%d multiple times", c->ix);
1453         z |= 1 << c->zorder;
1454         ix |= 1 << c->ix;
1455     }
1456     dsscomp->mode = DSSCOMP_SETUP_DISPLAY;
1457     dsscomp->mgrs[0].ix = 0;
1458     dsscomp->mgrs[0].alpha_blending = 1;
1459     dsscomp->mgrs[0].swap_rb = hwc_dev->swap_rb;
1460     dsscomp->num_mgrs = 1;
1461
1462     if (ext->current.enabled || hwc_dev->last_ext_ovls) {
1463         dsscomp->mgrs[1] = dsscomp->mgrs[0];
1464         dsscomp->mgrs[1].ix = 1;
1465         dsscomp->num_mgrs++;
1466         hwc_dev->ext_ovls = dsscomp->num_ovls - hwc_dev->post2_layers;
1467     }
1468
1469     if (debug) {
1470         ALOGD("prepare (%d) - %s (comp=%d, poss=%d/%d scaled, RGB=%d,BGR=%d,NV12=%d) (ext=%s%s%ddeg%s %dex/%dmx (last %dex,%din)\n",
1471              dsscomp->sync_id,
1472              hwc_dev->use_sgx ? "SGX+OVL" : "all-OVL",
1473              num.composited_layers,
1474              num.possible_overlay_layers, num.scaled_layers,
1475              num.RGB, num.BGR, num.NV12,
1476              ext->on_tv ? "tv+" : "",
1477              ext->current.enabled ? ext->current.docking ? "dock+" : "mirror+" : "OFF+",
1478              ext->current.rotation * 90,
1479              ext->current.hflip ? "+hflip" : "",
1480              hwc_dev->ext_ovls, num.max_hw_overlays, hwc_dev->last_ext_ovls, hwc_dev->last_int_ovls);
1481     }
1482
1483     pthread_mutex_unlock(&hwc_dev->lock);
1484     return 0;
1485 }
1486
1487 static void omap4_hwc_reset_screen(omap4_hwc_device_t *hwc_dev)
1488 {
1489     static int first_set = 1;
1490     int ret;
1491
1492     if (first_set) {
1493         first_set = 0;
1494         struct dsscomp_setup_dispc_data d = {
1495             .num_mgrs = 1,
1496         };
1497         /* remove bootloader image from the screen as blank/unblank does not change the composition */
1498         ret = ioctl(hwc_dev->dsscomp_fd, DSSCIOC_SETUP_DISPC, &d);
1499         if (ret)
1500             ALOGW("failed to remove bootloader image");
1501
1502         /* blank and unblank fd to make sure display is properly programmed on boot.
1503          * This is needed because the bootloader can not be trusted.
1504          */
1505         ret = ioctl(hwc_dev->fb_fd, FBIOBLANK, FB_BLANK_POWERDOWN);
1506         if (ret)
1507             ALOGW("failed to blank display");
1508
1509         ret = ioctl(hwc_dev->fb_fd, FBIOBLANK, FB_BLANK_UNBLANK);
1510         if (ret)
1511             ALOGW("failed to blank display");
1512     }
1513 }
1514
1515 static int omap4_hwc_set(struct hwc_composer_device_1 *dev,
1516         size_t numDisplays, hwc_display_contents_1_t** displays)
1517 {
1518     if (!numDisplays || displays == NULL) {
1519         ALOGD("set: empty display list");
1520         return 0;
1521     }
1522     hwc_display_t dpy = NULL;
1523     hwc_surface_t sur = NULL;
1524     hwc_display_contents_1_t* list = displays[0];  // ignore displays beyond the first
1525     if (list != NULL) {
1526         dpy = list->dpy;
1527         sur = list->sur;
1528     }
1529     omap4_hwc_device_t *hwc_dev = (omap4_hwc_device_t *)dev;
1530     struct dsscomp_setup_dispc_data *dsscomp = &hwc_dev->dsscomp_data;
1531     int err = 0;
1532     int invalidate;
1533
1534     pthread_mutex_lock(&hwc_dev->lock);
1535
1536     omap4_hwc_reset_screen(hwc_dev);
1537
1538     invalidate = hwc_dev->ext_ovls_wanted && !hwc_dev->ext_ovls;
1539
1540     if (debug)
1541         dump_set_info(hwc_dev, list);
1542
1543     if (dpy && sur) {
1544         // list can be NULL which means hwc is temporarily disabled.
1545         // however, if dpy and sur are null it means we're turning the
1546         // screen off. no shall not call eglSwapBuffers() in that case.
1547
1548         if (hwc_dev->use_sgx) {
1549             if (!eglSwapBuffers((EGLDisplay)dpy, (EGLSurface)sur)) {
1550                 ALOGE("eglSwapBuffers error");
1551                 err = HWC_EGL_ERROR;
1552                 goto err_out;
1553             }
1554         }
1555
1556         //dump_dsscomp(dsscomp);
1557
1558         // signal the event thread that a post has happened
1559         write(hwc_dev->pipe_fds[1], "s", 1);
1560         if (hwc_dev->force_sgx > 0)
1561             hwc_dev->force_sgx--;
1562
1563         err = hwc_dev->fb_dev->Post2((framebuffer_device_t *)hwc_dev->fb_dev,
1564                                  hwc_dev->buffers,
1565                                  hwc_dev->post2_layers,
1566                                  dsscomp, sizeof(*dsscomp));
1567     }
1568     hwc_dev->last_ext_ovls = hwc_dev->ext_ovls;
1569     hwc_dev->last_int_ovls = hwc_dev->post2_layers;
1570     if (err)
1571         ALOGE("Post2 error");
1572
1573     check_sync_fds(numDisplays, displays);
1574
1575 err_out:
1576     pthread_mutex_unlock(&hwc_dev->lock);
1577
1578     if (invalidate)
1579         hwc_dev->procs->invalidate(hwc_dev->procs);
1580
1581     return err;
1582 }
1583
1584 static void omap4_hwc_dump(struct hwc_composer_device_1 *dev, char *buff, int buff_len)
1585 {
1586     omap4_hwc_device_t *hwc_dev = (omap4_hwc_device_t *)dev;
1587     struct dsscomp_setup_dispc_data *dsscomp = &hwc_dev->dsscomp_data;
1588     struct dump_buf log = {
1589         .buf = buff,
1590         .buf_len = buff_len,
1591     };
1592     int i;
1593
1594     dump_printf(&log, "omap4_hwc %d:\n", dsscomp->num_ovls);
1595     dump_printf(&log, "  idle timeout: %dms\n", hwc_dev->idle);
1596
1597     for (i = 0; i < dsscomp->num_ovls; i++) {
1598         struct dss2_ovl_cfg *cfg = &dsscomp->ovls[i].cfg;
1599
1600         dump_printf(&log, "  layer %d:\n", i);
1601         dump_printf(&log, "     enabled: %s\n",
1602                           cfg->enabled ? "true" : "false");
1603         dump_printf(&log, "     buff: %p %dx%d stride: %d\n",
1604                           hwc_dev->buffers[i], cfg->width, cfg->height, cfg->stride);
1605         dump_printf(&log, "     src: (%d,%d) %dx%d\n",
1606                           cfg->crop.x, cfg->crop.y, cfg->crop.w, cfg->crop.h);
1607         dump_printf(&log, "     dst: (%d,%d) %dx%d\n",
1608                           cfg->win.x, cfg->win.y, cfg->win.w, cfg->win.h);
1609         dump_printf(&log, "     ix: %d\n", cfg->ix);
1610         dump_printf(&log, "     zorder: %d\n\n", cfg->zorder);
1611     }
1612 }
1613
1614 static void free_png_image(omap4_hwc_device_t *hwc_dev, struct omap4_hwc_img *img)
1615 {
1616     memset(img, 0, sizeof(*img));
1617 }
1618
1619 static int load_png_image(omap4_hwc_device_t *hwc_dev, char *path, struct omap4_hwc_img *img)
1620 {
1621     void *ptr = NULL;
1622     png_bytepp row_pointers = NULL;
1623
1624     FILE *fd = fopen(path, "rb");
1625     if (!fd) {
1626         ALOGE("failed to open PNG file %s: (%d)", path, errno);
1627         return -EINVAL;
1628     }
1629
1630     const int SIZE_PNG_HEADER = 8;
1631     __u8 header[SIZE_PNG_HEADER];
1632     fread(header, 1, SIZE_PNG_HEADER, fd);
1633     if (png_sig_cmp(header, 0, SIZE_PNG_HEADER)) {
1634         ALOGE("%s is not a PNG file", path);
1635         goto fail;
1636     }
1637
1638     png_structp png_ptr = png_create_read_struct(PNG_LIBPNG_VER_STRING, NULL, NULL, NULL);
1639     if (!png_ptr)
1640          goto fail_alloc;
1641     png_infop info_ptr = png_create_info_struct(png_ptr);
1642     if (!info_ptr)
1643          goto fail_alloc;
1644
1645     if (setjmp(png_jmpbuf(png_ptr)))
1646         goto fail_alloc;
1647
1648     png_init_io(png_ptr, fd);
1649     png_set_sig_bytes(png_ptr, SIZE_PNG_HEADER);
1650     png_set_user_limits(png_ptr, limits.max_width, limits.max_height);
1651     png_read_info(png_ptr, info_ptr);
1652
1653     __u8 bit_depth = png_get_bit_depth(png_ptr, info_ptr);
1654     __u32 width = png_get_image_width(png_ptr, info_ptr);
1655     __u32 height = png_get_image_height(png_ptr, info_ptr);
1656     __u8 color_type = png_get_color_type(png_ptr, info_ptr);
1657
1658     switch (color_type) {
1659     case PNG_COLOR_TYPE_PALETTE:
1660         png_set_palette_to_rgb(png_ptr);
1661         png_set_filler(png_ptr, 128, PNG_FILLER_AFTER);
1662         break;
1663     case PNG_COLOR_TYPE_GRAY:
1664         if (bit_depth < 8) {
1665             png_set_expand_gray_1_2_4_to_8(png_ptr);
1666             if (png_get_valid(png_ptr, info_ptr, PNG_INFO_tRNS))
1667                 png_set_tRNS_to_alpha(png_ptr);
1668         } else {
1669             png_set_filler(png_ptr, 128, PNG_FILLER_AFTER);
1670         }
1671         /* fall through */
1672     case PNG_COLOR_TYPE_GRAY_ALPHA:
1673         png_set_gray_to_rgb(png_ptr);
1674         break;
1675     case PNG_COLOR_TYPE_RGB:
1676         png_set_filler(png_ptr, 128, PNG_FILLER_AFTER);
1677         /* fall through */
1678     case PNG_COLOR_TYPE_RGB_ALPHA:
1679         png_set_bgr(png_ptr);
1680         break;
1681     default:
1682         ALOGE("unsupported PNG color: %x", color_type);
1683         goto fail_alloc;
1684     }
1685
1686     if (bit_depth == 16)
1687         png_set_strip_16(png_ptr);
1688
1689     const int bpp = 4;
1690     img->size = ALIGN(width * height * bpp, 4096);
1691     if (img->size > hwc_dev->img_mem_size) {
1692         ALOGE("image does not fit into framebuffer area (%d > %d)", img->size, hwc_dev->img_mem_size);
1693         goto fail_alloc;
1694     }
1695     img->ptr = hwc_dev->img_mem_ptr;
1696
1697     row_pointers = calloc(height, sizeof(*row_pointers));
1698     if (!row_pointers) {
1699         ALOGE("failed to allocate row pointers");
1700         goto fail_alloc;
1701     }
1702     __u32 i;
1703     for (i = 0; i < height; i++)
1704         row_pointers[i] = img->ptr + i * width * bpp;
1705     png_set_rows(png_ptr, info_ptr, row_pointers);
1706     png_read_update_info(png_ptr, info_ptr);
1707     img->rowbytes = png_get_rowbytes(png_ptr, info_ptr);
1708
1709     png_read_image(png_ptr, row_pointers);
1710     png_read_end(png_ptr, NULL);
1711     free(row_pointers);
1712     png_destroy_read_struct(&png_ptr, &info_ptr, NULL);
1713     fclose(fd);
1714     img->width = width;
1715     img->height = height;
1716     return 0;
1717
1718 fail_alloc:
1719     free_png_image(hwc_dev, img);
1720     free(row_pointers);
1721     if (!png_ptr || !info_ptr)
1722         ALOGE("failed to allocate PNG structures");
1723     png_destroy_read_struct(&png_ptr, &info_ptr, NULL);
1724 fail:
1725     fclose(fd);
1726     return -EINVAL;
1727 }
1728
1729
1730 static int omap4_hwc_device_close(hw_device_t* device)
1731 {
1732     omap4_hwc_device_t *hwc_dev = (omap4_hwc_device_t *) device;;
1733
1734     if (hwc_dev) {
1735         if (hwc_dev->dsscomp_fd >= 0)
1736             close(hwc_dev->dsscomp_fd);
1737         if (hwc_dev->hdmi_fb_fd >= 0)
1738             close(hwc_dev->hdmi_fb_fd);
1739         if (hwc_dev->fb_fd >= 0)
1740             close(hwc_dev->fb_fd);
1741         /* pthread will get killed when parent process exits */
1742         pthread_mutex_destroy(&hwc_dev->lock);
1743         free(hwc_dev);
1744     }
1745
1746     return 0;
1747 }
1748
1749 static int omap4_hwc_open_fb_hal(IMG_framebuffer_device_public_t **fb_dev)
1750 {
1751     const struct hw_module_t *psModule;
1752     IMG_gralloc_module_public_t *psGrallocModule;
1753     int err;
1754
1755     err = hw_get_module(GRALLOC_HARDWARE_MODULE_ID, &psModule);
1756     psGrallocModule = (IMG_gralloc_module_public_t *) psModule;
1757
1758     if(err)
1759         goto err_out;
1760
1761     if (strcmp(psGrallocModule->base.common.author, "Imagination Technologies")) {
1762         err = -EINVAL;
1763         goto err_out;
1764     }
1765
1766     *fb_dev = psGrallocModule->psFrameBufferDevice;
1767
1768     return 0;
1769
1770 err_out:
1771     ALOGE("Composer HAL failed to load compatible Graphics HAL");
1772     return err;
1773 }
1774
1775 static void set_primary_display_transform_matrix(omap4_hwc_device_t *hwc_dev)
1776 {
1777     /* create primary display translation matrix */
1778     hwc_dev->fb_dis.ix = 0;/*Default display*/
1779
1780     int ret = ioctl(hwc_dev->dsscomp_fd, DSSCIOC_QUERY_DISPLAY, &hwc_dev->fb_dis);
1781     if (ret)
1782         ALOGE("failed to get display info (%d): %m", errno);
1783
1784     int lcd_w = hwc_dev->fb_dis.timings.x_res;
1785     int lcd_h = hwc_dev->fb_dis.timings.y_res;
1786     int orig_w = hwc_dev->fb_dev->base.width;
1787     int orig_h = hwc_dev->fb_dev->base.height;
1788     hwc_rect_t region = {.left = 0, .top = 0, .right = orig_w, .bottom = orig_h};
1789     hwc_dev->primary_region = region;
1790     hwc_dev->primary_rotation = ((lcd_w > lcd_h) ^ (orig_w > orig_h)) ? 1 : 0;
1791     hwc_dev->primary_transform = ((lcd_w != orig_w)||(lcd_h != orig_h)) ? 1 : 0;
1792
1793     ALOGI("transforming FB (%dx%d) => (%dx%d) rot%d", orig_w, orig_h, lcd_w, lcd_h, hwc_dev->primary_rotation);
1794
1795     /* reorientation matrix is:
1796        m = (center-from-target-center) * (scale-to-target) * (mirror) * (rotate) * (center-to-original-center) */
1797
1798     memcpy(hwc_dev->primary_m, m_unit, sizeof(m_unit));
1799     m_translate(hwc_dev->primary_m, -(orig_w >> 1), -(orig_h >> 1));
1800     m_rotate(hwc_dev->primary_m, hwc_dev->primary_rotation);
1801     if (hwc_dev->primary_rotation & 1)
1802          swap(orig_w, orig_h);
1803     m_scale(hwc_dev->primary_m, orig_w, lcd_w, orig_h, lcd_h);
1804     m_translate(hwc_dev->primary_m, lcd_w >> 1, lcd_h >> 1);
1805 }
1806
1807 static void handle_hotplug(omap4_hwc_device_t *hwc_dev)
1808 {
1809     omap4_hwc_ext_t *ext = &hwc_dev->ext;
1810     __u8 state = ext->hdmi_state;
1811
1812     pthread_mutex_lock(&hwc_dev->lock);
1813     ext->dock.enabled = ext->mirror.enabled = 0;
1814     if (state) {
1815         /* check whether we can clone and/or dock */
1816         char value[PROPERTY_VALUE_MAX];
1817         property_get("persist.hwc.docking.enabled", value, "1");
1818         ext->dock.enabled = atoi(value) > 0;
1819         property_get("persist.hwc.mirroring.enabled", value, "1");
1820         ext->mirror.enabled = atoi(value) > 0;
1821         property_get("persist.hwc.avoid_mode_change", value, "1");
1822         ext->avoid_mode_change = atoi(value) > 0;
1823
1824         /* get cloning transformation */
1825         property_get("persist.hwc.docking.transform", value, "0");
1826         ext->dock.rotation = atoi(value) & EXT_ROTATION;
1827         ext->dock.hflip = (atoi(value) & EXT_HFLIP) > 0;
1828         ext->dock.docking = 1;
1829         property_get("persist.hwc.mirroring.transform", value, hwc_dev->fb_dev->base.height > hwc_dev->fb_dev->base.width ? "3" : "0");
1830         ext->mirror.rotation = atoi(value) & EXT_ROTATION;
1831         ext->mirror.hflip = (atoi(value) & EXT_HFLIP) > 0;
1832         ext->mirror.docking = 0;
1833
1834         if (ext->force_dock) {
1835             /* restrict to docking with no transform */
1836             ext->mirror.enabled = 0;
1837             ext->dock.rotation = 0;
1838             ext->dock.hflip = 0;
1839
1840             if (!dock_image.rowbytes) {
1841                 property_get("persist.hwc.dock_image", value, "/vendor/res/images/dock/dock.png");
1842                 load_png_image(hwc_dev, value, &dock_image);
1843             }
1844         }
1845
1846         /* select best mode for mirroring */
1847         if (ext->mirror.enabled) {
1848             ext->current = ext->mirror;
1849             ext->mirror_mode = 0;
1850             if (setup_mirroring(hwc_dev) == 0) {
1851                 ext->mirror_mode = ext->last_mode;
1852                 set_primary_display_transform_matrix(hwc_dev);
1853                 ioctl(hwc_dev->hdmi_fb_fd, FBIOBLANK, FB_BLANK_UNBLANK);
1854             } else
1855                 ext->mirror.enabled = 0;
1856         }
1857     } else {
1858         ext->last_mode = 0;
1859     }
1860     ALOGI("external display changed (state=%d, mirror={%s tform=%ddeg%s}, dock={%s tform=%ddeg%s%s}, tv=%d", state,
1861          ext->mirror.enabled ? "enabled" : "disabled",
1862          ext->mirror.rotation * 90,
1863          ext->mirror.hflip ? "+hflip" : "",
1864          ext->dock.enabled ? "enabled" : "disabled",
1865          ext->dock.rotation * 90,
1866          ext->dock.hflip ? "+hflip" : "",
1867          ext->force_dock ? " forced" : "",
1868          ext->on_tv);
1869
1870     pthread_mutex_unlock(&hwc_dev->lock);
1871
1872     /* hwc_dev->procs is set right after the device is opened, but there is
1873      * still a race condition where a hotplug event might occur after the open
1874      * but before the procs are registered. */
1875     if (hwc_dev->procs)
1876         hwc_dev->procs->invalidate(hwc_dev->procs);
1877 }
1878
1879 static void handle_uevents(omap4_hwc_device_t *hwc_dev, const char *buff, int len)
1880 {
1881     int dock;
1882     int hdmi;
1883     int vsync;
1884     int state = 0;
1885     uint64_t timestamp = 0;
1886     const char *s = buff;
1887
1888     dock = !strcmp(s, "change@/devices/virtual/switch/dock");
1889     hdmi = !strcmp(s, "change@/devices/virtual/switch/hdmi");
1890     vsync = !strcmp(s, "change@/devices/platform/omapfb") ||
1891         !strcmp(s, "change@/devices/virtual/switch/omapfb-vsync");
1892
1893     if (!dock && !vsync && !hdmi)
1894        return;
1895
1896     s += strlen(s) + 1;
1897
1898     while(*s) {
1899         if (!strncmp(s, "SWITCH_STATE=", strlen("SWITCH_STATE=")))
1900             state = atoi(s + strlen("SWITCH_STATE="));
1901         else if (!strncmp(s, "SWITCH_TIME=", strlen("SWITCH_TIME=")))
1902             timestamp = strtoull(s + strlen("SWITCH_TIME="), NULL, 0);
1903         else if (!strncmp(s, "VSYNC=", strlen("VSYNC=")))
1904             timestamp = strtoull(s + strlen("VSYNC="), NULL, 0);
1905
1906         s += strlen(s) + 1;
1907         if (s - buff >= len)
1908             break;
1909     }
1910
1911     if (vsync) {
1912         if (hwc_dev->procs)
1913             hwc_dev->procs->vsync(hwc_dev->procs, 0, timestamp);
1914     } else {
1915         if (dock)
1916             hwc_dev->ext.force_dock = state == 1;
1917         else
1918             hwc_dev->ext.hdmi_state = state == 1;
1919         handle_hotplug(hwc_dev);
1920     }
1921 }
1922
1923 #ifdef SYSFS_VSYNC_NOTIFICATION
1924 static void *omap4_hwc_vsync_sysfs_loop(void *data)
1925 {
1926     omap4_hwc_device_t *hwc_dev = data;
1927     static char buf[4096];
1928     int vsync_timestamp_fd;
1929     fd_set exceptfds;
1930     int res;
1931     int64_t timestamp = 0;
1932
1933     vsync_timestamp_fd = open("/sys/devices/platform/omapfb/vsync_time", O_RDONLY);
1934     char thread_name[64] = "hwcVsyncThread";
1935     prctl(PR_SET_NAME, (unsigned long) &thread_name, 0, 0, 0);
1936     setpriority(PRIO_PROCESS, 0, HAL_PRIORITY_URGENT_DISPLAY);
1937     memset(buf, 0, sizeof(buf));
1938
1939     ALOGD("Using sysfs mechanism for VSYNC notification");
1940
1941     FD_ZERO(&exceptfds);
1942     FD_SET(vsync_timestamp_fd, &exceptfds);
1943     do {
1944         ssize_t len = read(vsync_timestamp_fd, buf, sizeof(buf));
1945         timestamp = strtoull(buf, NULL, 0);
1946         hwc_dev->procs->vsync(hwc_dev->procs, 0, timestamp);
1947         select(vsync_timestamp_fd + 1, NULL, NULL, &exceptfds, NULL);
1948         lseek(vsync_timestamp_fd, 0, SEEK_SET);
1949     } while (1);
1950
1951     return NULL;
1952 }
1953 #endif
1954
1955 static void *omap4_hwc_hdmi_thread(void *data)
1956 {
1957     omap4_hwc_device_t *hwc_dev = data;
1958     static char uevent_desc[4096];
1959     struct pollfd fds[2];
1960     int invalidate = 0;
1961     int timeout;
1962     int err;
1963
1964     setpriority(PRIO_PROCESS, 0, HAL_PRIORITY_URGENT_DISPLAY);
1965
1966     uevent_init();
1967
1968     fds[0].fd = uevent_get_fd();
1969     fds[0].events = POLLIN;
1970     fds[1].fd = hwc_dev->pipe_fds[0];
1971     fds[1].events = POLLIN;
1972
1973     timeout = hwc_dev->idle ? hwc_dev->idle : -1;
1974
1975     memset(uevent_desc, 0, sizeof(uevent_desc));
1976
1977     do {
1978         err = poll(fds, hwc_dev->idle ? 2 : 1, timeout);
1979
1980         if (err == 0) {
1981             if (hwc_dev->idle) {
1982                 if (hwc_dev->procs) {
1983                     pthread_mutex_lock(&hwc_dev->lock);
1984                     invalidate = !hwc_dev->force_sgx && hwc_dev->ovls_blending;
1985                     if (invalidate) {
1986                         hwc_dev->force_sgx = 2;
1987                     }
1988                     pthread_mutex_unlock(&hwc_dev->lock);
1989
1990                     if (invalidate) {
1991                         hwc_dev->procs->invalidate(hwc_dev->procs);
1992                         timeout = -1;
1993                     }
1994                 }
1995
1996                 continue;
1997             }
1998         }
1999
2000         if (err == -1) {
2001             if (errno != EINTR)
2002                 ALOGE("event error: %m");
2003             continue;
2004         }
2005
2006         if (hwc_dev->idle && fds[1].revents & POLLIN) {
2007             char c;
2008             read(hwc_dev->pipe_fds[0], &c, 1);
2009             if (!hwc_dev->force_sgx)
2010                 timeout = hwc_dev->idle ? hwc_dev->idle : -1;
2011         }
2012
2013         if (fds[0].revents & POLLIN) {
2014             /* keep last 2 zeroes to ensure double 0 termination */
2015             int len = uevent_next_event(uevent_desc, sizeof(uevent_desc) - 2);
2016             handle_uevents(hwc_dev, uevent_desc, len);
2017         }
2018     } while (1);
2019
2020     return NULL;
2021 }
2022
2023 static void omap4_hwc_registerProcs(struct hwc_composer_device_1* dev,
2024                                     hwc_procs_t const* procs)
2025 {
2026     omap4_hwc_device_t *hwc_dev = (omap4_hwc_device_t *) dev;
2027
2028     hwc_dev->procs = (typeof(hwc_dev->procs)) procs;
2029 }
2030
2031 static int omap4_hwc_query(struct hwc_composer_device_1* dev,
2032         int what, int* value)
2033 {
2034     omap4_hwc_device_t *hwc_dev = (omap4_hwc_device_t *) dev;
2035
2036     switch (what) {
2037     case HWC_BACKGROUND_LAYER_SUPPORTED:
2038         // we don't support the background layer yet
2039         value[0] = 0;
2040         break;
2041     case HWC_VSYNC_PERIOD:
2042         // vsync period in nanosecond
2043         value[0] = 1000000000.0 / hwc_dev->fb_dev->base.fps;
2044         break;
2045     default:
2046         // unsupported query
2047         return -EINVAL;
2048     }
2049     return 0;
2050 }
2051
2052 static int omap4_hwc_event_control(struct hwc_composer_device_1* dev,
2053         int dpy, int event, int enabled)
2054 {
2055     omap4_hwc_device_t *hwc_dev = (omap4_hwc_device_t *) dev;
2056
2057     switch (event) {
2058     case HWC_EVENT_VSYNC:
2059     {
2060         int val = !!enabled;
2061         int err;
2062
2063         err = ioctl(hwc_dev->fb_fd, OMAPFB_ENABLEVSYNC, &val);
2064         if (err < 0)
2065             return -errno;
2066
2067         return 0;
2068     }
2069     default:
2070         return -EINVAL;
2071     }
2072 }
2073
2074 static int omap4_hwc_blank(struct hwc_composer_device_1 *dev, int dpy, int blank)
2075 {
2076     // We're using an older method of screen blanking based on
2077     // early_suspend in the kernel.  No need to do anything here.
2078     return 0;
2079 }
2080
2081 static int omap4_hwc_device_open(const hw_module_t* module, const char* name,
2082                 hw_device_t** device)
2083 {
2084     omap4_hwc_module_t *hwc_mod = (omap4_hwc_module_t *)module;
2085     omap4_hwc_device_t *hwc_dev;
2086     int err = 0;
2087
2088     if (strcmp(name, HWC_HARDWARE_COMPOSER)) {
2089         return -EINVAL;
2090     }
2091
2092     if (!hwc_mod->fb_dev) {
2093         err = omap4_hwc_open_fb_hal(&hwc_mod->fb_dev);
2094         if (err)
2095             return err;
2096
2097         if (!hwc_mod->fb_dev) {
2098             ALOGE("Framebuffer HAL not opened before HWC");
2099             return -EFAULT;
2100         }
2101         hwc_mod->fb_dev->bBypassPost = 1;
2102     }
2103
2104     hwc_dev = (omap4_hwc_device_t *)malloc(sizeof(*hwc_dev));
2105     if (hwc_dev == NULL)
2106         return -ENOMEM;
2107
2108     memset(hwc_dev, 0, sizeof(*hwc_dev));
2109
2110     hwc_dev->base.common.tag = HARDWARE_DEVICE_TAG;
2111     hwc_dev->base.common.version = HWC_DEVICE_API_VERSION_1_0;
2112     hwc_dev->base.common.module = (hw_module_t *)module;
2113     hwc_dev->base.common.close = omap4_hwc_device_close;
2114     hwc_dev->base.prepare = omap4_hwc_prepare;
2115     hwc_dev->base.set = omap4_hwc_set;
2116     hwc_dev->base.eventControl = omap4_hwc_event_control;
2117     hwc_dev->base.blank = omap4_hwc_blank;
2118     hwc_dev->base.query = omap4_hwc_query;
2119     hwc_dev->base.registerProcs = omap4_hwc_registerProcs;
2120     hwc_dev->base.dump = omap4_hwc_dump;
2121     hwc_dev->fb_dev = hwc_mod->fb_dev;
2122     *device = &hwc_dev->base.common;
2123
2124     hwc_dev->dsscomp_fd = open("/dev/dsscomp", O_RDWR);
2125     if (hwc_dev->dsscomp_fd < 0) {
2126         ALOGE("failed to open dsscomp (%d)", errno);
2127         err = -errno;
2128         goto done;
2129     }
2130
2131     hwc_dev->hdmi_fb_fd = open("/dev/graphics/fb1", O_RDWR);
2132     if (hwc_dev->hdmi_fb_fd < 0) {
2133         ALOGE("failed to open hdmi fb (%d)", errno);
2134         err = -errno;
2135         goto done;
2136     }
2137
2138     hwc_dev->fb_fd = open("/dev/graphics/fb0", O_RDWR);
2139     if (hwc_dev->fb_fd < 0) {
2140         ALOGE("failed to open fb (%d)", errno);
2141         err = -errno;
2142         goto done;
2143     }
2144
2145     struct fb_fix_screeninfo fix;
2146     if (ioctl(hwc_dev->fb_fd, FBIOGET_FSCREENINFO, &fix)) {
2147         ALOGE("failed to get fb info (%d)", errno);
2148         err = -errno;
2149         goto done;
2150     }
2151
2152     hwc_dev->img_mem_size = fix.smem_len;
2153     hwc_dev->img_mem_ptr = mmap(NULL, fix.smem_len, PROT_WRITE, MAP_SHARED, hwc_dev->fb_fd, 0);
2154     if (hwc_dev->img_mem_ptr == MAP_FAILED) {
2155         ALOGE("failed to map fb memory");
2156         err = -errno;
2157         goto done;
2158     }
2159
2160     hwc_dev->buffers = malloc(sizeof(buffer_handle_t) * MAX_HW_OVERLAYS);
2161     if (!hwc_dev->buffers) {
2162         err = -ENOMEM;
2163         goto done;
2164     }
2165
2166     int ret = ioctl(hwc_dev->dsscomp_fd, DSSCIOC_QUERY_DISPLAY, &hwc_dev->fb_dis);
2167     if (ret) {
2168         ALOGE("failed to get display info (%d): %m", errno);
2169         err = -errno;
2170         goto done;
2171     }
2172     hwc_dev->ext.lcd_xpy = (float) hwc_dev->fb_dis.width_in_mm / hwc_dev->fb_dis.timings.x_res /
2173                             hwc_dev->fb_dis.height_in_mm       * hwc_dev->fb_dis.timings.y_res;
2174
2175     set_primary_display_transform_matrix(hwc_dev);
2176
2177     if (pipe(hwc_dev->pipe_fds) == -1) {
2178             ALOGE("failed to event pipe (%d): %m", errno);
2179             err = -errno;
2180             goto done;
2181     }
2182
2183     if (pthread_mutex_init(&hwc_dev->lock, NULL)) {
2184         ALOGE("failed to create mutex (%d): %m", errno);
2185         err = -errno;
2186         goto done;
2187     }
2188
2189     if (pthread_create(&hwc_dev->hdmi_thread, NULL, omap4_hwc_hdmi_thread, hwc_dev))
2190     {
2191         ALOGE("failed to create HDMI listening thread (%d): %m", errno);
2192         err = -errno;
2193         goto done;
2194     }
2195
2196     /* get debug properties */
2197
2198     /* see if hwc is enabled at all */
2199     char value[PROPERTY_VALUE_MAX];
2200     property_get("debug.hwc.rgb_order", value, "1");
2201     hwc_dev->flags_rgb_order = atoi(value);
2202     property_get("debug.hwc.nv12_only", value, "0");
2203     hwc_dev->flags_nv12_only = atoi(value);
2204     property_get("debug.hwc.idle", value, "250");
2205     hwc_dev->idle = atoi(value);
2206
2207     /* get the board specific clone properties */
2208     /* 0:0:1280:720 */
2209     if (property_get("persist.hwc.mirroring.region", value, "") <= 0 ||
2210         sscanf(value, "%d:%d:%d:%d",
2211                &hwc_dev->ext.mirror_region.left, &hwc_dev->ext.mirror_region.top,
2212                &hwc_dev->ext.mirror_region.right, &hwc_dev->ext.mirror_region.bottom) != 4 ||
2213         hwc_dev->ext.mirror_region.left >= hwc_dev->ext.mirror_region.right ||
2214         hwc_dev->ext.mirror_region.top >= hwc_dev->ext.mirror_region.bottom) {
2215         struct hwc_rect fb_region = { .right = hwc_dev->fb_dev->base.width, .bottom = hwc_dev->fb_dev->base.height };
2216         hwc_dev->ext.mirror_region = fb_region;
2217     }
2218     ALOGI("clone region is set to (%d,%d) to (%d,%d)",
2219          hwc_dev->ext.mirror_region.left, hwc_dev->ext.mirror_region.top,
2220          hwc_dev->ext.mirror_region.right, hwc_dev->ext.mirror_region.bottom);
2221
2222     /* read switch state */
2223     int sw_fd = open("/sys/class/switch/hdmi/state", O_RDONLY);
2224     if (sw_fd >= 0) {
2225         char value;
2226         if (read(sw_fd, &value, 1) == 1)
2227             hwc_dev->ext.hdmi_state = value == '1';
2228         close(sw_fd);
2229     }
2230     sw_fd = open("/sys/class/switch/dock/state", O_RDONLY);
2231     if (sw_fd >= 0) {
2232         char value;
2233         if (read(sw_fd, &value, 1) == 1)
2234             hwc_dev->ext.force_dock = value == '1';
2235         close(sw_fd);
2236     }
2237     handle_hotplug(hwc_dev);
2238
2239 #ifdef SYSFS_VSYNC_NOTIFICATION
2240     if (pthread_create(&hwc_dev->vsync_thread, NULL, omap4_hwc_vsync_sysfs_loop, hwc_dev))
2241     {
2242         ALOGE("pthread_create() failed (%d): %m", errno);
2243         err = -errno;
2244         goto done;
2245     }
2246 #endif
2247
2248     ALOGI("omap4_hwc_device_open(rgb_order=%d nv12_only=%d)",
2249         hwc_dev->flags_rgb_order, hwc_dev->flags_nv12_only);
2250
2251 done:
2252     if (err && hwc_dev) {
2253         if (hwc_dev->dsscomp_fd >= 0)
2254             close(hwc_dev->dsscomp_fd);
2255         if (hwc_dev->hdmi_fb_fd >= 0)
2256             close(hwc_dev->hdmi_fb_fd);
2257         if (hwc_dev->fb_fd >= 0)
2258             close(hwc_dev->fb_fd);
2259         pthread_mutex_destroy(&hwc_dev->lock);
2260         free(hwc_dev->buffers);
2261         free(hwc_dev);
2262     }
2263
2264     return err;
2265 }
2266
2267 static struct hw_module_methods_t omap4_hwc_module_methods = {
2268     .open = omap4_hwc_device_open,
2269 };
2270
2271 omap4_hwc_module_t HAL_MODULE_INFO_SYM = {
2272     .base = {
2273         .common = {
2274             .tag =                  HARDWARE_MODULE_TAG,
2275             .module_api_version =   HWC_MODULE_API_VERSION_0_1,
2276             .hal_api_version =      HARDWARE_HAL_API_VERSION,
2277             .id =                   HWC_HARDWARE_MODULE_ID,
2278             .name =                 "OMAP 44xx Hardware Composer HAL",
2279             .author =               "Texas Instruments",
2280             .methods =              &omap4_hwc_module_methods,
2281         },
2282     },
2283 };