src/mm_player_capture.c

   1 /*\r
   2  * libmm-player\r
   3  *\r
   4  * Copyright (c) 2000 - 2011 Samsung Electronics Co., Ltd. All rights reserved.\r
   5  *\r
   6  * Contact: JongHyuk Choi <jhchoi.choi@samsung.com>, YeJin Cho <cho.yejin@samsung.com>, YoungHwan An <younghwan_.an@samsung.com>\r
   7  *\r
   8  * Licensed under the Apache License, Version 2.0 (the "License");\r
   9  * you may not use this file except in compliance with the License.\r
  10  * You may obtain a copy of the License at\r
  11  *\r
  12  * http://www.apache.org/licenses/LICENSE-2.0\r
  13  *\r
  14  * Unless required by applicable law or agreed to in writing, software\r
  15  * distributed under the License is distributed on an "AS IS" BASIS,\r
  16  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.\r
  17  * See the License for the specific language governing permissions and\r
  18  * limitations under the License.\r
  19  *\r
  20  */\r
  21 \r
  22 /*===========================================================================================\r
  23 |                                                                                                                                                                                       |\r
  24 |  INCLUDE FILES                                                                                                                                                        |\r
  25 |                                                                                                                                                                                       |\r
  26 ========================================================================================== */\r
  27 #include "mm_player_capture.h"\r
  28 #include "mm_player_priv.h"\r
  29 \r
  30 #include <mm_util_imgp.h>\r
  31 #include <gst/video/video-info.h>
  32 \r
  33 /*---------------------------------------------------------------------------\r
  34 |    LOCAL VARIABLE DEFINITIONS for internal                                                            |\r
  35 ---------------------------------------------------------------------------*/\r
  36 \r
  37 /*---------------------------------------------------------------------------\r
  38 |    LOCAL FUNCTION PROTOTYPES:                                                                                         |\r
  39 ---------------------------------------------------------------------------*/\r
  40 static GstPadProbeReturn __mmplayer_video_capture_probe (GstPad *pad, GstPadProbeInfo *info, gpointer u_data);
  41 static int  __mmplayer_get_video_frame_from_buffer(mm_player_t* player, GstPad *pad, GstBuffer *buffer);
  42 static gpointer __mmplayer_capture_thread(gpointer data);\r
  43 static void __csc_tiled_to_linear_crop(unsigned char *yuv420_dest, unsigned char *nv12t_src, int yuv420_width, int yuv420_height, int left, int top, int right, int buttom);\r
  44 static int __tile_4x2_read(int x_size, int y_size, int x_pos, int y_pos);\r
  45 static int __mm_player_convert_colorspace(mm_player_t* player, unsigned char* src_data, mm_util_img_format src_fmt, unsigned int src_w, unsigned int src_h, mm_util_img_format dst_fmt);\r
  46 \r
  47 /*===========================================================================================\r
  48 |                                                                                                                                                                                       |\r
  49 |  FUNCTION DEFINITIONS                                                                                                                                         |\r
  50 |                                                                                                                                                                                       |\r
  51 ========================================================================================== */\r
  52 int\r
  53 _mmplayer_initialize_video_capture(mm_player_t* player)\r
  54 {\r
  55         return_val_if_fail ( player, MM_ERROR_PLAYER_NOT_INITIALIZED );\r
  56         /* create capture mutex */\r
  57         player->capture_thread_mutex = g_mutex_new();\r
  58         if ( ! player->capture_thread_mutex )\r
  59         {\r
  60                 debug_critical("Cannot create capture mutex");\r
  61                 goto ERROR;\r
  62         }\r
  63 \r
  64         /* create capture cond */\r
  65         player->capture_thread_cond = g_cond_new();\r
  66         if ( ! player->capture_thread_cond )\r
  67         {\r
  68                 debug_critical("Cannot create capture cond");\r
  69                 goto ERROR;\r
  70         }\r
  71 \r
  72         player->capture_thread_exit = FALSE;\r
  73 \r
  74         /* create video capture thread */\r
  75         player->capture_thread =\r
  76                 g_thread_create (__mmplayer_capture_thread, (gpointer)player, TRUE, NULL);\r
  77         if ( ! player->capture_thread )\r
  78         {\r
  79                 goto ERROR;\r
  80         }\r
  81 \r
  82         return MM_ERROR_NONE;\r
  83 \r
  84 ERROR:\r
  85         /* capture thread */\r
  86         if ( player->capture_thread_mutex )\r
  87                 g_mutex_free ( player->capture_thread_mutex );\r
  88 \r
  89         if ( player->capture_thread_cond )\r
  90                 g_cond_free ( player->capture_thread_cond );\r
  91 \r
  92         return MM_ERROR_PLAYER_INTERNAL;\r
  93 }\r
  94 \r
  95 int\r
  96 _mmplayer_release_video_capture(mm_player_t* player)\r
  97 {\r
  98         return_val_if_fail ( player, MM_ERROR_PLAYER_NOT_INITIALIZED );\r
  99         /* release capture thread */\r
 100         if ( player->capture_thread_cond &&\r
 101                  player->capture_thread_mutex &&\r
 102                  player->capture_thread )\r
 103         {\r
 104                 g_mutex_lock(player->capture_thread_mutex);\r
 105                 player->capture_thread_exit = TRUE;\r
 106                 g_cond_signal( player->capture_thread_cond );\r
 107                 g_mutex_unlock(player->capture_thread_mutex);\r
 108 \r
 109                 debug_log("waitting for capture thread exit");\r
 110                 g_thread_join ( player->capture_thread );\r
 111                 g_mutex_free ( player->capture_thread_mutex );\r
 112                 g_cond_free ( player->capture_thread_cond );\r
 113                 debug_log("capture thread released");\r
 114         }\r
 115 \r
 116         return MM_ERROR_NONE;\r
 117 }\r
 118 \r
 119 int\r
 120 _mmplayer_do_video_capture(MMHandleType hplayer)\r
 121 {\r
 122         mm_player_t* player = (mm_player_t*) hplayer;\r
 123         int ret = MM_ERROR_NONE;\r
 124         GstPad *pad = NULL;\r
 125 \r
 126         debug_fenter();\r
 127 \r
 128         return_val_if_fail(player && player->pipeline, MM_ERROR_PLAYER_NOT_INITIALIZED);\r
 129 \r
 130         /* capturing or not */\r
 131         if (player->video_capture_cb_probe_id || player->capture.data || player->captured.a[0] || player->captured.a[1])\r
 132         {\r
 133                 debug_warning("capturing... we can't do any more");\r
 134                 return MM_ERROR_PLAYER_INVALID_STATE;\r
 135         }\r
 136 \r
 137         /* check if video pipeline is linked or not */\r
 138         if (!player->pipeline->videobin || !player->sent_bos)\r
 139         {\r
 140                 debug_warning("not ready to capture");\r
 141                 return MM_ERROR_PLAYER_INVALID_STATE;\r
 142         }\r
 143 \r
 144         pad = gst_element_get_static_pad(player->pipeline->videobin[MMPLAYER_V_SINK].gst, "sink" );
 145         if (player->state != MM_PLAYER_STATE_PLAYING)\r
 146         {\r
 147                 if (player->state == MM_PLAYER_STATE_PAUSED) // get last buffer from video sink\r
 148                 {\r
 149                         GstSample *sample = NULL;
 150                         g_object_get(player->pipeline->videobin[MMPLAYER_V_SINK].gst, "last-sample", &sample, NULL);
 151                         if (sample)
 152                         {
 153                         GstBuffer *buf = NULL;\r
 154                         buf = gst_sample_get_buffer(sample);
 155                         if (buf)\r
 156                         {\r
 157                                 ret = __mmplayer_get_video_frame_from_buffer(player, pad, buf);
 158                                 gst_buffer_unref(buf);\r
 159                         }
 160                         gst_sample_unref(sample);
 161                         }\r
 162                         return ret;\r
 163                 }\r
 164                 else\r
 165                 {\r
 166                         debug_warning("invalid state(%d) to capture", player->state);\r
 167                         return MM_ERROR_PLAYER_INVALID_STATE;\r
 168                 }\r
 169         }\r
 170 \r
 171         /* register probe */\r
 172         player->video_capture_cb_probe_id = gst_pad_add_probe (pad, GST_PAD_PROBE_TYPE_BUFFER,\r
 173                 __mmplayer_video_capture_probe, player, NULL);\r
 174 \r
 175         gst_object_unref(GST_OBJECT(pad));\r
 176         pad = NULL;\r
 177         debug_fleave();\r
 178 \r
 179         return ret;\r
 180 }\r
 181 \r
 182 static gpointer\r
 183 __mmplayer_capture_thread(gpointer data)\r
 184 {\r
 185         mm_player_t* player = (mm_player_t*) data;\r
 186         MMMessageParamType msg = {0, };\r
 187         unsigned char * linear_y_plane = NULL;\r
 188         unsigned char * linear_uv_plane = NULL;\r
 189 \r
 190         return_val_if_fail(player, NULL);\r
 191 \r
 192         while (!player->capture_thread_exit)\r
 193         {\r
 194                 debug_log("capture thread started. waiting for signal");\r
 195 \r
 196                 g_mutex_lock(player->capture_thread_mutex);\r
 197                 g_cond_wait( player->capture_thread_cond, player->capture_thread_mutex );\r
 198 \r
 199                 if ( player->capture_thread_exit )\r
 200                 {\r
 201                         debug_log("exiting capture thread");\r
 202                         goto EXIT;\r
 203                 }\r
 204                 debug_log("capture thread is recieved signal");\r
 205 \r
 206                 /* NOTE: Don't use MMPLAYER_CMD_LOCK() here.\r
 207                  * Because deadlock can be happened if other player api is used in message callback.\r
 208                  */\r
 209                 if (player->video_cs == MM_PLAYER_COLORSPACE_NV12_TILED)\r
 210                 {\r
 211                         /* Colorspace conversion : NV12T-> NV12-> RGB888 */\r
 212                         int ret = 0;\r
 213                         int linear_y_plane_size;\r
 214                         int linear_uv_plane_size;\r
 215                         unsigned char * src_buffer = NULL;\r
 216 \r
 217                         debug_log("w[0]=%d, w[1]=%d", player->captured.w[0], player->captured.w[1]);\r
 218                         debug_log("h[0]=%d, h[1]=%d", player->captured.h[0], player->captured.h[1]);\r
 219                         debug_log("s[0]=%d, s[1]=%d", player->captured.s[0], player->captured.s[1]);\r
 220                         debug_log("e[0]=%d, e[1]=%d", player->captured.e[0], player->captured.e[1]);\r
 221                         debug_log("a[0]=%p, a[1]=%p", player->captured.a[0], player->captured.a[1]);\r
 222 \r
 223                         #if 0\r
 224                         if (mm_attrs_get_int_by_name(player->attrs, "content_video_width", &(player->captured.w[0])) != MM_ERROR_NONE)\r
 225                         {\r
 226                                 debug_error("failed to get content width attribute");\r
 227                                 goto ERROR;\r
 228                         }\r
 229 \r
 230                         if (mm_attrs_get_int_by_name(player->attrs, "content_video_height", &(player->captured.h[0])) != MM_ERROR_NONE)\r
 231                         {\r
 232                                 debug_error("failed to get content height attribute");\r
 233                                 goto ERROR;\r
 234                         }\r
 235                         #endif\r
 236 \r
 237                         linear_y_plane_size = (player->captured.w[0] * player->captured.h[0]);\r
 238                         linear_uv_plane_size = (player->captured.w[0] * player->captured.h[0]/2);\r
 239 \r
 240                         linear_y_plane = (unsigned char*) g_try_malloc(linear_y_plane_size);\r
 241                         if (linear_y_plane == NULL)\r
 242                         {\r
 243                                 msg.code = MM_ERROR_PLAYER_NO_FREE_SPACE;\r
 244                                 goto ERROR;\r
 245                         }\r
 246 \r
 247                         linear_uv_plane = (unsigned char*) g_try_malloc(linear_uv_plane_size);\r
 248                         if (linear_uv_plane == NULL)\r
 249                         {\r
 250                                 msg.code = MM_ERROR_PLAYER_NO_FREE_SPACE;\r
 251                                 goto ERROR;\r
 252                         }\r
 253                         /* NV12 tiled to linear */\r
 254                         __csc_tiled_to_linear_crop(linear_y_plane, player->captured.a[0], player->captured.w[0], player->captured.h[0], 0,0,0,0);\r
 255                         __csc_tiled_to_linear_crop(linear_uv_plane, player->captured.a[1], player->captured.w[0], player->captured.h[0]/2, 0,0,0,0);\r
 256 \r
 257                         MMPLAYER_FREEIF(player->captured.a[0]);\r
 258                         MMPLAYER_FREEIF(player->captured.a[1]);\r
 259 \r
 260                         src_buffer = (unsigned char*) g_try_malloc(linear_y_plane_size+linear_uv_plane_size);\r
 261 \r
 262                         if (src_buffer == NULL)\r
 263                         {\r
 264                                 msg.code = MM_ERROR_PLAYER_NO_FREE_SPACE;\r
 265                                 goto ERROR;\r
 266                         }\r
 267                         memset(src_buffer, 0x00, linear_y_plane_size+linear_uv_plane_size);\r
 268                         memcpy(src_buffer, linear_y_plane, linear_y_plane_size);\r
 269                         memcpy(src_buffer+linear_y_plane_size, linear_uv_plane, linear_uv_plane_size);\r
 270 \r
 271                         /* NV12 linear to RGB888 */\r
 272                         ret = __mm_player_convert_colorspace(player, src_buffer, MM_UTIL_IMG_FMT_NV12,\r
 273                                 player->captured.w[0], player->captured.h[0], MM_UTIL_IMG_FMT_RGB888);\r
 274 \r
 275                         if (ret != MM_ERROR_NONE)\r
 276                         {\r
 277                                 debug_error("failed to convert nv12 linear");\r
 278                                 goto ERROR;\r
 279                         }\r
 280                         /* clean */\r
 281                         MMPLAYER_FREEIF(src_buffer);\r
 282                         MMPLAYER_FREEIF(linear_y_plane);\r
 283                         MMPLAYER_FREEIF(linear_uv_plane);\r
 284                 }\r
 285 \r
 286                 player->capture.fmt = MM_PLAYER_COLORSPACE_RGB888;\r
 287                 msg.data = &player->capture;\r
 288                 msg.size = player->capture.size;\r
 289 \r
 290                 if (player->cmd >= MMPLAYER_COMMAND_START)\r
 291                 {\r
 292                         MMPLAYER_POST_MSG( player, MM_MESSAGE_VIDEO_CAPTURED, &msg );\r
 293                         debug_log("returned from capture message callback");\r
 294                 }\r
 295 \r
 296                 g_mutex_unlock(player->capture_thread_mutex);\r
 297 \r
 298                 //MMPLAYER_FREEIF(player->capture.data);\r
 299                 continue;\r
 300 ERROR:\r
 301                 if (player->video_cs == MM_PLAYER_COLORSPACE_NV12_TILED)\r
 302                 {\r
 303                         /* clean */\r
 304                         MMPLAYER_FREEIF(linear_y_plane);\r
 305                         MMPLAYER_FREEIF(linear_uv_plane);\r
 306                         MMPLAYER_FREEIF(player->captured.a[0]);\r
 307                         MMPLAYER_FREEIF(player->captured.a[1]);\r
 308                 }\r
 309 \r
 310                 msg.union_type = MM_MSG_UNION_CODE;\r
 311 \r
 312                 g_mutex_unlock(player->capture_thread_mutex);\r
 313                 MMPLAYER_POST_MSG( player, MM_MESSAGE_VIDEO_NOT_CAPTURED, &msg );\r
 314         }\r
 315         return NULL;\r
 316 EXIT:\r
 317         g_mutex_unlock(player->capture_thread_mutex);\r
 318         return NULL;\r
 319 }\r
 320 \r
 321 /**\r
 322   * The output is fixed as RGB888\r
 323   */\r
 324 static int\r
 325 __mmplayer_get_video_frame_from_buffer(mm_player_t* player, GstPad *pad, GstBuffer *buffer)
 326 {\r
 327         gint yplane_size = 0;\r
 328         gint uvplane_size = 0;\r
 329         gint src_width = 0;\r
 330         gint src_height = 0;\r
 331         GstCaps *caps = NULL;\r
 332         GstStructure *structure = NULL;\r
 333     GstMapInfo mapinfo = GST_MAP_INFO_INIT;
 334     GstMemory *memory = 0;
 335         mm_util_img_format src_fmt = MM_UTIL_IMG_FMT_YUV420;\r
 336         mm_util_img_format dst_fmt = MM_UTIL_IMG_FMT_RGB888; // fixed\r
 337 \r
 338         debug_fenter();\r
 339 \r
 340         return_val_if_fail ( player, MM_ERROR_PLAYER_NOT_INITIALIZED );\r
 341         return_val_if_fail ( buffer, MM_ERROR_INVALID_ARGUMENT );\r
 342 \r
 343         /* get fourcc */\r
 344         caps = gst_pad_get_current_caps(pad);
 345 \r
 346         return_val_if_fail ( caps, MM_ERROR_INVALID_ARGUMENT );\r
 347         debug_log("caps to capture: %s\n", gst_caps_to_string(caps));\r
 348 \r
 349         structure = gst_caps_get_structure (caps, 0);\r
 350 \r
 351         return_val_if_fail (structure != NULL, MM_ERROR_PLAYER_INTERNAL);\r
 352 \r
 353         /* init capture image buffer */\r
 354         memset(&player->capture, 0x00, sizeof(MMPlayerVideoCapture));\r
 355 \r
 356         gst_structure_get_int (structure, "width", &src_width);\r
 357         gst_structure_get_int (structure, "height", &src_height);\r
 358 \r
 359         /* check rgb or yuv */\r
 360         if (gst_structure_has_name(structure, "video/x-raw"))
 361         {\r
 362                 /* NV12T */
 363                 if(!g_strcmp0(gst_structure_get_string(structure, "format"), "ST12"))
 364                 {\r
 365                         debug_msg ("captured format is ST12\n");
 366
 367                         MMPlayerMPlaneImage *proved = NULL;\r
 368                         player->video_cs = MM_PLAYER_COLORSPACE_NV12_TILED;\r
 369 \r
 370                         /* get video frame info from proved buffer */\r
 371                         memory = gst_buffer_get_memory(buffer, 1);
 372                         gst_memory_map(memory, &mapinfo, GST_MAP_READ);
 373                         proved = (MMPlayerMPlaneImage *)mapinfo.data;
 374                         gst_memory_unmap(memory, &mapinfo);
 375 \r
 376                         if ( !proved || !proved->a[0] || !proved->a[1] )
 377                                 return MM_ERROR_PLAYER_INTERNAL;
 378 \r
 379                         yplane_size = proved->y_size;
 380                         uvplane_size = proved->uv_size;
 381 \r
 382                         debug_msg ("yplane_size=%d, uvplane_size=%d\n",yplane_size,uvplane_size);
 383                         memset(&player->captured, 0x00, sizeof(MMPlayerMPlaneImage));
 384                         memcpy(&player->captured, proved, sizeof(MMPlayerMPlaneImage));
 385 \r
 386                         player->captured.a[0] = g_try_malloc(yplane_size);\r
 387                         if ( !player->captured.a[0] )\r
 388                                 return MM_ERROR_SOUND_NO_FREE_SPACE;\r
 389 \r
 390                         player->captured.a[1] = g_try_malloc(uvplane_size);\r
 391                         if ( !player->captured.a[1] )\r
 392                                 return MM_ERROR_SOUND_NO_FREE_SPACE;\r
 393 \r
 394                         memcpy(player->captured.a[0], proved->a[0], yplane_size);\r
 395                         memcpy(player->captured.a[1], proved->a[1], uvplane_size);\r
 396                         goto DONE;\r
 397                 }\r
 398                 else\r
 399                 {\r
 400                         GstVideoInfo format_info;
 401                         gst_video_info_from_caps(&format_info, caps);
 402                         switch (GST_VIDEO_INFO_FORMAT(&format_info))\r
 403                         {\r
 404                                 case GST_VIDEO_FORMAT_I420:
 405                                         src_fmt = MM_UTIL_IMG_FMT_I420;
 406                                         break;
 407 \r
 408                                 case GST_VIDEO_FORMAT_BGRA:
 409                                         src_fmt = MM_UTIL_IMG_FMT_BGRA8888;
 410                                         break;
 411 \r
 412                                 case GST_VIDEO_FORMAT_BGRx:
 413                                         src_fmt = MM_UTIL_IMG_FMT_BGRX8888;
 414                                         break;
 415 \r
 416                                 default:
 417                                         goto UNKNOWN;
 418                                         break;
 419                         }\r
 420                 }\r
 421         }\r
 422         else\r
 423         {\r
 424         goto UNKNOWN;\r
 425         }\r
 426         gst_buffer_map(buffer, &mapinfo, GST_MAP_READ);
 427         __mm_player_convert_colorspace(player, mapinfo.data, src_fmt, src_width, src_height, dst_fmt);
 428         gst_buffer_unmap(buffer, &mapinfo);
 429 \r
 430 DONE:\r
 431         /* do convert colorspace */\r
 432         g_cond_signal( player->capture_thread_cond );\r
 433 \r
 434         debug_fleave();\r
 435 \r
 436         return MM_ERROR_NONE;\r
 437 \r
 438 UNKNOWN:\r
 439         debug_error("unknown format to capture\n");\r
 440         return MM_ERROR_PLAYER_INTERNAL;\r
 441 }\r
 442 \r
 443 static GstPadProbeReturn
 444 __mmplayer_video_capture_probe (GstPad *pad, GstPadProbeInfo *info, gpointer u_data)
 445 {\r
 446         mm_player_t* player = (mm_player_t*) u_data;\r
 447         GstBuffer *buffer = NULL;
 448         int ret = MM_ERROR_NONE;\r
 449 \r
 450         return_val_if_fail ( info->data, GST_PAD_PROBE_REMOVE);
 451         debug_fenter();\r
 452 \r
 453         buffer = gst_pad_probe_info_get_buffer(info);
 454         ret = __mmplayer_get_video_frame_from_buffer(player, pad, buffer);
 455 \r
 456         if ( ret != MM_ERROR_NONE)\r
 457         {\r
 458                 debug_error("faild to get video frame. %x\n", ret);\r
 459                 return GST_PAD_PROBE_REMOVE;
 460         }\r
 461 \r
 462         /* remove probe to be called at one time */\r
 463         if (player->video_capture_cb_probe_id)\r
 464         {\r
 465                 gst_pad_remove_probe (pad, player->video_capture_cb_probe_id);\r
 466                 player->video_capture_cb_probe_id = 0;\r
 467         }\r
 468 \r
 469         debug_fleave();\r
 470 \r
 471         return GST_PAD_PROBE_OK;
 472 }\r
 473 \r
 474 static int\r
 475 __mm_player_convert_colorspace(mm_player_t* player, unsigned char* src_data, mm_util_img_format src_fmt, unsigned int src_w, unsigned int src_h, mm_util_img_format dst_fmt)\r
 476 {\r
 477         unsigned char *dst_data = NULL;\r
 478         unsigned int dst_size;\r
 479         int ret = MM_ERROR_NONE;\r
 480 \r
 481         return_val_if_fail(player, MM_ERROR_PLAYER_INTERNAL);\r
 482         ret = mm_util_get_image_size(dst_fmt, src_w, src_h, &dst_size);\r
 483 \r
 484         if (ret != MM_ERROR_NONE)\r
 485         {\r
 486                 debug_error("failed to get image size for capture, %d\n", ret);\r
 487                 return MM_ERROR_PLAYER_INTERNAL;\r
 488         }\r
 489 \r
 490         debug_log("width: %d, height: %d to capture, dest size: %d\n", src_w, src_h, dst_size);\r
 491 \r
 492         dst_data = (unsigned char*)g_malloc0(dst_size);\r
 493 \r
 494         if (!dst_data)\r
 495         {\r
 496                 debug_error("no free space to capture\n");\r
 497                 return MM_ERROR_PLAYER_NO_FREE_SPACE;\r
 498         }\r
 499 \r
 500         ret = mm_util_convert_colorspace(src_data, src_w, src_h, src_fmt, dst_data, dst_fmt);\r
 501 \r
 502         if (ret != MM_ERROR_NONE)\r
 503         {\r
 504                 debug_error("failed to convert for capture, %d\n", ret);\r
 505                 return MM_ERROR_PLAYER_INTERNAL;\r
 506         }\r
 507 \r
 508         player->capture.size = dst_size;\r
 509         player->capture.data = dst_data;\r
 510 \r
 511         return MM_ERROR_NONE;\r
 512 }\r
 513 \r
 514 /*\r
 515  * Get tiled address of position(x,y)\r
 516  *\r
 517  * @param x_size\r
 518  *   width of tiled[in]\r
 519  *\r
 520  * @param y_size\r
 521  *   height of tiled[in]\r
 522  *\r
 523  * @param x_pos\r
 524  *   x position of tield[in]\r
 525  *\r
 526  * @param src_size\r
 527  *   y position of tield[in]\r
 528  *\r
 529  * @return\r
 530  *   address of tiled data\r
 531  */\r
 532 static int\r
 533 __tile_4x2_read(int x_size, int y_size, int x_pos, int y_pos)\r
 534 {\r
 535     int pixel_x_m1, pixel_y_m1;\r
 536     int roundup_x, roundup_y;\r
 537     int linear_addr0, linear_addr1, bank_addr ;\r
 538     int x_addr;\r
 539     int trans_addr;\r
 540 \r
 541     pixel_x_m1 = x_size -1;\r
 542     pixel_y_m1 = y_size -1;\r
 543 \r
 544     roundup_x = ((pixel_x_m1 >> 7) + 1);\r
 545     roundup_y = ((pixel_x_m1 >> 6) + 1);\r
 546 \r
 547     x_addr = x_pos >> 2;\r
 548 \r
 549     if ((y_size <= y_pos+32) && ( y_pos < y_size) &&\r
 550         (((pixel_y_m1 >> 5) & 0x1) == 0) && (((y_pos >> 5) & 0x1) == 0)) {\r
 551         linear_addr0 = (((y_pos & 0x1f) <<4) | (x_addr & 0xf));\r
 552         linear_addr1 = (((y_pos >> 6) & 0xff) * roundup_x + ((x_addr >> 6) & 0x3f));\r
 553 \r
 554         if (((x_addr >> 5) & 0x1) == ((y_pos >> 5) & 0x1))\r
 555             bank_addr = ((x_addr >> 4) & 0x1);\r
 556         else\r
 557             bank_addr = 0x2 | ((x_addr >> 4) & 0x1);\r
 558     } else {\r
 559         linear_addr0 = (((y_pos & 0x1f) << 4) | (x_addr & 0xf));\r
 560         linear_addr1 = (((y_pos >> 6) & 0xff) * roundup_x + ((x_addr >> 5) & 0x7f));\r
 561 \r
 562         if (((x_addr >> 5) & 0x1) == ((y_pos >> 5) & 0x1))\r
 563             bank_addr = ((x_addr >> 4) & 0x1);\r
 564         else\r
 565             bank_addr = 0x2 | ((x_addr >> 4) & 0x1);\r
 566     }\r
 567 \r
 568     linear_addr0 = linear_addr0 << 2;\r
 569     trans_addr = (linear_addr1 <<13) | (bank_addr << 11) | linear_addr0;\r
 570 \r
 571     return trans_addr;\r
 572 }\r
 573 \r
 574 /*\r
 575  * Converts tiled data to linear\r
 576  * Crops left, top, right, buttom\r
 577  * 1. Y of NV12T to Y of YUV420P\r
 578  * 2. Y of NV12T to Y of YUV420S\r
 579  * 3. UV of NV12T to UV of YUV420S\r
 580  *\r
 581  * @param yuv420_dest\r
 582  *   Y or UV plane address of YUV420[out]\r
 583  *\r
 584  * @param nv12t_src\r
 585  *   Y or UV plane address of NV12T[in]\r
 586  *\r
 587  * @param yuv420_width\r
 588  *   Width of YUV420[in]\r
 589  *\r
 590  * @param yuv420_height\r
 591  *   Y: Height of YUV420, UV: Height/2 of YUV420[in]\r
 592  *\r
 593  * @param left\r
 594  *   Crop size of left\r
 595  *\r
 596  * @param top\r
 597  *   Crop size of top\r
 598  *\r
 599  * @param right\r
 600  *   Crop size of right\r
 601  *\r
 602  * @param buttom\r
 603  *   Crop size of buttom\r
 604  */\r
 605 static void\r
 606 __csc_tiled_to_linear_crop(unsigned char *yuv420_dest, unsigned char *nv12t_src, int yuv420_width, int yuv420_height,\r
 607                                 int left, int top, int right, int buttom)\r
 608 {\r
 609     int i, j;\r
 610     int tiled_offset = 0, tiled_offset1 = 0;\r
 611     int linear_offset = 0;\r
 612     int temp1 = 0, temp2 = 0, temp3 = 0, temp4 = 0;\r
 613 \r
 614     temp3 = yuv420_width-right;\r
 615     temp1 = temp3-left;\r
 616     /* real width is greater than or equal 256 */\r
 617     if (temp1 >= 256) {\r
 618         for (i=top; i<yuv420_height-buttom; i=i+1) {\r
 619             j = left;\r
 620             temp3 = (j>>8)<<8;\r
 621             temp3 = temp3>>6;\r
 622             temp4 = i>>5;\r
 623             if (temp4 & 0x1) {\r
 624                 /* odd fomula: 2+x+(x>>2)<<2+x_block_num*(y-1) */\r
 625                 tiled_offset = temp4-1;\r
 626                 temp1 = ((yuv420_width+127)>>7)<<7;\r
 627                 tiled_offset = tiled_offset*(temp1>>6);\r
 628                 tiled_offset = tiled_offset+temp3;\r
 629                 tiled_offset = tiled_offset+2;\r
 630                 temp1 = (temp3>>2)<<2;\r
 631                 tiled_offset = tiled_offset+temp1;\r
 632                 tiled_offset = tiled_offset<<11;\r
 633                 tiled_offset1 = tiled_offset+2048*2;\r
 634                 temp4 = 8;\r
 635             } else {\r
 636                 temp2 = ((yuv420_height+31)>>5)<<5;\r
 637                 if ((i+32)<temp2) {\r
 638                     /* even1 fomula: x+((x+2)>>2)<<2+x_block_num*y */\r
 639                     temp1 = temp3+2;\r
 640                     temp1 = (temp1>>2)<<2;\r
 641                     tiled_offset = temp3+temp1;\r
 642                     temp1 = ((yuv420_width+127)>>7)<<7;\r
 643                     tiled_offset = tiled_offset+temp4*(temp1>>6);\r
 644                     tiled_offset = tiled_offset<<11;\r
 645                     tiled_offset1 = tiled_offset+2048*6;\r
 646                     temp4 = 8;\r
 647                 } else {\r
 648                     /* even2 fomula: x+x_block_num*y */\r
 649                     temp1 = ((yuv420_width+127)>>7)<<7;\r
 650                     tiled_offset = temp4*(temp1>>6);\r
 651                     tiled_offset = tiled_offset+temp3;\r
 652                     tiled_offset = tiled_offset<<11;\r
 653                     tiled_offset1 = tiled_offset+2048*2;\r
 654                     temp4 = 4;\r
 655                 }\r
 656             }\r
 657 \r
 658             temp1 = i&0x1F;\r
 659             tiled_offset = tiled_offset+64*(temp1);\r
 660             tiled_offset1 = tiled_offset1+64*(temp1);\r
 661             temp2 = yuv420_width-left-right;\r
 662             linear_offset = temp2*(i-top);\r
 663             temp3 = ((j+256)>>8)<<8;\r
 664             temp3 = temp3-j;\r
 665             temp1 = left&0x3F;\r
 666             if (temp3 > 192) {\r
 667                 memcpy(yuv420_dest+linear_offset, nv12t_src+tiled_offset+temp1, 64-temp1);\r
 668                 temp2 = ((left+63)>>6)<<6;\r
 669                 temp3 = ((yuv420_width-right)>>6)<<6;\r
 670                 if (temp2 == temp3) {\r
 671                     temp2 = yuv420_width-right-(64-temp1);\r
 672                 }\r
 673                 memcpy(yuv420_dest+linear_offset+64-temp1, nv12t_src+tiled_offset+2048, 64);\r
 674                 memcpy(yuv420_dest+linear_offset+128-temp1, nv12t_src+tiled_offset1, 64);\r
 675                 memcpy(yuv420_dest+linear_offset+192-temp1, nv12t_src+tiled_offset1+2048, 64);\r
 676                 linear_offset = linear_offset+256-temp1;\r
 677             } else if (temp3 > 128) {\r
 678                 memcpy(yuv420_dest+linear_offset, nv12t_src+tiled_offset+2048+temp1, 64-temp1);\r
 679                 memcpy(yuv420_dest+linear_offset+64-temp1, nv12t_src+tiled_offset1, 64);\r
 680                 memcpy(yuv420_dest+linear_offset+128-temp1, nv12t_src+tiled_offset1+2048, 64);\r
 681                 linear_offset = linear_offset+192-temp1;\r
 682             } else if (temp3 > 64) {\r
 683                 memcpy(yuv420_dest+linear_offset, nv12t_src+tiled_offset1+temp1, 64-temp1);\r
 684                 memcpy(yuv420_dest+linear_offset+64-temp1, nv12t_src+tiled_offset1+2048, 64);\r
 685                 linear_offset = linear_offset+128-temp1;\r
 686             } else if (temp3 > 0) {\r
 687                 memcpy(yuv420_dest+linear_offset, nv12t_src+tiled_offset1+2048+temp1, 64-temp1);\r
 688                 linear_offset = linear_offset+64-temp1;\r
 689             }\r
 690 \r
 691             tiled_offset = tiled_offset+temp4*2048;\r
 692             j = (left>>8)<<8;\r
 693             j = j + 256;\r
 694             temp2 = yuv420_width-right-256;\r
 695             for (; j<=temp2; j=j+256) {\r
 696                 memcpy(yuv420_dest+linear_offset, nv12t_src+tiled_offset, 64);\r
 697                 tiled_offset1 = tiled_offset1+temp4*2048;\r
 698                 memcpy(yuv420_dest+linear_offset+64, nv12t_src+tiled_offset+2048, 64);\r
 699                 memcpy(yuv420_dest+linear_offset+128, nv12t_src+tiled_offset1, 64);\r
 700                 tiled_offset = tiled_offset+temp4*2048;\r
 701                 memcpy(yuv420_dest+linear_offset+192, nv12t_src+tiled_offset1+2048, 64);\r
 702                 linear_offset = linear_offset+256;\r
 703             }\r
 704 \r
 705             tiled_offset1 = tiled_offset1+temp4*2048;\r
 706             temp2 = yuv420_width-right-j;\r
 707             if (temp2 > 192) {\r
 708                 memcpy(yuv420_dest+linear_offset, nv12t_src+tiled_offset, 64);\r
 709                 memcpy(yuv420_dest+linear_offset+64, nv12t_src+tiled_offset+2048, 64);\r
 710                 memcpy(yuv420_dest+linear_offset+128, nv12t_src+tiled_offset1, 64);\r
 711                 memcpy(yuv420_dest+linear_offset+192, nv12t_src+tiled_offset1+2048, temp2-192);\r
 712             } else if (temp2 > 128) {\r
 713                 memcpy(yuv420_dest+linear_offset, nv12t_src+tiled_offset, 64);\r
 714                 memcpy(yuv420_dest+linear_offset+64, nv12t_src+tiled_offset+2048, 64);\r
 715                 memcpy(yuv420_dest+linear_offset+128, nv12t_src+tiled_offset1, temp2-128);\r
 716             } else if (temp2 > 64) {\r
 717                 memcpy(yuv420_dest+linear_offset, nv12t_src+tiled_offset, 64);\r
 718                 memcpy(yuv420_dest+linear_offset+64, nv12t_src+tiled_offset+2048, temp2-64);\r
 719             } else {\r
 720                 memcpy(yuv420_dest+linear_offset, nv12t_src+tiled_offset, temp2);\r
 721             }\r
 722         }\r
 723     } else if (temp1 >= 64) {\r
 724         for (i=top; i<(yuv420_height-buttom); i=i+1) {\r
 725             j = left;\r
 726             tiled_offset = __tile_4x2_read(yuv420_width, yuv420_height, j, i);\r
 727             temp2 = ((j+64)>>6)<<6;\r
 728             temp2 = temp2-j;\r
 729             linear_offset = temp1*(i-top);\r
 730             temp4 = j&0x3;\r
 731             tiled_offset = tiled_offset+temp4;\r
 732             memcpy(yuv420_dest+linear_offset, nv12t_src+tiled_offset, temp2);\r
 733             linear_offset = linear_offset+temp2;\r
 734             j = j+temp2;\r
 735             if ((j+64) <= temp3) {\r
 736                 tiled_offset = __tile_4x2_read(yuv420_width, yuv420_height, j, i);\r
 737                 memcpy(yuv420_dest+linear_offset, nv12t_src+tiled_offset, 64);\r
 738                 linear_offset = linear_offset+64;\r
 739                 j = j+64;\r
 740             }\r
 741             if ((j+64) <= temp3) {\r
 742                 tiled_offset = __tile_4x2_read(yuv420_width, yuv420_height, j, i);\r
 743                 memcpy(yuv420_dest+linear_offset, nv12t_src+tiled_offset, 64);\r
 744                 linear_offset = linear_offset+64;\r
 745                 j = j+64;\r
 746             }\r
 747             if (j < temp3) {\r
 748                 tiled_offset = __tile_4x2_read(yuv420_width, yuv420_height, j, i);\r
 749                 temp2 = temp3-j;\r
 750                 memcpy(yuv420_dest+linear_offset, nv12t_src+tiled_offset, temp2);\r
 751             }\r
 752         }\r
 753     } else {\r
 754         for (i=top; i<(yuv420_height-buttom); i=i+1) {\r
 755             linear_offset = temp1*(i-top);\r
 756             for (j=left; j<(yuv420_width-right); j=j+2) {\r
 757                 tiled_offset = __tile_4x2_read(yuv420_width, yuv420_height, j, i);\r
 758                 temp4 = j&0x3;\r
 759                 tiled_offset = tiled_offset+temp4;\r
 760                 memcpy(yuv420_dest+linear_offset, nv12t_src+tiled_offset, 2);\r
 761                 linear_offset = linear_offset+2;\r
 762             }\r
 763         }\r
 764     }\r
 765 }\r