Unify Code of getting color space
[platform/core/multimedia/libmm-imgp-gstcs.git] / gstcs / mm_util_gstcs.c
1 /*
2  * libmm-imgp-gstcs
3  *
4  * Copyright (c) 2000 - 2011 Samsung Electronics Co., Ltd. All rights reserved.
5  *
6  * Contact: YoungHun Kim <yh8004.kim@samsung.com>
7  *
8  * Licensed under the Apache License, Version 2.0 (the "License");
9  * you may not use this file except in compliance with the License.
10  * You may obtain a copy of the License at
11  *
12  * http://www.apache.org/licenses/LICENSE-2.0
13  *
14  * Unless required by applicable law or agreed to in writing, software
15  * distributed under the License is distributed on an "AS IS" BASIS,
16  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
17  * See the License for the specific language governing permissions and
18  * limitations under the License.
19  *
20  */
21 #include "mm_util_gstcs_internal.h"
22 #include <gst/check/gstcheck.h>
23 #include <gst/video/video-format.h>
24
25 #define MM_UTIL_ROUND_UP_2(num) (((num)+1)&~1)
26 #define MM_UTIL_ROUND_UP_4(num) (((num)+3)&~3)
27 #define MM_UTIL_ROUND_UP_8(num) (((num)+7)&~7)
28 #define MM_UTIL_ROUND_UP_16(num) (((num)+15)&~15)
29
30 #define SAFE_STRCPY(dst, src, n)        g_strlcpy(dst, src, n)
31
32
33 static GstFlowReturn
34 _mm_sink_sample(GstElement * appsink, gpointer user_data)
35 {
36         GstBuffer *_buf = NULL;
37         GstSample *_sample = NULL;
38         gstreamer_s * pGstreamer_s = (gstreamer_s*) user_data;
39         _sample = gst_app_sink_pull_sample((GstAppSink*)appsink);
40         if (_sample) {
41                 _buf = gst_sample_get_buffer(_sample);
42
43                 pGstreamer_s->output_buffer = _buf;
44
45                 if (pGstreamer_s->output_buffer != NULL) {
46                         GstMapInfo mapinfo = GST_MAP_INFO_INIT;
47                         gst_buffer_map(pGstreamer_s->output_buffer, &mapinfo, GST_MAP_READ);
48                         gstcs_debug("Create Output Buffer: GST_BUFFER_DATA: %p\t GST_BUFFER_SIZE: %d", mapinfo.data, mapinfo.size);
49                         gst_buffer_unmap(pGstreamer_s->output_buffer, &mapinfo);
50                 } else {
51                         gstcs_error("ERROR -Input Prepare Buffer! Check createoutput buffer function");
52                 }
53         }
54
55         gst_buffer_ref(pGstreamer_s->output_buffer); /* when you want to avoid flushing */
56         gst_sample_unref(_sample);
57
58         return GST_FLOW_OK;
59 }
60
61 static gboolean
62 _mm_on_src_message(GstBus * bus, GstMessage * message, gpointer user_data)
63 {
64         gstreamer_s * pGstreamer_s = (gstreamer_s*) user_data;
65         switch (GST_MESSAGE_TYPE(message)) {
66         case GST_MESSAGE_EOS: {
67                 gstcs_debug("The source got dry");
68                 gst_app_src_end_of_stream(GST_APP_SRC(pGstreamer_s->appsrc));
69                 g_main_context_pop_thread_default(pGstreamer_s->context);
70                 g_main_loop_quit(pGstreamer_s->loop);
71                 break;
72                 }
73         case GST_MESSAGE_ERROR: {
74                 GError *err = NULL;
75                 gchar *dbg_info = NULL;
76
77                 gst_message_parse_error(message, &err, &dbg_info);
78                 gstcs_error("ERROR from element %s: %s\n", GST_OBJECT_NAME(message->src), err->message);
79                 gstcs_error("Debugging info: %s\n", (dbg_info) ? dbg_info : "none");
80                 g_error_free(err);
81                 g_free(dbg_info);
82                 g_main_context_pop_thread_default(pGstreamer_s->context);
83                 g_main_loop_quit(pGstreamer_s->loop);
84                 gstcs_debug("Quit GST_CS\n");
85                 break;
86                 }
87         default:
88                 break;
89         }
90         return TRUE;
91 }
92
93 static int
94 _mm_get_byte_per_pixcel(const char *__format_label)
95 {
96         int byte_per_pixcel = 1;
97         if (strcmp(__format_label, "RGB565") == 0) {
98                 byte_per_pixcel = 2;
99         } else if (strcmp(__format_label, "RGB888") == 0 ||
100                 strcmp(__format_label, "BGR888") == 0) {
101                 byte_per_pixcel = 3;
102         } else if (strcmp(__format_label, "RGBA8888") == 0 ||
103                 strcmp(__format_label, "ARGB8888") == 0 ||
104                 strcmp(__format_label, "BGRA8888") == 0 ||
105                 strcmp(__format_label, "ABGR8888") == 0 ||
106                 strcmp(__format_label, "RGBX") == 0 ||
107                 strcmp(__format_label, "XRGB") == 0 ||
108                 strcmp(__format_label, "BGRX") == 0 ||
109                 strcmp(__format_label, "XBGR") == 0) {
110                 byte_per_pixcel = 4;
111         }
112
113         gstcs_debug("byte per pixcel : %d", byte_per_pixcel);
114
115         return byte_per_pixcel;
116 }
117
118 static int _mm_create_pipeline(gstreamer_s* pGstreamer_s)
119 {
120         int ret = GSTCS_ERROR_NONE;
121         pGstreamer_s->pipeline = gst_pipeline_new("pipeline");
122         if (!pGstreamer_s->pipeline) {
123                 gstcs_error("pipeline could not be created. Exiting.\n");
124                 ret = GSTCS_ERROR_INVALID_PARAMETER;
125         }
126         pGstreamer_s->appsrc = gst_element_factory_make("appsrc" , "appsrc");
127         if (!pGstreamer_s->appsrc) {
128                 gstcs_error("appsrc could not be created. Exiting.\n");
129                 ret = GSTCS_ERROR_INVALID_PARAMETER;
130         }
131         pGstreamer_s->colorspace = gst_element_factory_make("videoconvert" , "convert");
132         if (!pGstreamer_s->colorspace) {
133                 gstcs_error("colorspace could not be created. Exiting.\n");
134                 ret = GSTCS_ERROR_INVALID_PARAMETER;
135         }
136         pGstreamer_s->videoscale = gst_element_factory_make("videoscale", "scale");
137         if (!pGstreamer_s->videoscale) {
138                 gstcs_error("videoscale could not be created. Exiting.\n");
139                 ret = GSTCS_ERROR_INVALID_PARAMETER;
140         }
141         pGstreamer_s->videoflip = gst_element_factory_make("videoflip", "flip");
142         if (!pGstreamer_s->videoflip) {
143                 gstcs_error("videoflip could not be created. Exiting.\n");
144                 ret = GSTCS_ERROR_INVALID_PARAMETER;
145         }
146         pGstreamer_s->appsink = gst_element_factory_make("appsink" , "appsink");
147         if (!pGstreamer_s->appsink) {
148                 gstcs_error("appsink could not be created. Exiting.\n");
149                 ret = GSTCS_ERROR_INVALID_PARAMETER;
150         }
151         return ret;
152 }
153
154 static void _mm_destroy_notify(gpointer data)
155 {
156         unsigned char *_data = (unsigned char *)data;
157         if (_data != NULL) {
158                 free(_data);
159                 _data = NULL;
160         }
161 }
162
163 static void
164 _mm_check_caps_format(GstCaps* caps)
165 {
166         GstStructure *caps_structure = gst_caps_get_structure(caps, 0);
167         const gchar* formatInfo = gst_structure_get_string(caps_structure, "format");
168         gstcs_debug("[%d] caps: %s", GST_IS_CAPS(caps), formatInfo);
169 }
170
171 static void
172 _mm_link_pipeline(gstreamer_s* pGstreamer_s, int value)
173 {
174         /* set property */
175         gst_bin_add_many(GST_BIN(pGstreamer_s->pipeline), pGstreamer_s->appsrc, pGstreamer_s->colorspace, pGstreamer_s->videoscale, pGstreamer_s->videoflip, pGstreamer_s->appsink, NULL);
176         if (!gst_element_link_many(pGstreamer_s->appsrc, pGstreamer_s->colorspace, pGstreamer_s->videoscale, pGstreamer_s->videoflip, pGstreamer_s->appsink, NULL))
177                 gstcs_error("Fail to link pipeline");
178         else
179                 gstcs_debug("Success to link pipeline");
180
181         g_object_set(G_OBJECT(pGstreamer_s->appsrc), "stream-type", 0, "format", GST_FORMAT_TIME, NULL);
182         g_object_set(pGstreamer_s->appsrc, "num-buffers", 1, NULL);
183         g_object_set(pGstreamer_s->appsrc, "is-live", TRUE, NULL); /* add because of gstreamer_s time issue */
184
185         g_object_set(pGstreamer_s->videoflip, "method", value, NULL); /* GST_VIDEO_FLIP_METHOD_IDENTITY (0): none- Identity (no rotation) (1): clockwise - Rotate clockwise 90 degrees (2): rotate-180 - Rotate 180 degrees (3): counterclockwise - Rotate counter-clockwise 90 degrees (4): horizontal-flip - Flip horizontally (5): vertical-flip - Flip vertically (6): upper-left-diagonal - Flip across upper left/lower right diagonal (7): upper-right-diagonal - Flip across upper right/lower left diagonal */
186
187         /*g_object_set(pGstreamer_s->appsink, "drop", TRUE, NULL);*/
188         g_object_set(pGstreamer_s->appsink, "emit-signals", TRUE, "sync", FALSE, NULL);
189 }
190
191 static GstVideoFormat _mm_get_video_format(char *format_label)
192 {
193         GstVideoFormat videoFormat = GST_VIDEO_FORMAT_UNKNOWN;
194         int _bpp = 0;
195         int _depth = 0;
196         int _red_mask = 0;
197         int _green_mask = 0;
198         int _blue_mask = 0;
199         int _alpha_mask = 0;
200         int _endianness = 0;
201
202         if (format_label == NULL) {
203                 gstcs_error("Wrong format label");
204                 return videoFormat;
205         }
206
207         if (strcmp(format_label, "I420") == 0)
208                 videoFormat = GST_VIDEO_FORMAT_I420;
209         else if (strcmp(format_label, "Y42B") == 0)
210                 videoFormat = GST_VIDEO_FORMAT_Y42B;
211         else if (strcmp(format_label, "Y444") == 0)
212                 videoFormat = GST_VIDEO_FORMAT_Y444;
213         else if (strcmp(format_label, "YV12") == 0)
214                 videoFormat = GST_VIDEO_FORMAT_YV12;
215         else if (strcmp(format_label, "NV12") == 0)
216                 videoFormat = GST_VIDEO_FORMAT_NV12;
217         else if (strcmp(format_label, "UYVY") == 0)
218                 videoFormat = GST_VIDEO_FORMAT_UYVY;
219         else if (strcmp(format_label, "YUYV") == 0)
220                 videoFormat = GST_VIDEO_FORMAT_YVYU;
221         else if (strcmp(format_label, "RGB888") == 0) {
222                 _bpp = 24; _depth = 24; _red_mask = 16711680; _green_mask = 65280; _blue_mask = 255; _endianness = 4321; _alpha_mask = 0;
223                 videoFormat = gst_video_format_from_masks(_depth, _bpp, _endianness, _red_mask, _green_mask, _blue_mask, _alpha_mask);
224         } else if (strcmp(format_label, "BGR888") == 0) {
225                 _bpp = 24; _depth = 24; _red_mask = 255; _green_mask = 65280; _blue_mask = 16711680; _endianness = 4321; _alpha_mask = 0;
226                 videoFormat = gst_video_format_from_masks(_depth, _bpp, _endianness, _red_mask, _green_mask, _blue_mask, _alpha_mask);
227         } else if (strcmp(format_label, "RGB565") == 0) {
228                 _bpp = 16; _depth = 16; _red_mask = 63488; _green_mask = 2016; _blue_mask = 31; _endianness = 1234; _alpha_mask = 0;
229                 videoFormat = gst_video_format_from_masks(_depth, _bpp, _endianness, _red_mask, _green_mask, _blue_mask, _alpha_mask);
230         } else if ((strcmp(format_label, "BGRX") == 0)) {
231                 _bpp = 32; _depth = 24; _red_mask = 65280; _green_mask = 16711680; _blue_mask = -16777216; _endianness = 4321; _alpha_mask = 0;
232                 videoFormat = gst_video_format_from_masks(_depth, _bpp, _endianness, _red_mask, _green_mask, _blue_mask, _alpha_mask);
233         } else if (strcmp(format_label, "ARGB8888") == 0) { /*[Low Arrary Address] ARGBARGB... [High Array Address]*/
234                 gstcs_debug("ARGB8888");
235                 _bpp = 32; _depth = 32; _red_mask = 16711680; _green_mask = 65280; _blue_mask = 255; _alpha_mask = -16777216; _endianness = 4321;
236                 videoFormat = gst_video_format_from_masks(_depth, _bpp, _endianness, _red_mask, _green_mask, _blue_mask, _alpha_mask);
237         } else if (strcmp(format_label, "BGRA8888") == 0) { /*[Low Arrary Address] BGRABGRA...[High Array Address]*/
238                 gstcs_debug("BGRA8888");
239                 _bpp = 32; _depth = 32; _red_mask = 65280; _green_mask = 16711680; _blue_mask = -16777216; _alpha_mask = 255; _endianness = 4321;
240         } else if (strcmp(format_label, "RGBA8888") == 0) { /*[Low Arrary Address] RGBARGBA...[High Array Address]*/
241                 gstcs_debug("RGBA8888");
242                 _bpp = 32; _depth = 32; _red_mask = -16777216; _green_mask = 16711680; _blue_mask = 65280; _alpha_mask = 255; _endianness = 4321;
243         } else if (strcmp(format_label, "ABGR8888") == 0) { /*[Low Arrary Address] ABGRABGR...[High Array Address]*/
244                 gstcs_debug("ABGR8888");
245                 _bpp = 32; _depth = 32; _red_mask = 255; _green_mask = 65280; _blue_mask = 16711680; _alpha_mask = -16777216; _endianness = 4321;
246         } else {
247                 gstcs_error("***Wrong format cs type***");
248         }
249
250         gstcs_debug("format_label [%s], Chosen video format [%s]", format_label, gst_video_format_to_string(videoFormat));
251
252         return videoFormat;
253
254 }
255
256 static void
257 _mm_set_image_input_format_s_capabilities(image_format_s* __format) /*_format_label: I420 _colorsapace: YUV */
258 {
259         GstVideoFormat videoFormat = GST_VIDEO_FORMAT_UNKNOWN;
260
261         if (__format == NULL) {
262                 gstcs_error("Image format is NULL\n");
263                 return;
264         }
265
266         gstcs_debug("colorspace: %s(%d)\n", __format->colorspace, strlen(__format->colorspace));
267
268         videoFormat = _mm_get_video_format(__format->format_label);
269
270         if (strcmp(__format->colorspace, "YUV") == 0) {
271                 __format->caps = gst_caps_new_simple("video/x-raw",
272                         "format", G_TYPE_STRING, gst_video_format_to_string(videoFormat),
273                         "framerate", GST_TYPE_FRACTION, 25, 1,
274                         "pixel-aspect-ratio", GST_TYPE_FRACTION, 1, 1,
275                         "width", G_TYPE_INT, __format->width,
276                         "height", G_TYPE_INT, __format->height,
277                         "framerate", GST_TYPE_FRACTION, 1, 1,
278                         NULL);
279         }
280
281         else if (strcmp(__format->colorspace, "RGB") == 0 || strcmp(__format->colorspace, "BGRX") == 0) {
282                 __format->caps = gst_caps_new_simple("video/x-raw",
283                         "format", G_TYPE_STRING, gst_video_format_to_string(videoFormat),
284                         "width", G_TYPE_INT, __format->stride,
285                         "height", G_TYPE_INT, __format->elevation,
286                         "framerate", GST_TYPE_FRACTION, 1, 1, NULL);
287         }
288
289         else if (strcmp(__format->colorspace, "RGBA") == 0) {
290                 __format->caps = gst_caps_new_simple("video/x-raw",
291                         "format", G_TYPE_STRING, gst_video_format_to_string(videoFormat),
292                         "width", G_TYPE_INT, __format->width,
293                         "height", G_TYPE_INT, __format->elevation,
294                         "framerate", GST_TYPE_FRACTION, 1, 1, NULL);
295         }
296
297         if (__format->caps) {
298                 gstcs_debug("###__format->caps is not NULL###, %p", __format->caps);
299                 _mm_check_caps_format(__format->caps);
300         } else {
301                 gstcs_error("__format->caps is NULL");
302         }
303 }
304
305 static void
306 _mm_set_image_output_format_s_capabilities(image_format_s* __format) /*_format_label: I420 _colorsapace: YUV */
307 {
308         GstVideoFormat videoFormat = GST_VIDEO_FORMAT_UNKNOWN;
309
310         if (__format == NULL) {
311                 gstcs_error("Image format is NULL\n");
312                 return;
313         }
314
315         gstcs_debug("colorspace: %s(%d)\n", __format->colorspace, strlen(__format->colorspace));
316
317         videoFormat = _mm_get_video_format(__format->format_label);
318
319         if (strcmp(__format->colorspace, "YUV") == 0) {
320                 __format->caps = gst_caps_new_simple("video/x-raw",
321                         "format", G_TYPE_STRING, gst_video_format_to_string(videoFormat),
322                         "width", G_TYPE_INT, __format->width,
323                         "height", G_TYPE_INT, __format->height,
324                         "framerate", GST_TYPE_FRACTION, 1, 1,
325                         NULL);
326         }
327
328         else if (strcmp(__format->colorspace, "RGB") == 0 || strcmp(__format->colorspace, "BGRX") == 0) {
329                 __format->caps = gst_caps_new_simple("video/x-raw",
330                         "format", G_TYPE_STRING, gst_video_format_to_string(videoFormat),
331                         "width", G_TYPE_INT, __format->width,
332                         "height", G_TYPE_INT, __format->height,
333                         "framerate", GST_TYPE_FRACTION, 1, 1, NULL);
334         }
335
336         else if (strcmp(__format->colorspace, "RGBA") == 0) {
337                 __format->caps = gst_caps_new_simple("video/x-raw",
338                         "format", G_TYPE_STRING, gst_video_format_to_string(videoFormat),
339                         "width", G_TYPE_INT, __format->width,
340                         "height", G_TYPE_INT, __format->height,
341                         "framerate", GST_TYPE_FRACTION, 1, 1, NULL);
342         }
343
344         if (__format->caps) {
345                 gstcs_debug("###__format->caps is not NULL###, %p", __format->caps);
346                 _mm_check_caps_format(__format->caps);
347         } else {
348                 gstcs_error("__format->caps is NULL");
349         }
350 }
351
352 static void
353 _mm_set_image_colorspace(image_format_s* __format)
354 {
355         gstcs_debug("format_label: %s\n", __format->format_label);
356
357         __format->colorspace = (char*)malloc(sizeof(char) * IMAGE_FORMAT_LABEL_BUFFER_SIZE);
358         if (__format->colorspace == NULL) {
359                 gstcs_error("memory allocation failed");
360                 return;
361         }
362         memset(__format->colorspace, 0, IMAGE_FORMAT_LABEL_BUFFER_SIZE);
363         if ((strcmp(__format->format_label, "I420") == 0) || (strcmp(__format->format_label, "Y42B") == 0) || (strcmp(__format->format_label, "Y444") == 0)
364                 || (strcmp(__format->format_label, "YV12") == 0) || (strcmp(__format->format_label, "NV12") == 0) || (strcmp(__format->format_label, "UYVY") == 0) || (strcmp(__format->format_label, "YUYV") == 0)) {
365                 SAFE_STRCPY(__format->colorspace, "YUV", IMAGE_FORMAT_LABEL_BUFFER_SIZE);
366         } else if ((strcmp(__format->format_label, "RGB888") == 0) || (strcmp(__format->format_label, "BGR888") == 0) || (strcmp(__format->format_label, "RGB565") == 0)) {
367                 SAFE_STRCPY(__format->colorspace, "RGB", IMAGE_FORMAT_LABEL_BUFFER_SIZE);
368         } else if ((strcmp(__format->format_label, "ARGB8888") == 0) || (strcmp(__format->format_label, "BGRA8888") == 0) || (strcmp(__format->format_label, "RGBA8888") == 0)  || (strcmp(__format->format_label, "ABGR8888") == 0)) {
369                 SAFE_STRCPY(__format->colorspace, "RGBA", IMAGE_FORMAT_LABEL_BUFFER_SIZE);
370         } else if ((strcmp(__format->format_label, "BGRX") == 0)) {
371                 SAFE_STRCPY(__format->colorspace, "BGRX", IMAGE_FORMAT_LABEL_BUFFER_SIZE);
372         } else {
373                 gstcs_error("Check your colorspace format label");
374                 GSTCS_FREE(__format->colorspace);
375         }
376 }
377
378 static int _gstcs_create_image_format(image_format_s **format)
379 {
380         int ret = GSTCS_ERROR_NONE;
381         image_format_s *_format = NULL;
382
383         if (format == NULL) {
384                 gstcs_error("format is wrong value");
385                 return GSTCS_ERROR_INVALID_OPERATION;
386         }
387
388         _format = (image_format_s*)malloc(sizeof(image_format_s));
389         if (_format == NULL) {
390                 gstcs_error("memory allocation failed");
391                 return GSTCS_ERROR_OUT_OF_MEMORY;
392         }
393         memset(_format, 0, sizeof(image_format_s));
394         *format = _format;
395
396         return ret;
397 }
398
399 static void _gstcs_destroy_image_format(image_format_s *format)
400 {
401         if (format != NULL) {
402                 gst_caps_unref(format->caps);
403                 GSTCS_FREE(format->format_label);
404                 GSTCS_FREE(format->colorspace);
405                 GSTCS_FREE(format);
406         }
407 }
408
409 static void
410 _mm_round_up_input_image_widh_height(image_format_s* pFormat)
411 {
412         if (strcmp(pFormat->colorspace, "YUV") == 0) {
413                 pFormat->stride = MM_UTIL_ROUND_UP_8(pFormat->width);
414                 pFormat->elevation = MM_UTIL_ROUND_UP_2(pFormat->height);
415         } else if (strcmp(pFormat->colorspace, "RGB") == 0) {
416                 pFormat->stride = MM_UTIL_ROUND_UP_4(pFormat->width);
417                 pFormat->elevation = MM_UTIL_ROUND_UP_2(pFormat->height);
418         } else if ((strcmp(pFormat->colorspace, "RGBA") == 0) || (strcmp(pFormat->colorspace, "BGRX") == 0)) {
419                 pFormat->stride = pFormat->width;
420                 pFormat->elevation = MM_UTIL_ROUND_UP_2(pFormat->height);
421         }
422         gstcs_debug("input_format stride: %d, elevation: %d", pFormat->stride, pFormat->elevation);
423 }
424
425 static image_format_s*
426 _mm_set_input_image_format_s_struct(imgp_info_s* pImgp_info) /* char* __format_label, int __width, int __height) */
427 {
428         int ret = GSTCS_ERROR_NONE;
429         image_format_s* __format = NULL;
430
431         ret = _gstcs_create_image_format(&__format);
432         if (ret != GSTCS_ERROR_NONE) {
433                 gstcs_debug("Error: _gstcs_create_image_format is failed (%d)\n", ret);
434                 return NULL;
435         }
436
437         __format->format_label = (char *)malloc(sizeof(char) * IMAGE_FORMAT_LABEL_BUFFER_SIZE);
438         if (__format->format_label == NULL) {
439                 gstcs_error("memory allocation failed");
440                 _gstcs_destroy_image_format(__format);
441                 return NULL;
442         }
443         memset(__format->format_label, 0, IMAGE_FORMAT_LABEL_BUFFER_SIZE);
444         SAFE_STRCPY(__format->format_label, pImgp_info->input_format_label, IMAGE_FORMAT_LABEL_BUFFER_SIZE);
445         gstcs_debug("input_format_label: %s\n", pImgp_info->input_format_label);
446         _mm_set_image_colorspace(__format);
447
448         __format->width = pImgp_info->src_width;
449         __format->height = pImgp_info->src_height;
450         _mm_round_up_input_image_widh_height(__format);
451
452         _mm_set_image_input_format_s_capabilities(__format);
453
454         return __format;
455 }
456
457 static void
458 _mm_round_up_output_image_widh_height(image_format_s* pFormat, const image_format_s *input_format)
459 {
460         if (strcmp(pFormat->colorspace, "YUV") == 0) {
461                 pFormat->stride = MM_UTIL_ROUND_UP_8(pFormat->width);
462                 pFormat->elevation = MM_UTIL_ROUND_UP_2(pFormat->height);
463         } else if (strcmp(pFormat->colorspace, "RGB") == 0) {
464                 pFormat->stride = MM_UTIL_ROUND_UP_4(pFormat->width);
465                 pFormat->elevation = MM_UTIL_ROUND_UP_2(pFormat->height);
466                 pFormat->width = pFormat->stride;
467                 if (input_format->height != input_format->elevation)
468                         pFormat->height = pFormat->elevation;
469         } else if ((strcmp(pFormat->colorspace, "RGBA") == 0) || (strcmp(pFormat->colorspace, "BGRX") == 0)) {
470                 pFormat->stride = pFormat->width;
471                 pFormat->elevation = MM_UTIL_ROUND_UP_2(pFormat->height);
472                 if (input_format->height != input_format->elevation)
473                         pFormat->height = pFormat->elevation;
474         }
475         gstcs_debug("output_format stride: %d, elevation: %d", pFormat->stride, pFormat->elevation);
476 }
477
478 static image_format_s*
479 _mm_set_output_image_format_s_struct(imgp_info_s* pImgp_info, const image_format_s *input_format)
480 {
481         int ret = GSTCS_ERROR_NONE;
482         image_format_s* __format = NULL;
483
484         ret = _gstcs_create_image_format(&__format);
485         if (ret != GSTCS_ERROR_NONE) {
486                 gstcs_debug("Error: _gstcs_create_image_format is failed (%d)\n", ret);
487                 return NULL;
488         }
489
490         __format->format_label = (char *)malloc(sizeof(char) * IMAGE_FORMAT_LABEL_BUFFER_SIZE);
491         if (__format->format_label == NULL) {
492                 gstcs_error("memory allocation failed");
493                 _gstcs_destroy_image_format(__format);
494                 return NULL;
495         }
496         memset(__format->format_label, 0, IMAGE_FORMAT_LABEL_BUFFER_SIZE);
497         SAFE_STRCPY(__format->format_label, pImgp_info->output_format_label, IMAGE_FORMAT_LABEL_BUFFER_SIZE);
498         _mm_set_image_colorspace(__format);
499
500         __format->width = pImgp_info->dst_width;
501         __format->height = pImgp_info->dst_height;
502         _mm_round_up_output_image_widh_height(__format, input_format);
503
504         pImgp_info->output_stride = __format->stride;
505         pImgp_info->output_elevation = __format->elevation;
506
507         gstcs_debug("output_format_label: %s", pImgp_info->output_format_label);
508         _mm_set_image_output_format_s_capabilities(__format);
509         return __format;
510 }
511
512 static int
513 _mm_push_buffer_into_pipeline(imgp_info_s* pImgp_info, unsigned char *src, gstreamer_s * pGstreamer_s)
514 {
515         int ret = GSTCS_ERROR_NONE;
516
517         if (pGstreamer_s->pipeline == NULL) {
518                 gstcs_error("pipeline is NULL\n");
519                 return GSTCS_ERROR_INVALID_PARAMETER;
520         }
521
522         gsize data_size = mm_setup_image_size(pImgp_info->input_format_label, pImgp_info->src_width, pImgp_info->src_height);
523         GstBuffer* gst_buf = gst_buffer_new_wrapped_full(GST_MEMORY_FLAG_READONLY, src, data_size, 0, data_size, NULL, NULL);
524
525         if (gst_buf == NULL) {
526                 gstcs_error("buffer is NULL\n");
527                 return GSTCS_ERROR_INVALID_PARAMETER;
528         }
529
530         gst_app_src_push_buffer(GST_APP_SRC(pGstreamer_s->appsrc), gst_buf); /* push buffer to pipeline */
531         return ret;
532 }
533
534 static int
535 _mm_push_buffer_into_pipeline_new(image_format_s *input_format, unsigned char *src, gstreamer_s * pGstreamer_s)
536 {
537         int ret = GSTCS_ERROR_NONE;
538         GstBuffer *gst_buf = NULL;
539         unsigned int src_size = 0;
540         unsigned char *data = NULL;
541         unsigned int stride = input_format->stride;
542         unsigned int elevation = input_format->elevation;
543
544         if (pGstreamer_s->pipeline == NULL) {
545                 gstcs_error("pipeline is NULL\n");
546                 return GSTCS_ERROR_INVALID_PARAMETER;
547         }
548
549         gstcs_debug("stride: %d, elevation: %d", stride, elevation);
550         src_size = mm_setup_image_size(input_format->format_label, stride, elevation);
551         gstcs_debug("buffer size (src): %d", src_size);
552
553         int byte_per_pixcel = _mm_get_byte_per_pixcel(input_format->format_label);
554         unsigned int src_row = input_format->width * byte_per_pixcel;
555         unsigned int stride_row = stride * byte_per_pixcel;
556         unsigned int i = 0, y = 0;
557         gstcs_debug("padding will be inserted to buffer");
558         data = (unsigned char *) malloc(src_size);
559         if (data == NULL) {
560                 gstcs_error("app_buffer is NULL\n");
561                 return GSTCS_ERROR_INVALID_PARAMETER;
562         }
563         for (y = 0; y < (unsigned int)(input_format->height); y++) {
564                 guint8 *pLine = (guint8 *) &(src[src_row * y]);
565                 for (i = 0; i < src_row; i++)
566                         data[y * stride_row + i] = pLine[i];
567                 guint8 stride_row_color = pLine[i - 1];
568                 for (i = src_row; i < stride_row; i++)
569                         data[y * stride_row + i] = stride_row_color;
570         }
571         for (y = (unsigned int)(input_format->height); y < (unsigned int)(input_format->elevation); y++) {
572                 for (i = 0; i < stride_row; i++)
573                         data[y * stride_row + i] = data[(y - 1) * stride_row + i];
574         }
575         gst_buf = gst_buffer_new_wrapped_full(GST_MEMORY_FLAG_READONLY, data, src_size, 0, src_size, data, _mm_destroy_notify);
576
577         if (gst_buf == NULL) {
578                 gstcs_error("buffer is NULL\n");
579                 GSTCS_FREE(data);
580                 return GSTCS_ERROR_INVALID_PARAMETER;
581         }
582
583         gst_app_src_push_buffer(GST_APP_SRC(pGstreamer_s->appsrc), gst_buf); /* push buffer to pipeline */
584         return ret;
585 }
586
587 static int
588 _mm_imgp_gstcs_processing(gstreamer_s* pGstreamer_s, unsigned char *src, unsigned char **dst, image_format_s* input_format, image_format_s* output_format, imgp_info_s* pImgp_info)
589 {
590         GstBus *bus = NULL;
591         GstStateChangeReturn ret_state;
592         int ret = GSTCS_ERROR_NONE;
593
594         /*create pipeline*/
595         ret = _mm_create_pipeline(pGstreamer_s);
596         if (ret != GSTCS_ERROR_NONE)
597                 gstcs_error("ERROR - mm_create_pipeline ");
598
599         /* Make appsink emit the "new-preroll" and "new-sample" signals. This option is by default disabled because signal emission is expensive and unneeded when the application prefers to operate in pull mode. */
600         gst_app_sink_set_emit_signals((GstAppSink*)pGstreamer_s->appsink, TRUE);
601
602         bus = gst_pipeline_get_bus(GST_PIPELINE(pGstreamer_s->pipeline));
603         gst_bus_add_watch(bus, (GstBusFunc) _mm_on_src_message, pGstreamer_s);
604         gst_object_unref(bus);
605
606         gst_app_src_set_caps(GST_APP_SRC(pGstreamer_s->appsrc), input_format->caps);
607         gst_app_sink_set_caps(GST_APP_SINK(pGstreamer_s->appsink), output_format->caps);
608
609         if (((input_format->width != input_format->stride) || (input_format->height != input_format->elevation)) &&
610                 ((strcmp(input_format->colorspace, "RGB") == 0) || (strcmp(input_format->colorspace, "RGBA") == 0))) {
611                 gstcs_debug("Start _mm_push_buffer_into_pipeline_new");
612                 ret = _mm_push_buffer_into_pipeline_new(input_format, src, pGstreamer_s);
613         } else {
614                 gstcs_debug("Start mm_push_buffer_into_pipeline");
615                 ret = _mm_push_buffer_into_pipeline(pImgp_info, src, pGstreamer_s);
616         }
617         if (ret != GSTCS_ERROR_NONE) {
618                 gstcs_error("ERROR - mm_push_buffer_into_pipeline ");
619                 gst_object_unref(pGstreamer_s->pipeline);
620                 return ret;
621         }
622         gstcs_debug("End mm_push_buffer_into_pipeline");
623
624         /*link pipeline*/
625         gstcs_debug("Start mm_link_pipeline");
626         _mm_link_pipeline(pGstreamer_s, pImgp_info->angle);
627         gstcs_debug("End mm_link_pipeline");
628
629         /* Conecting to the new-sample signal emited by the appsink*/
630         gstcs_debug("Start G_CALLBACK(_mm_sink_sample)");
631         g_signal_connect(pGstreamer_s->appsink, "new-sample", G_CALLBACK(_mm_sink_sample), pGstreamer_s);
632         gstcs_debug("End G_CALLBACK(_mm_sink_sample)");
633
634         /* GST_STATE_PLAYING*/
635         gstcs_debug("Start GST_STATE_PLAYING");
636         ret_state = gst_element_set_state(pGstreamer_s->pipeline, GST_STATE_PLAYING);
637         gstcs_debug("End GST_STATE_PLAYING ret_state: %d", ret_state);
638
639         /*g_main_loop_run*/
640         gstcs_debug("g_main_loop_run");
641         g_main_loop_run(pGstreamer_s->loop);
642
643         gstcs_debug("Sucess GST_STATE_CHANGE");
644
645         /*GST_STATE_NULL*/
646         gst_element_set_state(pGstreamer_s->pipeline, GST_STATE_NULL);
647         gstcs_debug("End GST_STATE_NULL");
648
649         gstcs_debug("###pGstreamer_s->output_buffer### : %p", pGstreamer_s->output_buffer);
650
651         ret_state = gst_element_get_state(pGstreamer_s->pipeline, NULL, NULL, 1*GST_SECOND);
652
653         if (ret_state == GST_STATE_CHANGE_SUCCESS)
654                 gstcs_debug("GST_STATE_NULL ret_state = %d (GST_STATE_CHANGE_SUCCESS)\n", ret_state);
655         else if (ret_state == GST_STATE_CHANGE_ASYNC)
656                 gstcs_debug("GST_STATE_NULL ret_state = %d (GST_STATE_CHANGE_ASYNC)\n", ret_state);
657
658         gstcs_debug("Success gst_element_get_state\n");
659
660         if (ret_state == GST_STATE_CHANGE_FAILURE) {
661                 gstcs_error("GST_STATE_CHANGE_FAILURE");
662         } else {
663                 if (pGstreamer_s->output_buffer != NULL) {
664                         GstMapInfo mapinfo = GST_MAP_INFO_INIT;
665                         gst_buffer_map(pGstreamer_s->output_buffer, &mapinfo, GST_MAP_READ);
666                         int buffer_size = mapinfo.size;
667                         int calc_buffer_size = 0;
668                         if (((pImgp_info->dst_width != (unsigned int)(output_format->width)) || (pImgp_info->dst_height != (unsigned int)(output_format->height))) &&
669                                 ((strcmp(input_format->colorspace, "RGB") == 0) || (strcmp(input_format->colorspace, "RGBA") == 0))) {
670                                 gstcs_debug("calculate image size with stride & elevation");
671                                 calc_buffer_size = mm_setup_image_size(pImgp_info->output_format_label, output_format->width, output_format->height);
672                         } else {
673                                 calc_buffer_size = mm_setup_image_size(pImgp_info->output_format_label, pImgp_info->dst_width, pImgp_info->dst_height);
674                         }
675                         gstcs_debug("buffer size: %d, calc: %d\n", buffer_size, calc_buffer_size);
676                         if (buffer_size != calc_buffer_size) {
677                                 gstcs_debug("Buffer size is different \n");
678                                 gstcs_debug("unref output buffer");
679                                 gst_buffer_unref(pGstreamer_s->output_buffer);
680                                 gst_object_unref(pGstreamer_s->pipeline);
681                                 pGstreamer_s->output_buffer = NULL;
682                                 return GSTCS_ERROR_INVALID_OPERATION;
683                         }
684                         gstcs_debug("pGstreamer_s->output_buffer: %p\n", pGstreamer_s->output_buffer);
685                         *dst = calloc(1, buffer_size);
686                         if (*dst == NULL) {
687                                 gstcs_error("ERROR - calloc ");
688                                 gst_buffer_unref(pGstreamer_s->output_buffer);
689                                 gst_object_unref(pGstreamer_s->pipeline);
690                                 pGstreamer_s->output_buffer = NULL;
691                                 return GSTCS_ERROR_INVALID_OPERATION;
692                         }
693
694                         memcpy(*dst, mapinfo.data, buffer_size);
695                         pImgp_info->buffer_size = buffer_size;
696                         gst_buffer_unmap(pGstreamer_s->output_buffer, &mapinfo);
697                 } else {
698                         gstcs_debug("pGstreamer_s->output_buffer is NULL");
699                 }
700         }
701         gstcs_debug("unref output buffer");
702         gst_buffer_unref(pGstreamer_s->output_buffer);
703         gst_object_unref(pGstreamer_s->pipeline);
704         pGstreamer_s->output_buffer = NULL;
705
706         gstcs_debug("End gstreamer processing");
707         gstcs_debug("dst: %p", *dst);
708         return ret;
709 }
710
711
712 static int
713 mm_setup_image_size(const char* _format_label, int width, int height)
714 {
715         int size = 0;
716
717         if (strcmp(_format_label, "I420") == 0)
718                 size = (MM_UTIL_ROUND_UP_4(width) * MM_UTIL_ROUND_UP_2(height) + MM_UTIL_ROUND_UP_8(width) * MM_UTIL_ROUND_UP_2(height) /2); /*width * height *1.5; */
719         else if (strcmp(_format_label, "Y42B") == 0)
720                 size = (MM_UTIL_ROUND_UP_4(width) * height + MM_UTIL_ROUND_UP_8(width) * height); /*width * height *2; */
721         else if (strcmp(_format_label, "YUV422") == 0)
722                 size = (MM_UTIL_ROUND_UP_4(width) * height + MM_UTIL_ROUND_UP_8(width) * height); /*width * height *2; */
723         else if (strcmp(_format_label, "Y444") == 0)
724                 size = (MM_UTIL_ROUND_UP_4(width) * height * 3); /* width * height *3; */
725         else if (strcmp(_format_label, "YV12") == 0)
726                 size = (MM_UTIL_ROUND_UP_4(width) * MM_UTIL_ROUND_UP_2(height) + MM_UTIL_ROUND_UP_8(width) * MM_UTIL_ROUND_UP_2(height) / 2); /* width * height *1; */
727         else if (strcmp(_format_label, "NV12") == 0)
728                 size = (MM_UTIL_ROUND_UP_4(width) * MM_UTIL_ROUND_UP_2(height) * 1.5); /* width * height *1.5; */
729         else if (strcmp(_format_label, "RGB565") == 0)
730                 size = (MM_UTIL_ROUND_UP_4(width) * 2 * height); /* width * height *2; */
731         else if (strcmp(_format_label, "RGB888") == 0)
732                 size = (MM_UTIL_ROUND_UP_4(width) * 3 * height); /* width * height *3; */
733         else if (strcmp(_format_label, "BGR888") == 0)
734                 size = (MM_UTIL_ROUND_UP_4(width) * 3 * height); /* width * height *3; */
735         else if (strcmp(_format_label, "UYVY") == 0)
736                 size = (MM_UTIL_ROUND_UP_2(width) * 2 * height); /* width * height *2; */
737         else if (strcmp(_format_label, "YUYV") == 0)
738                 size = (MM_UTIL_ROUND_UP_2(width) * 2 * height); /* width * height *2; */
739         else if (strcmp(_format_label, "ARGB8888") == 0)
740                 size = width * height *4;
741         else if (strcmp(_format_label, "BGRA8888") == 0)
742                 size = width * height *4;
743         else if (strcmp(_format_label, "RGBA8888") == 0)
744                 size = width * height *4;
745         else if (strcmp(_format_label, "ABGR8888") == 0)
746                 size = width * height *4;
747         else if (strcmp(_format_label, "BGRX") == 0)
748                 size = width * height *4;
749
750         gstcs_debug("file_size: %d\n", size);
751
752         return size;
753 }
754
755 static int _gstcs_create_default_thread(gstreamer_s *gstreamer)
756 {
757         if (gstreamer == NULL) {
758                 gstcs_error("ERROR - gstreamer is null ");
759                 return GSTCS_ERROR_INVALID_OPERATION;
760         }
761
762         gstreamer->context = g_main_context_new();
763         if (gstreamer->context == NULL) {
764                 gstcs_error("ERROR - g_main_context_new ");
765                 return GSTCS_ERROR_INVALID_OPERATION;
766         }
767         gstreamer->loop = g_main_loop_new(gstreamer->context, FALSE);
768         if (gstreamer->loop == NULL) {
769                 gstcs_error("ERROR - g_main_loop_new ");
770                 g_main_context_unref(gstreamer->context);
771                 return GSTCS_ERROR_INVALID_OPERATION;
772         }
773
774         g_main_context_push_thread_default(gstreamer->context);
775         return GSTCS_ERROR_NONE;
776 }
777
778 static int _gstcs_destroy_default_thread(gstreamer_s *gstreamer)
779 {
780         if (gstreamer == NULL) {
781                 gstcs_error("ERROR - gstreamer is null ");
782                 return GSTCS_ERROR_INVALID_OPERATION;
783         }
784
785         if (gstreamer->loop != NULL)
786                 g_main_loop_unref(gstreamer->loop);
787
788         if (gstreamer->context != NULL)
789                 g_main_context_unref(gstreamer->context);
790
791         return GSTCS_ERROR_NONE;
792 }
793
794 static int _gstcs_init(gstreamer_s** gstreamer)
795 {
796         static const int max_argc = 50;
797         gint argc = 0;
798         gchar** argv = NULL;
799         int i = 0;
800         int ret = GSTCS_ERROR_NONE;
801
802         argv = malloc(sizeof(gchar*) * max_argc);
803
804         if (!argv) {
805                 gstcs_error("argv is not allocated");
806                 return GSTCS_ERROR_OUT_OF_MEMORY;
807         }
808         memset(argv, 0, sizeof(gchar*) * max_argc);
809
810         argv[argc] = g_strdup("mmutil_gstcs");
811         if (argv[argc] == NULL) {
812                 gstcs_error("argv[%d] is not allocated", argc);
813                 ret = GSTCS_ERROR_OUT_OF_MEMORY;
814         }
815         argc++;
816         /* check disable registry scan */
817         argv[argc] = g_strdup("--gst-disable-registry-update");
818         if (argv[argc] == NULL) {
819                 gstcs_error("argv[%d] is not allocated", argc);
820                 ret = GSTCS_ERROR_OUT_OF_MEMORY;
821         }
822         argc++;
823         if (ret != GSTCS_ERROR_NONE) {
824                 for (i = 0; i < argc; i++)
825                         GSTCS_FREE(argv[i]);
826
827                 GSTCS_FREE(argv);
828                 return ret;
829         }
830
831         gst_init(&argc, &argv);
832
833         *gstreamer = g_new0(gstreamer_s, 1);
834         if (*gstreamer == NULL) {
835                 gstcs_error("gstreamer structure is not allocated");
836                 ret = GSTCS_ERROR_OUT_OF_MEMORY;
837         }
838
839         for (i = 0; i < argc; i++)
840                 GSTCS_FREE(argv[i]);
841
842         GSTCS_FREE(argv);
843         return ret;
844 }
845
846 static int _mm_imgp_gstcs(imgp_info_s* pImgp_info, unsigned char *src, unsigned char **dst)
847 {
848         image_format_s* input_format = NULL, *output_format = NULL;
849         gstreamer_s* pGstreamer_s;
850         int ret = GSTCS_ERROR_NONE;
851
852         /* Print debug message for inout structure */
853         gstcs_debug("[input] format label : %s width: %d height: %d\t[output] format label: %s width: %d height: %d rotation vaule: %d",
854         pImgp_info->input_format_label, pImgp_info->src_width, pImgp_info->src_height, pImgp_info->output_format_label, pImgp_info->dst_width, pImgp_info->dst_height, pImgp_info->angle);
855
856         /* Initialize gstreamer */
857         ret = _gstcs_init(&pGstreamer_s);
858         if (ret != GSTCS_ERROR_NONE) {
859                 gstcs_error("Error: _gstcs_new is failed");
860                 return ret;
861         }
862
863         /* Create input/output format for gstreamer processing */
864         input_format = _mm_set_input_image_format_s_struct(pImgp_info);
865         if (input_format == NULL) {
866                 gstcs_error("Error: memory allocation failed");
867                 GSTCS_FREE(pGstreamer_s);
868                 return GSTCS_ERROR_OUT_OF_MEMORY;
869         }
870
871         output_format = _mm_set_output_image_format_s_struct(pImgp_info, input_format);
872         if (output_format == NULL) {
873                 gstcs_error("Error: memory allocation failed");
874                 _gstcs_destroy_image_format(input_format);
875                 GSTCS_FREE(pGstreamer_s);
876                 return GSTCS_ERROR_OUT_OF_MEMORY;
877         }
878
879         /* Create default thread for async behavior */
880         ret = _gstcs_create_default_thread(pGstreamer_s);
881         if (ret != GSTCS_ERROR_NONE) {
882                 gstcs_error("Error: _gstcs_create_default_thread is failed");
883                 _gstcs_destroy_image_format(input_format);
884                 _gstcs_destroy_image_format(output_format);
885                 GSTCS_FREE(pGstreamer_s);
886                 return ret;
887         }
888
889         /* Do gstreamer processing */
890         gstcs_debug("Start _mm_imgp_gstcs_processing ");
891         ret = _mm_imgp_gstcs_processing(pGstreamer_s, src, dst, input_format, output_format, pImgp_info); /* input: buffer pointer for input image , input image format, input image width, input image height, output: buffer porinter for output image */
892
893         if (ret == GSTCS_ERROR_NONE)
894                 gstcs_debug("End _mm_imgp_gstcs_processing [dst: %p]", *dst);
895         else if (ret != GSTCS_ERROR_NONE)
896                 gstcs_error("ERROR - _mm_imgp_gstcs_processing");
897
898         /* Free resouces */
899         ret = _gstcs_destroy_default_thread(pGstreamer_s);
900         if (ret != GSTCS_ERROR_NONE)
901                 gstcs_error("Error: _gstcs_create_default_thread is failed");
902
903         _gstcs_destroy_image_format(input_format);
904         _gstcs_destroy_image_format(output_format);
905         GSTCS_FREE(pGstreamer_s);
906
907         return ret;
908 }
909
910 int mm_imgp(imgp_info_s* pImgp_info, unsigned char *src, unsigned char **dst, imgp_type_e _imgp_type)
911 {
912         if (pImgp_info == NULL) {
913                 gstcs_error("Error: input vaule is NULL");
914                 return GSTCS_ERROR_INVALID_PARAMETER;
915         }
916
917         if (src == NULL || dst == NULL) {
918                 gstcs_error("Error: src | dst is NULL");
919                 return GSTCS_ERROR_INVALID_PARAMETER;
920         }
921
922         if (_imgp_type < 0 || _imgp_type > IMGP_MAX) {
923                 gstcs_error("Error: imgp_type is wrong");
924                 return GSTCS_ERROR_INVALID_PARAMETER;
925         }
926
927         gstcs_debug("[src %p] [dst %p]", src, dst);
928
929         return _mm_imgp_gstcs(pImgp_info, src, dst);
930 }