1/*
2 * Copyright (C) 2008 The Android Open Source Project
3 * Copyright (c) 2010 - 2014, The Linux Foundation. All rights reserved.
4 *
5 * Not a Contribution, Apache license notifications and license are retained
6 * for attribution purposes only.
7 *
8 * Licensed under the Apache License, Version 2.0 (the "License");
9 * you may not use this file except in compliance with the License.
10 * You may obtain a copy of the License at
11 *
12 *      http://www.apache.org/licenses/LICENSE-2.0
13 *
14 * Unless required by applicable law or agreed to in writing, software
15 * distributed under the License is distributed on an "AS IS" BASIS,
16 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
17 * See the License for the specific language governing permissions and
18 * limitations under the License.
19 */
20
21#include <cutils/log.h>
22
23#include <linux/msm_mdp.h>
24#include <linux/fb.h>
25
26#include <stdint.h>
27#include <string.h>
28#include <unistd.h>
29#include <errno.h>
30#include <fcntl.h>
31
32#include <sys/ioctl.h>
33#include <sys/types.h>
34#include <sys/mman.h>
35
36#include <copybit.h>
37
38#include "gralloc_priv.h"
39#include "software_converter.h"
40
41#define DEBUG_MDP_ERRORS 1
42
43/******************************************************************************/
44
45#define MAX_SCALE_FACTOR    (4)
46#define MAX_DIMENSION       (4096)
47
48/******************************************************************************/
49struct blitReq{
50    struct  mdp_buf_sync sync;
51    uint32_t count;
52    struct mdp_blit_req req[10];
53};
54
55/** State information for each device instance */
56struct copybit_context_t {
57    struct copybit_device_t device;
58    int     mFD;
59    uint8_t mAlpha;
60    int     mFlags;
61    bool    mBlitToFB;
62    int     acqFence[MDP_MAX_FENCE_FD];
63    int     relFence;
64    struct  mdp_buf_sync sync;
65    struct  blitReq list;
66};
67
68/**
69 * Common hardware methods
70 */
71
72static int open_copybit(const struct hw_module_t* module, const char* name,
73                        struct hw_device_t** device);
74
75static struct hw_module_methods_t copybit_module_methods = {
76open:  open_copybit
77};
78
79/*
80 * The COPYBIT Module
81 */
82struct copybit_module_t HAL_MODULE_INFO_SYM = {
83common: {
84tag: HARDWARE_MODULE_TAG,
85     version_major: 1,
86     version_minor: 0,
87     id: COPYBIT_HARDWARE_MODULE_ID,
88     name: "QCT MSM7K COPYBIT Module",
89     author: "Google, Inc.",
90     methods: &copybit_module_methods
91        }
92};
93
94/******************************************************************************/
95
96/** min of int a, b */
97static inline int min(int a, int b) {
98    return (a<b) ? a : b;
99}
100
101/** max of int a, b */
102static inline int max(int a, int b) {
103    return (a>b) ? a : b;
104}
105
106/** scale each parameter by mul/div. Assume div isn't 0 */
107static inline void MULDIV(uint32_t *a, uint32_t *b, int mul, int div) {
108    if (mul != div) {
109        *a = (mul * *a) / div;
110        *b = (mul * *b) / div;
111    }
112}
113
114/** Determine the intersection of lhs & rhs store in out */
115static void intersect(struct copybit_rect_t *out,
116                      const struct copybit_rect_t *lhs,
117                      const struct copybit_rect_t *rhs) {
118    out->l = max(lhs->l, rhs->l);
119    out->t = max(lhs->t, rhs->t);
120    out->r = min(lhs->r, rhs->r);
121    out->b = min(lhs->b, rhs->b);
122}
123
124/** convert COPYBIT_FORMAT to MDP format */
125static int get_format(int format) {
126    switch (format) {
127        case HAL_PIXEL_FORMAT_RGB_565:       return MDP_RGB_565;
128        case HAL_PIXEL_FORMAT_RGBX_8888:     return MDP_RGBX_8888;
129        case HAL_PIXEL_FORMAT_BGRX_8888:     return MDP_BGRX_8888;
130        case HAL_PIXEL_FORMAT_RGB_888:       return MDP_RGB_888;
131        case HAL_PIXEL_FORMAT_RGBA_8888:     return MDP_RGBA_8888;
132        case HAL_PIXEL_FORMAT_BGRA_8888:     return MDP_BGRA_8888;
133        case HAL_PIXEL_FORMAT_YCrCb_422_I:   return MDP_YCRYCB_H2V1;
134        case HAL_PIXEL_FORMAT_YCbCr_422_I:   return MDP_YCBYCR_H2V1;
135        case HAL_PIXEL_FORMAT_YCrCb_422_SP:  return MDP_Y_CRCB_H2V1;
136        case HAL_PIXEL_FORMAT_YCrCb_420_SP:  return MDP_Y_CRCB_H2V2;
137        case HAL_PIXEL_FORMAT_YCbCr_422_SP:  return MDP_Y_CBCR_H2V1;
138        case HAL_PIXEL_FORMAT_YCbCr_420_SP:  return MDP_Y_CBCR_H2V2;
139        case HAL_PIXEL_FORMAT_YCrCb_420_SP_ADRENO: return MDP_Y_CBCR_H2V2_ADRENO;
140        case HAL_PIXEL_FORMAT_YCbCr_420_SP_VENUS: return MDP_Y_CBCR_H2V2_VENUS;
141        case HAL_PIXEL_FORMAT_NV12_ENCODEABLE: return MDP_Y_CBCR_H2V2;
142    }
143    return -1;
144}
145
146/** convert from copybit image to mdp image structure */
147static void set_image(struct mdp_img *img, const struct copybit_image_t *rhs)
148{
149    private_handle_t* hnd = (private_handle_t*)rhs->handle;
150    if(hnd == NULL){
151        ALOGE("copybit: Invalid handle");
152        return;
153    }
154    img->width      = rhs->w;
155    img->height     = rhs->h;
156    img->format     = get_format(rhs->format);
157    img->offset     = (uint32_t)hnd->offset;
158    img->memory_id  = hnd->fd;
159}
160/** setup rectangles */
161static void set_rects(struct copybit_context_t *dev,
162                      struct mdp_blit_req *e,
163                      const struct copybit_rect_t *dst,
164                      const struct copybit_rect_t *src,
165                      const struct copybit_rect_t *scissor) {
166    struct copybit_rect_t clip;
167    intersect(&clip, scissor, dst);
168
169    e->dst_rect.x  = clip.l;
170    e->dst_rect.y  = clip.t;
171    e->dst_rect.w  = clip.r - clip.l;
172    e->dst_rect.h  = clip.b - clip.t;
173
174    uint32_t W, H, delta_x, delta_y;
175    if (dev->mFlags & COPYBIT_TRANSFORM_ROT_90) {
176        delta_x = (clip.t - dst->t);
177        delta_y = (dst->r - clip.r);
178        e->src_rect.w = (clip.b - clip.t);
179        e->src_rect.h = (clip.r - clip.l);
180        W = dst->b - dst->t;
181        H = dst->r - dst->l;
182    } else {
183        delta_x  = (clip.l - dst->l);
184        delta_y  = (clip.t - dst->t);
185        e->src_rect.w  = (clip.r - clip.l);
186        e->src_rect.h  = (clip.b - clip.t);
187        W = dst->r - dst->l;
188        H = dst->b - dst->t;
189    }
190
191    MULDIV(&delta_x, &e->src_rect.w, src->r - src->l, W);
192    MULDIV(&delta_y, &e->src_rect.h, src->b - src->t, H);
193
194    e->src_rect.x = delta_x + src->l;
195    e->src_rect.y = delta_y + src->t;
196
197    if (dev->mFlags & COPYBIT_TRANSFORM_FLIP_V) {
198        if (dev->mFlags & COPYBIT_TRANSFORM_ROT_90) {
199            e->src_rect.x = (src->l + src->r) - (e->src_rect.x + e->src_rect.w);
200        }else{
201            e->src_rect.y = (src->t + src->b) - (e->src_rect.y + e->src_rect.h);
202        }
203    }
204
205    if (dev->mFlags & COPYBIT_TRANSFORM_FLIP_H) {
206        if (dev->mFlags & COPYBIT_TRANSFORM_ROT_90) {
207            e->src_rect.y = (src->t + src->b) - (e->src_rect.y + e->src_rect.h);
208        }else{
209            e->src_rect.x = (src->l + src->r) - (e->src_rect.x + e->src_rect.w);
210        }
211    }
212}
213
214/** setup mdp request */
215static void set_infos(struct copybit_context_t *dev,
216                      struct mdp_blit_req *req, int flags)
217{
218    req->alpha = dev->mAlpha;
219    req->transp_mask = MDP_TRANSP_NOP;
220    req->flags = dev->mFlags | flags;
221    // check if we are blitting to f/b
222    if (COPYBIT_ENABLE == dev->mBlitToFB) {
223        req->flags |= MDP_MEMORY_ID_TYPE_FB;
224    }
225#if defined(COPYBIT_QSD8K)
226    req->flags |= MDP_BLEND_FG_PREMULT;
227#endif
228}
229
230/** copy the bits */
231static int msm_copybit(struct copybit_context_t *dev, void const *list)
232{
233    int err;
234    if (dev->relFence != -1) {
235        close(dev->relFence);
236        dev->relFence = -1;
237    }
238    err = ioctl(dev->mFD, MSMFB_ASYNC_BLIT,
239                    (struct mdp_async_blit_req_list const*)list);
240    ALOGE_IF(err<0, "copyBits failed (%s)", strerror(errno));
241    if (err == 0) {
242        return 0;
243    } else {
244#if DEBUG_MDP_ERRORS
245        struct mdp_async_blit_req_list const* l =
246            (struct mdp_async_blit_req_list const*)list;
247        for (unsigned int i=0 ; i<l->count ; i++) {
248            ALOGE("%d: src={w=%d, h=%d, f=%d, rect={%d,%d,%d,%d}}\n"
249                  "    dst={w=%d, h=%d, f=%d, rect={%d,%d,%d,%d}}\n"
250                  "    flags=%08x"
251                  ,
252                  i,
253                  l->req[i].src.width,
254                  l->req[i].src.height,
255                  l->req[i].src.format,
256                  l->req[i].src_rect.x,
257                  l->req[i].src_rect.y,
258                  l->req[i].src_rect.w,
259                  l->req[i].src_rect.h,
260                  l->req[i].dst.width,
261                  l->req[i].dst.height,
262                  l->req[i].dst.format,
263                  l->req[i].dst_rect.x,
264                  l->req[i].dst_rect.y,
265                  l->req[i].dst_rect.w,
266                  l->req[i].dst_rect.h,
267                  l->req[i].flags
268                 );
269        }
270#endif
271        return -errno;
272    }
273}
274
275/*****************************************************************************/
276
277/** Set a parameter to value */
278static int set_parameter_copybit(
279    struct copybit_device_t *dev,
280    int name,
281    int value)
282{
283    struct copybit_context_t* ctx = (struct copybit_context_t*)dev;
284    int status = 0;
285    if (ctx) {
286        switch(name) {
287            case COPYBIT_ROTATION_DEG:
288                switch (value) {
289                    case 0:
290                        ctx->mFlags &= ~0x7;
291                        break;
292                    case 90:
293                        ctx->mFlags &= ~0x7;
294                        ctx->mFlags |= MDP_ROT_90;
295                        break;
296                    case 180:
297                        ctx->mFlags &= ~0x7;
298                        ctx->mFlags |= MDP_ROT_180;
299                        break;
300                    case 270:
301                        ctx->mFlags &= ~0x7;
302                        ctx->mFlags |= MDP_ROT_270;
303                        break;
304                    default:
305                        ALOGE("Invalid value for COPYBIT_ROTATION_DEG");
306                        status = -EINVAL;
307                        break;
308                }
309                break;
310            case COPYBIT_PLANE_ALPHA:
311                if (value < 0)      value = MDP_ALPHA_NOP;
312                if (value >= 256)   value = 255;
313                ctx->mAlpha = (uint8_t)value;
314                break;
315            case COPYBIT_DITHER:
316                if (value == COPYBIT_ENABLE) {
317                    ctx->mFlags |= MDP_DITHER;
318                } else if (value == COPYBIT_DISABLE) {
319                    ctx->mFlags &= ~MDP_DITHER;
320                }
321                break;
322            case COPYBIT_BLUR:
323                if (value == COPYBIT_ENABLE) {
324                    ctx->mFlags |= MDP_BLUR;
325                } else if (value == COPYBIT_DISABLE) {
326                    ctx->mFlags &= ~MDP_BLUR;
327                }
328                break;
329            case COPYBIT_BLEND_MODE:
330                if(value == COPYBIT_BLENDING_PREMULT) {
331                    ctx->mFlags |= MDP_BLEND_FG_PREMULT;
332                } else {
333                    ctx->mFlags &= ~MDP_BLEND_FG_PREMULT;
334                }
335                break;
336            case COPYBIT_TRANSFORM:
337                ctx->mFlags &= ~0x7;
338                ctx->mFlags |= value & 0x7;
339                break;
340            case COPYBIT_BLIT_TO_FRAMEBUFFER:
341                if (COPYBIT_ENABLE == value) {
342                    ctx->mBlitToFB = value;
343                } else if (COPYBIT_DISABLE == value) {
344                    ctx->mBlitToFB = value;
345                } else {
346                    ALOGE ("%s:Invalid input for COPYBIT_BLIT_TO_FRAMEBUFFER : %d",
347                            __FUNCTION__, value);
348                }
349                break;
350            case COPYBIT_FG_LAYER:
351                if(value == COPYBIT_ENABLE) {
352                     ctx->mFlags |= MDP_IS_FG;
353                } else if (value == COPYBIT_DISABLE) {
354                    ctx->mFlags &= ~MDP_IS_FG;
355                }
356                break ;
357            default:
358                status = -EINVAL;
359                break;
360        }
361    } else {
362        status = -EINVAL;
363    }
364    return status;
365}
366
367/** Get a static info value */
368static int get(struct copybit_device_t *dev, int name)
369{
370    struct copybit_context_t* ctx = (struct copybit_context_t*)dev;
371    int value;
372    if (ctx) {
373        switch(name) {
374            case COPYBIT_MINIFICATION_LIMIT:
375                value = MAX_SCALE_FACTOR;
376                break;
377            case COPYBIT_MAGNIFICATION_LIMIT:
378                value = MAX_SCALE_FACTOR;
379                break;
380            case COPYBIT_SCALING_FRAC_BITS:
381                value = 32;
382                break;
383            case COPYBIT_ROTATION_STEP_DEG:
384                value = 90;
385                break;
386            default:
387                value = -EINVAL;
388        }
389    } else {
390        value = -EINVAL;
391    }
392    return value;
393}
394
395static int set_sync_copybit(struct copybit_device_t *dev,
396    int acquireFenceFd)
397{
398    struct copybit_context_t* ctx = (struct copybit_context_t*)dev;
399    if (acquireFenceFd != -1) {
400        if (ctx->list.sync.acq_fen_fd_cnt < (MDP_MAX_FENCE_FD - 1)) {
401            ctx->acqFence[ctx->list.sync.acq_fen_fd_cnt++] = acquireFenceFd;
402        } else {
403            int ret = -EINVAL;
404            struct blitReq *list = &ctx->list;
405
406            // Since fence is full kick off what is already in the list
407            ret = msm_copybit(ctx, list);
408            if (ret < 0) {
409                ALOGE("%s: Blit call failed", __FUNCTION__);
410                return -EINVAL;
411            }
412            list->count = 0;
413            list->sync.acq_fen_fd_cnt = 0;
414            ctx->acqFence[list->sync.acq_fen_fd_cnt++] = acquireFenceFd;
415        }
416    }
417    return 0;
418}
419
420/** do a stretch blit type operation */
421static int stretch_copybit(
422    struct copybit_device_t *dev,
423    struct copybit_image_t const *dst,
424    struct copybit_image_t const *src,
425    struct copybit_rect_t const *dst_rect,
426    struct copybit_rect_t const *src_rect,
427    struct copybit_region_t const *region)
428{
429    struct copybit_context_t* ctx = (struct copybit_context_t*)dev;
430    struct blitReq *list;
431    int status = 0;
432    private_handle_t *yv12_handle = NULL;
433
434    if (ctx) {
435        list = &ctx->list;
436
437        if (ctx->mAlpha < 255) {
438            switch (src->format) {
439                // we don't support plane alpha with RGBA formats
440                case HAL_PIXEL_FORMAT_RGBA_8888:
441                case HAL_PIXEL_FORMAT_BGRA_8888:
442                    ALOGE ("%s : Unsupported Pixel format %d", __FUNCTION__,
443                           src->format);
444                    return -EINVAL;
445            }
446        }
447
448        if (src_rect->l < 0 || (uint32_t)src_rect->r > src->w ||
449            src_rect->t < 0 || (uint32_t)src_rect->b > src->h) {
450            // this is always invalid
451            ALOGE ("%s : Invalid source rectangle : src_rect l %d t %d r %d b %d",\
452                   __FUNCTION__, src_rect->l, src_rect->t, src_rect->r, src_rect->b);
453
454            return -EINVAL;
455        }
456
457        if (src->w > MAX_DIMENSION || src->h > MAX_DIMENSION) {
458            ALOGE ("%s : Invalid source dimensions w %d h %d", __FUNCTION__, src->w, src->h);
459            return -EINVAL;
460        }
461
462        if (dst->w > MAX_DIMENSION || dst->h > MAX_DIMENSION) {
463            ALOGE ("%s : Invalid DST dimensions w %d h %d", __FUNCTION__, dst->w, dst->h);
464            return -EINVAL;
465        }
466
467        if(src->format ==  HAL_PIXEL_FORMAT_YV12) {
468            int usage =
469            GRALLOC_USAGE_PRIVATE_IOMMU_HEAP | GRALLOC_USAGE_PRIVATE_UNCACHED;
470            if (0 == alloc_buffer(&yv12_handle,src->w,src->h,
471                                  src->format, usage)){
472                if(0 == convertYV12toYCrCb420SP(src,yv12_handle)){
473                    (const_cast<copybit_image_t *>(src))->format =
474                        HAL_PIXEL_FORMAT_YCrCb_420_SP;
475                    (const_cast<copybit_image_t *>(src))->handle =
476                        yv12_handle;
477                    (const_cast<copybit_image_t *>(src))->base =
478                        (void *)yv12_handle->base;
479                }
480                else{
481                    ALOGE("Error copybit conversion from yv12 failed");
482                    if(yv12_handle)
483                        free_buffer(yv12_handle);
484                    return -EINVAL;
485                }
486            }
487            else{
488                ALOGE("Error:unable to allocate memeory for yv12 software conversion");
489                return -EINVAL;
490            }
491        }
492        const uint32_t maxCount =
493                (uint32_t)(sizeof(list->req)/sizeof(list->req[0]));
494        const struct copybit_rect_t bounds = { 0, 0, (int)dst->w, (int)dst->h };
495        struct copybit_rect_t clip;
496        status = 0;
497        while ((status == 0) && region->next(region, &clip)) {
498            intersect(&clip, &bounds, &clip);
499            mdp_blit_req* req = &list->req[list->count];
500            int flags = 0;
501
502            private_handle_t* src_hnd = (private_handle_t*)src->handle;
503            if(src_hnd != NULL && src_hnd->flags & private_handle_t::PRIV_FLAGS_DO_NOT_FLUSH) {
504                flags |=  MDP_BLIT_NON_CACHED;
505            }
506
507            set_infos(ctx, req, flags);
508            set_image(&req->dst, dst);
509            set_image(&req->src, src);
510            set_rects(ctx, req, dst_rect, src_rect, &clip);
511
512            if (req->src_rect.w<=0 || req->src_rect.h<=0)
513                continue;
514
515            if (req->dst_rect.w<=0 || req->dst_rect.h<=0)
516                continue;
517
518            if (++list->count == maxCount) {
519                status = msm_copybit(ctx, list);
520                list->sync.acq_fen_fd_cnt = 0;
521                list->count = 0;
522            }
523        }
524        if(yv12_handle) {
525            //Before freeing the buffer we need buffer passed through blit call
526            if (list->count != 0) {
527                status = msm_copybit(ctx, list);
528                list->sync.acq_fen_fd_cnt = 0;
529                list->count = 0;
530            }
531            free_buffer(yv12_handle);
532        }
533    } else {
534        ALOGE ("%s : Invalid COPYBIT context", __FUNCTION__);
535        status = -EINVAL;
536    }
537    return status;
538}
539
540/** Perform a blit type operation */
541static int blit_copybit(
542    struct copybit_device_t *dev,
543    struct copybit_image_t const *dst,
544    struct copybit_image_t const *src,
545    struct copybit_region_t const *region)
546{
547    struct copybit_rect_t dr = { 0, 0, (int)dst->w, (int)dst->h };
548    struct copybit_rect_t sr = { 0, 0, (int)src->w, (int)src->h };
549    return stretch_copybit(dev, dst, src, &dr, &sr, region);
550}
551
552static int finish_copybit(struct copybit_device_t *dev)
553{
554    // NOP for MDP copybit
555    if(!dev)
556       return -EINVAL;
557
558    return 0;
559}
560static int clear_copybit(struct copybit_device_t *dev,
561                         struct copybit_image_t const *buf,
562                         struct copybit_rect_t *rect)
563{
564    struct copybit_context_t* ctx = (struct copybit_context_t*)dev;
565    uint32_t color = 0; // black color
566
567    if (!ctx) {
568        ALOGE ("%s: Invalid copybit context", __FUNCTION__);
569        return -EINVAL;
570    }
571
572    struct blitReq list1;
573    memset((char *)&list1 , 0 ,sizeof (struct blitReq) );
574    list1.count = 1;
575    int rel_fen_fd = -1;
576    int my_tmp_get_fence = -1;
577
578    list1.sync.acq_fen_fd  =  ctx->acqFence;
579    list1.sync.rel_fen_fd  =  &my_tmp_get_fence;
580    list1.sync.acq_fen_fd_cnt = ctx->list.sync.acq_fen_fd_cnt;
581    mdp_blit_req* req = &list1.req[0];
582
583    if(!req) {
584        ALOGE ("%s : Invalid request", __FUNCTION__);
585        return -EINVAL;
586    }
587
588    set_image(&req->dst, buf);
589    set_image(&req->src, buf);
590
591    if (rect->l < 0 || (uint32_t)(rect->r - rect->l) > req->dst.width ||
592       rect->t < 0 || (uint32_t)(rect->b - rect->t) > req->dst.height) {
593       ALOGE ("%s : Invalid rect : src_rect l %d t %d r %d b %d",\
594       __FUNCTION__, rect->l, rect->t, rect->r, rect->b);
595       return -EINVAL;
596    }
597
598    req->dst_rect.x  = rect->l;
599    req->dst_rect.y  = rect->t;
600    req->dst_rect.w  = rect->r - rect->l;
601    req->dst_rect.h  = rect->b - rect->t;
602
603    req->src_rect = req->dst_rect;
604
605    req->const_color.b = (uint32_t)((color >> 16) & 0xff);
606    req->const_color.g = (uint32_t)((color >> 8) & 0xff);
607    req->const_color.r = (uint32_t)((color >> 0) & 0xff);
608    req->const_color.alpha = MDP_ALPHA_NOP;
609
610    req->transp_mask = MDP_TRANSP_NOP;
611    req->flags = MDP_SOLID_FILL | MDP_MEMORY_ID_TYPE_FB | MDP_BLEND_FG_PREMULT;
612    int status = msm_copybit(ctx, &list1);
613
614    ctx->list.sync.acq_fen_fd_cnt = 0;
615    if (my_tmp_get_fence !=  -1)
616        close(my_tmp_get_fence);
617
618    return status;
619}
620
621/** Fill the rect on dst with RGBA color **/
622static int fill_color(struct copybit_device_t *dev,
623                      struct copybit_image_t const *dst,
624                      struct copybit_rect_t const *rect,
625                      uint32_t color)
626{
627    struct copybit_context_t* ctx = (struct copybit_context_t*)dev;
628    if (!ctx) {
629        ALOGE("%s: Invalid copybit context", __FUNCTION__);
630        return -EINVAL;
631    }
632
633    if (dst->w > MAX_DIMENSION || dst->h > MAX_DIMENSION) {
634        ALOGE("%s: Invalid DST w=%d h=%d", __FUNCTION__, dst->w, dst->h);
635        return -EINVAL;
636    }
637
638    if (rect->l < 0 || (uint32_t)(rect->r - rect->l) > dst->w ||
639        rect->t < 0 || (uint32_t)(rect->b - rect->t) > dst->h) {
640        ALOGE("%s: Invalid destination rect: l=%d t=%d r=%d b=%d",
641                __FUNCTION__, rect->l, rect->t, rect->r, rect->b);
642        return -EINVAL;
643    }
644
645    int status = 0;
646    struct blitReq* list = &ctx->list;
647    mdp_blit_req* req = &list->req[list->count++];
648    set_infos(ctx, req, MDP_SOLID_FILL);
649    set_image(&req->src, dst);
650    set_image(&req->dst, dst);
651
652    req->dst_rect.x = rect->l;
653    req->dst_rect.y = rect->t;
654    req->dst_rect.w = rect->r - rect->l;
655    req->dst_rect.h = rect->b - rect->t;
656    req->src_rect = req->dst_rect;
657
658    req->const_color.r = (uint32_t)((color >> 0) & 0xff);
659    req->const_color.g = (uint32_t)((color >> 8) & 0xff);
660    req->const_color.b = (uint32_t)((color >> 16) & 0xff);
661    req->const_color.alpha = (uint32_t)((color >> 24) & 0xff);
662
663    if (list->count == sizeof(list->req)/sizeof(list->req[0])) {
664        status = msm_copybit(ctx, list);
665        list->sync.acq_fen_fd_cnt = 0;
666        list->count = 0;
667    }
668    return status;
669}
670
671/*****************************************************************************/
672
673/** Close the copybit device */
674static int close_copybit(struct hw_device_t *dev)
675{
676    struct copybit_context_t* ctx = (struct copybit_context_t*)dev;
677    if (ctx) {
678        close(ctx->mFD);
679        free(ctx);
680    }
681    return 0;
682}
683
684static int flush_get_fence(struct copybit_device_t *dev, int* fd)
685{
686    struct copybit_context_t* ctx = (struct copybit_context_t*)dev;
687    struct blitReq *list = &ctx->list;
688    int ret = -EINVAL;
689
690    if (list->count) {
691        ret = msm_copybit(ctx, list);
692        if (ret < 0)
693            ALOGE("%s: Blit call failed", __FUNCTION__);
694        list->count = 0;
695    }
696    *fd = ctx->relFence;
697    list->sync.acq_fen_fd_cnt = 0;
698    ctx->relFence = -1;
699    return ret;
700}
701
702/** Open a new instance of a copybit device using name */
703static int open_copybit(const struct hw_module_t* module, const char* name,
704                        struct hw_device_t** device)
705{
706    int status = -EINVAL;
707
708    if (!strcmp(name, COPYBIT_HARDWARE_COPYBIT0)) {
709        return COPYBIT_FAILURE;
710    }
711    copybit_context_t *ctx;
712    ctx = (copybit_context_t *)malloc(sizeof(copybit_context_t));
713    memset(ctx, 0, sizeof(*ctx));
714
715    ctx->device.common.tag = HARDWARE_DEVICE_TAG;
716    ctx->device.common.version = 1;
717    ctx->device.common.module = const_cast<hw_module_t*>(module);
718    ctx->device.common.close = close_copybit;
719    ctx->device.set_parameter = set_parameter_copybit;
720    ctx->device.get = get;
721    ctx->device.blit = blit_copybit;
722    ctx->device.set_sync = set_sync_copybit;
723    ctx->device.stretch = stretch_copybit;
724    ctx->device.finish = finish_copybit;
725    ctx->device.fill_color = fill_color;
726    ctx->device.flush_get_fence = flush_get_fence;
727    ctx->device.clear = clear_copybit;
728    ctx->mAlpha = MDP_ALPHA_NOP;
729    ctx->mFlags = 0;
730    ctx->sync.flags = 0;
731    ctx->relFence = -1;
732    for (int i=0; i < MDP_MAX_FENCE_FD; i++) {
733        ctx->acqFence[i] = -1;
734    }
735    ctx->sync.acq_fen_fd = ctx->acqFence;
736    ctx->sync.rel_fen_fd = &ctx->relFence;
737    ctx->list.count = 0;
738    ctx->list.sync.acq_fen_fd_cnt = 0;
739    ctx->list.sync.rel_fen_fd = ctx->sync.rel_fen_fd;
740    ctx->list.sync.acq_fen_fd = ctx->sync.acq_fen_fd;
741    ctx->mFD = open("/dev/graphics/fb0", O_RDWR, 0);
742    if (ctx->mFD < 0) {
743        status = errno;
744        ALOGE("Error opening frame buffer errno=%d (%s)",
745              status, strerror(status));
746        status = -status;
747    } else {
748        status = 0;
749        *device = &ctx->device.common;
750    }
751    return status;
752}
753