1/*
2* Copyright (c) 2011-2012, The Linux Foundation. All rights reserved.
3*
4* Redistribution and use in source and binary forms, with or without
5* modification, are permitted provided that the following conditions are
6* met:
7*    * Redistributions of source code must retain the above copyright
8*      notice, this list of conditions and the following disclaimer.
9*    * Redistributions in binary form must reproduce the above
10*      copyright notice, this list of conditions and the following
11*      disclaimer in the documentation and/or other materials provided
12*      with the distribution.
13*    * Neither the name of The Linux Foundation nor the names of its
14*      contributors may be used to endorse or promote products derived
15*      from this software without specific prior written permission.
16*
17* THIS SOFTWARE IS PROVIDED "AS IS" AND ANY EXPRESS OR IMPLIED
18* WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
19* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT
20* ARE DISCLAIMED.  IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS
21* BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
22* CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
23* SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
24* BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
25* WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
26* OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN
27* IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
28*/
29
30#include <stdlib.h>
31#include <math.h>
32#include <utils/Log.h>
33#include <linux/msm_mdp.h>
34#include <cutils/properties.h>
35#include "gralloc_priv.h"
36#include "overlayUtils.h"
37#include "mdpWrapper.h"
38#include "mdp_version.h"
39
40// just a helper static thingy
41namespace {
42struct IOFile {
43    IOFile(const char* s, const char* mode) : fp(0) {
44        fp = ::fopen(s, mode);
45        if(!fp) {
46            ALOGE("Failed open %s", s);
47        }
48    }
49    template <class T>
50            size_t read(T& r, size_t elem) {
51                if(fp) {
52                    return ::fread(&r, sizeof(T), elem, fp);
53                }
54                return 0;
55            }
56    size_t write(const char* s, uint32_t val) {
57        if(fp) {
58            return ::fprintf(fp, s, val);
59        }
60        return 0;
61    }
62    bool valid() const { return fp != 0; }
63    ~IOFile() {
64        if(fp) ::fclose(fp);
65        fp=0;
66    }
67    FILE* fp;
68};
69}
70
71namespace overlay {
72
73//----------From class Res ------------------------------
74const char* const Res::fbPath = "/dev/graphics/fb%u";
75const char* const Res::rotPath = "/dev/msm_rotator";
76const char* const Res::format3DFile =
77        "/sys/class/graphics/fb1/format_3d";
78const char* const Res::edid3dInfoFile =
79        "/sys/class/graphics/fb1/3d_present";
80const char* const Res::barrierFile =
81        "/sys/devices/platform/mipi_novatek.0/enable_3d_barrier";
82//--------------------------------------------------------
83
84
85
86namespace utils {
87
88//--------------------------------------------------------
89//Refer to graphics.h, gralloc_priv.h, msm_mdp.h
90int getMdpFormat(int format) {
91    switch (format) {
92        //From graphics.h
93        case HAL_PIXEL_FORMAT_RGBA_8888 :
94            return MDP_RGBA_8888;
95        case HAL_PIXEL_FORMAT_RGBX_8888:
96            return MDP_RGBX_8888;
97        case HAL_PIXEL_FORMAT_RGB_888:
98            return MDP_RGB_888;
99        case HAL_PIXEL_FORMAT_RGB_565:
100            return MDP_RGB_565;
101        case HAL_PIXEL_FORMAT_BGRA_8888:
102            return MDP_BGRA_8888;
103        case HAL_PIXEL_FORMAT_YV12:
104            return MDP_Y_CR_CB_GH2V2;
105        case HAL_PIXEL_FORMAT_YCbCr_422_SP:
106            return MDP_Y_CBCR_H2V1;
107        case HAL_PIXEL_FORMAT_YCrCb_420_SP:
108            return MDP_Y_CRCB_H2V2;
109
110        //From gralloc_priv.h
111        case HAL_PIXEL_FORMAT_YCbCr_420_SP_TILED:
112            return MDP_Y_CBCR_H2V2_TILE;
113        case HAL_PIXEL_FORMAT_YCbCr_420_SP:
114            return MDP_Y_CBCR_H2V2;
115        case HAL_PIXEL_FORMAT_YCrCb_422_SP:
116            return MDP_Y_CRCB_H2V1;
117        case HAL_PIXEL_FORMAT_YCbCr_444_SP:
118            return MDP_Y_CBCR_H1V1;
119        case HAL_PIXEL_FORMAT_YCrCb_444_SP:
120            return MDP_Y_CRCB_H1V1;
121        case HAL_PIXEL_FORMAT_YCbCr_420_SP_VENUS:
122            return MDP_Y_CBCR_H2V2_VENUS;
123        default:
124            //Unsupported by MDP
125            //---graphics.h--------
126            //HAL_PIXEL_FORMAT_RGBA_5551
127            //HAL_PIXEL_FORMAT_RGBA_4444
128            //HAL_PIXEL_FORMAT_YCbCr_422_I
129            //---gralloc_priv.h-----
130            //HAL_PIXEL_FORMAT_YCrCb_420_SP_ADRENO    = 0x7FA30C01
131            //HAL_PIXEL_FORMAT_R_8                    = 0x10D
132            //HAL_PIXEL_FORMAT_RG_88                  = 0x10E
133            ALOGE("%s: Unsupported HAL format = 0x%x", __func__, format);
134            return -1;
135    }
136    // not reached
137    return -1;
138}
139
140//Takes mdp format as input and translates to equivalent HAL format
141//Refer to graphics.h, gralloc_priv.h, msm_mdp.h for formats.
142int getHALFormat(int mdpFormat) {
143    switch (mdpFormat) {
144        //From graphics.h
145        case MDP_RGBA_8888:
146            return HAL_PIXEL_FORMAT_RGBA_8888;
147        case MDP_RGBX_8888:
148            return HAL_PIXEL_FORMAT_RGBX_8888;
149        case MDP_RGB_888:
150            return HAL_PIXEL_FORMAT_RGB_888;
151        case MDP_RGB_565:
152            return HAL_PIXEL_FORMAT_RGB_565;
153        case MDP_BGRA_8888:
154            return HAL_PIXEL_FORMAT_BGRA_8888;
155        case MDP_Y_CR_CB_GH2V2:
156            return HAL_PIXEL_FORMAT_YV12;
157        case MDP_Y_CBCR_H2V1:
158            return HAL_PIXEL_FORMAT_YCbCr_422_SP;
159        case MDP_Y_CRCB_H2V2:
160            return HAL_PIXEL_FORMAT_YCrCb_420_SP;
161
162        //From gralloc_priv.h
163        case MDP_Y_CBCR_H2V2_TILE:
164            return HAL_PIXEL_FORMAT_YCbCr_420_SP_TILED;
165        case MDP_Y_CBCR_H2V2:
166            return HAL_PIXEL_FORMAT_YCbCr_420_SP;
167        case MDP_Y_CRCB_H2V1:
168            return HAL_PIXEL_FORMAT_YCrCb_422_SP;
169        case MDP_Y_CBCR_H1V1:
170            return HAL_PIXEL_FORMAT_YCbCr_444_SP;
171        case MDP_Y_CRCB_H1V1:
172            return HAL_PIXEL_FORMAT_YCrCb_444_SP;
173        case MDP_Y_CBCR_H2V2_VENUS:
174            return HAL_PIXEL_FORMAT_YCbCr_420_SP_VENUS;
175        default:
176            ALOGE("%s: Unsupported MDP format = 0x%x", __func__, mdpFormat);
177            return -1;
178    }
179    // not reached
180    return -1;
181}
182
183int getDownscaleFactor(const int& src_w, const int& src_h,
184        const int& dst_w, const int& dst_h) {
185    int dscale_factor = utils::ROT_DS_NONE;
186    // The tolerance is an empirical grey area that needs to be adjusted
187    // manually so that we always err on the side of caution
188    float fDscaleTolerance = 0.05;
189    // We need this check to engage the rotator whenever possible to assist MDP
190    // in performing video downscale.
191    // This saves bandwidth and avoids causing the driver to make too many panel
192    // -mode switches between BLT (writeback) and non-BLT (Direct) modes.
193    // Use-case: Video playback [with downscaling and rotation].
194    if (dst_w && dst_h)
195    {
196        float fDscale =  sqrtf((float)(src_w * src_h) / (float)(dst_w * dst_h)) +
197                         fDscaleTolerance;
198
199        // On our MTP 1080p playback case downscale after sqrt is coming to 1.87
200        // we were rounding to 1. So entirely MDP has to do the downscaling.
201        // BW requirement and clock requirement is high across MDP4 targets.
202        // It is unable to downscale 1080p video to panel resolution on 8960.
203        // round(x) will round it to nearest integer and avoids above issue.
204        uint32_t dscale = round(fDscale);
205
206        if(dscale < 2) {
207            // Down-scale to > 50% of orig.
208            dscale_factor = utils::ROT_DS_NONE;
209        } else if(dscale < 4) {
210            // Down-scale to between > 25% to <= 50% of orig.
211            dscale_factor = utils::ROT_DS_HALF;
212        } else if(dscale < 8) {
213            // Down-scale to between > 12.5% to <= 25% of orig.
214            dscale_factor = utils::ROT_DS_FOURTH;
215        } else {
216            // Down-scale to <= 12.5% of orig.
217            dscale_factor = utils::ROT_DS_EIGHTH;
218        }
219    }
220    return dscale_factor;
221}
222
223static inline int compute(const uint32_t& x, const uint32_t& y,
224        const uint32_t& z) {
225    return x - ( y + z );
226}
227
228//Expects transform to be adjusted for clients of Android.
229//i.e flips switched if 90 component present.
230//See getMdpOrient()
231void preRotateSource(const eTransform& tr, Whf& whf, Dim& srcCrop) {
232    if(tr & OVERLAY_TRANSFORM_FLIP_H) {
233        srcCrop.x = compute(whf.w, srcCrop.x, srcCrop.w);
234    }
235    if(tr & OVERLAY_TRANSFORM_FLIP_V) {
236        srcCrop.y = compute(whf.h, srcCrop.y, srcCrop.h);
237    }
238    if(tr & OVERLAY_TRANSFORM_ROT_90) {
239        int tmp = srcCrop.x;
240        srcCrop.x = compute(whf.h,
241                srcCrop.y,
242                srcCrop.h);
243        srcCrop.y = tmp;
244        swap(whf.w, whf.h);
245        swap(srcCrop.w, srcCrop.h);
246    }
247}
248
249bool is3DTV() {
250    char is3DTV = '0';
251    IOFile fp(Res::edid3dInfoFile, "r");
252    (void)fp.read(is3DTV, 1);
253    ALOGI("3DTV EDID flag: %d", is3DTV);
254    return (is3DTV == '0') ? false : true;
255}
256
257bool isPanel3D() {
258    OvFD fd;
259    if(!overlay::open(fd, 0 /*fb*/, Res::fbPath)){
260        ALOGE("isPanel3D Can't open framebuffer 0");
261        return false;
262    }
263    fb_fix_screeninfo finfo;
264    if(!mdp_wrapper::getFScreenInfo(fd.getFD(), finfo)) {
265        ALOGE("isPanel3D read fb0 failed");
266    }
267    fd.close();
268    return (FB_TYPE_3D_PANEL == finfo.type) ? true : false;
269}
270
271bool usePanel3D() {
272    if(!isPanel3D())
273        return false;
274    char value[PROPERTY_VALUE_MAX];
275    property_get("persist.user.panel3D", value, "0");
276    int usePanel3D = atoi(value);
277    return usePanel3D ? true : false;
278}
279
280bool send3DInfoPacket (uint32_t format3D) {
281    IOFile fp(Res::format3DFile, "wb");
282    (void)fp.write("%d", format3D);
283    if(!fp.valid()) {
284        ALOGE("send3DInfoPacket: no sysfs entry for setting 3d mode");
285        return false;
286    }
287    return true;
288}
289
290bool enableBarrier (uint32_t orientation) {
291    IOFile fp(Res::barrierFile, "wb");
292    (void)fp.write("%d", orientation);
293    if(!fp.valid()) {
294        ALOGE("enableBarrier no sysfs entry for "
295                "enabling barriers on 3D panel");
296        return false;
297    }
298    return true;
299}
300
301uint32_t getS3DFormat(uint32_t fmt) {
302    // The S3D is part of the HAL_PIXEL_FORMAT_YV12 value. Add
303    // an explicit check for the format
304    if (fmt == HAL_PIXEL_FORMAT_YV12) {
305        return 0;
306    }
307    uint32_t fmt3D = format3D(fmt);
308    uint32_t fIn3D = format3DInput(fmt3D); // MSB 2 bytes - inp
309    uint32_t fOut3D = format3DOutput(fmt3D); // LSB 2 bytes - out
310    fmt3D = fIn3D | fOut3D;
311    if (!fIn3D) {
312        fmt3D |= fOut3D << SHIFT_TOT_3D; //Set the input format
313    }
314    if (!fOut3D) {
315        switch (fIn3D) {
316            case HAL_3D_IN_SIDE_BY_SIDE_L_R:
317            case HAL_3D_IN_SIDE_BY_SIDE_R_L:
318                // For all side by side formats, set the output
319                // format as Side-by-Side i.e 0x1
320                fmt3D |= HAL_3D_IN_SIDE_BY_SIDE_L_R >> SHIFT_TOT_3D;
321                break;
322            default:
323                fmt3D |= fIn3D >> SHIFT_TOT_3D; //Set the output format
324        }
325    }
326    return fmt3D;
327}
328
329void getDump(char *buf, size_t len, const char *prefix,
330        const mdp_overlay& ov) {
331    char str[256] = {'\0'};
332    snprintf(str, 256,
333            "%s id=%d z=%d fg=%d alpha=%d mask=%d flags=0x%x\n",
334            prefix, ov.id, ov.z_order, ov.is_fg, ov.alpha,
335            ov.transp_mask, ov.flags);
336    strncat(buf, str, strlen(str));
337    getDump(buf, len, "\tsrc(msmfb_img)", ov.src);
338    getDump(buf, len, "\tsrc_rect(mdp_rect)", ov.src_rect);
339    getDump(buf, len, "\tdst_rect(mdp_rect)", ov.dst_rect);
340}
341
342void getDump(char *buf, size_t len, const char *prefix,
343        const msmfb_img& ov) {
344    char str_src[256] = {'\0'};
345    snprintf(str_src, 256,
346            "%s w=%d h=%d format=%d %s\n",
347            prefix, ov.width, ov.height, ov.format,
348            overlay::utils::getFormatString(ov.format));
349    strncat(buf, str_src, strlen(str_src));
350}
351
352void getDump(char *buf, size_t len, const char *prefix,
353        const mdp_rect& ov) {
354    char str_rect[256] = {'\0'};
355    snprintf(str_rect, 256,
356            "%s x=%d y=%d w=%d h=%d\n",
357            prefix, ov.x, ov.y, ov.w, ov.h);
358    strncat(buf, str_rect, strlen(str_rect));
359}
360
361void getDump(char *buf, size_t len, const char *prefix,
362        const msmfb_overlay_data& ov) {
363    char str[256] = {'\0'};
364    snprintf(str, 256,
365            "%s id=%d\n",
366            prefix, ov.id);
367    strncat(buf, str, strlen(str));
368    getDump(buf, len, "\tdata(msmfb_data)", ov.data);
369}
370
371void getDump(char *buf, size_t len, const char *prefix,
372        const msmfb_data& ov) {
373    char str_data[256] = {'\0'};
374    snprintf(str_data, 256,
375            "%s offset=%d memid=%d id=%d flags=0x%x priv=%d\n",
376            prefix, ov.offset, ov.memory_id, ov.id, ov.flags,
377            ov.priv);
378    strncat(buf, str_data, strlen(str_data));
379}
380
381void getDump(char *buf, size_t len, const char *prefix,
382        const msm_rotator_img_info& rot) {
383    char str[256] = {'\0'};
384    snprintf(str, 256, "%s sessid=%u rot=%d, enable=%d downscale=%d\n",
385            prefix, rot.session_id, rot.rotations, rot.enable,
386            rot.downscale_ratio);
387    strncat(buf, str, strlen(str));
388    getDump(buf, len, "\tsrc", rot.src);
389    getDump(buf, len, "\tdst", rot.dst);
390    getDump(buf, len, "\tsrc_rect", rot.src_rect);
391}
392
393void getDump(char *buf, size_t len, const char *prefix,
394        const msm_rotator_data_info& rot) {
395    char str[256] = {'\0'};
396    snprintf(str, 256,
397            "%s sessid=%u verkey=%d\n",
398            prefix, rot.session_id, rot.version_key);
399    strncat(buf, str, strlen(str));
400    getDump(buf, len, "\tsrc", rot.src);
401    getDump(buf, len, "\tdst", rot.dst);
402    getDump(buf, len, "\tsrc_chroma", rot.src_chroma);
403    getDump(buf, len, "\tdst_chroma", rot.dst_chroma);
404}
405
406} // utils
407
408} // overlay
409