src/tdm_helper.c

   1 /**************************************************************************
   2  *
   3  * libtdm
   4  *
   5  * Copyright 2015 Samsung Electronics co., Ltd. All Rights Reserved.
   6  *
   7  * Contact: Eunchul Kim <chulspro.kim@samsung.com>,
   8  *          JinYoung Jeon <jy0.jeon@samsung.com>,
   9  *          Taeheon Kim <th908.kim@samsung.com>,
  10  *          YoungJun Cho <yj44.cho@samsung.com>,
  11  *          SooChan Lim <sc1.lim@samsung.com>,
  12  *          Boram Park <sc1.lim@samsung.com>
  13  *
  14  * Permission is hereby granted, free of charge, to any person obtaining a
  15  * copy of this software and associated documentation files (the
  16  * "Software"), to deal in the Software without restriction, including
  17  * without limitation the rights to use, copy, modify, merge, publish,
  18  * distribute, sub license, and/or sell copies of the Software, and to
  19  * permit persons to whom the Software is furnished to do so, subject to
  20  * the following conditions:
  21  *
  22  * The above copyright notice and this permission notice (including the
  23  * next paragraph) shall be included in all copies or substantial portions
  24  * of the Software.
  25  *
  26  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
  27  * OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
  28  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT.
  29  * IN NO EVENT SHALL PRECISION INSIGHT AND/OR ITS SUPPLIERS BE LIABLE FOR
  30  * ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT,
  31  * TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE
  32  * SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
  33  *
  34 **************************************************************************/
  35
  36 #ifdef HAVE_CONFIG_H
  37 #include "config.h"
  38 #endif
  39
  40 #include <png.h>
  41 #include <string.h>
  42 #include <tbm_surface.h>
  43 #include <tbm_surface_internal.h>
  44 #include <string.h>
  45 #include <time.h>
  46 #include <pixman.h>
  47
  48 #include "tdm.h"
  49 #include "tdm_private.h"
  50 #include "tdm_helper.h"
  51
  52 #define PNG_DEPTH 8
  53
  54 static const char *file_exts[2] = {"png", "yuv"};
  55
  56 int tdm_dump_enable;
  57 char *tdm_debug_dump_dir;
  58
  59 EXTERN double
  60 tdm_helper_get_time(void)
  61 {
  62         struct timespec tp;
  63
  64         if (clock_gettime(CLOCK_MONOTONIC, &tp) == 0)
  65                 return (double)tp.tv_sec + ((double)tp.tv_nsec) / 1000000000.0;
  66
  67         return 0;
  68 }
  69
  70 static void
  71 _tdm_helper_dump_raw(const char *file, void *data1, int size1, void *data2,
  72                                          int size2, void *data3, int size3)
  73 {
  74         unsigned int *blocks;
  75         FILE *fp = fopen(file, "w+");
  76         TDM_RETURN_IF_FAIL(fp != NULL);
  77
  78         blocks = (unsigned int *)data1;
  79         fwrite(blocks, 1, size1, fp);
  80
  81         if (size2 > 0) {
  82                 blocks = (unsigned int *)data2;
  83                 fwrite(blocks, 1, size2, fp);
  84         }
  85
  86         if (size3 > 0) {
  87                 blocks = (unsigned int *)data3;
  88                 fwrite(blocks, 1, size3, fp);
  89         }
  90
  91         fclose(fp);
  92 }
  93
  94 static void
  95 _tdm_helper_dump_png(const char *file, const void *data, int width,
  96                                          int height)
  97 {
  98         FILE *fp = fopen(file, "wb");
  99         TDM_RETURN_IF_FAIL(fp != NULL);
 100
 101         png_structp pPngStruct =
 102                 png_create_write_struct(PNG_LIBPNG_VER_STRING, NULL, NULL, NULL);
 103         if (!pPngStruct) {
 104                 fclose(fp);
 105                 return;
 106         }
 107
 108         png_infop pPngInfo = png_create_info_struct(pPngStruct);
 109         if (!pPngInfo) {
 110                 png_destroy_write_struct(&pPngStruct, NULL);
 111                 fclose(fp);
 112                 return;
 113         }
 114
 115         png_init_io(pPngStruct, fp);
 116         png_set_IHDR(pPngStruct,
 117                                  pPngInfo,
 118                                  width,
 119                                  height,
 120                                  PNG_DEPTH,
 121                                  PNG_COLOR_TYPE_RGBA,
 122                                  PNG_INTERLACE_NONE,
 123                                  PNG_COMPRESSION_TYPE_DEFAULT, PNG_FILTER_TYPE_DEFAULT);
 124
 125         png_set_bgr(pPngStruct);
 126         png_write_info(pPngStruct, pPngInfo);
 127
 128         const int pixel_size = 4;       // RGBA
 129         png_bytep *row_pointers =
 130                 png_malloc(pPngStruct, height * sizeof(png_byte *));
 131         if (!row_pointers) {
 132                 png_destroy_write_struct(&pPngStruct, &pPngInfo);
 133                 fclose(fp);
 134                 return;
 135         }
 136
 137         unsigned int *blocks = (unsigned int *)data;
 138         int y = 0;
 139         int x = 0;
 140
 141         for (; y < height; ++y) {
 142                 png_bytep row =
 143                         png_malloc(pPngStruct, sizeof(png_byte) * width * pixel_size);
 144                 if (!row) {
 145                         for (x = 0; x < y; x++)
 146                                 png_free(pPngStruct, row_pointers[x]);
 147                         png_free(pPngStruct, row_pointers);
 148                         png_destroy_write_struct(&pPngStruct, &pPngInfo);
 149                         fclose(fp);
 150                         return;
 151                 }
 152
 153                 row_pointers[y] = (png_bytep)row;
 154                 for (x = 0; x < width; ++x) {
 155                         unsigned int curBlock = blocks[y * width + x];
 156                         row[x * pixel_size] = (curBlock & 0xFF);
 157                         row[1 + x * pixel_size] = (curBlock >> 8) & 0xFF;
 158                         row[2 + x * pixel_size] = (curBlock >> 16) & 0xFF;
 159                         row[3 + x * pixel_size] = (curBlock >> 24) & 0xFF;
 160                 }
 161         }
 162
 163         png_write_image(pPngStruct, row_pointers);
 164         png_write_end(pPngStruct, pPngInfo);
 165
 166         for (y = 0; y < height; y++)
 167                 png_free(pPngStruct, row_pointers[y]);
 168         png_free(pPngStruct, row_pointers);
 169
 170         png_destroy_write_struct(&pPngStruct, &pPngInfo);
 171
 172         fclose(fp);
 173 }
 174
 175 INTERN char *
 176 tdm_helper_dump_make_directory(const char *path, char *reply, int *len)
 177 {
 178         char *fullpath = NULL;
 179         time_t timer;
 180         struct tm *t, *buf = NULL;
 181
 182         timer = time(NULL);
 183
 184         buf = calloc(1, sizeof(struct tm));
 185         TDM_GOTO_IF_FAIL(buf != NULL, failed_make);
 186
 187         fullpath = calloc(1, TDM_PATH_LEN * sizeof(char));
 188         TDM_GOTO_IF_FAIL(fullpath != NULL, failed_make);
 189
 190         t = localtime_r(&timer, buf);
 191         TDM_GOTO_IF_FAIL(t != NULL, failed_make);
 192
 193         snprintf(fullpath, TDM_PATH_LEN, "%s/dump_%04d%02d%02d.%02d%02d%02d", path,
 194                          t->tm_year + 1900, t->tm_mon + 1, t->tm_mday, t->tm_hour, t->tm_min, t->tm_sec);
 195
 196         if ((mkdir(fullpath, 0755)) < 0) {
 197                 TDM_ERR("mkdir '%s' fail\n", fullpath);
 198                 TDM_SNPRINTF(reply, len, "mkdir '%s' fail\n", fullpath);
 199                 goto failed_make;
 200         }
 201
 202         free(buf);
 203
 204         return fullpath;
 205 failed_make:
 206         if (fullpath)
 207                 free(fullpath);
 208         if (buf)
 209                 free(buf);
 210         return NULL;
 211 }
 212
 213 INTERN void
 214 tdm_helper_dump_buffer_str(tbm_surface_h buffer, char *dir, char *str)
 215 {
 216         tbm_surface_info_s info;
 217         const char *ext;
 218         char file[TDM_PATH_LEN];
 219         int ret, bw;
 220
 221         TDM_RETURN_IF_FAIL(buffer != NULL);
 222         TDM_RETURN_IF_FAIL(dir != NULL);
 223         TDM_RETURN_IF_FAIL(str != NULL);
 224
 225         ret = tbm_surface_get_info(buffer, &info);
 226         TDM_RETURN_IF_FAIL(ret == TBM_SURFACE_ERROR_NONE);
 227
 228         if (info.format == TBM_FORMAT_ARGB8888 || info.format == TBM_FORMAT_XRGB8888) {
 229                 ext = file_exts[0];
 230                 bw = info.planes[0].stride >> 2;
 231         } else {
 232                 ext = file_exts[1];
 233                 bw = info.planes[0].stride;
 234         }
 235
 236         snprintf(file, TDM_PATH_LEN, "%s/%c%c%c%c_%dx%d_%s.%s",
 237                          dir, FOURCC_STR(info.format), bw, info.height, str, ext);
 238
 239         tdm_helper_dump_buffer(buffer, file);
 240 }
 241
 242 EXTERN void
 243 tdm_helper_dump_buffer(tbm_surface_h buffer, const char *file)
 244 {
 245         tbm_surface_info_s info;
 246         int len, ret;
 247         const char *ext;
 248
 249         TDM_RETURN_IF_FAIL(buffer != NULL);
 250         TDM_RETURN_IF_FAIL(file != NULL);
 251
 252         ret = tbm_surface_map(buffer, TBM_OPTION_READ, &info);
 253         TDM_RETURN_IF_FAIL(ret == TBM_SURFACE_ERROR_NONE);
 254
 255         len = strnlen(file, 1024);
 256         if (info.format == TBM_FORMAT_ARGB8888 || info.format == TBM_FORMAT_XRGB8888)
 257                 ext = file_exts[0];
 258         else
 259                 ext = file_exts[1];
 260
 261         if (strncmp(file + (len - 3), ext, 3)) {
 262                 TDM_ERR("can't dump to '%s' file", file + (len - 3));
 263                 tbm_surface_unmap(buffer);
 264                 return;
 265         }
 266
 267         switch (info.format) {
 268         case TBM_FORMAT_ARGB8888:
 269         case TBM_FORMAT_XRGB8888:
 270                 _tdm_helper_dump_png(file, info.planes[0].ptr,
 271                                                          info.planes[0].stride >> 2, info.height);
 272                 break;
 273         case TBM_FORMAT_YVU420:
 274         case TBM_FORMAT_YUV420:
 275                 _tdm_helper_dump_raw(file,
 276                                                          info.planes[0].ptr,
 277                                                          info.planes[0].stride * info.height,
 278                                                          info.planes[1].ptr,
 279                                                          info.planes[1].stride * (info.height >> 1),
 280                                                          info.planes[2].ptr,
 281                                                          info.planes[2].stride * (info.height >> 1));
 282                 break;
 283         case TBM_FORMAT_NV12:
 284         case TBM_FORMAT_NV21:
 285                 _tdm_helper_dump_raw(file,
 286                                                          info.planes[0].ptr,
 287                                                          info.planes[0].stride * info.height,
 288                                                          info.planes[1].ptr,
 289                                                          info.planes[1].stride * (info.height >> 1), NULL,
 290                                                          0);
 291                 break;
 292         case TBM_FORMAT_YUYV:
 293         case TBM_FORMAT_UYVY:
 294                 _tdm_helper_dump_raw(file,
 295                                                          info.planes[0].ptr,
 296                                                          info.planes[0].stride * info.height, NULL, 0,
 297                                                          NULL, 0);
 298                 break;
 299         default:
 300                 TDM_ERR("can't dump %c%c%c%c buffer", FOURCC_STR(info.format));
 301                 tbm_surface_unmap(buffer);
 302                 return;
 303         }
 304
 305         tbm_surface_unmap(buffer);
 306
 307         TDM_INFO("dump %s", file);
 308 }
 309
 310 void
 311 tdm_helper_clear_buffer_pos(tbm_surface_h buffer, tdm_pos *pos)
 312 {
 313         tbm_surface_info_s info;
 314         int ret;
 315
 316         TDM_RETURN_IF_FAIL(buffer != NULL);
 317
 318         ret = tbm_surface_map(buffer, TBM_OPTION_READ, &info);
 319         TDM_RETURN_IF_FAIL(ret == TBM_SURFACE_ERROR_NONE);
 320
 321         switch (info.format) {
 322         case TBM_FORMAT_ARGB8888:
 323         case TBM_FORMAT_XRGB8888:
 324                 if (!pos) {
 325                         memset(info.planes[0].ptr, 0, info.planes[0].stride * info.height);
 326                 } else {
 327                         unsigned char *p;
 328                         int x, y;
 329                         for (y = pos->y; y <= (pos->y + pos->h); y++) {
 330                                 p = info.planes[0].ptr + info.planes[0].stride * y;
 331                                 for (x = pos->x; x <= (pos->x + pos->w); x++) {
 332                                         int *ibuf = (int*)p;
 333                                         ibuf[x] = 0x00000000;
 334                                 }
 335                         }
 336                 }
 337                 break;
 338         case TBM_FORMAT_YVU420:
 339         case TBM_FORMAT_YUV420:
 340                 memset((char*)info.planes[0].ptr, 0x10, info.planes[0].stride * info.height);
 341                 memset((char*)info.planes[1].ptr, 0x80, info.planes[1].stride * (info.height >> 1));
 342                 memset((char*)info.planes[2].ptr, 0x80, info.planes[2].stride * (info.height >> 1));
 343                 break;
 344         case TBM_FORMAT_NV12:
 345         case TBM_FORMAT_NV21:
 346                 memset((char*)info.planes[0].ptr, 0x10, info.planes[0].stride * info.height);
 347                 memset((char*)info.planes[1].ptr, 0x80, info.planes[1].stride * (info.height >> 1));
 348                 break;
 349         case TBM_FORMAT_YUYV: {
 350                 int *ibuf = (int*)info.planes[0].ptr;
 351                 int i, size = info.planes[0].stride * info.height / 4;
 352
 353                 for (i = 0 ; i < size ; i++)
 354                         ibuf[i] = 0x10801080;
 355         }
 356         break;
 357         case TBM_FORMAT_UYVY: {
 358                 int *ibuf = (int*)info.planes[0].ptr;
 359                 int i, size = info.planes[0].stride * info.height / 4;
 360
 361                 for (i = 0 ; i < size ; i++)
 362                         ibuf[i] = 0x80108010; /* YUYV -> 0xVYUY */
 363         }
 364         break;
 365         default:
 366                 TDM_ERR("can't clear %c%c%c%c buffer", FOURCC_STR(info.format));
 367                 break;
 368         }
 369
 370         tbm_surface_unmap(buffer);
 371 }
 372
 373 EXTERN void
 374 tdm_helper_clear_buffer(tbm_surface_h buffer)
 375 {
 376         TDM_RETURN_IF_FAIL(buffer != NULL);
 377
 378         tdm_helper_clear_buffer_pos(buffer, NULL);
 379 }
 380
 381 static pixman_format_code_t
 382 _tdm_helper_pixman_format_get(tbm_format format)
 383 {
 384         switch (format) {
 385         case TBM_FORMAT_ARGB8888:
 386                 return PIXMAN_a8r8g8b8;
 387         case TBM_FORMAT_XRGB8888:
 388                 return PIXMAN_x8r8g8b8;
 389         default:
 390                 return 0;
 391         }
 392
 393         return 0;
 394 }
 395
 396 EXTERN tdm_error
 397 tdm_helper_convert_buffer(tbm_surface_h srcbuf, tbm_surface_h dstbuf,
 398                                                   tdm_pos *srcpos, tdm_pos *dstpos,
 399                                                   tdm_transform transform, int over)
 400 {
 401         tbm_surface_info_s src_info, dst_info;
 402         pixman_image_t *src_img = NULL, *dst_img = NULL;
 403         pixman_format_code_t src_format, dst_format;
 404         double scale_x, scale_y;
 405         int rotate_step, bos;
 406         pixman_transform_t t;
 407         struct pixman_f_transform ft;
 408         pixman_op_t op;
 409         int src_stride, dst_stride;
 410         int buf_width, err;
 411         tdm_error ret = TDM_ERROR_OPERATION_FAILED;
 412
 413         TDM_RETURN_VAL_IF_FAIL(srcbuf != NULL, TDM_ERROR_INVALID_PARAMETER);
 414         TDM_RETURN_VAL_IF_FAIL(dstbuf != NULL, TDM_ERROR_INVALID_PARAMETER);
 415
 416         bos = tbm_surface_internal_get_num_bos(srcbuf);
 417         TDM_RETURN_VAL_IF_FAIL(bos == 1, TDM_ERROR_OPERATION_FAILED);
 418
 419         bos = tbm_surface_internal_get_num_bos(dstbuf);
 420         TDM_RETURN_VAL_IF_FAIL(bos == 1, TDM_ERROR_OPERATION_FAILED);
 421
 422         err = tbm_surface_map(srcbuf, TBM_OPTION_READ, &src_info);
 423         TDM_RETURN_VAL_IF_FAIL(err == TBM_SURFACE_ERROR_NONE, TDM_ERROR_OPERATION_FAILED);
 424
 425         err = tbm_surface_map(dstbuf, TBM_OPTION_WRITE, &dst_info);
 426         TDM_GOTO_IF_FAIL(err == TBM_SURFACE_ERROR_NONE, unmap_srcbuf);
 427
 428         /* not handle buffers which have 2 more gem handles */
 429         TDM_GOTO_IF_FAIL(src_info.planes[0].ptr != NULL, unmap_dstbuf);
 430         TDM_GOTO_IF_FAIL(dst_info.planes[0].ptr != NULL, unmap_dstbuf);
 431
 432         src_format = _tdm_helper_pixman_format_get(src_info.format);
 433         TDM_GOTO_IF_FAIL(src_format > 0, unmap_dstbuf);
 434         dst_format = _tdm_helper_pixman_format_get(dst_info.format);
 435         TDM_GOTO_IF_FAIL(dst_format > 0, unmap_dstbuf);
 436
 437         buf_width = src_info.planes[0].stride >> 2;
 438         src_stride = src_info.planes[0].stride;
 439         src_img = pixman_image_create_bits(src_format, buf_width, src_info.height,
 440                                                                            (uint32_t*)src_info.planes[0].ptr, src_stride);
 441         TDM_GOTO_IF_FAIL(src_img, unref_img);
 442
 443         buf_width = dst_info.planes[0].stride >> 2;
 444         dst_stride = dst_info.planes[0].stride;
 445         dst_img = pixman_image_create_bits(dst_format, buf_width, dst_info.height,
 446                                                                            (uint32_t*)dst_info.planes[0].ptr, dst_stride);
 447         TDM_GOTO_IF_FAIL(dst_img, unref_img);
 448
 449         pixman_f_transform_init_identity(&ft);
 450
 451         if (transform & TDM_TRANSFORM_FLIPPED) {
 452                 pixman_f_transform_scale(&ft, NULL, -1, 1);
 453                 pixman_f_transform_translate(&ft, NULL, dstpos->w, 0);
 454         }
 455
 456         rotate_step = transform & 0x3;
 457         if (rotate_step > 0) {
 458                 int c, s, tx = 0, ty = 0;
 459                 switch (rotate_step) {
 460                 case 1:
 461                         c = 0, s = -1, tx = -dstpos->w;
 462                         break;
 463                 case 2:
 464                         c = -1, s = 0, tx = -dstpos->w, ty = -dstpos->h;
 465                         break;
 466                 case 3:
 467                         c = 0, s = 1, ty = -dstpos->h;
 468                         break;
 469                 }
 470                 pixman_f_transform_translate(&ft, NULL, tx, ty);
 471                 pixman_f_transform_rotate(&ft, NULL, c, s);
 472         }
 473
 474         if (rotate_step % 2 == 0) {
 475                 scale_x = (double)srcpos->w / dstpos->w;
 476                 scale_y = (double)srcpos->h / dstpos->h;
 477         } else {
 478                 scale_x = (double)srcpos->w / dstpos->h;
 479                 scale_y = (double)srcpos->h / dstpos->w;
 480         }
 481
 482         pixman_f_transform_scale(&ft, NULL, scale_x, scale_y);
 483         pixman_f_transform_translate(&ft, NULL, srcpos->x, srcpos->y);
 484         pixman_transform_from_pixman_f_transform(&t, &ft);
 485         pixman_image_set_transform(src_img, &t);
 486
 487         op = (!over) ? PIXMAN_OP_SRC : PIXMAN_OP_OVER;
 488
 489         pixman_image_composite(op, src_img, NULL, dst_img, 0, 0, 0, 0,
 490                                                    dstpos->x, dstpos->y, dstpos->w, dstpos->h);
 491
 492         ret = TDM_ERROR_NONE;
 493
 494 unref_img:
 495         if (src_img)
 496                 pixman_image_unref(src_img);
 497         if (dst_img)
 498                 pixman_image_unref(dst_img);
 499 unmap_dstbuf:
 500         tbm_surface_unmap(dstbuf);
 501 unmap_srcbuf:
 502         tbm_surface_unmap(srcbuf);
 503
 504         return ret;
 505 }
 506
 507 EXTERN int
 508 tdm_helper_get_fd(const char *env)
 509 {
 510         const char *value;
 511         int fd, newfd, flags, ret;
 512
 513         value = (const char*)getenv(env);
 514         if (!value)
 515                 return -1;
 516
 517         ret = sscanf(value, "%d", &fd);
 518         if (ret < 0) {
 519                 TDM_ERR("sscanf failed: %m");
 520                 return -1;
 521         }
 522
 523         flags = fcntl(fd, F_GETFD);
 524         if (flags == -1) {
 525                 TDM_ERR("fcntl failed: %m");
 526                 return -1;
 527         }
 528
 529         newfd = dup(fd);
 530         if (newfd < 0) {
 531                 TDM_ERR("dup failed: %m");
 532                 return -1;
 533         }
 534
 535         TDM_INFO("%s: fd(%d) newfd(%d)", env, fd, newfd);
 536
 537         ret = fcntl(newfd, F_SETFD, flags | FD_CLOEXEC);
 538         if (ret == -1) {
 539                 TDM_ERR("fcntl failed: %m");
 540                 close(newfd);
 541                 return -1;
 542         }
 543
 544         return newfd;
 545 }
 546
 547 EXTERN void
 548 tdm_helper_set_fd(const char *env, int fd)
 549 {
 550         char buf[32];
 551         int ret;
 552
 553         snprintf(buf, sizeof(buf), "%d", fd);
 554
 555         ret = setenv(env, (const char*)buf, 1);
 556         if (ret) {
 557                 TDM_ERR("setenv failed: %m");
 558                 return;
 559         }
 560
 561         if (fd >= 0)
 562                 TDM_INFO("%s: fd(%d)", env, fd);
 563 }
 564
 565 EXTERN void
 566 tdm_helper_dump_start(char *dumppath, int *count)
 567 {
 568         if (dumppath == NULL || count == NULL) {
 569                 TDM_DBG("tdm_helper_dump dumppath or count is null.");
 570                 return;
 571         }
 572
 573         tdm_dump_enable = 1;
 574
 575         TDM_DBG("tdm_helper_dump start.(path : %s)", dumppath);
 576 }
 577
 578 EXTERN void
 579 tdm_helper_dump_stop(void)
 580 {
 581         tdm_dump_enable = 0;
 582
 583         TDM_DBG("tdm_helper_dump stop.");
 584 }
 585
 586 static tdm_error
 587 _tdm_helper_buffer_convert(tbm_surface_h srcbuf, tbm_surface_h dstbuf,
 588                                                    int dx, int dy, int dw, int dh, int count)
 589 {
 590         pixman_image_t *src_img = NULL, *dst_img = NULL;
 591         pixman_format_code_t src_format, dst_format;
 592         pixman_transform_t t;
 593         struct pixman_f_transform ft;
 594         pixman_op_t op;
 595         tbm_surface_info_s src_info = {0, };
 596         tbm_surface_info_s dst_info = {0, };
 597         int stride, width;
 598         double scale_x, scale_y;
 599
 600         TDM_RETURN_VAL_IF_FAIL(srcbuf != NULL, TDM_ERROR_INVALID_PARAMETER);
 601         TDM_RETURN_VAL_IF_FAIL(dstbuf != NULL, TDM_ERROR_INVALID_PARAMETER);
 602
 603         if (tbm_surface_map(srcbuf, TBM_SURF_OPTION_READ, &src_info) != TBM_SURFACE_ERROR_NONE) {
 604                 TDM_ERR("cannot mmap srcbuf\n");
 605                 return TDM_ERROR_OPERATION_FAILED;
 606         }
 607
 608         if (tbm_surface_map(dstbuf, TBM_SURF_OPTION_WRITE, &dst_info) != TBM_SURFACE_ERROR_NONE) {
 609                 TDM_ERR("cannot mmap dstbuf\n");
 610                 tbm_surface_unmap(srcbuf);
 611                 return TDM_ERROR_OPERATION_FAILED;
 612         }
 613         TDM_GOTO_IF_FAIL(src_info.num_planes == 1, cant_convert);
 614         TDM_GOTO_IF_FAIL(dst_info.num_planes == 1, cant_convert);
 615
 616         /* src */
 617         src_format = _tdm_helper_pixman_format_get(src_info.format);
 618         TDM_GOTO_IF_FAIL(src_format > 0, cant_convert);
 619
 620         width = src_info.planes[0].stride / 4;
 621         stride = src_info.planes[0].stride;
 622         src_img = pixman_image_create_bits(src_format, width, src_info.height,
 623                                                                            (uint32_t*)src_info.planes[0].ptr, stride);
 624         TDM_GOTO_IF_FAIL(src_img != NULL, cant_convert);
 625
 626         /* dst */
 627         dst_format = _tdm_helper_pixman_format_get(dst_info.format);
 628         TDM_GOTO_IF_FAIL(dst_format > 0, cant_convert);
 629
 630         width = dst_info.planes[0].stride / 4;
 631         stride = dst_info.planes[0].stride;
 632         dst_img = pixman_image_create_bits(dst_format, width, dst_info.height,
 633                                                                            (uint32_t*)dst_info.planes[0].ptr, stride);
 634         TDM_GOTO_IF_FAIL(dst_img != NULL, cant_convert);
 635
 636         pixman_f_transform_init_identity(&ft);
 637
 638         scale_x = (double)src_info.width / dw;
 639         scale_y = (double)src_info.height / dh;
 640
 641         pixman_f_transform_scale(&ft, NULL, scale_x, scale_y);
 642         pixman_f_transform_translate(&ft, NULL, 0, 0);
 643         pixman_transform_from_pixman_f_transform(&t, &ft);
 644         pixman_image_set_transform(src_img, &t);
 645
 646         if (count == 0)
 647                 op = PIXMAN_OP_SRC;
 648         else
 649                 op = PIXMAN_OP_OVER;
 650
 651         pixman_image_composite(op, src_img, NULL, dst_img,
 652                                                    0, 0, 0, 0, dx, dy, dw, dh);
 653
 654         if (src_img)
 655                 pixman_image_unref(src_img);
 656         if (dst_img)
 657                 pixman_image_unref(dst_img);
 658
 659         tbm_surface_unmap(srcbuf);
 660         tbm_surface_unmap(dstbuf);
 661
 662         return TDM_ERROR_NONE;
 663
 664 cant_convert:
 665         if (src_img)
 666                 pixman_image_unref(src_img);
 667
 668         tbm_surface_unmap(srcbuf);
 669         tbm_surface_unmap(dstbuf);
 670
 671         return TDM_ERROR_OPERATION_FAILED;
 672 }
 673
 674 EXTERN tdm_error
 675 tdm_helper_capture_output(tdm_output *output, tbm_surface_h dst_buffer,
 676                                                   int x, int y, int w, int h,
 677                                                   tdm_helper_capture_handler func, void *data)
 678 {
 679         tbm_surface_h surface;
 680         tdm_error err;
 681         int i, count, first = 0;
 682
 683         TDM_RETURN_VAL_IF_FAIL(output != NULL, TDM_ERROR_INVALID_PARAMETER);
 684         TDM_RETURN_VAL_IF_FAIL(dst_buffer != NULL, TDM_ERROR_INVALID_PARAMETER);
 685         TDM_RETURN_VAL_IF_FAIL(x >= 0, TDM_ERROR_INVALID_PARAMETER);
 686         TDM_RETURN_VAL_IF_FAIL(y >= 0, TDM_ERROR_INVALID_PARAMETER);
 687         TDM_RETURN_VAL_IF_FAIL(w >= 0, TDM_ERROR_INVALID_PARAMETER);
 688         TDM_RETURN_VAL_IF_FAIL(h >= 0, TDM_ERROR_INVALID_PARAMETER);
 689         TDM_RETURN_VAL_IF_FAIL(func != NULL, TDM_ERROR_INVALID_PARAMETER);
 690         TDM_RETURN_VAL_IF_FAIL(data != NULL, TDM_ERROR_INVALID_PARAMETER);
 691
 692         err = tdm_output_get_layer_count(output, &count);
 693         if (err != TDM_ERROR_NONE) {
 694                 TDM_ERR("tdm_output_get_layer_count fail(%d)\n", err);
 695                 return TDM_ERROR_OPERATION_FAILED;
 696         }
 697         if (count <= 0) {
 698                 TDM_ERR("tdm_output_get_layer_count err(%d, %d)\n", err, count);
 699                 return TDM_ERROR_BAD_MODULE;
 700         }
 701
 702         for (i = count - 1; i >= 0; i--) {
 703                 tdm_layer *layer = tdm_output_get_layer(output, i, NULL);
 704
 705                 surface = tdm_layer_get_displaying_buffer(layer, &err);
 706                 if (err != TDM_ERROR_NONE)
 707                         continue;
 708
 709                 err = _tdm_helper_buffer_convert(surface, dst_buffer, x, y, w, h, first++);
 710                 if (err != TDM_ERROR_NONE)
 711                         TDM_DBG("convert fail %d-layer buffer\n", i);
 712                 else
 713                         TDM_DBG("convert success %d-layer buffer\n", i);
 714         }
 715
 716         func(dst_buffer, data);
 717
 718         return TDM_ERROR_NONE;
 719 }
 720
 721 EXTERN void
 722 tdm_helper_get_display_information(tdm_display *dpy, char *reply, int *len)
 723 {
 724         tdm_private_display *private_display;
 725         tdm_backend_module *module_data;
 726         tdm_func_output *func_output;
 727         tdm_func_layer *func_layer;
 728         tdm_private_output *private_output = NULL;
 729         tdm_private_layer *private_layer = NULL;
 730         tdm_private_pp *private_pp = NULL;
 731         tdm_private_capture *private_capture = NULL;
 732         tdm_error ret;
 733         int i;
 734
 735         TDM_DBG_RETURN_IF_FAIL(dpy != NULL);
 736
 737         private_display = dpy;
 738         func_output = &private_display->func_output;
 739         func_layer = &private_display->func_layer;
 740         _pthread_mutex_lock(&private_display->lock);
 741
 742         /* module information */
 743         module_data = private_display->module_data;
 744         TDM_SNPRINTF(reply, len, "[TDM backend information]\n");
 745         TDM_SNPRINTF(reply, len, "name: %s\n", module_data->name);
 746         TDM_SNPRINTF(reply, len, "vendor: %s\n", module_data->vendor);
 747         TDM_SNPRINTF(reply, len, "version: %d.%d\n\n",
 748                                  (int)TDM_BACKEND_GET_ABI_MAJOR(module_data->abi_version),
 749                                  (int)TDM_BACKEND_GET_ABI_MINOR(module_data->abi_version));
 750
 751         /* output information */
 752         TDM_SNPRINTF(reply, len, "[Output information]\n");
 753         TDM_SNPRINTF(reply, len, "--------------------------------------------------------------------------------------------\n");
 754         TDM_SNPRINTF(reply, len, "idx   maker   model   name   type   status   dpms   subpixel   align_w   min   max   phy(mm)\n");
 755         TDM_SNPRINTF(reply, len, "--------------------------------------------------------------------------------------------\n");
 756         LIST_FOR_EACH_ENTRY(private_output, &private_display->output_list, link) {
 757                 TDM_SNPRINTF(reply, len, "%d   %s   %s   %s   %s   %s   %s   %u   %d   %dx%d   %dx%d   %ux%u\n",
 758                                          private_output->index, private_output->caps.maker,
 759                                          private_output->caps.model, private_output->caps.name,
 760                                          tdm_conn_str(private_output->caps.type),
 761                                          tdm_status_str(private_output->caps.status),
 762                                          tdm_dpms_str(private_output->current_dpms_value),
 763                                          private_output->caps.subpixel,
 764                                          TDM_FRONT_VALUE(private_output->caps.preferred_align),
 765                                          TDM_FRONT_VALUE(private_output->caps.min_w),
 766                                          TDM_FRONT_VALUE(private_output->caps.min_h),
 767                                          TDM_FRONT_VALUE(private_output->caps.max_w),
 768                                          TDM_FRONT_VALUE(private_output->caps.max_h),
 769                                          private_output->caps.mmWidth, private_output->caps.mmHeight);
 770
 771                 TDM_SNPRINTF(reply, len, "\t%u modes:\n", private_output->caps.mode_count);
 772
 773                 if (private_output->caps.mode_count > 0) {
 774                         const tdm_output_mode *current_mode = NULL;
 775
 776                         TDM_DBG_GOTO_IF_FAIL(func_output->output_get_mode, unlock);
 777                         ret = func_output->output_get_mode(private_output->output_backend, &current_mode);
 778                         TDM_DBG_GOTO_IF_FAIL(ret == TDM_ERROR_NONE, unlock);
 779
 780                         TDM_SNPRINTF(reply, len, "\t\t name refresh (Hz) clk hdisp hss hse htot vdisp vss vse vtot vscan\n");
 781                         for (i = 0; i < private_output->caps.mode_count; i++) {
 782                                 char *current = (current_mode == private_output->caps.modes + i) ? "*" : " ";
 783                                 TDM_SNPRINTF(reply, len, "\t\t%s%s %u %u %u %u %u %u %u %u %u %u %u ",
 784                                                          current,
 785                                                          private_output->caps.modes[i].name,
 786                                                          private_output->caps.modes[i].vrefresh,
 787                                                          private_output->caps.modes[i].clock,
 788                                                          private_output->caps.modes[i].hdisplay,
 789                                                          private_output->caps.modes[i].hsync_start,
 790                                                          private_output->caps.modes[i].hsync_end,
 791                                                          private_output->caps.modes[i].htotal,
 792                                                          private_output->caps.modes[i].vdisplay,
 793                                                          private_output->caps.modes[i].vsync_start,
 794                                                          private_output->caps.modes[i].vsync_end,
 795                                                          private_output->caps.modes[i].vtotal,
 796                                                          private_output->caps.modes[i].vscan);
 797                                 tdm_mode_flag_str(private_output->caps.modes[i].flags, &reply, len);
 798                                 TDM_SNPRINTF(reply, len, " ");
 799                                 tdm_mode_type_str(private_output->caps.modes[i].type, &reply, len);
 800                                 TDM_SNPRINTF(reply, len, "\n");
 801                         }
 802                 }
 803
 804                 TDM_SNPRINTF(reply, len, "\t%d properties:\n", private_output->caps.prop_count);
 805                 if (private_output->caps.prop_count > 0) {
 806                         TDM_SNPRINTF(reply, len, "\t\tname\tidx\tvalue\n");
 807                         for (i = 0; i < private_output->caps.prop_count; i++) {
 808                                 tdm_value value;
 809                                 TDM_DBG_GOTO_IF_FAIL(func_output->output_get_property, unlock);
 810                                 ret = func_output->output_get_property(private_output->output_backend,
 811                                                                                                            private_output->caps.props[i].id,
 812                                                                                                            &value);
 813                                 TDM_DBG_GOTO_IF_FAIL(ret == TDM_ERROR_NONE, unlock);
 814                                 TDM_SNPRINTF(reply, len, "\t\t%s\t%u\t%u\n",
 815                                                          private_output->caps.props[i].name,
 816                                                          private_output->caps.props[i].id,
 817                                                          value.u32);
 818                         }
 819                 }
 820         }
 821         TDM_SNPRINTF(reply, len, "\n");
 822
 823         /* layer information */
 824         TDM_SNPRINTF(reply, len, "[Layer information]\n");
 825         TDM_SNPRINTF(reply, len, "-----------------------------------------------------------------------\n");
 826         TDM_SNPRINTF(reply, len, "idx   output   zpos   buf   format   size   crop   geometry   transform\n");
 827         TDM_SNPRINTF(reply, len, "-----------------------------------------------------------------------\n");
 828         LIST_FOR_EACH_ENTRY(private_output, &private_display->output_list, link) {
 829                 LIST_FOR_EACH_ENTRY(private_layer, &private_output->layer_list, link) {
 830                         if (!private_layer->usable) {
 831                                 tdm_info_layer info;
 832                                 unsigned int format;
 833                                 tdm_size size;
 834                                 tbm_surface_info_s buf_info;
 835
 836                                 TDM_DBG_GOTO_IF_FAIL(func_layer->layer_get_info, unlock);
 837                                 memset(&info, 0, sizeof info);
 838                                 ret = func_layer->layer_get_info(private_layer->layer_backend, &info);
 839                                 TDM_DBG_GOTO_IF_FAIL(ret == TDM_ERROR_NONE, unlock);
 840
 841                                 format = tbm_surface_get_format(private_layer->showing_buffer);
 842                                 tbm_surface_get_info(private_layer->showing_buffer, &buf_info);
 843
 844                                 if (IS_RGB(format))
 845                                         size.h = buf_info.planes[0].stride >> 2;
 846                                 else
 847                                         size.h = buf_info.planes[0].stride;
 848                                 size.v = tbm_surface_get_height(private_layer->showing_buffer);
 849
 850                                 if (info.src_config.format)
 851                                         format = (info.src_config.format) ? : format;
 852
 853                                 TDM_SNPRINTF(reply, len, "%d   %d   %d   %p   %c%c%c%c   %ux%u   %ux%u+%u+%u   %ux%u+%u+%u   %s\n",
 854                                                          private_layer->index,
 855                                                          private_output->index,
 856                                                          private_layer->caps.zpos,
 857                                                          private_layer->showing_buffer, FOURCC_STR(format), size.h, size.v,
 858                                                          info.src_config.pos.w, info.src_config.pos.h, info.src_config.pos.x, info.src_config.pos.y,
 859                                                          info.dst_pos.w, info.dst_pos.h, info.dst_pos.x, info.dst_pos.y,
 860                                                          tdm_transform_str(info.transform));
 861                         } else {
 862                                 TDM_SNPRINTF(reply, len, "%d   %d   %d   -\n",
 863                                                          private_layer->index,
 864                                                          private_output->index,
 865                                                          private_layer->caps.zpos);
 866                         }
 867
 868                         TDM_SNPRINTF(reply, len, "\tcaps\t: ");
 869                         tdm_layer_caps_str(private_layer->caps.capabilities, &reply, len);
 870                         TDM_SNPRINTF(reply, len, "\n");
 871
 872                         TDM_SNPRINTF(reply, len, "\tformats\t: ");
 873                         if (private_layer->caps.format_count > 0) {
 874                                 const char *sep = "";
 875                                 for (i = 0; i < private_layer->caps.format_count; i++) {
 876                                         if (private_layer->caps.formats[i] == 0)
 877                                                 continue;
 878                                         TDM_SNPRINTF(reply, len, "%s%c%c%c%c", sep, FOURCC_STR(private_layer->caps.formats[i]));
 879                                         sep = ",";
 880                                 }
 881                                 TDM_SNPRINTF(reply, len, "\n");
 882                         }
 883
 884                         TDM_SNPRINTF(reply, len, "\t%u properties:\n", private_layer->caps.prop_count);
 885                         if (private_layer->caps.prop_count > 0) {
 886                                 TDM_SNPRINTF(reply, len, "\t\tname\tidx\tvalue\n");
 887                                 for (i = 0; i < private_layer->caps.prop_count; i++) {
 888                                         tdm_value value;
 889                                         TDM_DBG_GOTO_IF_FAIL(func_layer->layer_get_property, unlock);
 890                                         ret = func_layer->layer_get_property(private_layer->layer_backend,
 891                                                                                                                  private_layer->caps.props[i].id,
 892                                                                                                                  &value);
 893                                         TDM_DBG_GOTO_IF_FAIL(ret == TDM_ERROR_NONE, unlock);
 894                                         TDM_SNPRINTF(reply, len, "\t\t%s\t%u\t%u\n",
 895                                                                  private_layer->caps.props[i].name,
 896                                                                  private_layer->caps.props[i].id,
 897                                                                  value.u32);
 898                                 }
 899                         }
 900                 }
 901         }
 902         TDM_SNPRINTF(reply, len, "\n");
 903
 904         if (private_display->capabilities & TDM_DISPLAY_CAPABILITY_PP) {
 905                 const char *sep = "";
 906                 TDM_SNPRINTF(reply, len, "[PP information]\n");
 907                 TDM_SNPRINTF(reply, len, "caps\t: ");
 908                 tdm_pp_caps_str(private_display->caps_pp.capabilities, &reply, len);
 909                 TDM_SNPRINTF(reply, len, "\n");
 910                 TDM_SNPRINTF(reply, len, "formats\t: ");
 911                 for (i = 0; i < private_display->caps_pp.format_count; i++) {
 912                         if (private_display->caps_pp.formats[i] == 0)
 913                                 continue;
 914                         TDM_SNPRINTF(reply, len, "%s%c%c%c%c", sep, FOURCC_STR(private_display->caps_pp.formats[i]));
 915                         sep = ",";
 916                 }
 917                 TDM_SNPRINTF(reply, len, "\n");
 918                 TDM_SNPRINTF(reply, len, "size\t: min(%dx%d) max(%dx%d) align_w(%d)\n",
 919                                          TDM_FRONT_VALUE(private_display->caps_pp.min_w),
 920                                          TDM_FRONT_VALUE(private_display->caps_pp.min_h),
 921                                          TDM_FRONT_VALUE(private_display->caps_pp.max_w),
 922                                          TDM_FRONT_VALUE(private_display->caps_pp.max_h),
 923                                          TDM_FRONT_VALUE(private_display->caps_pp.preferred_align));
 924                 if (!LIST_IS_EMPTY(&private_display->pp_list)) {
 925                         TDM_SNPRINTF(reply, len, "-------------------------------------------------------------\n");
 926                         TDM_SNPRINTF(reply, len, "src(format size crop)  |  dst(format size crop)  |  transform\n");
 927                         TDM_SNPRINTF(reply, len, "-------------------------------------------------------------\n");
 928                         LIST_FOR_EACH_ENTRY(private_pp, &private_display->pp_list, link) {
 929                                 TDM_SNPRINTF(reply, len, "%c%c%c%c %ux%u %ux%u+%u+%u | %c%c%c%c %ux%u %ux%u+%u+%u | %s\n",
 930                                                          FOURCC_STR(private_pp->info.src_config.format),
 931                                                          private_pp->info.src_config.size.h,
 932                                                          private_pp->info.src_config.size.v,
 933                                                          private_pp->info.src_config.pos.x, private_pp->info.src_config.pos.y,
 934                                                          private_pp->info.src_config.pos.w, private_pp->info.src_config.pos.h,
 935                                                          FOURCC_STR(private_pp->info.dst_config.format),
 936                                                          private_pp->info.dst_config.size.h,
 937                                                          private_pp->info.dst_config.size.v,
 938                                                          private_pp->info.dst_config.pos.x, private_pp->info.dst_config.pos.y,
 939                                                          private_pp->info.dst_config.pos.w, private_pp->info.dst_config.pos.h,
 940                                                          tdm_transform_str(private_pp->info.transform));
 941                         }
 942                 }
 943         } else {
 944                 TDM_SNPRINTF(reply, len, "[No PP capability]\n");
 945         }
 946         TDM_SNPRINTF(reply, len, "\n");
 947
 948         if (private_display->capabilities & TDM_DISPLAY_CAPABILITY_CAPTURE) {
 949                 const char *sep = "";
 950                 TDM_SNPRINTF(reply, len, "[Capture information]\n");
 951                 TDM_SNPRINTF(reply, len, "caps\t: ");
 952                 tdm_capture_caps_str(private_display->caps_capture.capabilities, &reply, len);
 953                 TDM_SNPRINTF(reply, len, "\n");
 954                 TDM_SNPRINTF(reply, len, "formats\t: ");
 955                 for (i = 0; i < private_display->caps_capture.format_count; i++) {
 956                         if (private_display->caps_capture.formats[i] == 0)
 957                                 continue;
 958                         TDM_SNPRINTF(reply, len, "%s%c%c%c%c", sep, FOURCC_STR(private_display->caps_capture.formats[i]));
 959                         sep = ",";
 960                 }
 961                 TDM_SNPRINTF(reply, len, "\n");
 962                 TDM_SNPRINTF(reply, len, "size\t: min(%dx%d) max(%dx%d) align_w(%d)\n",
 963                                          TDM_FRONT_VALUE(private_display->caps_capture.min_w),
 964                                          TDM_FRONT_VALUE(private_display->caps_capture.min_h),
 965                                          TDM_FRONT_VALUE(private_display->caps_capture.max_w),
 966                                          TDM_FRONT_VALUE(private_display->caps_capture.max_h),
 967                                          TDM_FRONT_VALUE(private_display->caps_capture.preferred_align));
 968                 if (!LIST_IS_EMPTY(&private_display->capture_list)) {
 969                         TDM_SNPRINTF(reply, len, "-----------------------------------\n");
 970                         TDM_SNPRINTF(reply, len, "dst(format size crop)  |  transform\n");
 971                         TDM_SNPRINTF(reply, len, "-----------------------------------\n");
 972                         LIST_FOR_EACH_ENTRY(private_capture, &private_display->capture_list, link) {
 973                                 TDM_SNPRINTF(reply, len, "%c%c%c%c %ux%u %ux%u+%u+%u | %s\n",
 974                                                          FOURCC_STR(private_capture->info.dst_config.format),
 975                                                          private_capture->info.dst_config.size.h,
 976                                                          private_capture->info.dst_config.size.v,
 977                                                          private_capture->info.dst_config.pos.x, private_capture->info.dst_config.pos.y,
 978                                                          private_capture->info.dst_config.pos.w, private_capture->info.dst_config.pos.h,
 979                                                          tdm_transform_str(private_capture->info.transform));
 980                         }
 981                 }
 982         } else {
 983                 TDM_SNPRINTF(reply, len, "[No Capture capability]\n");
 984         }
 985         TDM_SNPRINTF(reply, len, "\n");
 986
 987 unlock:
 988         _pthread_mutex_unlock(&private_display->lock);
 989 }