4 * Copyright(c) 2000 - 2011 Samsung Electronics Co., Ltd. All rights reserved.
6 * Contact: JongHyuk Choi <jhchoi.choi@samsung.com>, YeJin Cho <cho.yejin@samsung.com>,
7 * Seungbae Shin <seungbae.shin@samsung.com>, YoungHwan An <younghwan_.an@samsung.com>
9 * Licensed under the Apache License, Version 2.0(the "License");
10 * you may not use this file except in compliance with the License.
11 * You may obtain a copy of the License at
13 * http://www.apache.org/licenses/LICENSE-2.0
15 * Unless required by applicable law or agreed to in writing, software
16 * distributed under the License is distributed on an "AS IS" BASIS,
17 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
18 * See the License for the specific language governing permissions and
19 * limitations under the License.
23 /*===========================================================================================
27 ========================================================================================== */
29 #include "mm_player_utils.h"
30 #include "mm_player_capture.h"
31 #include "mm_player_priv.h"
33 #include <mm_util_imgp.h>
34 #include <gst/video/video-info.h>
36 /*---------------------------------------------------------------------------
37 | LOCAL VARIABLE DEFINITIONS for internal |
38 ---------------------------------------------------------------------------*/
40 /*---------------------------------------------------------------------------
41 | LOCAL FUNCTION PROTOTYPES: |
42 ---------------------------------------------------------------------------*/
43 static GstPadProbeReturn __mmplayer_video_capture_probe(GstPad *pad, GstPadProbeInfo *info, gpointer u_data);
44 static int __mmplayer_get_video_frame_from_buffer(mm_player_t* player, GstPad *pad, GstBuffer *buffer);
45 static gpointer __mmplayer_capture_thread(gpointer data);
46 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);
47 static int __tile_4x2_read(int x_size, int y_size, int x_pos, int y_pos);
48 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);
50 /*===========================================================================================
52 | FUNCTION DEFINITIONS |
54 ========================================================================================== */
56 _mmplayer_initialize_video_capture(mm_player_t* player)
58 int ret = MM_ERROR_NONE;
59 MMPLAYER_RETURN_VAL_IF_FAIL(player, MM_ERROR_PLAYER_NOT_INITIALIZED);
60 /* create capture mutex */
61 g_mutex_init(&player->capture_thread_mutex);
63 /* create capture cond */
64 g_cond_init(&player->capture_thread_cond);
67 player->capture_thread_exit = FALSE;
69 /* create video capture thread */
70 player->capture_thread =
71 g_thread_try_new("capture_thread", __mmplayer_capture_thread, (gpointer)player, NULL);
73 if (!player->capture_thread) {
74 ret = MM_ERROR_PLAYER_RESOURCE_LIMIT;
82 g_mutex_clear(&player->capture_thread_mutex);
84 g_cond_clear(&player->capture_thread_cond);
90 _mmplayer_release_video_capture(mm_player_t* player)
92 MMPLAYER_RETURN_VAL_IF_FAIL(player, MM_ERROR_PLAYER_NOT_INITIALIZED);
93 /* release capture thread */
94 MMPLAYER_CAPTURE_THREAD_LOCK(player);
95 player->capture_thread_exit = TRUE;
96 MMPLAYER_CAPTURE_THREAD_SIGNAL(player);
97 MMPLAYER_CAPTURE_THREAD_UNLOCK(player);
99 LOGD("waitting for capture thread exit");
100 g_thread_join(player->capture_thread);
101 g_mutex_clear(&player->capture_thread_mutex);
102 g_cond_clear(&player->capture_thread_cond);
103 LOGD("capture thread released");
105 return MM_ERROR_NONE;
109 _mmplayer_do_video_capture(MMHandleType hplayer)
111 mm_player_t* player = (mm_player_t*) hplayer;
112 int ret = MM_ERROR_NONE;
117 MMPLAYER_RETURN_VAL_IF_FAIL(player && player->pipeline, MM_ERROR_PLAYER_NOT_INITIALIZED);
119 /* capturing or not */
120 if (player->video_capture_cb_probe_id || player->capture.data
121 || player->captured.data[0] || player->captured.data[1]) {
122 LOGW("capturing... we can't do any more");
123 return MM_ERROR_PLAYER_INVALID_STATE;
125 gint surface_type = 0;
126 mm_attrs_get_int_by_name(player->attrs, "display_surface_type", &surface_type);
128 /* check if video pipeline is linked or not */
129 if (!player->pipeline->videobin) {
130 if (surface_type == MM_DISPLAY_SURFACE_REMOTE && player->video_fakesink) {
131 LOGD("it is evas surface type.");
133 LOGW("not ready to capture");
134 return MM_ERROR_PLAYER_INVALID_STATE;
138 if (player->pipeline->videobin)
139 pad = gst_element_get_static_pad(player->pipeline->videobin[MMPLAYER_V_SINK].gst, "sink");
141 pad = gst_element_get_static_pad(player->video_fakesink, "sink");
143 if (player->state != MM_PLAYER_STATE_PLAYING) {
144 if (player->state == MM_PLAYER_STATE_PAUSED) {
145 // get last buffer from video sink
146 GstSample *sample = NULL;
148 gst_element_get_state(player->pipeline->mainbin[MMPLAYER_M_PIPE].gst, NULL, NULL, 5 * GST_SECOND); //5 seconds
150 if (player->pipeline->videobin)
151 g_object_get(player->pipeline->videobin[MMPLAYER_V_SINK].gst, "last-sample", &sample, NULL);
153 g_object_get(player->video_fakesink, "last-sample", &sample, NULL);
156 GstBuffer *buf = NULL;
157 buf = gst_sample_get_buffer(sample);
159 if (__mmplayer_get_video_frame_from_buffer(player, pad, buf) != MM_ERROR_NONE)
160 ret = MM_ERROR_PLAYER_INTERNAL;
162 LOGW("failed to get video frame");
164 gst_sample_unref(sample);
168 LOGW("invalid state(%d) to capture", player->state);
169 return MM_ERROR_PLAYER_INVALID_STATE;
174 player->video_capture_cb_probe_id = gst_pad_add_probe(pad, GST_PAD_PROBE_TYPE_BUFFER,
175 __mmplayer_video_capture_probe, player, NULL);
177 gst_object_unref(GST_OBJECT(pad));
186 __mmplayer_handle_orientation(mm_player_t* player, int orientation, int format)
188 unsigned char *src_buffer = NULL;
189 int ret = MM_ERROR_NONE;
190 unsigned char *dst_frame = NULL;
191 unsigned int dst_width = 0;
192 unsigned int dst_height = 0;
193 unsigned int dst_size = 0;
194 mm_util_img_rotate_type rot_enum = MM_UTIL_ROTATE_NUM;
196 player->capture.orientation = orientation;
198 if (orientation == 90 || orientation == 270) {
199 dst_width = player->captured.height[0];
200 dst_height = player->captured.width[0];
201 LOGD("interchange width & height");
202 } else if (orientation == 180) {
203 dst_width = player->captured.width[0];
204 dst_height = player->captured.height[0];
205 } else if (orientation == 0) {
206 LOGE("no need handle orientation : %d", orientation);
207 player->capture.width = player->captured.width[0];
208 player->capture.height = player->captured.height[0];
209 return MM_ERROR_NONE;
211 LOGE("wrong orientation value...");
213 /* height & width will be interchanged for 90 and 270 orientation */
214 ret = mm_util_get_image_size(format, dst_width, dst_height, &dst_size);
215 if (ret != MM_ERROR_NONE) {
216 LOGE("failed to get destination frame size");
220 LOGD("before rotation : dst_width = %d and dst_height = %d", dst_width, dst_height);
222 dst_frame = (unsigned char*) malloc(dst_size);
224 LOGE("failed to allocate memory");
225 return MM_ERROR_PLAYER_NO_FREE_SPACE;
228 src_buffer = (unsigned char*)player->capture.data;
230 /* convert orientation degree into enum here */
231 switch (orientation) {
233 rot_enum = MM_UTIL_ROTATE_0;
236 rot_enum = MM_UTIL_ROTATE_90;
239 rot_enum = MM_UTIL_ROTATE_180;
242 rot_enum = MM_UTIL_ROTATE_270;
245 LOGE("wrong rotate value");
249 LOGD("source buffer for rotation = %p and rotation = %d", src_buffer, rot_enum);
251 ret = mm_util_rotate_image(src_buffer,
252 player->captured.width[0], player->captured.height[0], format,
253 dst_frame, &dst_width, &dst_height, rot_enum);
254 if (ret != MM_ERROR_NONE) {
255 LOGE("failed to do rotate image");
260 LOGD("after rotation same stride: dst_width = %d and dst_height = %d", dst_width, dst_height);
264 player->capture.data = dst_frame;
265 player->capture.size = dst_size;
266 player->capture.orientation = orientation;
267 player->capture.width = dst_width;
268 player->capture.height = dst_height;
270 player->captured.width[0] = player->captured.stride_width[0] = dst_width;
271 player->captured.height[0] = player->captured.stride_height[0] = dst_height;
278 __mmplayer_capture_thread(gpointer data)
280 mm_player_t* player = (mm_player_t*) data;
281 MMMessageParamType msg = {0, };
282 unsigned char * linear_y_plane = NULL;
283 unsigned char * linear_uv_plane = NULL;
287 MMPLAYER_RETURN_VAL_IF_FAIL(player, NULL);
289 MMPLAYER_CAPTURE_THREAD_LOCK(player);
290 while (!player->capture_thread_exit) {
291 LOGD("capture thread started. waiting for signal");
292 MMPLAYER_CAPTURE_THREAD_WAIT(player);
294 if (player->capture_thread_exit) {
295 LOGD("exiting capture thread");
298 LOGD("capture thread is received signal");
300 /* NOTE: Don't use MMPLAYER_CMD_LOCK() here.
301 * Because deadlock can be happened if other player api is used in message callback.
303 if (player->video_cs == MM_PLAYER_COLORSPACE_NV12_TILED) {
304 /* Colorspace conversion : NV12T-> NV12-> RGB888 */
306 int linear_y_plane_size;
307 int linear_uv_plane_size;
308 int width = player->captured.width[0];
309 int height = player->captured.height[0];
310 unsigned char * src_buffer = NULL;
312 linear_y_plane_size = (width * height);
313 linear_uv_plane_size = (width * height / 2);
315 linear_y_plane = (unsigned char*) g_try_malloc(linear_y_plane_size);
316 if (linear_y_plane == NULL) {
317 msg.code = MM_ERROR_PLAYER_NO_FREE_SPACE;
321 linear_uv_plane = (unsigned char*) g_try_malloc(linear_uv_plane_size);
322 if (linear_uv_plane == NULL) {
323 msg.code = MM_ERROR_PLAYER_NO_FREE_SPACE;
326 /* NV12 tiled to linear */
327 __csc_tiled_to_linear_crop(linear_y_plane,
328 player->captured.data[0], width, height, 0, 0, 0, 0);
329 __csc_tiled_to_linear_crop(linear_uv_plane,
330 player->captured.data[1], width, height / 2, 0, 0, 0, 0);
332 MMPLAYER_FREEIF(player->captured.data[0]);
333 MMPLAYER_FREEIF(player->captured.data[1]);
335 src_buffer = (unsigned char*) g_try_malloc(linear_y_plane_size+linear_uv_plane_size);
337 if (src_buffer == NULL) {
338 msg.code = MM_ERROR_PLAYER_NO_FREE_SPACE;
341 memset(src_buffer, 0x00, linear_y_plane_size+linear_uv_plane_size);
342 memcpy(src_buffer, linear_y_plane, linear_y_plane_size);
343 memcpy(src_buffer+linear_y_plane_size, linear_uv_plane, linear_uv_plane_size);
345 /* NV12 linear to RGB888 */
346 ret = __mm_player_convert_colorspace(player, src_buffer, MM_UTIL_IMG_FMT_NV12,
347 width, height, MM_UTIL_IMG_FMT_RGB888);
349 if (ret != MM_ERROR_NONE) {
350 LOGE("failed to convert nv12 linear");
354 MMPLAYER_FREEIF(src_buffer);
355 MMPLAYER_FREEIF(linear_y_plane);
356 MMPLAYER_FREEIF(linear_uv_plane);
357 } else if (MM_PLAYER_COLORSPACE_NV12 == player->video_cs) {
358 #define MM_ALIGN(x, a) (((x) +(a) - 1) & ~((a) - 1))
360 char *src_buffer = NULL;
361 /* using original width otherwises, app can't know aligned to resize */
362 int width_align = player->captured.width[0];
363 int y_size = width_align * player->captured.height[0];
364 int uv_size = width_align * player->captured.height[1];
365 int src_buffer_size = y_size + uv_size;
370 if (!src_buffer_size) {
371 LOGE("invalid data size");
375 src_buffer = (char*) g_try_malloc(src_buffer_size);
378 msg.code = MM_ERROR_PLAYER_NO_FREE_SPACE;
382 memset(src_buffer, 0x00, src_buffer_size);
384 temp = player->captured.data[0];
385 dst_buf = src_buffer;
388 for (i = 0; i < player->captured.height[0]; i++) {
389 memcpy(dst_buf, temp, width_align);
390 dst_buf += width_align;
391 temp += player->captured.stride_width[0];
394 temp = player->captured.data[1];
397 for (j = 0; j < player->captured.height[1]; j++) {
398 memcpy(dst_buf, temp, width_align);
399 dst_buf += width_align;
400 temp += player->captured.stride_width[1];
403 /* free captured buf */
404 MMPLAYER_FREEIF(player->captured.data[0]);
405 MMPLAYER_FREEIF(player->captured.data[1]);
408 ret = __mm_player_convert_colorspace(player, (unsigned char*)src_buffer, MM_UTIL_IMG_FMT_NV12,
409 width_align, player->captured.height[0], MM_UTIL_IMG_FMT_RGB888);
410 if (ret != MM_ERROR_NONE) {
411 LOGE("failed to convert nv12 linear");
416 ret = _mmplayer_get_video_rotate_angle((MMHandleType)player, &orientation);
417 if (ret != MM_ERROR_NONE) {
418 LOGE("failed to get rotation angle");
422 LOGD("orientation value = %d", orientation);
424 ret = __mmplayer_handle_orientation(player, orientation, MM_UTIL_IMG_FMT_RGB888);
425 if (ret != MM_ERROR_NONE) {
426 LOGE("failed to convert nv12 linear");
430 player->capture.fmt = MM_PLAYER_COLORSPACE_RGB888;
431 msg.data = &player->capture;
432 msg.size = player->capture.size;
433 // msg.captured_frame.width = player->capture.width;
434 // msg.captured_frame.height = player->capture.height;
435 // msg.captured_frame.orientation = player->capture.orientation;
437 if (player->cmd >= MMPLAYER_COMMAND_START) {
438 MMPLAYER_POST_MSG(player, MM_MESSAGE_VIDEO_CAPTURED, &msg);
439 LOGD("returned from capture message callback");
442 //MMPLAYER_FREEIF(player->capture.data);
445 if (player->video_cs == MM_PLAYER_COLORSPACE_NV12_TILED) {
447 MMPLAYER_FREEIF(linear_y_plane);
448 MMPLAYER_FREEIF(linear_uv_plane);
449 MMPLAYER_FREEIF(player->captured.data[0]);
450 MMPLAYER_FREEIF(player->captured.data[1]);
451 } else if (MM_PLAYER_COLORSPACE_NV12 == player->video_cs) {
452 MMPLAYER_FREEIF(player->captured.data[0]);
453 MMPLAYER_FREEIF(player->captured.data[1]);
456 msg.union_type = MM_MSG_UNION_CODE;
458 MMPLAYER_POST_MSG(player, MM_MESSAGE_VIDEO_NOT_CAPTURED, &msg);
462 MMPLAYER_CAPTURE_THREAD_UNLOCK(player);
467 * The output is fixed as RGB888
470 __mmplayer_get_video_frame_from_buffer(mm_player_t* player, GstPad *pad, GstBuffer *buffer)
472 int ret = MM_ERROR_NONE;
473 gint yplane_size = 0;
474 gint uvplane_size = 0;
477 GstCaps *caps = NULL;
478 GstStructure *structure = NULL;
479 GstMapInfo mapinfo = GST_MAP_INFO_INIT;
480 GstMemory *memory = NULL;
481 mm_util_img_format src_fmt = MM_UTIL_IMG_FMT_YUV420;
482 mm_util_img_format dst_fmt = MM_UTIL_IMG_FMT_RGB888; // fixed
486 MMPLAYER_RETURN_VAL_IF_FAIL(player, MM_ERROR_PLAYER_NOT_INITIALIZED);
487 MMPLAYER_RETURN_VAL_IF_FAIL(buffer, MM_ERROR_INVALID_ARGUMENT);
490 caps = gst_pad_get_current_caps(pad);
492 MMPLAYER_RETURN_VAL_IF_FAIL(caps, MM_ERROR_INVALID_ARGUMENT);
493 MMPLAYER_LOG_GST_CAPS_TYPE(caps);
495 structure = gst_caps_get_structure(caps, 0);
497 LOGE("cannot get structure from caps.\n");
498 ret = MM_ERROR_PLAYER_INTERNAL;
502 /* init capture image buffer */
503 memset(&player->capture, 0x00, sizeof(MMPlayerVideoCapture));
505 gst_structure_get_int(structure, "width", &src_width);
506 gst_structure_get_int(structure, "height", &src_height);
508 /* check rgb or yuv */
509 if (gst_structure_has_name(structure, "video/x-raw")) {
511 const gchar *gst_format = gst_structure_get_string(structure, "format");
512 if (!g_strcmp0(gst_format, "ST12") || !g_strcmp0(gst_format, "SN12")) {
514 LOGI("captured format is %s\n", gst_format);
516 MMVideoBuffer *proved = NULL;
517 if (!g_strcmp0(gst_format, "ST12"))
518 player->video_cs = MM_PLAYER_COLORSPACE_NV12_TILED;
520 player->video_cs = MM_PLAYER_COLORSPACE_NV12;
522 /* get video frame info from proved buffer */
523 n = gst_buffer_n_memory(buffer);
524 memory = gst_buffer_peek_memory(buffer, n-1);
525 gst_memory_map(memory, &mapinfo, GST_MAP_READ);
526 proved = (MMVideoBuffer *)mapinfo.data;
528 if (!proved || !proved->data[0] || !proved->data[1]) {
529 LOGE("fail to gst_memory_map");
530 ret = MM_ERROR_PLAYER_INTERNAL;
534 memcpy(&player->captured, proved, sizeof(MMVideoBuffer));
536 yplane_size = proved->size[0];
537 uvplane_size = proved->size[1];
538 LOGI("yplane_size=%d, uvplane_size=%d", yplane_size, uvplane_size);
540 player->captured.data[0] = g_try_malloc(yplane_size);
541 if (!player->captured.data[0]) {
542 gst_memory_unmap(memory, &mapinfo);
543 LOGE("no free space\n");
544 ret = MM_ERROR_PLAYER_NO_FREE_SPACE;
550 player->captured.data[1] = g_try_malloc(uvplane_size);
552 if (uvplane_size < proved->stride_width[1] * proved->stride_height[1]) {
553 player->captured.data[1] =
554 g_try_malloc(proved->stride_width[1] * proved->stride_height[1]);
555 uvplane_size = proved->stride_width[1] * proved->stride_height[1];
557 player->captured.data[1] = g_try_malloc(uvplane_size);
560 if (!player->captured.data[1]) {
561 LOGE("no free space\n");
562 MMPLAYER_FREEIF(player->captured.data[0]);
563 gst_memory_unmap(memory, &mapinfo);
564 ret = MM_ERROR_PLAYER_NO_FREE_SPACE;
568 LOGD("Buffer type %d", proved->type);
569 if (proved->type == MM_VIDEO_BUFFER_TYPE_TBM_BO) {
570 tbm_bo_ref(proved->handle.bo[0]);
571 tbm_bo_ref(proved->handle.bo[1]);
572 LOGD("source y : %p, size %d", proved->data[0], yplane_size);
574 memcpy(player->captured.data[0], proved->data[0], yplane_size);
576 LOGD("source uv : %p, size %d", proved->data[1], uvplane_size);
578 memcpy(player->captured.data[1], proved->data[1], uvplane_size);
580 tbm_bo_unref(proved->handle.bo[0]);
581 tbm_bo_unref(proved->handle.bo[1]);
583 LOGE("Not support video buffer type %d", proved->type);
584 MMPLAYER_FREEIF(player->captured.data[0]);
585 MMPLAYER_FREEIF(player->captured.data[1]);
586 gst_memory_unmap(memory, &mapinfo);
587 ret = MM_ERROR_PLAYER_INTERNAL;
591 gst_memory_unmap(memory, &mapinfo);
594 GstVideoInfo format_info;
595 gst_video_info_from_caps(&format_info, caps);
597 switch (GST_VIDEO_INFO_FORMAT(&format_info)) {
598 case GST_VIDEO_FORMAT_I420:
599 src_fmt = MM_UTIL_IMG_FMT_I420;
601 case GST_VIDEO_FORMAT_BGRA:
602 src_fmt = MM_UTIL_IMG_FMT_BGRA8888;
604 case GST_VIDEO_FORMAT_BGRx:
605 src_fmt = MM_UTIL_IMG_FMT_BGRX8888;
608 LOGE("unknown format to capture\n");
609 ret = MM_ERROR_PLAYER_INTERNAL;
615 LOGE("unknown format to capture\n");
616 ret = MM_ERROR_PLAYER_INTERNAL;
620 gst_buffer_map(buffer, &mapinfo, GST_MAP_READ);
621 __mm_player_convert_colorspace(player, mapinfo.data, src_fmt, src_width, src_height, dst_fmt);
622 gst_buffer_unmap(buffer, &mapinfo);
625 /* do convert colorspace */
626 MMPLAYER_CAPTURE_THREAD_SIGNAL(player);
630 gst_caps_unref(caps);
638 static GstPadProbeReturn
639 __mmplayer_video_capture_probe(GstPad *pad, GstPadProbeInfo *info, gpointer u_data)
641 mm_player_t* player = (mm_player_t*) u_data;
642 GstBuffer *buffer = NULL;
643 int ret = MM_ERROR_NONE;
645 MMPLAYER_RETURN_VAL_IF_FAIL(info->data, GST_PAD_PROBE_REMOVE);
648 buffer = gst_pad_probe_info_get_buffer(info);
649 ret = __mmplayer_get_video_frame_from_buffer(player, pad, buffer);
651 if (ret != MM_ERROR_NONE) {
652 LOGE("failed to get video frame");
653 return GST_PAD_PROBE_REMOVE;
656 /* remove probe to be called at one time */
657 if (player->video_capture_cb_probe_id) {
658 gst_pad_remove_probe(pad, player->video_capture_cb_probe_id);
659 player->video_capture_cb_probe_id = 0;
664 return GST_PAD_PROBE_OK;
668 __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)
670 unsigned char *dst_data = NULL;
671 unsigned int dst_size;
672 int ret = MM_ERROR_NONE;
674 MMPLAYER_RETURN_VAL_IF_FAIL(player, MM_ERROR_PLAYER_INTERNAL);
675 ret = mm_util_get_image_size(dst_fmt, src_w, src_h, &dst_size);
677 if (ret != MM_ERROR_NONE) {
678 LOGE("failed to get image size for capture, %d\n", ret);
679 return MM_ERROR_PLAYER_INTERNAL;
682 SECURE_LOGD("width: %d, height: %d to capture, dest size: %d\n", src_w, src_h, dst_size);
684 dst_data = (unsigned char*)g_malloc0(dst_size);
687 LOGE("no free space to capture\n");
689 return MM_ERROR_PLAYER_NO_FREE_SPACE;
692 ret = mm_util_convert_colorspace(src_data, src_w, src_h, src_fmt, dst_data, dst_fmt);
694 if (ret != MM_ERROR_NONE) {
695 LOGE("failed to convert for capture, %d\n", ret);
697 return MM_ERROR_PLAYER_INTERNAL;
700 player->capture.size = dst_size;
701 player->capture.data = dst_data;
703 return MM_ERROR_NONE;
707 * Get tiled address of position(x,y)
713 * height of tiled[in]
716 * x position of tield[in]
719 * y position of tield[in]
722 * address of tiled data
725 __tile_4x2_read(int x_size, int y_size, int x_pos, int y_pos)
727 int pixel_x_m1, pixel_y_m1;
729 int linear_addr0, linear_addr1, bank_addr ;
733 pixel_x_m1 = x_size -1;
734 pixel_y_m1 = y_size -1;
736 roundup_x = ((pixel_x_m1 >> 7) + 1);
740 if ((y_size <= y_pos+32) && (y_pos < y_size) &&
741 (((pixel_y_m1 >> 5) & 0x1) == 0) && (((y_pos >> 5) & 0x1) == 0)) {
742 linear_addr0 = (((y_pos & 0x1f) <<4) | (x_addr & 0xf));
743 linear_addr1 = (((y_pos >> 6) & 0xff) * roundup_x +((x_addr >> 6) & 0x3f));
745 if (((x_addr >> 5) & 0x1) == ((y_pos >> 5) & 0x1))
746 bank_addr = ((x_addr >> 4) & 0x1);
748 bank_addr = 0x2 | ((x_addr >> 4) & 0x1);
750 linear_addr0 = (((y_pos & 0x1f) << 4) | (x_addr & 0xf));
751 linear_addr1 = (((y_pos >> 6) & 0xff) * roundup_x +((x_addr >> 5) & 0x7f));
753 if (((x_addr >> 5) & 0x1) == ((y_pos >> 5) & 0x1))
754 bank_addr = ((x_addr >> 4) & 0x1);
756 bank_addr = 0x2 | ((x_addr >> 4) & 0x1);
759 linear_addr0 = linear_addr0 << 2;
760 trans_addr = (linear_addr1 <<13) | (bank_addr << 11) | linear_addr0;
766 * Converts tiled data to linear
767 * Crops left, top, right, buttom
768 * 1. Y of NV12T to Y of YUV420P
769 * 2. Y of NV12T to Y of YUV420S
770 * 3. UV of NV12T to UV of YUV420S
773 * Y or UV plane address of YUV420[out]
776 * Y or UV plane address of NV12T[in]
778 * @param yuv420_width
779 * Width of YUV420[in]
781 * @param yuv420_height
782 * Y: Height of YUV420, UV: Height/2 of YUV420[in]
794 * Crop size of buttom
797 __csc_tiled_to_linear_crop(unsigned char *yuv420_dest, unsigned char *nv12t_src, int yuv420_width, int yuv420_height,
798 int left, int top, int right, int buttom)
801 int tiled_offset = 0, tiled_offset1 = 0;
802 int linear_offset = 0;
803 int temp1 = 0, temp2 = 0, temp3 = 0, temp4 = 0;
805 temp3 = yuv420_width-right;
807 /* real width is greater than or equal 256 */
809 for (i = top; i < yuv420_height-buttom; i = i+1) {
815 /* odd fomula: 2+x+(x>>2)<<2+x_block_num*(y-1) */
816 tiled_offset = temp4-1;
817 temp1 = ((yuv420_width+127)>>7)<<7;
818 tiled_offset = tiled_offset*(temp1>>6);
819 tiled_offset = tiled_offset+temp3;
820 tiled_offset = tiled_offset+2;
821 temp1 = (temp3>>2)<<2;
822 tiled_offset = tiled_offset+temp1;
823 tiled_offset = tiled_offset<<11;
824 tiled_offset1 = tiled_offset+2048*2;
827 temp2 = ((yuv420_height+31)>>5)<<5;
828 if ((i+32) < temp2) {
829 /* even1 fomula: x+((x+2)>>2)<<2+x_block_num*y */
831 temp1 = (temp1>>2)<<2;
832 tiled_offset = temp3+temp1;
833 temp1 = ((yuv420_width+127)>>7)<<7;
834 tiled_offset = tiled_offset+temp4*(temp1>>6);
835 tiled_offset = tiled_offset<<11;
836 tiled_offset1 = tiled_offset+2048*6;
839 /* even2 fomula: x+x_block_num*y */
840 temp1 = ((yuv420_width+127)>>7)<<7;
841 tiled_offset = temp4*(temp1>>6);
842 tiled_offset = tiled_offset+temp3;
843 tiled_offset = tiled_offset<<11;
844 tiled_offset1 = tiled_offset+2048*2;
850 tiled_offset = tiled_offset+64*(temp1);
851 tiled_offset1 = tiled_offset1+64*(temp1);
852 temp2 = yuv420_width-left-right;
853 linear_offset = temp2*(i-top);
854 temp3 = ((j+256)>>8)<<8;
858 memcpy(yuv420_dest+linear_offset, nv12t_src+tiled_offset+temp1, 64-temp1);
859 temp2 = ((left+63)>>6)<<6;
860 temp3 = ((yuv420_width-right)>>6)<<6;
862 temp2 = yuv420_width-right-(64-temp1);
863 memcpy(yuv420_dest+linear_offset+64-temp1, nv12t_src+tiled_offset+2048, 64);
864 memcpy(yuv420_dest+linear_offset+128-temp1, nv12t_src+tiled_offset1, 64);
865 memcpy(yuv420_dest+linear_offset+192-temp1, nv12t_src+tiled_offset1+2048, 64);
866 linear_offset = linear_offset+256-temp1;
867 } else if (temp3 > 128) {
868 memcpy(yuv420_dest+linear_offset, nv12t_src+tiled_offset+2048+temp1, 64-temp1);
869 memcpy(yuv420_dest+linear_offset+64-temp1, nv12t_src+tiled_offset1, 64);
870 memcpy(yuv420_dest+linear_offset+128-temp1, nv12t_src+tiled_offset1+2048, 64);
871 linear_offset = linear_offset+192-temp1;
872 } else if (temp3 > 64) {
873 memcpy(yuv420_dest+linear_offset, nv12t_src+tiled_offset1+temp1, 64-temp1);
874 memcpy(yuv420_dest+linear_offset+64-temp1, nv12t_src+tiled_offset1+2048, 64);
875 linear_offset = linear_offset+128-temp1;
876 } else if (temp3 > 0) {
877 memcpy(yuv420_dest+linear_offset, nv12t_src+tiled_offset1+2048+temp1, 64-temp1);
878 linear_offset = linear_offset+64-temp1;
881 tiled_offset = tiled_offset+temp4*2048;
884 temp2 = yuv420_width-right-256;
885 for (; j <= temp2; j = j+256) {
886 memcpy(yuv420_dest+linear_offset, nv12t_src+tiled_offset, 64);
887 tiled_offset1 = tiled_offset1+temp4*2048;
888 memcpy(yuv420_dest+linear_offset+64, nv12t_src+tiled_offset+2048, 64);
889 memcpy(yuv420_dest+linear_offset+128, nv12t_src+tiled_offset1, 64);
890 tiled_offset = tiled_offset+temp4*2048;
891 memcpy(yuv420_dest+linear_offset+192, nv12t_src+tiled_offset1+2048, 64);
892 linear_offset = linear_offset+256;
895 tiled_offset1 = tiled_offset1+temp4*2048;
896 temp2 = yuv420_width-right-j;
898 memcpy(yuv420_dest+linear_offset, nv12t_src+tiled_offset, 64);
899 memcpy(yuv420_dest+linear_offset+64, nv12t_src+tiled_offset+2048, 64);
900 memcpy(yuv420_dest+linear_offset+128, nv12t_src+tiled_offset1, 64);
901 memcpy(yuv420_dest+linear_offset+192, nv12t_src+tiled_offset1+2048, temp2-192);
902 } else if (temp2 > 128) {
903 memcpy(yuv420_dest+linear_offset, nv12t_src+tiled_offset, 64);
904 memcpy(yuv420_dest+linear_offset+64, nv12t_src+tiled_offset+2048, 64);
905 memcpy(yuv420_dest+linear_offset+128, nv12t_src+tiled_offset1, temp2-128);
906 } else if (temp2 > 64) {
907 memcpy(yuv420_dest+linear_offset, nv12t_src+tiled_offset, 64);
908 memcpy(yuv420_dest+linear_offset+64, nv12t_src+tiled_offset+2048, temp2-64);
910 memcpy(yuv420_dest+linear_offset, nv12t_src+tiled_offset, temp2);
912 } else if (temp1 >= 64) {
913 for (i = top; i < (yuv420_height-buttom); i = i+1) {
915 tiled_offset = __tile_4x2_read(yuv420_width, yuv420_height, j, i);
916 temp2 = ((j+64)>>6)<<6;
918 linear_offset = temp1*(i-top);
920 tiled_offset = tiled_offset+temp4;
921 memcpy(yuv420_dest+linear_offset, nv12t_src+tiled_offset, temp2);
922 linear_offset = linear_offset+temp2;
924 if ((j+64) <= temp3) {
925 tiled_offset = __tile_4x2_read(yuv420_width, yuv420_height, j, i);
926 memcpy(yuv420_dest+linear_offset, nv12t_src+tiled_offset, 64);
927 linear_offset = linear_offset+64;
930 if ((j+64) <= temp3) {
931 tiled_offset = __tile_4x2_read(yuv420_width, yuv420_height, j, i);
932 memcpy(yuv420_dest+linear_offset, nv12t_src+tiled_offset, 64);
933 linear_offset = linear_offset+64;
937 tiled_offset = __tile_4x2_read(yuv420_width, yuv420_height, j, i);
939 memcpy(yuv420_dest+linear_offset, nv12t_src+tiled_offset, temp2);
943 for (i = top; i < (yuv420_height-buttom); i = i+1) {
944 linear_offset = temp1*(i-top);
945 for (j = left; j < (yuv420_width-right); j = j+2) {
946 tiled_offset = __tile_4x2_read(yuv420_width, yuv420_height, j, i);
948 tiled_offset = tiled_offset+temp4;
949 memcpy(yuv420_dest+linear_offset, nv12t_src+tiled_offset, 2);
950 linear_offset = linear_offset+2;