From 80054a3b1e47a4257044b0a415743c717c73fbe8 Mon Sep 17 00:00:00 2001 From: Thibault Saunier Date: Mon, 17 Oct 2011 17:25:11 +0200 Subject: [PATCH] video: add some internal helper functions for image blending This could be improved if we decide we don't need it to be this generic/flexible. --- gst-libs/gst/video/.gitignore | 1 + gst-libs/gst/video/Makefile.am | 39 +- gst-libs/gst/video/video-blend.c | 1423 ++++++++++++++++++++++++++++++++++ gst-libs/gst/video/video-blend.h | 77 ++ gst-libs/gst/video/videoblendorc.orc | 498 ++++++++++++ 5 files changed, 2028 insertions(+), 10 deletions(-) create mode 100644 gst-libs/gst/video/video-blend.c create mode 100644 gst-libs/gst/video/video-blend.h create mode 100644 gst-libs/gst/video/videoblendorc.orc diff --git a/gst-libs/gst/video/.gitignore b/gst-libs/gst/video/.gitignore index 42df1ec..750405b 100644 --- a/gst-libs/gst/video/.gitignore +++ b/gst-libs/gst/video/.gitignore @@ -1,2 +1,3 @@ video-enumtypes.c video-enumtypes.h +videoblendorc.h diff --git a/gst-libs/gst/video/Makefile.am b/gst-libs/gst/video/Makefile.am index 21ce6e4..5ab524f 100644 --- a/gst-libs/gst/video/Makefile.am +++ b/gst-libs/gst/video/Makefile.am @@ -4,26 +4,45 @@ glib_enum_define = GST_VIDEO glib_gen_prefix = gst_video glib_gen_basename = video +lib_LTLIBRARIES = libgstvideo-@GST_MAJORMINOR@.la + +ORC_SOURCE=videoblendorc +include $(top_srcdir)/common/orc.mak + built_sources = video-enumtypes.c built_headers = video-enumtypes.h -BUILT_SOURCES = $(built_sources) $(built_headers) -lib_LTLIBRARIES = libgstvideo-@GST_MAJORMINOR@.la +# orc.mak sets BUILT_SOURCES as well +BUILT_SOURCES += $(built_sources) $(built_headers) CLEANFILES = $(BUILT_SOURCES) +# video-blend.h should be disted but not installed into the includedir libgstvideo_@GST_MAJORMINOR@_la_SOURCES = \ - video.c gstvideosink.c gstvideofilter.c convertframe.c -nodist_libgstvideo_@GST_MAJORMINOR@_la_SOURCES = $(BUILT_SOURCES) - + video.c gstvideosink.c gstvideofilter.c convertframe.c \ + video-blend.c video-blend.h +nodist_libgstvideo_@GST_MAJORMINOR@_la_SOURCES = \ + $(built_sources) $(built_headers) \ + $(ORC_NODIST_SOURCES) libgstvideo_@GST_MAJORMINOR@includedir = $(includedir)/gstreamer-@GST_MAJORMINOR@/gst/video libgstvideo_@GST_MAJORMINOR@include_HEADERS = \ video.h gstvideosink.h gstvideofilter.h nodist_libgstvideo_@GST_MAJORMINOR@include_HEADERS = $(built_headers) -libgstvideo_@GST_MAJORMINOR@_la_CFLAGS = $(GST_PLUGINS_BASE_CFLAGS) $(GST_BASE_CFLAGS) $(GST_CFLAGS) -libgstvideo_@GST_MAJORMINOR@_la_LIBADD = $(GST_BASE_LIBS) $(GST_LIBS) -libgstvideo_@GST_MAJORMINOR@_la_LDFLAGS = $(GST_LIB_LDFLAGS) $(GST_ALL_LDFLAGS) $(GST_LT_LDFLAGS) +libgstvideo_@GST_MAJORMINOR@_la_CFLAGS = \ + $(GST_PLUGINS_BASE_CFLAGS)\ + $(GST_BASE_CFLAGS) \ + $(GST_CFLAGS) \ + $(ORC_CFLAGS) + +libgstvideo_@GST_MAJORMINOR@_la_LIBADD = $(GST_BASE_LIBS) \ + $(GST_LIBS) \ + $(ORC_LIBS) + +libgstvideo_@GST_MAJORMINOR@_la_LDFLAGS = \ + $(GST_LIB_LDFLAGS) \ + $(GST_ALL_LDFLAGS) \ + $(GST_LT_LDFLAGS) include $(top_srcdir)/common/gst-glib-gen.mak @@ -31,9 +50,9 @@ if HAVE_INTROSPECTION BUILT_GIRSOURCES = GstVideo-@GST_MAJORMINOR@.gir gir_headers=$(patsubst %,$(srcdir)/%, $(libgstvideo_@GST_MAJORMINOR@include_HEADERS)) -gir_headers+=$(patsubst %,$(builddir)/%, $(nodist_libgstvideo_@GST_MAJORMINOR@include_HEADERS)) +gir_headers+=$(patsubst %,$(builddir)/%, $(built_headers)) gir_sources=$(patsubst %,$(srcdir)/%, $(libgstvideo_@GST_MAJORMINOR@_la_SOURCES)) -gir_sources+=$(patsubst %,$(builddir)/%, $(nodist_libgstvideo_@GST_MAJORMINOR@_la_SOURCES)) +gir_sources+=$(patsubst %,$(builddir)/%, $(built_sources)) gir_cincludes=$(patsubst %,--c-include='gst/video/%',$(libgstvideo_@GST_MAJORMINOR@include_HEADERS)) gir_cincludes+=$(patsubst %,--c-include='gst/video/%',$(nodist_libgstvideo_@GST_MAJORMINOR@include_HEADERS)) diff --git a/gst-libs/gst/video/video-blend.c b/gst-libs/gst/video/video-blend.c new file mode 100644 index 0000000..745d540 --- /dev/null +++ b/gst-libs/gst/video/video-blend.c @@ -0,0 +1,1423 @@ +/* Gstreamer video blending utility functions + * + * Copied/pasted from gst/videoconvert/videoconvert.c + * Copyright (C) 2010 David Schleef + * Copyright (C) 2010 Sebastian Dröge + * + * Copyright (C) <2011> Intel Corporation + * Copyright (C) <2011> Collabora Ltd. + * Copyright (C) <2011> Thibault Saunier + * + * This library is free software; you can redistribute it and/or + * modify it under the terms of the GNU Library General Public + * License as published by the Free Software Foundation; either + * version 2 of the License, or (at your option) any later version. + * + * This library is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU + * Library General Public License for more details. + * + * You should have received a copy of the GNU Library General Public + * License along with this library; if not, write to the + * Free Software Foundation, Inc., 59 Temple Place - Suite 330, + * Boston, MA 02111-1307, USA. + */ +#ifdef HAVE_CONFIG_H +#include "config.h" +#endif + +#include "video-blend.h" +#include "videoblendorc.h" + +#include + +#ifndef GST_DISABLE_GST_DEBUG + +#define GST_CAT_DEFAULT ensure_debug_category() + +static GstDebugCategory * +ensure_debug_category (void) +{ + static gsize cat_gonce = 0; + + if (g_once_init_enter (&cat_gonce)) { + gsize cat_done; + + cat_done = (gsize) _gst_debug_category_new ("video-blending", 0, + "video blending"); + + g_once_init_leave (&cat_gonce, cat_done); + } + + return (GstDebugCategory *) cat_gonce; +} + +#else + +#define ensure_debug_category() /* NOOP */ + +#endif /* GST_DISABLE_GST_DEBUG */ + +#if G_BYTE_ORDER == G_LITTLE_ENDIAN +# define ARGB_A 3 +# define ARGB_R 2 +# define ARGB_G 1 +# define ARGB_B 0 +#else +# define ARGB_A 0 +# define ARGB_R 1 +# define ARGB_G 2 +# define ARGB_B 3 +#endif + +/* Copy/pasted from 0.11 video.c */ +static int +fill_planes (GstBlendVideoFormatInfo * info) +{ + gint width, height; + + width = info->width; + height = info->height; + + switch (info->fmt) { + case GST_VIDEO_FORMAT_YUY2: + case GST_VIDEO_FORMAT_YVYU: + case GST_VIDEO_FORMAT_UYVY: + info->stride[0] = GST_ROUND_UP_4 (width * 2); + info->offset[0] = 0; + break; + case GST_VIDEO_FORMAT_AYUV: + case GST_VIDEO_FORMAT_RGBx: + case GST_VIDEO_FORMAT_RGBA: + case GST_VIDEO_FORMAT_BGRx: + case GST_VIDEO_FORMAT_BGRA: + case GST_VIDEO_FORMAT_xRGB: + case GST_VIDEO_FORMAT_ARGB: + case GST_VIDEO_FORMAT_xBGR: + case GST_VIDEO_FORMAT_ABGR: + case GST_VIDEO_FORMAT_r210: + info->stride[0] = width * 4; + info->offset[0] = 0; + break; + case GST_VIDEO_FORMAT_RGB16: + case GST_VIDEO_FORMAT_BGR16: + case GST_VIDEO_FORMAT_RGB15: + case GST_VIDEO_FORMAT_BGR15: + info->stride[0] = GST_ROUND_UP_4 (width * 2); + info->offset[0] = 0; + break; + case GST_VIDEO_FORMAT_RGB: + case GST_VIDEO_FORMAT_BGR: + case GST_VIDEO_FORMAT_v308: + info->stride[0] = GST_ROUND_UP_4 (width * 3); + info->offset[0] = 0; + break; + case GST_VIDEO_FORMAT_v210: + info->stride[0] = ((width + 47) / 48) * 128; + info->offset[0] = 0; + break; + case GST_VIDEO_FORMAT_v216: + info->stride[0] = GST_ROUND_UP_8 (width * 4); + info->offset[0] = 0; + break; + case GST_VIDEO_FORMAT_GRAY8: + case GST_VIDEO_FORMAT_Y800: + info->stride[0] = GST_ROUND_UP_4 (width); + info->offset[0] = 0; + break; + case GST_VIDEO_FORMAT_GRAY16_BE: + case GST_VIDEO_FORMAT_GRAY16_LE: + case GST_VIDEO_FORMAT_Y16: + info->stride[0] = GST_ROUND_UP_4 (width * 2); + info->offset[0] = 0; + break; + case GST_VIDEO_FORMAT_UYVP: + info->stride[0] = GST_ROUND_UP_4 ((width * 2 * 5 + 3) / 4); + info->offset[0] = 0; + break; + case GST_VIDEO_FORMAT_RGB8_PALETTED: + info->stride[0] = GST_ROUND_UP_4 (width); + info->offset[0] = 0; + break; + case GST_VIDEO_FORMAT_IYU1: + info->stride[0] = GST_ROUND_UP_4 (GST_ROUND_UP_4 (width) + + GST_ROUND_UP_4 (width) / 2); + info->offset[0] = 0; + break; + case GST_VIDEO_FORMAT_ARGB64: + case GST_VIDEO_FORMAT_AYUV64: + info->stride[0] = width * 8; + info->offset[0] = 0; + break; + case GST_VIDEO_FORMAT_I420: + info->stride[0] = GST_ROUND_UP_4 (width); + info->stride[1] = GST_ROUND_UP_4 (GST_ROUND_UP_2 (width) / 2); + info->stride[2] = info->stride[1]; + info->offset[0] = 0; + info->offset[1] = info->stride[0] * GST_ROUND_UP_2 (height); + info->offset[2] = info->offset[1] + + info->stride[1] * (GST_ROUND_UP_2 (height) / 2); + break; + case GST_VIDEO_FORMAT_YV12: /* same as I420, but plane 1+2 swapped */ + info->stride[0] = GST_ROUND_UP_4 (width); + info->stride[1] = GST_ROUND_UP_4 (GST_ROUND_UP_2 (width) / 2); + info->stride[2] = info->stride[1]; + info->offset[0] = 0; + info->offset[2] = info->stride[0] * GST_ROUND_UP_2 (height); + info->offset[1] = info->offset[2] + + info->stride[1] * (GST_ROUND_UP_2 (height) / 2); + break; + case GST_VIDEO_FORMAT_Y41B: + info->stride[0] = GST_ROUND_UP_4 (width); + info->stride[1] = GST_ROUND_UP_16 (width) / 4; + info->stride[2] = info->stride[1]; + info->offset[0] = 0; + info->offset[1] = info->stride[0] * height; + info->offset[2] = info->offset[1] + info->stride[1] * height; + /* simplification of ROUNDUP4(w)*h + 2*((ROUNDUP16(w)/4)*h */ + break; + case GST_VIDEO_FORMAT_Y42B: + info->stride[0] = GST_ROUND_UP_4 (width); + info->stride[1] = GST_ROUND_UP_8 (width) / 2; + info->stride[2] = info->stride[1]; + info->offset[0] = 0; + info->offset[1] = info->stride[0] * height; + info->offset[2] = info->offset[1] + info->stride[1] * height; + /* simplification of ROUNDUP4(w)*h + 2*(ROUNDUP8(w)/2)*h */ + break; + case GST_VIDEO_FORMAT_Y444: + info->stride[0] = GST_ROUND_UP_4 (width); + info->stride[1] = info->stride[0]; + info->stride[2] = info->stride[0]; + info->offset[0] = 0; + info->offset[1] = info->stride[0] * height; + info->offset[2] = info->offset[1] * 2; + break; + case GST_VIDEO_FORMAT_NV12: + case GST_VIDEO_FORMAT_NV21: + info->stride[0] = GST_ROUND_UP_4 (width); + info->stride[1] = info->stride[0]; + info->offset[0] = 0; + info->offset[1] = info->stride[0] * GST_ROUND_UP_2 (height); + break; + case GST_VIDEO_FORMAT_A420: + info->stride[0] = GST_ROUND_UP_4 (width); + info->stride[1] = GST_ROUND_UP_4 (GST_ROUND_UP_2 (width) / 2); + info->stride[2] = info->stride[1]; + info->stride[3] = info->stride[0]; + info->offset[0] = 0; + info->offset[1] = info->stride[0] * GST_ROUND_UP_2 (height); + info->offset[2] = info->offset[1] + + info->stride[1] * (GST_ROUND_UP_2 (height) / 2); + info->offset[3] = info->offset[2] + + info->stride[2] * (GST_ROUND_UP_2 (height) / 2); + break; + case GST_VIDEO_FORMAT_YUV9: + info->stride[0] = GST_ROUND_UP_4 (width); + info->stride[1] = GST_ROUND_UP_4 (GST_ROUND_UP_4 (width) / 4); + info->stride[2] = info->stride[1]; + info->offset[0] = 0; + info->offset[1] = info->stride[0] * height; + info->offset[2] = info->offset[1] + + info->stride[1] * (GST_ROUND_UP_4 (height) / 4); + break; + case GST_VIDEO_FORMAT_YVU9: + info->stride[0] = GST_ROUND_UP_4 (width); + info->stride[1] = GST_ROUND_UP_4 (GST_ROUND_UP_4 (width) / 4); + info->stride[2] = info->stride[1]; + info->offset[0] = 0; + info->offset[2] = info->stride[0] * height; + info->offset[1] = info->offset[2] + + info->stride[1] * (GST_ROUND_UP_4 (height) / 4); + break; + case GST_VIDEO_FORMAT_UNKNOWN: + GST_ERROR ("invalid format"); + g_warning ("invalid format"); + break; + } + return 0; +} + +typedef struct +{ + GstVideoFormat format; + void (*getline) (guint8 * dest, const GstBlendVideoFormatInfo * src, + guint xoff, int j); + void (*putline) (GstBlendVideoFormatInfo * dest, + GstBlendVideoFormatInfo * srcinfo, const guint8 * line, guint xoff, + int j); + void (*matrix) (guint8 * tmpline, guint width); +} GetPutLine; + + +#define GET_LINE(info, comp, line) \ + (info)->pixels + info->offset[(comp)] + ((info)->stride[(comp)] * (line)) + +/* Line conversion to AYUV */ + +/* Supports YV12 as well */ +static void +getline_I420 (guint8 * dest, const GstBlendVideoFormatInfo * src, guint xoff, + int j) +{ + cogorc_getline_I420 (dest, + GET_LINE (src, 0, j) + xoff, + GET_LINE (src, 1, j >> 1) + GST_ROUND_UP_2 (xoff / 2), + GET_LINE (src, 2, j >> 1) + GST_ROUND_UP_2 (xoff / 2), src->width); +} + +/* Supports YV12 as well */ +static void +putline_I420 (GstBlendVideoFormatInfo * dest, + GstBlendVideoFormatInfo * srcinfo, const guint8 * line, guint xoff, int j) +{ + cogorc_putline_I420 (GET_LINE (dest, 0, j) + xoff, + GET_LINE (dest, 1, j >> 1) + GST_ROUND_UP_2 (xoff / 2), + GET_LINE (dest, 2, j >> 1) + GST_ROUND_UP_2 (xoff / 2), + line, srcinfo->width / 2); +} + +static void +getline_YUY2 (guint8 * dest, const GstBlendVideoFormatInfo * src, guint xoff, + int j) +{ + cogorc_getline_YUY2 (dest, GET_LINE (src, 0, j) + + (GST_ROUND_UP_2 (xoff * 4) / 2), src->width / 2); +} + +static void +putline_YUY2 (GstBlendVideoFormatInfo * dest, GstBlendVideoFormatInfo * srcinfo, + const guint8 * line, guint xoff, int j) +{ + cogorc_putline_YUY2 (GET_LINE (dest, 0, + j) + (GST_ROUND_UP_2 (xoff * 4) / 2), line, srcinfo->width / 2); +} + + +static void +getline_AYUV (guint8 * dest, const GstBlendVideoFormatInfo * src, guint xoff, + int j) +{ + memcpy (dest, GET_LINE (src, 0, j) + (xoff * 4), (src->width - xoff) * 4); +} + +static void +putline_AYUV (GstBlendVideoFormatInfo * dest, GstBlendVideoFormatInfo * srcinfo, + const guint8 * line, guint xoff, int j) +{ + memcpy (GET_LINE (dest, 0, j) + (xoff * 4), line, srcinfo->width * 4); +} + +static void +getline_UYVY (guint8 * dest, const GstBlendVideoFormatInfo * src, guint xoff, + int j) +{ + cogorc_getline_UYVY (dest, GET_LINE (src, 0, j) + xoff * 2, src->width / 2); +} + +static void +putline_UYVY (GstBlendVideoFormatInfo * dest, GstBlendVideoFormatInfo * srcinfo, + const guint8 * line, guint xoff, int j) +{ + cogorc_putline_UYVY (GET_LINE (dest, 0, j) + + (GST_ROUND_UP_2 (xoff * 4) / 2), line, srcinfo->width / 2); +} + +static void +getline_v308 (guint8 * dest, const GstBlendVideoFormatInfo * src, guint xoff, + int j) +{ + int i; + const guint8 *srcline = GET_LINE (src, 0, j) + GST_ROUND_UP_2 (xoff * 3); + + for (i = 0; i < src->width; i++) { + dest[i * 4 + 0] = 0xff; + dest[i * 4 + 1] = srcline[i * 3 + 0]; + dest[i * 4 + 2] = srcline[i * 3 + 1]; + dest[i * 4 + 3] = srcline[i * 3 + 2]; + } +} + +static void +putline_v308 (GstBlendVideoFormatInfo * dest, GstBlendVideoFormatInfo * srcinfo, + const guint8 * line, guint xoff, int j) +{ + int i; + guint8 *destline = GET_LINE (dest, 0, j) + GST_ROUND_UP_2 (xoff * 3); + + for (i = 0; i < srcinfo->width; i++) { + destline[i * 3 + 0] = line[i * 4 + 1]; + destline[i * 3 + 1] = line[i * 4 + 2]; + destline[i * 3 + 2] = line[i * 4 + 3]; + } +} + +static void +getline_v210 (guint8 * dest, const GstBlendVideoFormatInfo * src, guint xoff, + int j) +{ + int i; + const guint8 *srcline = GET_LINE (src, 0, j) + GST_ROUND_UP_2 (xoff * 4) / 5; + + for (i = 0; i < src->width; i += 6) { + guint32 a0, a1, a2, a3; + guint16 y0, y1, y2, y3, y4, y5; + guint16 u0, u2, u4; + guint16 v0, v2, v4; + + a0 = GST_READ_UINT32_LE (srcline + (i / 6) * 16 + 0); + a1 = GST_READ_UINT32_LE (srcline + (i / 6) * 16 + 4); + a2 = GST_READ_UINT32_LE (srcline + (i / 6) * 16 + 8); + a3 = GST_READ_UINT32_LE (srcline + (i / 6) * 16 + 12); + + u0 = ((a0 >> 0) & 0x3ff) >> 2; + y0 = ((a0 >> 10) & 0x3ff) >> 2; + v0 = ((a0 >> 20) & 0x3ff) >> 2; + y1 = ((a1 >> 0) & 0x3ff) >> 2; + + u2 = ((a1 >> 10) & 0x3ff) >> 2; + y2 = ((a1 >> 20) & 0x3ff) >> 2; + v2 = ((a2 >> 0) & 0x3ff) >> 2; + y3 = ((a2 >> 10) & 0x3ff) >> 2; + + u4 = ((a2 >> 20) & 0x3ff) >> 2; + y4 = ((a3 >> 0) & 0x3ff) >> 2; + v4 = ((a3 >> 10) & 0x3ff) >> 2; + y5 = ((a3 >> 20) & 0x3ff) >> 2; + + dest[4 * (i + 0) + 0] = 0xff; + dest[4 * (i + 0) + 1] = y0; + dest[4 * (i + 0) + 2] = u0; + dest[4 * (i + 0) + 3] = v0; + + dest[4 * (i + 1) + 0] = 0xff; + dest[4 * (i + 1) + 1] = y1; + dest[4 * (i + 1) + 2] = u0; + dest[4 * (i + 1) + 3] = v0; + + dest[4 * (i + 2) + 0] = 0xff; + dest[4 * (i + 2) + 1] = y2; + dest[4 * (i + 2) + 2] = u2; + dest[4 * (i + 2) + 3] = v2; + + dest[4 * (i + 3) + 0] = 0xff; + dest[4 * (i + 3) + 1] = y3; + dest[4 * (i + 3) + 2] = u2; + dest[4 * (i + 3) + 3] = v2; + + dest[4 * (i + 4) + 0] = 0xff; + dest[4 * (i + 4) + 1] = y4; + dest[4 * (i + 4) + 2] = u4; + dest[4 * (i + 4) + 3] = v4; + + dest[4 * (i + 5) + 0] = 0xff; + dest[4 * (i + 5) + 1] = y5; + dest[4 * (i + 5) + 2] = u4; + dest[4 * (i + 5) + 3] = v4; + + } + +} + +static void +putline_v210 (GstBlendVideoFormatInfo * dest, GstBlendVideoFormatInfo * srcinfo, + const guint8 * line, guint xoff, int j) +{ + int i; + guint8 *destline = GET_LINE (dest, 0, j) + GST_ROUND_UP_2 (xoff * 4) / 5; + + + for (i = 0; i < srcinfo->width + 5; i += 6) { + guint32 a0, a1, a2, a3; + guint16 y0, y1, y2, y3, y4, y5; + guint16 u0, u1, u2; + guint16 v0, v1, v2; + + y0 = line[4 * (i + 0) + 1] << 2; + y1 = line[4 * (i + 1) + 1] << 2; + y2 = line[4 * (i + 2) + 1] << 2; + y3 = line[4 * (i + 3) + 1] << 2; + y4 = line[4 * (i + 4) + 1] << 2; + y5 = line[4 * (i + 5) + 1] << 2; + + u0 = (line[4 * (i + 0) + 2] + line[4 * (i + 1) + 2]) << 1; + u1 = (line[4 * (i + 2) + 2] + line[4 * (i + 3) + 2]) << 1; + u2 = (line[4 * (i + 4) + 2] + line[4 * (i + 5) + 2]) << 1; + + v0 = (line[4 * (i + 0) + 3] + line[4 * (i + 1) + 3]) << 1; + v1 = (line[4 * (i + 2) + 3] + line[4 * (i + 3) + 3]) << 1; + v2 = (line[4 * (i + 4) + 3] + line[4 * (i + 5) + 3]) << 1; + + a0 = u0 | (y0 << 10) | (v0 << 20); + a1 = y1 | (u1 << 10) | (y2 << 20); + a2 = v1 | (y3 << 10) | (u2 << 20); + a3 = y4 | (v2 << 10) | (y5 << 20); + + GST_WRITE_UINT32_LE (destline + (i / 6) * 16 + 0, a0); + GST_WRITE_UINT32_LE (destline + (i / 6) * 16 + 4, a1); + GST_WRITE_UINT32_LE (destline + (i / 6) * 16 + 8, a2); + GST_WRITE_UINT32_LE (destline + (i / 6) * 16 + 12, a3); + } +} + +static void +getline_v216 (guint8 * dest, const GstBlendVideoFormatInfo * src, guint xoff, + int j) +{ + int i; + const guint8 *srcline = GET_LINE (src, 0, j) + GST_ROUND_UP_2 (xoff + 3); + + for (i = 0; i < src->width; i++) { + dest[i * 4 + 0] = 0xff; + dest[i * 4 + 1] = GST_READ_UINT16_LE (srcline + i * 4 + 2) >> 8; + dest[i * 4 + 2] = GST_READ_UINT16_LE (srcline + (i >> 1) * 8 + 0) >> 8; + dest[i * 4 + 3] = GST_READ_UINT16_LE (srcline + (i >> 1) * 8 + 4) >> 8; + } +} + +static void +putline_v216 (GstBlendVideoFormatInfo * dest, GstBlendVideoFormatInfo * srcinfo, + const guint8 * line, guint xoff, int j) +{ + int i; + guint8 *destline = GET_LINE (dest, 0, j) + GST_ROUND_UP_2 (xoff + 3); + + for (i = 0; i < srcinfo->width / 2; i++) { + GST_WRITE_UINT16_LE (destline + i * 8 + 0, line[(i * 2 + 0) * 4 + 2] << 8); + GST_WRITE_UINT16_LE (destline + i * 8 + 2, line[(i * 2 + 0) * 4 + 1] << 8); + GST_WRITE_UINT16_LE (destline + i * 8 + 4, line[(i * 2 + 1) * 4 + 3] << 8); + GST_WRITE_UINT16_LE (destline + i * 8 + 8, line[(i * 2 + 0) * 4 + 1] << 8); + } +} + +static void +getline_Y41B (guint8 * dest, const GstBlendVideoFormatInfo * src, guint xoff, + int j) +{ + cogorc_getline_YUV9 (dest, + GET_LINE (src, 0, j) + xoff, + GET_LINE (src, 1, j) + (xoff / 4), GET_LINE (src, 2, j) + (xoff / 4), + src->width / 2); +} + +static void +putline_Y41B (GstBlendVideoFormatInfo * dest, + GstBlendVideoFormatInfo * srcinfo, const guint8 * line, guint xoff, int j) +{ + int i; + guint8 *destlineY = GET_LINE (dest, 0, j) + xoff; + guint8 *destlineU = GET_LINE (dest, 1, j) + (xoff / 4); + guint8 *destlineV = GET_LINE (dest, 2, j) + (xoff / 4); + + for (i = 0; i < srcinfo->width - 3; i += 4) { + destlineY[i] = line[i * 4 + 1]; + destlineY[i + 1] = line[i * 4 + 5]; + destlineY[i + 2] = line[i * 4 + 9]; + destlineY[i + 3] = line[i * 4 + 13]; + + destlineU[i >> 2] = + (line[i * 4 + 2] + line[i * 4 + 6] + line[i * 4 + 10] + line[i * 4 + + 14] + 2) >> 2; + destlineV[i >> 2] = + (line[i * 4 + 3] + line[i * 4 + 7] + line[i * 4 + 11] + line[i * 4 + + 15] + 2) >> 2; + } + + if (i == srcinfo->width - 3) { + destlineY[i] = line[i * 4 + 1]; + destlineY[i + 1] = line[i * 4 + 5]; + destlineY[i + 2] = line[i * 4 + 9]; + + destlineU[i >> 2] = + (line[i * 4 + 2] + line[i * 4 + 6] + line[i * 4 + 10] + 1) / 3; + destlineV[i >> 2] = + (line[i * 4 + 3] + line[i * 4 + 7] + line[i * 4 + 11] + 1) / 3; + } else if (i == srcinfo->width - 2) { + destlineY[i] = line[i * 4 + 1]; + destlineY[i + 1] = line[i * 4 + 5]; + + destlineU[i >> 2] = (line[i * 4 + 2] + line[i * 4 + 6] + 1) >> 1; + destlineV[i >> 2] = (line[i * 4 + 3] + line[i * 4 + 7] + 1) >> 1; + } else if (i == srcinfo->width - 1) { + destlineY[i + 1] = line[i * 4 + 5]; + + destlineU[i >> 2] = line[i * 4 + 2]; + destlineV[i >> 2] = line[i * 4 + 3]; + } +} + +static void +getline_Y42B (guint8 * dest, const GstBlendVideoFormatInfo * src, guint xoff, + int j) +{ + cogorc_getline_Y42B (dest, + GET_LINE (src, 0, j) + xoff, + GET_LINE (src, 1, j) + GST_ROUND_UP_2 (xoff / 2), + GET_LINE (src, 2, j) + GST_ROUND_UP_2 (xoff / 2), src->width / 2); +} + +static void +putline_Y42B (GstBlendVideoFormatInfo * dest, + GstBlendVideoFormatInfo * srcinfo, const guint8 * line, guint xoff, int j) +{ + cogorc_putline_Y42B (GET_LINE (dest, 0, j) + xoff, + GET_LINE (dest, 1, j) + GST_ROUND_UP_2 (xoff / 2), + GET_LINE (dest, 2, j) + GST_ROUND_UP_2 (xoff / 2), line, + srcinfo->width / 2); +} + +static void +getline_Y444 (guint8 * dest, const GstBlendVideoFormatInfo * src, guint xoff, + int j) +{ + cogorc_getline_Y444 (dest, + GET_LINE (src, 0, j) + xoff, + GET_LINE (src, 1, j) + xoff, GET_LINE (src, 2, j) + xoff, src->width); +} + +static void +putline_Y444 (GstBlendVideoFormatInfo * dest, + GstBlendVideoFormatInfo * srcinfo, const guint8 * line, guint xoff, int j) +{ + cogorc_putline_Y444 (GET_LINE (dest, 0, j) + xoff, + GET_LINE (dest, 1, j) + xoff, + GET_LINE (dest, 2, j) + xoff, line, srcinfo->width); +} + +static void +getline_Y800 (guint8 * dest, const GstBlendVideoFormatInfo * src, guint xoff, + int j) +{ + cogorc_getline_Y800 (dest, GET_LINE (src, 0, j) + xoff, src->width); +} + +static void +putline_Y800 (GstBlendVideoFormatInfo * dest, + GstBlendVideoFormatInfo * srcinfo, const guint8 * line, guint xoff, int j) +{ + cogorc_putline_Y800 (GET_LINE (dest, 0, j) + xoff, line, srcinfo->width); +} + +static void +getline_Y16 (guint8 * dest, const GstBlendVideoFormatInfo * src, guint xoff, + int j) +{ + cogorc_getline_Y16 (dest, GET_LINE (src, 0, j) + xoff * 2, src->width); +} + +static void +putline_Y16 (GstBlendVideoFormatInfo * dest, + GstBlendVideoFormatInfo * srcinfo, const guint8 * line, guint xoff, int j) +{ + cogorc_putline_Y16 (GET_LINE (dest, 0, j) + xoff * 2, line, srcinfo->width); +} + +static void +getline_NV12 (guint8 * dest, const GstBlendVideoFormatInfo * src, guint xoff, + int j) +{ + cogorc_getline_NV12 (dest, + GET_LINE (src, 0, j) + xoff, + GET_LINE (src, 1, j >> 1) + xoff, src->width / 2); +} + +static void +putline_NV12 (GstBlendVideoFormatInfo * dest, + GstBlendVideoFormatInfo * srcinfo, const guint8 * line, guint xoff, int j) +{ + cogorc_putline_NV12 (GET_LINE (dest, 0, j) + xoff, + GET_LINE (dest, 1, j >> 1) + xoff, line, srcinfo->width / 2); +} + +static void +getline_NV21 (guint8 * dest, const GstBlendVideoFormatInfo * src, guint xoff, + int j) +{ + cogorc_getline_NV21 (dest, + GET_LINE (src, 0, j) + xoff, + GET_LINE (src, 1, j >> 1) + xoff, src->width / 2); +} + +static void +putline_NV21 (GstBlendVideoFormatInfo * dest, + GstBlendVideoFormatInfo * srcinfo, const guint8 * line, guint xoff, int j) +{ + cogorc_putline_NV21 (GET_LINE (dest, 0, j) + xoff, + GET_LINE (dest, 1, j >> 1) + xoff, line, srcinfo->width / 2); +} + +static void +getline_UYVP (guint8 * dest, const GstBlendVideoFormatInfo * src, guint xoff, + int j) +{ + int i; + const guint8 *srcline = GET_LINE (src, 0, j) + + xoff * 3; + + for (i = 0; i < src->width; i += 2) { + guint16 y0, y1; + guint16 u0; + guint16 v0; + + u0 = (srcline[(i / 2) * 5 + 0] << 2) | (srcline[(i / 2) * 5 + 1] >> 6); + + y0 = ((srcline[(i / 2) * 5 + 1] & 0x3f) << 4) | + (srcline[(i / 2) * 5 + 2] >> 4); + + v0 = ((srcline[(i / 2) * 5 + 2] & 0x0f) << 6) | + (srcline[(i / 2) * 5 + 3] >> 2); + + y1 = ((srcline[(i / 2) * 5 + 3] & 0x03) << 8) | srcline[(i / 2) * 5 + 4]; + + dest[i * 4 + 0] = 0xff; + dest[i * 4 + 1] = y0 >> 2; + dest[i * 4 + 2] = u0 >> 2; + dest[i * 4 + 3] = v0 >> 2; + dest[i * 4 + 4] = 0xff; + dest[i * 4 + 5] = y1 >> 2; + dest[i * 4 + 6] = u0 >> 2; + dest[i * 4 + 7] = v0 >> 2; + } +} + +static void +putline_UYVP (GstBlendVideoFormatInfo * dest, + GstBlendVideoFormatInfo * srcinfo, const guint8 * line, guint xoff, int j) +{ + int i; + guint8 *destline = GET_LINE (dest, 0, j) + xoff * 3; + + for (i = 0; i < srcinfo->width; i += 2) { + guint16 y0, y1; + guint16 u0; + guint16 v0; + + y0 = line[4 * (i + 0) + 1]; + y1 = line[4 * (i + 1) + 1]; + u0 = (line[4 * (i + 0) + 2] + line[4 * (i + 1) + 2] + 1) >> 1; + v0 = (line[4 * (i + 0) + 3] + line[4 * (i + 1) + 3] + 1) >> 1; + + destline[(i / 2) * 5 + 0] = u0; + destline[(i / 2) * 5 + 1] = y0 >> 2; + destline[(i / 2) * 5 + 2] = (y0 << 6) | (v0 >> 4); + destline[(i / 2) * 5 + 3] = (v0 << 4) | (y1 >> 2); + destline[(i / 2) * 5 + 4] = (y1 << 2); + } +} + +static void +getline_A420 (guint8 * dest, const GstBlendVideoFormatInfo * src, guint xoff, + int j) +{ + cogorc_getline_A420 (dest, + GET_LINE (src, 0, j) + xoff, + GET_LINE (src, 1, j >> 1) + GST_ROUND_UP_2 (xoff / 2), + GET_LINE (src, 2, j >> 1) + GST_ROUND_UP_2 (xoff / 2), + GET_LINE (src, 3, j) + GST_ROUND_UP_2 (xoff / 2), src->width); +} + +static void +putline_A420 (GstBlendVideoFormatInfo * dest, + GstBlendVideoFormatInfo * srcinfo, const guint8 * line, guint xoff, int j) +{ + cogorc_putline_A420 (GET_LINE (dest, 0, j) + xoff, + GET_LINE (dest, 1, j >> 1) + GST_ROUND_UP_2 (xoff / 2), + GET_LINE (dest, 2, j >> 1) + GST_ROUND_UP_2 (xoff / 2), + GET_LINE (dest, 3, j) + GST_ROUND_UP_2 (xoff / 2), line, + srcinfo->width / 2); +} + +static void +getline_YUV9 (guint8 * dest, const GstBlendVideoFormatInfo * src, guint xoff, + int j) +{ + cogorc_getline_YUV9 (dest, + GET_LINE (src, 0, j) + xoff, + GET_LINE (src, 1, j >> 2) + GST_ROUND_UP_4 (xoff / 4), + GET_LINE (src, 2, j >> 2) + GST_ROUND_UP_4 (xoff / 4), src->width / 2); +} + +static void +putline_YUV9 (GstBlendVideoFormatInfo * dest, + GstBlendVideoFormatInfo * srcinfo, const guint8 * line, guint xoff, int j) +{ + int i; + guint8 *destY = GET_LINE (dest, 0, j) + xoff; + guint8 *destU = GET_LINE (dest, 1, j >> 2) + GST_ROUND_UP_4 (xoff / 4); + guint8 *destV = GET_LINE (dest, 2, j >> 2) + GST_ROUND_UP_4 (xoff / 4); + guint width = srcinfo->width; + + for (i = 0; i < width - 3; i += 4) { + destY[i] = line[i * 4 + 1]; + destY[i + 1] = line[i * 4 + 5]; + destY[i + 2] = line[i * 4 + 9]; + destY[i + 3] = line[i * 4 + 13]; + if (j % 4 == 0) { + destU[i >> 2] = + (line[i * 4 + 2] + line[i * 4 + 6] + line[i * 4 + 10] + line[i * 4 + + 14]) >> 2; + destV[i >> 2] = + (line[i * 4 + 3] + line[i * 4 + 7] + line[i * 4 + 11] + line[i * 4 + + 15]) >> 2; + } + } + + if (i == width - 3) { + destY[i] = line[i * 4 + 1]; + destY[i + 1] = line[i * 4 + 5]; + destY[i + 2] = line[i * 4 + 9]; + if (j % 4 == 0) { + destU[i >> 2] = + (line[i * 4 + 2] + line[i * 4 + 6] + line[i * 4 + 10]) / 3; + destV[i >> 2] = + (line[i * 4 + 3] + line[i * 4 + 7] + line[i * 4 + 11]) / 3; + } + } else if (i == width - 2) { + destY[i] = line[i * 4 + 1]; + destY[i + 1] = line[i * 4 + 5]; + if (j % 4 == 0) { + destU[i >> 2] = (line[i * 4 + 2] + line[i * 4 + 6]) >> 1; + destV[i >> 2] = (line[i * 4 + 3] + line[i * 4 + 7]) >> 1; + } + } else if (i == width - 1) { + destY[i] = line[i * 4 + 1]; + destU[i >> 2] = line[i * 4 + 2]; + destV[i >> 2] = line[i * 4 + 3]; + } +} + +static void +getline_IYU1 (guint8 * dest, const GstBlendVideoFormatInfo * src, guint xoff, + int j) +{ + int i; + const guint8 *srcline = + GET_LINE (src, 0, j) + GST_ROUND_UP_2 ((xoff * 3) / 2); + guint width = src->width; + + for (i = 0; i < width - 3; i += 4) { + dest[i * 4 + 0] = 0xff; + dest[i * 4 + 4] = 0xff; + dest[i * 4 + 8] = 0xff; + dest[i * 4 + 12] = 0xff; + dest[i * 4 + 1] = srcline[(i >> 2) * 6 + 1]; + dest[i * 4 + 5] = srcline[(i >> 2) * 6 + 2]; + dest[i * 4 + 9] = srcline[(i >> 2) * 6 + 4]; + dest[i * 4 + 13] = srcline[(i >> 2) * 6 + 5]; + dest[i * 4 + 2] = dest[i * 4 + 6] = dest[i * 4 + 10] = dest[i * 4 + 14] = + srcline[(i >> 2) * 6 + 0]; + dest[i * 4 + 3] = dest[i * 4 + 7] = dest[i * 4 + 11] = dest[i * 4 + 15] = + srcline[(i >> 2) * 6 + 3]; + } + + if (i == width - 3) { + dest[i * 4 + 0] = 0xff; + dest[i * 4 + 4] = 0xff; + dest[i * 4 + 8] = 0xff; + dest[i * 4 + 1] = srcline[(i >> 2) * 6 + 1]; + dest[i * 4 + 5] = srcline[(i >> 2) * 6 + 2]; + dest[i * 4 + 9] = srcline[(i >> 2) * 6 + 4]; + dest[i * 4 + 2] = dest[i * 4 + 6] = dest[i * 4 + 10] = + srcline[(i >> 2) * 6 + 0]; + dest[i * 4 + 3] = dest[i * 4 + 7] = dest[i * 4 + 11] = + srcline[(i >> 2) * 6 + 3]; + } else if (i == width - 2) { + dest[i * 4 + 0] = 0xff; + dest[i * 4 + 4] = 0xff; + dest[i * 4 + 1] = srcline[(i >> 2) * 6 + 1]; + dest[i * 4 + 5] = srcline[(i >> 2) * 6 + 2]; + dest[i * 4 + 2] = dest[i * 4 + 6] = srcline[(i >> 2) * 6 + 0]; + dest[i * 4 + 3] = dest[i * 4 + 7] = srcline[(i >> 2) * 6 + 3]; + } else if (i == width - 1) { + dest[i * 4 + 0] = 0xff; + dest[i * 4 + 1] = srcline[(i >> 2) * 6 + 1]; + dest[i * 4 + 2] = srcline[(i >> 2) * 6 + 0]; + dest[i * 4 + 3] = srcline[(i >> 2) * 6 + 3]; + } +} + +static void +putline_IYU1 (GstBlendVideoFormatInfo * dest, + GstBlendVideoFormatInfo * srcinfo, const guint8 * line, guint xoff, int j) +{ + int i; + guint8 *destline = GET_LINE (dest, 0, j) + GST_ROUND_UP_2 ((xoff * 3) / 2); + guint width = srcinfo->width; + + for (i = 0; i < width - 3; i += 4) { + destline[(i >> 2) * 6 + 1] = line[i * 4 + 1]; + destline[(i >> 2) * 6 + 2] = line[i * 4 + 5]; + destline[(i >> 2) * 6 + 4] = line[i * 4 + 9]; + destline[(i >> 2) * 6 + 5] = line[i * 4 + 13]; + destline[(i >> 2) * 6 + 0] = + (line[i * 4 + 2] + line[i * 4 + 6] + line[i * 4 + 10] + line[i * 4 + + 14]) >> 2; + destline[(i >> 2) * 6 + 3] = + (line[i * 4 + 3] + line[i * 4 + 7] + line[i * 4 + 11] + line[i * 4 + + 15]) >> 2; + } + + if (i == width - 3) { + destline[(i >> 2) * 6 + 1] = line[i * 4 + 1]; + destline[(i >> 2) * 6 + 2] = line[i * 4 + 5]; + destline[(i >> 2) * 6 + 4] = line[i * 4 + 9]; + destline[(i >> 2) * 6 + 0] = + (line[i * 4 + 2] + line[i * 4 + 6] + line[i * 4 + 10]) / 3; + destline[(i >> 2) * 6 + 3] = + (line[i * 4 + 3] + line[i * 4 + 7] + line[i * 4 + 11]) / 3; + } else if (i == width - 2) { + destline[(i >> 2) * 6 + 1] = line[i * 4 + 1]; + destline[(i >> 2) * 6 + 2] = line[i * 4 + 5]; + destline[(i >> 2) * 6 + 0] = (line[i * 4 + 2] + line[i * 4 + 6]) >> 1; + destline[(i >> 2) * 6 + 3] = (line[i * 4 + 3] + line[i * 4 + 7]) >> 1; + } else if (i == width - 1) { + destline[(i >> 2) * 6 + 1] = line[i * 4 + 1]; + destline[(i >> 2) * 6 + 0] = line[i * 4 + 2]; + destline[(i >> 2) * 6 + 3] = line[i * 4 + 3]; + } +} + + +/* Line conversion to ARGB */ +static void +getline_RGB (guint8 * dest, const GstBlendVideoFormatInfo * src, guint xoff, + int j) +{ + int i; + const guint8 *srcline = GET_LINE (src, 0, j) + xoff * 3; + + for (i = 0; i < src->width; i++) { + dest[i * 4 + 0] = 0xff; + dest[i * 4 + 1] = srcline[i * 3 + 0]; + dest[i * 4 + 2] = srcline[i * 3 + 1]; + dest[i * 4 + 3] = srcline[i * 3 + 2]; + } +} + +static void +putline_RGB (GstBlendVideoFormatInfo * dest, GstBlendVideoFormatInfo * srcinfo, + const guint8 * line, guint xoff, int j) +{ + int i; + guint8 *destline = GET_LINE (dest, 0, j) + xoff * 3; + + for (i = 0; i < srcinfo->width; i++) { + destline[i * 3 + 0] = line[i * 4 + 1]; + destline[i * 3 + 1] = line[i * 4 + 2]; + destline[i * 3 + 2] = line[i * 4 + 3]; + } +} + +static void +getline_BGR (guint8 * dest, const GstBlendVideoFormatInfo * src, guint xoff, + int j) +{ + int i; + const guint8 *srcline = GET_LINE (src, 0, j) + xoff * 3; + + for (i = 0; i < src->width; i++) { + dest[i * 4 + 0] = 0xff; + dest[i * 4 + 1] = srcline[i * 3 + 2]; + dest[i * 4 + 2] = srcline[i * 3 + 1]; + dest[i * 4 + 3] = srcline[i * 3 + 0]; + } +} + +static void +putline_BGR (GstBlendVideoFormatInfo * dest, GstBlendVideoFormatInfo * srcinfo, + const guint8 * line, guint xoff, int j) +{ + int i; + guint8 *destline = GET_LINE (dest, 0, j) + xoff * 3; + + for (i = 0; i < srcinfo->width; i++) { + destline[i * 3 + 0] = line[i * 4 + 3]; + destline[i * 3 + 1] = line[i * 4 + 2]; + destline[i * 3 + 2] = line[i * 4 + 1]; + } +} + +static void +getline_RGBA (guint8 * dest, const GstBlendVideoFormatInfo * src, guint xoff, + int j) +{ + cogorc_getline_RGBA (dest, GET_LINE (src, 0, j) + (4 * xoff), src->width); +} + +static void +putline_RGBA (GstBlendVideoFormatInfo * dest, GstBlendVideoFormatInfo * srcinfo, + const guint8 * line, guint xoff, int j) +{ + cogorc_putline_RGBA (GET_LINE (dest, 0, j) + (4 * xoff), + line, srcinfo->width); +} + +static void +getline_ARGB (guint8 * dest, const GstBlendVideoFormatInfo * src, guint xoff, + int j) +{ + + memcpy (dest, GET_LINE (src, 0, j), (src->width - xoff) * 4); +} + +static void +putline_ARGB (GstBlendVideoFormatInfo * dest, GstBlendVideoFormatInfo * srcinfo, + const guint8 * line, guint xoff, int j) +{ + memcpy (GET_LINE (dest, 0, j) + (xoff * 4), line, srcinfo->width * 4); +} + +static void +getline_RGB16 (guint8 * dest, const GstBlendVideoFormatInfo * src, guint xoff, + int j) +{ + int i; + const guint16 *srcline = (const guint16 *) GET_LINE (src, 0, j) + + (xoff * 3); + + for (i = 0; i < src->width; i++) { + dest[i * 4 + 0] = 0xff; + dest[i * 4 + 1] = ((srcline[i] >> 11) & 0x1f) << 3; + dest[i * 4 + 2] = ((srcline[i] >> 5) & 0x3f) << 2; + dest[i * 4 + 3] = ((srcline[i]) & 0x1f) << 3; + } +} + +static void +putline_RGB16 (GstBlendVideoFormatInfo * dest, + GstBlendVideoFormatInfo * srcinfo, const guint8 * line, guint xoff, int j) +{ + int i; + guint16 *destline = (guint16 *) GET_LINE (dest, 0, j) + (xoff * 3); + + for (i = 0; i < srcinfo->width; i++) { + destline[i] = ((line[i * 4 + 1] >> 3) << 11) | ((line[i * 4 + + 2] >> 2) << 5) | (line[i * 4 + 3] >> 3); + } +} + +static void +getline_RGB15 (guint8 * dest, const GstBlendVideoFormatInfo * src, guint xoff, + int j) +{ + int i; + const guint16 *srcline = (const guint16 *) GET_LINE (src, 0, j) + + (xoff * 3); + + for (i = 0; i < src->width; i++) { + dest[i * 4 + 0] = 0xff; + dest[i * 4 + 1] = ((srcline[i] >> 10) & 0x1f) << 3; + dest[i * 4 + 2] = ((srcline[i] >> 5) & 0x1f) << 3; + dest[i * 4 + 3] = ((srcline[i]) & 0x1f) << 3; + } +} + +static void +putline_RGB15 (GstBlendVideoFormatInfo * dest, + GstBlendVideoFormatInfo * srcinfo, const guint8 * line, guint xoff, int j) +{ + int i; + guint16 *destline = (guint16 *) GET_LINE (dest, 0, j) + (xoff * 3); + + for (i = 0; i < srcinfo->width; i++) { + destline[i] = ((line[i * 4 + 1] >> 3) << 10) | ((line[i * 4 + + 2] >> 3) << 5) | (line[i * 4 + 3] >> 3); + } +} + +static void +getline_BGR15 (guint8 * dest, const GstBlendVideoFormatInfo * src, guint xoff, + int j) +{ + int i; + const guint16 *srcline = (const guint16 *) GET_LINE (src, 0, j) + + (xoff * 3); + + for (i = 0; i < src->width; i++) { + dest[i * 4 + 0] = 0xff; + dest[i * 4 + 3] = ((srcline[i] >> 10) & 0x1f) << 3; + dest[i * 4 + 2] = ((srcline[i] >> 5) & 0x1f) << 3; + dest[i * 4 + 1] = ((srcline[i]) & 0x1f) << 3; + } +} + +static void +putline_BGR15 (GstBlendVideoFormatInfo * dest, + GstBlendVideoFormatInfo * srcinfo, const guint8 * line, guint xoff, int j) +{ + int i; + guint16 *destline = (guint16 *) GET_LINE (dest, 0, j) + (xoff * 3); + + for (i = 0; i < srcinfo->width; i++) { + destline[i] = ((line[i * 4 + 3] >> 3) << 10) | ((line[i * 4 + + 2] >> 3) << 5) | (line[i * 4 + 1] >> 3); + } +} + +static void +getline_BGR16 (guint8 * dest, const GstBlendVideoFormatInfo * src, guint xoff, + int j) +{ + int i; + const guint16 *srcline = (const guint16 *) GET_LINE (src, 0, j) + + (xoff * 3); + + for (i = 0; i < src->width; i++) { + dest[i * 4 + 0] = 0xff; + dest[i * 4 + 3] = ((srcline[i] >> 11) & 0x1f) << 3; + dest[i * 4 + 2] = ((srcline[i] >> 5) & 0x3f) << 2; + dest[i * 4 + 1] = ((srcline[i]) & 0x1f) << 3; + } +} + +static void +putline_BGR16 (GstBlendVideoFormatInfo * dest, + GstBlendVideoFormatInfo * srcinfo, const guint8 * line, guint xoff, int j) +{ + int i; + guint16 *destline = (guint16 *) GET_LINE (dest, 0, j) + (xoff * 3); + + for (i = 0; i < srcinfo->width; i++) { + destline[i] = ((line[i * 4 + 3] >> 3) << 11) | ((line[i * 4 + + 2] >> 2) << 5) | (line[i * 4 + 1] >> 3); + } +} + +static void +getline_BGRA (guint8 * dest, const GstBlendVideoFormatInfo * src, guint xoff, + int j) +{ + cogorc_getline_BGRA (dest, GET_LINE (src, 0, j) + xoff * 4, src->width); +} + +static void +putline_BGRA (GstBlendVideoFormatInfo * dest, + GstBlendVideoFormatInfo * srcinfo, const guint8 * line, guint xoff, int j) +{ + cogorc_putline_BGRA (GET_LINE (dest, 0, j) + xoff * 4, line, srcinfo->width); +} + +static void +getline_ABGR (guint8 * dest, const GstBlendVideoFormatInfo * src, guint xoff, + int j) +{ + cogorc_getline_ABGR (dest, GET_LINE (src, 0, j) + (xoff * 4), src->width); +} + +static void +putline_ABGR (GstBlendVideoFormatInfo * dest, + GstBlendVideoFormatInfo * srcinfo, const guint8 * line, guint xoff, int j) +{ + cogorc_putline_ABGR (GET_LINE (dest, 0, j) + (xoff * 4), + line, srcinfo->width); +} + +static const GetPutLine lines[] = { + /* YUV lines conversion */ + {GST_VIDEO_FORMAT_I420, getline_I420, putline_I420}, + {GST_VIDEO_FORMAT_YV12, getline_I420, putline_I420}, + {GST_VIDEO_FORMAT_AYUV, getline_AYUV, putline_AYUV}, + {GST_VIDEO_FORMAT_YUY2, getline_YUY2, putline_YUY2}, + {GST_VIDEO_FORMAT_UYVY, getline_UYVY, putline_UYVY}, + {GST_VIDEO_FORMAT_v308, getline_v308, putline_v308}, + {GST_VIDEO_FORMAT_v210, getline_v210, putline_v210}, + {GST_VIDEO_FORMAT_v216, getline_v216, putline_v216}, + {GST_VIDEO_FORMAT_Y41B, getline_Y41B, putline_Y41B}, + {GST_VIDEO_FORMAT_Y42B, getline_Y42B, putline_Y42B}, + {GST_VIDEO_FORMAT_Y444, getline_Y444, putline_Y444}, + {GST_VIDEO_FORMAT_Y800, getline_Y800, putline_Y800}, + {GST_VIDEO_FORMAT_Y16, getline_Y16, putline_Y16}, + {GST_VIDEO_FORMAT_NV12, getline_NV12, putline_NV12}, + {GST_VIDEO_FORMAT_NV21, getline_NV21, putline_NV21}, + {GST_VIDEO_FORMAT_UYVP, getline_UYVP, putline_UYVP}, + {GST_VIDEO_FORMAT_A420, getline_A420, putline_A420}, + {GST_VIDEO_FORMAT_YUV9, getline_YUV9, putline_YUV9}, + {GST_VIDEO_FORMAT_IYU1, getline_IYU1, putline_IYU1}, + + /* ARGB lines conversion */ + {GST_VIDEO_FORMAT_RGB, getline_RGB, putline_RGB}, + {GST_VIDEO_FORMAT_BGR, getline_BGR, putline_BGR}, + {GST_VIDEO_FORMAT_RGBx, getline_RGBA, putline_RGBA}, + {GST_VIDEO_FORMAT_RGBA, getline_RGBA, putline_RGBA}, + {GST_VIDEO_FORMAT_ARGB, getline_ARGB, putline_ARGB}, + {GST_VIDEO_FORMAT_RGB16, getline_RGB16, putline_RGB16}, + {GST_VIDEO_FORMAT_BGR16, getline_BGR16, putline_BGR16}, + {GST_VIDEO_FORMAT_BGR15, getline_BGR15, putline_BGR15}, + {GST_VIDEO_FORMAT_RGB15, getline_RGB15, putline_RGB15}, + {GST_VIDEO_FORMAT_BGRA, getline_BGRA, putline_BGRA}, + {GST_VIDEO_FORMAT_ABGR, getline_ABGR, putline_ABGR}, + {GST_VIDEO_FORMAT_BGRx, getline_BGRA, putline_BGRA} +}; + +static void +matrix_identity (guint8 * tmpline, guint width) +{ +} + +static void +matrix_rgb_to_yuv (guint8 * tmpline, guint width) +{ + int i; + int r, g, b; + int y, u, v; + + for (i = 0; i < width; i++) { + r = tmpline[i * 4 + 1]; + g = tmpline[i * 4 + 2]; + b = tmpline[i * 4 + 3]; + + y = (47 * r + 157 * g + 16 * b + 4096) >> 8; + u = (-26 * r - 87 * g + 112 * b + 32768) >> 8; + v = (112 * r - 102 * g - 10 * b + 32768) >> 8; + + tmpline[i * 4 + 1] = CLAMP (y, 0, 255); + tmpline[i * 4 + 2] = CLAMP (u, 0, 255); + tmpline[i * 4 + 3] = CLAMP (v, 0, 255); + } +} + +static void +matrix_yuv_to_rgb (guint8 * tmpline, guint width) +{ + int i; + int r, g, b; + int y, u, v; + + for (i = 0; i < width; i++) { + y = tmpline[i * 4 + 1]; + u = tmpline[i * 4 + 2]; + v = tmpline[i * 4 + 3]; + + r = (298 * y + 459 * v - 63514) >> 8; + g = (298 * y - 55 * u - 136 * v + 19681) >> 8; + b = (298 * y + 541 * u - 73988) >> 8; + + tmpline[i * 4 + ARGB_R] = CLAMP (r, 0, 255); + tmpline[i * 4 + ARGB_G] = CLAMP (g, 0, 255); + tmpline[i * 4 + ARGB_B] = CLAMP (b, 0, 255); + } +} + +static gboolean +lookup_getput (GetPutLine * getput, GstVideoFormat fmt) +{ + int i; + + getput->getline = NULL; + getput->putline = NULL; + getput->matrix = matrix_identity; + + for (i = 0; i < sizeof (lines) / sizeof (lines[0]); i++) { + if (lines[i].format == fmt) { + getput->getline = lines[i].getline; + getput->putline = lines[i].putline; + + return TRUE; + } + } + GST_WARNING ("Conversion from %i not supported", fmt); + + return FALSE; +} + +#define BLEND(ret, alpha, v0, v1) \ +{ \ + ret = (v0 * alpha + v1 * (255 - alpha)) / 255; \ +} + +void +video_blend_scale_linear_RGBA (GstBlendVideoFormatInfo * src, + gint dest_height, gint dest_width) +{ + int acc; + int y_increment; + int x_increment; + int y1; + int i; + int j; + int x; + int dest_size; + guint dest_stride = dest_width * 4; + guint src_stride = src->width * 4; + + guint8 *tmpbuf = g_malloc (dest_width * 8 * 4); + guint8 *dest_pixels = + g_malloc (gst_video_format_get_size (src->fmt, dest_height, + dest_width)); + + if (dest_height == 1) + y_increment = 0; + else + y_increment = ((src->height - 1) << 16) / (dest_height - 1) - 1; + + if (dest_width == 1) + x_increment = 0; + else + x_increment = ((src->width - 1) << 16) / (dest_width - 1) - 1; + + dest_size = dest_width * 4; + +#define LINE(x) ((tmpbuf) + (dest_size)*((x)&1)) + + acc = 0; + orc_resample_bilinear_u32 (LINE (0), src->pixels, 0, x_increment, dest_width); + y1 = 0; + for (i = 0; i < dest_height; i++) { + j = acc >> 16; + x = acc & 0xffff; + + if (x == 0) { + memcpy (dest_pixels + i * dest_stride, LINE (j), dest_size); + } else { + if (j > y1) { + orc_resample_bilinear_u32 (LINE (j), + src->pixels + j * src_stride, 0, x_increment, dest_width); + y1++; + } + if (j >= y1) { + orc_resample_bilinear_u32 (LINE (j + 1), + src->pixels + (j + 1) * src_stride, 0, x_increment, dest_width); + y1++; + } + orc_merge_linear_u8 (dest_pixels + i * dest_stride, + LINE (j), LINE (j + 1), (x >> 8), dest_width * 4); + } + + acc += y_increment; + } + + /* Update src, our reference to the old src->pixels is lost */ + video_blend_format_info_init (src, dest_pixels, dest_height, dest_width, + src->fmt); + + g_free (tmpbuf); +} + +/* video_blend: + * @dest: The #GstBlendVideoFormatInfo where to blend @src in + * @src: the #GstBlendVideoFormatInfo that we want to blend into + * @dest + * @x: The x offset in pixel where the @src image should be blended + * @y: the y offset in pixel where the @src image should be blended + * + * Lets you blend the @src image into the @dest image + */ +gboolean +video_blend (GstBlendVideoFormatInfo * dest, + GstBlendVideoFormatInfo * src, guint x, guint y) +{ + guint i, j; + guint8 alpha; + GetPutLine getputdest, getputsrc; + + gint src_stride = src->width * 4; + guint8 *tmpdestline = g_malloc (sizeof (guint8) * (dest->width + 8) * 4); + guint8 *tmpsrcline = g_malloc (sizeof (guint8) * (dest->width + 8) * 4); + + ensure_debug_category (); + + + if (!lookup_getput (&getputdest, dest->fmt)) + goto failed; + + if (!lookup_getput (&getputsrc, src->fmt)) + goto failed; + + if (gst_video_format_is_rgb (src->fmt) != gst_video_format_is_rgb (dest->fmt)) + getputsrc.matrix = gst_video_format_is_rgb (src->fmt) ? + matrix_rgb_to_yuv : matrix_yuv_to_rgb; + + /* adjust src pointers for negative sizes */ + if (x < 0) { + src += -x * 4; + src->width -= -x; + x = 0; + } + + if (y < 0) { + src += -y * src_stride; + src->height -= -y; + y = 0; + } + + /* adjust width/height if the src is bigger than dest */ + if (x + src->width > dest->width) + src->width = dest->width - x; + + if (y + src->height > dest->height) + src->height = dest->height - y; + + /* Mainloop doing the needed conversions, and blending */ + for (i = y; i < y + src->height; i++) { + + getputdest.getline (tmpdestline, dest, x, i); + getputsrc.getline (tmpsrcline, src, 0, (i - y)); + + getputsrc.matrix (tmpsrcline, src->width); + + /* Here dest and src are both either in AYUV or ARGB + * TODO: Make the orc version working properly*/ + for (j = 0; j < src->width * 4; j += 4) { + alpha = tmpsrcline[j]; + + BLEND (tmpdestline[j + 1], alpha, tmpsrcline[j + 1], tmpdestline[j + 1]); + BLEND (tmpdestline[j + 2], alpha, tmpsrcline[j + 2], tmpdestline[j + 2]); + BLEND (tmpdestline[j + 3], alpha, tmpsrcline[j + 3], tmpdestline[j + 3]); + } + + /* FIXME + * #if G_BYTE_ORDER == LITTLE_ENDIAN + * orc_blend_little (tmpdestline, tmpsrcline, dest->width); + * #else + * orc_blend_big (tmpdestline, tmpsrcline, src->width); + * #endif + */ + + getputdest.putline (dest, src, tmpdestline, x, i); + + } + + g_free (tmpdestline); + g_free (tmpsrcline); + + return TRUE; + +failed: + GST_WARNING ("Could not do the blending"); + g_free (tmpdestline); + g_free (tmpsrcline); + + return FALSE; +} + +/* video_blend_format_info_init: + * @info: The #GstBlendVideoFormatInfo to initialize + * @pixels: The pixels data in @fmt format + * @height: The height of the image + * @width: the width of the image + * @fmt: The #GstVideoFormat of the image + * + * Initializes a GstBlendVideoFormatInfo. + * This function can be called on already initialized instances. + */ +void +video_blend_format_info_init (GstBlendVideoFormatInfo * info, + guint8 * pixels, guint height, guint width, GstVideoFormat fmt) +{ + guint nb_component = gst_video_format_has_alpha (fmt) ? 4 : 3; + + ensure_debug_category (); + + GST_DEBUG + ("Initializing video bleding info, height %i, width %i, fmt %i nb_component %i", + height, width, fmt, nb_component); + + info->width = width; + info->height = height; + info->pixels = pixels; + info->fmt = fmt; + info->size = gst_video_format_get_size (fmt, height, width); + + fill_planes (info); +} diff --git a/gst-libs/gst/video/video-blend.h b/gst-libs/gst/video/video-blend.h new file mode 100644 index 0000000..3d9402e --- /dev/null +++ b/gst-libs/gst/video/video-blend.h @@ -0,0 +1,77 @@ +/* Gstreamer video blending utility functions + * + * Copyright (C) <2011> Intel Corporation + * Copyright (C) <2011> Collabora Ltd. + * Copyright (C) <2011> Thibault Saunier + * + * This library is free software; you can redistribute it and/or + * modify it under the terms of the GNU Library General Public + * License as published by the Free Software Foundation; either + * version 2 of the License, or (at your option) any later version. + * + * This library is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU + * Library General Public License for more details. + * + * You should have received a copy of the GNU Library General Public + * License along with this library; if not, write to the + * Free Software Foundation, Inc., 59 Temple Place - Suite 330, + * Boston, MA 02111-1307, USA. + */ + + +#ifndef __GST_VIDEO_BLEND__ +#define __GST_VIDEO_BLEND__ + +#include +#include + +#define MAX_VIDEO_PLANES 4 + +typedef struct _GstBlendVideoFormatInfo GstBlendVideoFormatInfo; + +/** + * GstBlendVideoFormatInfo: + * @fmt: The #GstVideoFormat describing the video format + * @width: The width of the video + * @height: The height of the video + * @pixels: The buffer containing the pixels of the video + * @size: The size in byte of @pixels + * @offset: The offsets of the different component of the video + * @stride: The stride of the different component of the video + * + * Information describing image properties containing necessary + * fields to do video blending. + */ +struct _GstBlendVideoFormatInfo +{ + GstVideoFormat fmt; + + gint width; + gint height; + + gint dest_width; + gint dest_height; + + guint8 * pixels; + gsize size; + + /* YUV components: Y=0, U=1, V=2, A=3 + * RGB components: R=0, G=1, B=2, A=3 */ + gint offset[MAX_VIDEO_PLANES]; + gint stride[MAX_VIDEO_PLANES]; +}; + +void video_blend_format_info_init (GstBlendVideoFormatInfo * info, + guint8 *pixels, guint height, + guint width, GstVideoFormat fmt); + +void video_blend_scale_linear_RGBA (GstBlendVideoFormatInfo * src, + gint dest_height, gint dest_width); + +gboolean video_blend (GstBlendVideoFormatInfo * dest, + GstBlendVideoFormatInfo * src, + guint x, guint y); + +#endif diff --git a/gst-libs/gst/video/videoblendorc.orc b/gst-libs/gst/video/videoblendorc.orc new file mode 100644 index 0000000..2bdae90 --- /dev/null +++ b/gst-libs/gst/video/videoblendorc.orc @@ -0,0 +1,498 @@ +.function orc_blend_little +.flags 1d +.dest 4 d guint8 +.source 4 s guint8 +.temp 4 t +.temp 2 tw +.temp 1 tb +.temp 4 a +.temp 8 d_wide +.temp 8 s_wide +.temp 8 a_wide +.const 4 a_alpha 0x000000ff + +loadl t, s +convlw tw, t +convwb tb, tw +splatbl a, tb +x4 convubw a_wide, a +x4 shruw a_wide, a_wide, 8 +x4 convubw s_wide, t +loadl t, d +x4 convubw d_wide, t +x4 subw s_wide, s_wide, d_wide +x4 mullw s_wide, s_wide, a_wide +x4 div255w s_wide, s_wide +x4 addw d_wide, d_wide, s_wide +x4 convwb t, d_wide +orl t, t, a_alpha +storel d, t + +.function orc_blend_big +.flags 1d +.dest 4 d guint8 +.source 4 s guint8 +.temp 4 t +.temp 4 t2 +.temp 2 tw +.temp 1 tb +.temp 4 a +.temp 8 d_wide +.temp 8 s_wide +.temp 8 a_wide +.const 4 a_alpha 0xff000000 + +loadl t, s +shrul t2, t, 24 +convlw tw, t2 +convwb tb, tw +splatbl a, tb +x4 convubw a_wide, a +x4 shruw a_wide, a_wide, 8 +x4 convubw s_wide, t +loadl t, d +x4 convubw d_wide, t +x4 subw s_wide, s_wide, d_wide +x4 mullw s_wide, s_wide, a_wide +x4 div255w s_wide, s_wide +x4 addw d_wide, d_wide, s_wide +x4 convwb t, d_wide +orl t, t, a_alpha +storel d, t + +.function cogorc_getline_I420 +.dest 4 d guint8 +.source 1 y guint8 +.source 1 u guint8 +.source 1 v guint8 +.const 1 c255 255 +.temp 2 uv +.temp 2 ay +.temp 1 tu +.temp 1 tv + +loadupdb tu, u +loadupdb tv, v +mergebw uv, tu, tv +mergebw ay, c255, y +mergewl d, ay, uv + + +.function cogorc_putline_I420 +.dest 2 y guint8 +.dest 1 u guint8 +.dest 1 v guint8 +.source 8 ayuv guint8 +.temp 4 ay +.temp 4 uv +.temp 2 uu +.temp 2 vv +.temp 1 t1 +.temp 1 t2 + +x2 splitlw uv, ay, ayuv +x2 select1wb y, ay +x2 splitwb vv, uu, uv +splitwb t1, t2, uu +avgub u, t1, t2 +splitwb t1, t2, vv +avgub v, t1, t2 + +.function cogorc_getline_YUY2 +.dest 8 ayuv guint8 +.source 4 yuy2 guint8 +.const 2 c255 0xff +.temp 2 yy +.temp 2 uv +.temp 4 ayay +.temp 4 uvuv + +x2 splitwb uv, yy, yuy2 +x2 mergebw ayay, c255, yy +mergewl uvuv, uv, uv +x2 mergewl ayuv, ayay, uvuv + + +.function cogorc_putline_YUY2 +.dest 4 yuy2 guint8 +.source 8 ayuv guint8 +.temp 2 yy +.temp 2 uv1 +.temp 2 uv2 +.temp 4 ayay +.temp 4 uvuv + +x2 splitlw uvuv, ayay, ayuv +splitlw uv1, uv2, uvuv +x2 avgub uv1, uv1, uv2 +x2 select1wb yy, ayay +x2 mergebw yuy2, yy, uv1 + + +.function cogorc_putline_UYVY +.dest 4 yuy2 guint8 +.source 8 ayuv guint8 +.temp 2 yy +.temp 2 uv1 +.temp 2 uv2 +.temp 4 ayay +.temp 4 uvuv + +x2 splitlw uvuv, ayay, ayuv +splitlw uv1, uv2, uvuv +x2 avgub uv1, uv1, uv2 +x2 select1wb yy, ayay +x2 mergebw yuy2, uv1, yy + + +.function cogorc_getline_UYVY +.dest 8 ayuv guint8 +.source 4 uyvy guint8 +.const 2 c255 0xff +.temp 2 yy +.temp 2 uv +.temp 4 ayay +.temp 4 uvuv + +x2 splitwb yy, uv, uyvy +x2 mergebw ayay, c255, yy +mergewl uvuv, uv, uv +x2 mergewl ayuv, ayay, uvuv + + +.function cogorc_getline_YUV9 +.dest 8 d guint8 +.source 2 y guint8 +.source 1 u guint8 +.source 1 v guint8 +.const 1 c255 255 +.temp 2 tuv +.temp 4 ay +.temp 4 uv +.temp 1 tu +.temp 1 tv + +loadupdb tu, u +loadupdb tv, v +mergebw tuv, tu, tv +mergewl uv, tuv, tuv +x2 mergebw ay, c255, y +x2 mergewl d, ay, uv + + +.function cogorc_getline_Y42B +.dest 8 ayuv guint8 +.source 2 yy guint8 +.source 1 u guint8 +.source 1 v guint8 +.const 1 c255 255 +.temp 2 uv +.temp 2 ay +.temp 4 uvuv +.temp 4 ayay + +mergebw uv, u, v +x2 mergebw ayay, c255, yy +mergewl uvuv, uv, uv +x2 mergewl ayuv, ayay, uvuv + +.function cogorc_putline_Y42B +.dest 2 y guint8 +.dest 1 u guint8 +.dest 1 v guint8 +.source 8 ayuv guint8 +.temp 4 ayay +.temp 4 uvuv +.temp 2 uv1 +.temp 2 uv2 + +x2 splitlw uvuv, ayay, ayuv +splitlw uv1, uv2, uvuv +x2 avgub uv1, uv1, uv2 +splitwb v, u, uv1 +x2 select1wb y, ayay + + +.function cogorc_getline_Y444 +.dest 4 ayuv guint8 +.source 1 y guint8 +.source 1 u guint8 +.source 1 v guint8 +.const 1 c255 255 +.temp 2 uv +.temp 2 ay + +mergebw uv, u, v +mergebw ay, c255, y +mergewl ayuv, ay, uv + + +.function cogorc_putline_Y444 +.dest 1 y guint8 +.dest 1 u guint8 +.dest 1 v guint8 +.source 4 ayuv guint8 +.temp 2 ay +.temp 2 uv + +splitlw uv, ay, ayuv +splitwb v, u, uv +select1wb y, ay + +.function cogorc_getline_Y800 +.dest 4 ayuv guint8 +.source 1 y guint8 +.const 1 c255 255 +.const 2 c0x8080 0x8080 +.temp 2 ay + +mergebw ay, c255, y +mergewl ayuv, ay, c0x8080 + + +.function cogorc_putline_Y800 +.dest 1 y guint8 +.source 4 ayuv guint8 +.temp 2 ay + +select0lw ay, ayuv +select1wb y, ay + + +.function cogorc_putline_Y16 +.dest 2 y guint8 +.source 4 ayuv guint8 +.temp 2 ay +.temp 1 yb + +select0lw ay, ayuv +select1wb yb, ay +convubw ay, yb +shlw y, ay, 8 + + +.function cogorc_getline_Y16 +.dest 4 ayuv guint8 +.source 2 y guint8 +.const 1 c255 255 +.const 2 c0x8080 0x8080 +.temp 2 ay +.temp 1 yb + +convhwb yb, y +mergebw ay, c255, yb +mergewl ayuv, ay, c0x8080 + +.function cogorc_getline_BGRA +.dest 4 argb guint8 +.source 4 bgra guint8 + +swapl argb, bgra + +.function cogorc_putline_BGRA +.dest 4 bgra guint8 +.source 4 argb guint8 + +swapl bgra, argb + +.function cogorc_putline_RGBA +.dest 4 rgba guint8 +.source 4 argb guint8 +.temp 1 a +.temp 1 r +.temp 1 g +.temp 1 b +.temp 2 rg +.temp 2 ba +.temp 2 ar +.temp 2 gb + +splitlw gb, ar, argb +splitwb b, g, gb +splitwb r, a, ar +mergebw ba, b, a +mergebw rg, r, g +mergewl rgba, rg, ba + +.function cogorc_getline_RGBA +.dest 4 argb guint8 +.source 4 rgba guint8 +.temp 1 a +.temp 1 r +.temp 1 g +.temp 1 b +.temp 2 rg +.temp 2 ba +.temp 2 ar +.temp 2 gb + +splitlw ba, rg, rgba +splitwb g, r, rg +splitwb a, b, ba +mergebw ar, a, r +mergebw gb, g, b +mergewl argb, ar, gb + + +.function cogorc_getline_ABGR +.dest 4 argb guint8 +.source 4 abgr guint8 +.temp 1 a +.temp 1 r +.temp 1 g +.temp 1 b +.temp 2 gr +.temp 2 ab +.temp 2 ar +.temp 2 gb + +splitlw gr, ab, abgr +splitwb r, g, gr +splitwb b, a, ab +mergebw ar, a, r +mergebw gb, g, b +mergewl argb, ar, gb + + +.function cogorc_putline_ABGR +.dest 4 abgr guint8 +.source 4 argb guint8 +.temp 1 a +.temp 1 r +.temp 1 g +.temp 1 b +.temp 2 gr +.temp 2 ab +.temp 2 ar +.temp 2 gb + +splitlw gb, ar, argb +splitwb b, g, gb +splitwb r, a, ar +mergebw ab, a, b +mergebw gr, g, r +mergewl abgr, ab, gr + +.function cogorc_getline_NV12 +.dest 8 d guint8 +.source 2 y guint8 +.source 2 uv guint8 +.const 1 c255 255 +.temp 4 ay +.temp 4 uvuv + +mergewl uvuv, uv, uv +x2 mergebw ay, c255, y +x2 mergewl d, ay, uvuv + +.function cogorc_putline_NV12 +.dest 2 y guint8 +.dest 2 uv guint8 +.source 8 ayuv guint8 +.temp 4 ay +.temp 4 uvuv +.temp 2 uv1 +.temp 2 uv2 + +x2 splitlw uvuv, ay, ayuv +x2 select1wb y, ay +splitlw uv1, uv2, uvuv +x2 avgub uv, uv1, uv2 + +.function cogorc_getline_NV21 +.dest 8 d guint8 +.source 2 y guint8 +.source 2 vu guint8 +.const 1 c255 255 +.temp 2 uv +.temp 4 ay +.temp 4 uvuv + +swapw uv, vu +mergewl uvuv, uv, uv +x2 mergebw ay, c255, y +x2 mergewl d, ay, uvuv + + +.function cogorc_putline_NV21 +.dest 2 y guint8 +.dest 2 vu guint8 +.source 8 ayuv guint8 +.temp 4 ay +.temp 4 uvuv +.temp 2 uv1 +.temp 2 uv2 +.temp 2 uv + +x2 splitlw uvuv, ay, ayuv +x2 select1wb y, ay +splitlw uv1, uv2, uvuv +x2 avgub uv, uv1, uv2 +swapw vu, uv + + +.function cogorc_getline_A420 +.dest 4 d guint8 +.source 1 y guint8 +.source 1 u guint8 +.source 1 v guint8 +.source 1 a guint8 +.temp 2 uv +.temp 2 ay +.temp 1 tu +.temp 1 tv + +loadupdb tu, u +loadupdb tv, v +mergebw uv, tu, tv +mergebw ay, a, y +mergewl d, ay, uv + +.function cogorc_putline_A420 +.dest 2 y guint8 +.dest 1 u guint8 +.dest 1 v guint8 +.dest 2 a guint8 +.source 8 ayuv guint8 +.temp 4 ay +.temp 4 uv +.temp 2 uu +.temp 2 vv +.temp 1 t1 +.temp 1 t2 + +x2 splitlw uv, ay, ayuv +x2 select1wb y, ay +x2 select0wb a, ay +x2 splitwb vv, uu, uv +splitwb t1, t2, uu +avgub u, t1, t2 +splitwb t1, t2, vv +avgub v, t1, t2 + +.function orc_resample_bilinear_u32 +.dest 4 d1 guint8 +.source 4 s1 guint8 +.param 4 p1 +.param 4 p2 + +ldreslinl d1, s1, p1, p2 + +.function orc_merge_linear_u8 +.dest 1 d1 +.source 1 s1 +.source 1 s2 +.param 1 p1 +.temp 2 t1 +.temp 2 t2 +.temp 1 a +.temp 1 t + +loadb a, s1 +convubw t1, s1 +convubw t2, s2 +subw t2, t2, t1 +mullw t2, t2, p1 +addw t2, t2, 128 +convhwb t, t2 +addb d1, t, a -- 2.7.4