blob: befab78ea7ac07de839af948f3c00ee1903dd210 [file] [log] [blame]
/* GStreamer
* Copyright (C) <1999> Erik Walthinsen <omega@cse.ogi.edu>
* Library <2002> Ronald Bultje <rbultje@ronald.bitfreak.net>
* Copyright (C) 2007 David A. Schleef <ds@schleef.org>
*
* 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., 51 Franklin St, Fifth Floor,
* Boston, MA 02110-1301, USA.
*/
#ifdef HAVE_CONFIG_H
# include "config.h"
#endif
#include <string.h>
#include <stdio.h>
#include "video-format.h"
#include "video-orc.h"
#ifndef restrict
#if defined(__STDC_VERSION__) && __STDC_VERSION__ >= 199901L
/* restrict should be available */
#elif defined(__GNUC__) && __GNUC__ >= 4
#define restrict __restrict__
#elif defined(_MSC_VER) && _MSC_VER >= 1500
#define restrict __restrict
#else
#define restrict /* no op */
#endif
#endif
/* Line conversion to AYUV */
#define GET_PLANE_STRIDE(plane) (stride(plane))
#define GET_PLANE_LINE(plane, line) \
(gpointer)(((guint8*)(data[plane])) + stride[plane] * (line))
#define GET_COMP_STRIDE(comp) \
GST_VIDEO_FORMAT_INFO_STRIDE (info, stride, comp)
#define GET_COMP_DATA(comp) \
GST_VIDEO_FORMAT_INFO_DATA (info, data, comp)
#define GET_COMP_LINE(comp, line) \
(gpointer)(((guint8*)GET_COMP_DATA (comp)) + \
GET_COMP_STRIDE(comp) * (line))
#define GET_LINE(line) GET_PLANE_LINE (0, line)
#define GET_Y_LINE(line) GET_COMP_LINE(GST_VIDEO_COMP_Y, line)
#define GET_U_LINE(line) GET_COMP_LINE(GST_VIDEO_COMP_U, line)
#define GET_V_LINE(line) GET_COMP_LINE(GST_VIDEO_COMP_V, line)
#define GET_R_LINE(line) GET_COMP_LINE(GST_VIDEO_COMP_R, line)
#define GET_G_LINE(line) GET_COMP_LINE(GST_VIDEO_COMP_G, line)
#define GET_B_LINE(line) GET_COMP_LINE(GST_VIDEO_COMP_B, line)
#define GET_A_LINE(line) GET_COMP_LINE(GST_VIDEO_COMP_A, line)
#define GET_UV_420(line, flags) \
(flags & GST_VIDEO_PACK_FLAG_INTERLACED ? \
((line & ~3) >> 1) + (line & 1) : \
line >> 1)
#define GET_UV_410(line, flags) \
(flags & GST_VIDEO_PACK_FLAG_INTERLACED ? \
((line & ~7) >> 2) + (line & 1) : \
line >> 2)
#define IS_CHROMA_LINE_420(line, flags) \
(flags & GST_VIDEO_PACK_FLAG_INTERLACED ? \
!(line & 2) : !(line & 1))
#define IS_CHROMA_LINE_410(line, flags) \
(flags & GST_VIDEO_PACK_FLAG_INTERLACED ? \
!(line & 6) : !(line & 3))
#define IS_ALIGNED(x,n) ((((guintptr)(x)&((n)-1))) == 0)
#define PACK_420 GST_VIDEO_FORMAT_AYUV, unpack_planar_420, 1, pack_planar_420
static void
unpack_planar_420 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
gpointer dest, const gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], gint x, gint y, gint width)
{
gint uv = GET_UV_420 (y, flags);
const guint8 *restrict sy = GET_Y_LINE (y);
const guint8 *restrict su = GET_U_LINE (uv);
const guint8 *restrict sv = GET_V_LINE (uv);
guint8 *restrict d = dest;
sy += x;
su += x >> 1;
sv += x >> 1;
if (x & 1) {
d[0] = 0xff;
d[1] = *sy++;
d[2] = *su++;
d[3] = *sv++;
width--;
d += 4;
}
video_orc_unpack_I420 (d, sy, su, sv, width);
}
static void
pack_planar_420 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
const gpointer src, gint sstride, gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], GstVideoChromaSite chroma_site,
gint y, gint width)
{
gint uv = GET_UV_420 (y, flags);
guint8 *dy = GET_Y_LINE (y);
guint8 *du = GET_U_LINE (uv);
guint8 *dv = GET_V_LINE (uv);
const guint8 *s = src;
if (IS_CHROMA_LINE_420 (y, flags)) {
if (IS_ALIGNED (s, 8))
video_orc_pack_I420 (dy, du, dv, s, width / 2);
else {
gint i;
for (i = 0; i < width / 2; i++) {
dy[i * 2 + 0] = s[i * 8 + 1];
dy[i * 2 + 1] = s[i * 8 + 5];
du[i] = s[i * 8 + 2];
dv[i] = s[i * 8 + 3];
}
}
if (width & 1) {
gint i = width - 1;
dy[i] = s[i * 4 + 1];
du[i >> 1] = s[i * 4 + 2];
dv[i >> 1] = s[i * 4 + 3];
}
} else
video_orc_pack_Y (dy, s, width);
}
#define PACK_YUY2 GST_VIDEO_FORMAT_AYUV, unpack_YUY2, 1, pack_YUY2
static void
unpack_YUY2 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
gpointer dest, const gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], gint x, gint y, gint width)
{
const guint8 *restrict s = GET_LINE (y);
guint8 *restrict d = dest;
s += (x & ~1) << 1;
if (x & 1) {
d[0] = 0xff;
d[1] = s[2];
d[2] = s[1];
d[3] = s[3];
s += 4;
d += 4;
width--;
}
if (IS_ALIGNED (d, 8))
video_orc_unpack_YUY2 (d, s, width / 2);
else {
gint i;
for (i = 0; i < width / 2; i++) {
d[i * 8 + 0] = 0xff;
d[i * 8 + 1] = s[i * 4 + 0];
d[i * 8 + 2] = s[i * 4 + 1];
d[i * 8 + 3] = s[i * 4 + 3];
d[i * 8 + 4] = 0xff;
d[i * 8 + 5] = s[i * 4 + 2];
d[i * 8 + 6] = s[i * 4 + 1];
d[i * 8 + 7] = s[i * 4 + 3];
}
}
if (width & 1) {
gint i = width - 1;
d[i * 4 + 0] = 0xff;
d[i * 4 + 1] = s[i * 2 + 0];
d[i * 4 + 2] = s[i * 2 + 1];
d[i * 4 + 3] = s[i * 2 + 3];
}
}
static void
pack_YUY2 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
const gpointer src, gint sstride, gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], GstVideoChromaSite chroma_site,
gint y, gint width)
{
guint8 *restrict d = GET_LINE (y);
const guint8 *restrict s = src;
if (IS_ALIGNED (s, 8))
video_orc_pack_YUY2 (d, s, width / 2);
else {
gint i;
for (i = 0; i < width / 2; i++) {
d[i * 4 + 0] = s[i * 8 + 1];
d[i * 4 + 1] = s[i * 8 + 2];
d[i * 4 + 2] = s[i * 8 + 5];
d[i * 4 + 3] = s[i * 8 + 3];
}
}
if (width & 1) {
gint i = width - 1;
d[i * 2 + 0] = s[i * 4 + 1];
d[i * 2 + 1] = s[i * 4 + 2];
d[i * 2 + 3] = s[i * 4 + 3];
}
}
#define PACK_UYVY GST_VIDEO_FORMAT_AYUV, unpack_UYVY, 1, pack_UYVY
static void
unpack_UYVY (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
gpointer dest, const gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], gint x, gint y, gint width)
{
const guint8 *s = GET_LINE (y);
guint8 *d = dest;
s += (x & ~1) << 1;
if (x & 1) {
d[0] = 0xff;
d[1] = s[3];
d[2] = s[0];
d[3] = s[2];
s += 4;
d += 4;
width--;
}
if (IS_ALIGNED (d, 8))
video_orc_unpack_UYVY (d, s, width / 2);
else {
gint i;
for (i = 0; i < width / 2; i++) {
d[i * 8 + 0] = 0xff;
d[i * 8 + 1] = s[i * 4 + 1];
d[i * 8 + 2] = s[i * 4 + 0];
d[i * 8 + 3] = s[i * 4 + 2];
d[i * 8 + 4] = 0xff;
d[i * 8 + 5] = s[i * 4 + 3];
d[i * 8 + 6] = s[i * 4 + 0];
d[i * 8 + 7] = s[i * 4 + 2];
}
}
if (width & 1) {
gint i = width - 1;
d[i * 4 + 0] = 0xff;
d[i * 4 + 1] = s[i * 2 + 1];
d[i * 4 + 2] = s[i * 2 + 0];
d[i * 4 + 3] = s[i * 2 + 2];
}
}
static void
pack_UYVY (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
const gpointer src, gint sstride, gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], GstVideoChromaSite chroma_site,
gint y, gint width)
{
guint8 *restrict d = GET_LINE (y);
const guint8 *restrict s = src;
if (IS_ALIGNED (s, 8))
video_orc_pack_UYVY (d, s, width / 2);
else {
gint i;
for (i = 0; i < width / 2; i++) {
d[i * 4 + 0] = s[i * 8 + 2];
d[i * 4 + 1] = s[i * 8 + 1];
d[i * 4 + 2] = s[i * 8 + 3];
d[i * 4 + 3] = s[i * 8 + 5];
}
}
if (width & 1) {
gint i = width - 1;
d[i * 2 + 0] = s[i * 4 + 2];
d[i * 2 + 1] = s[i * 4 + 1];
d[i * 2 + 2] = s[i * 4 + 3];
}
}
#define PACK_VYUY GST_VIDEO_FORMAT_AYUV, unpack_VYUY, 1, pack_VYUY
static void
unpack_VYUY (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
gpointer dest, const gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], gint x, gint y, gint width)
{
const guint8 *s = GET_LINE (y);
guint8 *d = dest;
s += (x & ~1) << 1;
if (x & 1) {
d[0] = 0xff;
d[1] = s[3];
d[2] = s[0];
d[3] = s[2];
s += 4;
d += 4;
width--;
}
if (IS_ALIGNED (d, 8))
video_orc_unpack_VYUY (d, s, width / 2);
else {
gint i;
for (i = 0; i < width / 2; i++) {
d[i * 8 + 0] = 0xff;
d[i * 8 + 1] = s[i * 4 + 1];
d[i * 8 + 2] = s[i * 4 + 0];
d[i * 8 + 3] = s[i * 4 + 2];
d[i * 8 + 4] = 0xff;
d[i * 8 + 5] = s[i * 4 + 3];
d[i * 8 + 6] = s[i * 4 + 0];
d[i * 8 + 7] = s[i * 4 + 2];
}
}
if (width & 1) {
gint i = width - 1;
d[i * 4 + 0] = 0xff;
d[i * 4 + 1] = s[i * 2 + 1];
d[i * 4 + 2] = s[i * 2 + 0];
d[i * 4 + 3] = s[i * 2 + 2];
}
}
static void
pack_VYUY (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
const gpointer src, gint sstride, gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], GstVideoChromaSite chroma_site,
gint y, gint width)
{
guint8 *restrict d = GET_LINE (y);
const guint8 *restrict s = src;
if (IS_ALIGNED (s, 8))
video_orc_pack_VYUY (d, s, width / 2);
else {
gint i;
for (i = 0; i < width / 2; i++) {
d[i * 4 + 0] = s[i * 8 + 2];
d[i * 4 + 1] = s[i * 8 + 1];
d[i * 4 + 2] = s[i * 8 + 3];
d[i * 4 + 3] = s[i * 8 + 5];
}
}
if (width & 1) {
gint i = width - 1;
d[i * 2 + 0] = s[i * 4 + 2];
d[i * 2 + 1] = s[i * 4 + 1];
d[i * 2 + 2] = s[i * 4 + 3];
}
}
#define PACK_YVYU GST_VIDEO_FORMAT_AYUV, unpack_YVYU, 1, pack_YVYU
static void
unpack_YVYU (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
gpointer dest, const gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], gint x, gint y, gint width)
{
const guint8 *restrict s = GET_LINE (y);
guint8 *restrict d = dest;
s += (x & ~1) << 1;
if (x & 1) {
d[0] = 0xff;
d[1] = s[2];
d[2] = s[3];
d[3] = s[1];
s += 4;
d += 4;
width--;
}
if (IS_ALIGNED (d, 8))
video_orc_unpack_YVYU (d, s, width / 2);
else {
gint i;
for (i = 0; i < width / 2; i++) {
d[i * 8 + 0] = 0xff;
d[i * 8 + 1] = s[i * 4 + 0];
d[i * 8 + 2] = s[i * 4 + 3];
d[i * 8 + 3] = s[i * 4 + 1];
d[i * 8 + 4] = 0xff;
d[i * 8 + 5] = s[i * 4 + 2];
d[i * 8 + 6] = s[i * 4 + 3];
d[i * 8 + 7] = s[i * 4 + 1];
}
}
if (width & 1) {
gint i = width - 1;
d[i * 4 + 0] = 0xff;
d[i * 4 + 1] = s[i * 2 + 0];
d[i * 4 + 2] = s[i * 2 + 3];
d[i * 4 + 3] = s[i * 2 + 1];
}
}
static void
pack_YVYU (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
const gpointer src, gint sstride, gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], GstVideoChromaSite chroma_site,
gint y, gint width)
{
guint8 *restrict d = GET_LINE (y);
const guint8 *restrict s = src;
if (IS_ALIGNED (s, 8))
video_orc_pack_YVYU (d, s, width / 2);
else {
gint i;
for (i = 0; i < width / 2; i++) {
d[i * 4 + 0] = s[i * 8 + 1];
d[i * 4 + 1] = s[i * 8 + 3];
d[i * 4 + 2] = s[i * 8 + 5];
d[i * 4 + 3] = s[i * 8 + 2];
}
}
if (width & 1) {
gint i = width - 1;
d[i * 2 + 0] = s[i * 4 + 1];
d[i * 2 + 1] = s[i * 4 + 3];
d[i * 2 + 3] = s[i * 4 + 2];
}
}
#define PACK_v308 GST_VIDEO_FORMAT_AYUV, unpack_v308, 1, pack_v308
static void
unpack_v308 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
gpointer dest, const gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], gint x, gint y, gint width)
{
int i;
const guint8 *restrict s = GET_LINE (y);
guint8 *restrict d = dest;
s += x * 3;
for (i = 0; i < width; i++) {
d[i * 4 + 0] = 0xff;
d[i * 4 + 1] = s[i * 3 + 0];
d[i * 4 + 2] = s[i * 3 + 1];
d[i * 4 + 3] = s[i * 3 + 2];
}
}
static void
pack_v308 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
const gpointer src, gint sstride, gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], GstVideoChromaSite chroma_site,
gint y, gint width)
{
int i;
guint8 *restrict d = GET_LINE (y);
const guint8 *restrict s = src;
for (i = 0; i < width; i++) {
d[i * 3 + 0] = s[i * 4 + 1];
d[i * 3 + 1] = s[i * 4 + 2];
d[i * 3 + 2] = s[i * 4 + 3];
}
}
#define PACK_IYU2 GST_VIDEO_FORMAT_AYUV, unpack_IYU2, 1, pack_IYU2
static void
unpack_IYU2 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
gpointer dest, const gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], gint x, gint y, gint width)
{
int i;
const guint8 *restrict s = GET_LINE (y);
guint8 *restrict d = dest;
s += x * 3;
for (i = 0; i < width; i++) {
d[i * 4 + 0] = 0xff;
d[i * 4 + 1] = s[i * 3 + 1];
d[i * 4 + 2] = s[i * 3 + 0];
d[i * 4 + 3] = s[i * 3 + 2];
}
}
static void
pack_IYU2 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
const gpointer src, gint sstride, gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], GstVideoChromaSite chroma_site,
gint y, gint width)
{
int i;
guint8 *restrict d = GET_LINE (y);
const guint8 *restrict s = src;
for (i = 0; i < width; i++) {
d[i * 3 + 0] = s[i * 4 + 2];
d[i * 3 + 1] = s[i * 4 + 1];
d[i * 3 + 2] = s[i * 4 + 3];
}
}
#define PACK_AYUV GST_VIDEO_FORMAT_AYUV, unpack_copy4, 1, pack_copy4
#define PACK_ARGB GST_VIDEO_FORMAT_ARGB, unpack_copy4, 1, pack_copy4
static void
unpack_copy4 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
gpointer dest, const gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], gint x, gint y, gint width)
{
const guint8 *restrict s = GET_LINE (y);
s += x * 4;
memcpy (dest, s, width * 4);
}
static void
pack_copy4 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
const gpointer src, gint sstride, gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], GstVideoChromaSite chroma_site,
gint y, gint width)
{
guint8 *restrict d = GET_LINE (y);
memcpy (d, src, width * 4);
}
#define PACK_v210 GST_VIDEO_FORMAT_AYUV64, unpack_v210, 1, pack_v210
static void
unpack_v210 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
gpointer dest, const gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], gint x, gint y, gint width)
{
int i;
const guint8 *restrict s = GET_LINE (y);
guint16 *restrict d = dest;
guint32 a0, a1, a2, a3;
guint16 y0, y1, y2, y3, y4, y5;
guint16 u0, u2, u4;
guint16 v0, v2, v4;
/* FIXME */
s += x * 2;
for (i = 0; i < width; i += 6) {
a0 = GST_READ_UINT32_LE (s + (i / 6) * 16 + 0);
a1 = GST_READ_UINT32_LE (s + (i / 6) * 16 + 4);
a2 = GST_READ_UINT32_LE (s + (i / 6) * 16 + 8);
a3 = GST_READ_UINT32_LE (s + (i / 6) * 16 + 12);
u0 = ((a0 >> 0) & 0x3ff) << 6;
y0 = ((a0 >> 10) & 0x3ff) << 6;
v0 = ((a0 >> 20) & 0x3ff) << 6;
y1 = ((a1 >> 0) & 0x3ff) << 6;
u2 = ((a1 >> 10) & 0x3ff) << 6;
y2 = ((a1 >> 20) & 0x3ff) << 6;
v2 = ((a2 >> 0) & 0x3ff) << 6;
y3 = ((a2 >> 10) & 0x3ff) << 6;
u4 = ((a2 >> 20) & 0x3ff) << 6;
y4 = ((a3 >> 0) & 0x3ff) << 6;
v4 = ((a3 >> 10) & 0x3ff) << 6;
y5 = ((a3 >> 20) & 0x3ff) << 6;
if (!(flags & GST_VIDEO_PACK_FLAG_TRUNCATE_RANGE)) {
y0 |= (y0 >> 10);
y1 |= (y1 >> 10);
u0 |= (u0 >> 10);
v0 |= (v0 >> 10);
y2 |= (y2 >> 10);
y3 |= (y3 >> 10);
u2 |= (u2 >> 10);
v2 |= (v2 >> 10);
y4 |= (y4 >> 10);
y5 |= (y5 >> 10);
u4 |= (u4 >> 10);
v4 |= (v4 >> 10);
}
d[4 * (i + 0) + 0] = 0xffff;
d[4 * (i + 0) + 1] = y0;
d[4 * (i + 0) + 2] = u0;
d[4 * (i + 0) + 3] = v0;
if (i < width - 1) {
d[4 * (i + 1) + 0] = 0xffff;
d[4 * (i + 1) + 1] = y1;
d[4 * (i + 1) + 2] = u0;
d[4 * (i + 1) + 3] = v0;
}
if (i < width - 2) {
d[4 * (i + 2) + 0] = 0xffff;
d[4 * (i + 2) + 1] = y2;
d[4 * (i + 2) + 2] = u2;
d[4 * (i + 2) + 3] = v2;
}
if (i < width - 3) {
d[4 * (i + 3) + 0] = 0xffff;
d[4 * (i + 3) + 1] = y3;
d[4 * (i + 3) + 2] = u2;
d[4 * (i + 3) + 3] = v2;
}
if (i < width - 4) {
d[4 * (i + 4) + 0] = 0xffff;
d[4 * (i + 4) + 1] = y4;
d[4 * (i + 4) + 2] = u4;
d[4 * (i + 4) + 3] = v4;
}
if (i < width - 5) {
d[4 * (i + 5) + 0] = 0xffff;
d[4 * (i + 5) + 1] = y5;
d[4 * (i + 5) + 2] = u4;
d[4 * (i + 5) + 3] = v4;
}
}
}
static void
pack_v210 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
const gpointer src, gint sstride, gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], GstVideoChromaSite chroma_site,
gint y, gint width)
{
int i;
guint8 *restrict d = GET_LINE (y);
const guint16 *restrict s = src;
guint32 a0, a1, a2, a3;
guint16 y0, y1, y2, y3, y4, y5;
guint16 u0, u1, u2;
guint16 v0, v1, v2;
for (i = 0; i < width - 5; i += 6) {
y0 = s[4 * (i + 0) + 1] >> 6;
y1 = s[4 * (i + 1) + 1] >> 6;
y2 = s[4 * (i + 2) + 1] >> 6;
y3 = s[4 * (i + 3) + 1] >> 6;
y4 = s[4 * (i + 4) + 1] >> 6;
y5 = s[4 * (i + 5) + 1] >> 6;
u0 = s[4 * (i + 0) + 2] >> 6;
u1 = s[4 * (i + 2) + 2] >> 6;
u2 = s[4 * (i + 4) + 2] >> 6;
v0 = s[4 * (i + 0) + 3] >> 6;
v1 = s[4 * (i + 2) + 3] >> 6;
v2 = s[4 * (i + 4) + 3] >> 6;
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 (d + (i / 6) * 16 + 0, a0);
GST_WRITE_UINT32_LE (d + (i / 6) * 16 + 4, a1);
GST_WRITE_UINT32_LE (d + (i / 6) * 16 + 8, a2);
GST_WRITE_UINT32_LE (d + (i / 6) * 16 + 12, a3);
}
if (i < width) {
y0 = s[4 * (i + 0) + 1] >> 6;
u0 = s[4 * (i + 0) + 2] >> 6;
v0 = s[4 * (i + 0) + 3] >> 6;
if (i < width - 1)
y1 = s[4 * (i + 1) + 1] >> 6;
else
y1 = y0;
if (i < width - 2) {
y2 = s[4 * (i + 2) + 1] >> 6;
u1 = s[4 * (i + 2) + 2] >> 6;
v1 = s[4 * (i + 2) + 3] >> 6;
} else {
y2 = y1;
u1 = u0;
v1 = v0;
}
if (i < width - 3)
y3 = s[4 * (i + 3) + 1] >> 6;
else
y3 = y2;
if (i < width - 4) {
y4 = s[4 * (i + 4) + 1] >> 6;
u2 = s[4 * (i + 4) + 2] >> 6;
v2 = s[4 * (i + 4) + 3] >> 6;
} else {
y4 = y3;
u2 = u1;
v2 = v1;
}
y5 = y4;
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 (d + (i / 6) * 16 + 0, a0);
GST_WRITE_UINT32_LE (d + (i / 6) * 16 + 4, a1);
GST_WRITE_UINT32_LE (d + (i / 6) * 16 + 8, a2);
GST_WRITE_UINT32_LE (d + (i / 6) * 16 + 12, a3);
}
}
#define PACK_v216 GST_VIDEO_FORMAT_AYUV64, unpack_v216, 1, pack_v216
static void
unpack_v216 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
gpointer dest, const gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], gint x, gint y, gint width)
{
int i;
const guint8 *restrict s = GET_LINE (y);
guint16 *restrict d = dest;
s += (x & ~1) << 2;
if (x & 1) {
d[0] = 0xffff;
d[1] = GST_READ_UINT16_LE (s + 6);
d[2] = GST_READ_UINT16_LE (s + 0);
d[3] = GST_READ_UINT16_LE (s + 4);
s += 8;
d += 4;
width--;
}
for (i = 0; i < width; i++) {
d[i * 4 + 0] = 0xffff;
d[i * 4 + 1] = GST_READ_UINT16_LE (s + i * 4 + 2);
d[i * 4 + 2] = GST_READ_UINT16_LE (s + (i >> 1) * 8 + 0);
d[i * 4 + 3] = GST_READ_UINT16_LE (s + (i >> 1) * 8 + 4);
}
}
static void
pack_v216 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
const gpointer src, gint sstride, gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], GstVideoChromaSite chroma_site,
gint y, gint width)
{
int i;
guint8 *restrict d = GET_LINE (y);
const guint16 *restrict s = src;
for (i = 0; i < width - 1; i += 2) {
GST_WRITE_UINT16_LE (d + i * 4 + 0, s[(i + 0) * 4 + 2]);
GST_WRITE_UINT16_LE (d + i * 4 + 2, s[(i + 0) * 4 + 1]);
GST_WRITE_UINT16_LE (d + i * 4 + 4, s[(i + 0) * 4 + 3]);
GST_WRITE_UINT16_LE (d + i * 4 + 6, s[(i + 1) * 4 + 1]);
}
if (i == width - 1) {
GST_WRITE_UINT16_LE (d + i * 4 + 0, s[i * 4 + 2]);
GST_WRITE_UINT16_LE (d + i * 4 + 2, s[i * 4 + 1]);
GST_WRITE_UINT16_LE (d + i * 4 + 4, s[i * 4 + 3]);
GST_WRITE_UINT16_LE (d + i * 4 + 6, s[i * 4 + 1]);
}
}
#define PACK_Y41B GST_VIDEO_FORMAT_AYUV, unpack_Y41B, 1, pack_Y41B
static void
unpack_Y41B (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
gpointer dest, const gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], gint x, gint y, gint width)
{
const guint8 *restrict sy = GET_Y_LINE (y);
const guint8 *restrict su = GET_U_LINE (y);
const guint8 *restrict sv = GET_V_LINE (y);
guint8 *restrict d = dest;
sy += x;
su += x >> 2;
sv += x >> 2;
if (x & 3) {
for (; x & 3; x++) {
d[0] = 0xff;
d[1] = *sy++;
d[2] = *su;
d[3] = *sv;
width--;
d += 4;
}
su++;
sy++;
}
if (IS_ALIGNED (d, 8))
video_orc_unpack_YUV9 (d, sy, su, sv, width / 2);
else {
gint i;
for (i = 0; i < width / 2; i++) {
d[i * 8 + 0] = 0xff;
d[i * 8 + 1] = sy[i * 2 + 0];
d[i * 8 + 2] = su[i >> 1];
d[i * 8 + 3] = sv[i >> 1];
d[i * 8 + 4] = 0xff;
d[i * 8 + 5] = sy[i * 2 + 1];
d[i * 8 + 6] = su[i >> 1];
d[i * 8 + 7] = sv[i >> 1];
}
}
if (width & 1) {
gint i = width - 1;
d[i * 4 + 0] = 0xff;
d[i * 4 + 1] = sy[i];
d[i * 4 + 2] = su[i >> 2];
d[i * 4 + 3] = sv[i >> 2];
}
}
static void
pack_Y41B (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
const gpointer src, gint sstride, gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], GstVideoChromaSite chroma_site,
gint y, gint width)
{
int i;
guint8 *restrict dy = GET_Y_LINE (y);
guint8 *restrict du = GET_U_LINE (y);
guint8 *restrict dv = GET_V_LINE (y);
const guint8 *restrict s = src;
for (i = 0; i < width - 3; i += 4) {
dy[i] = s[i * 4 + 1];
dy[i + 1] = s[i * 4 + 5];
dy[i + 2] = s[i * 4 + 9];
dy[i + 3] = s[i * 4 + 13];
du[i >> 2] = s[i * 4 + 2];
dv[i >> 2] = s[i * 4 + 3];
}
if (i < width) {
dy[i] = s[i * 4 + 1];
du[i >> 2] = s[i * 4 + 2];
dv[i >> 2] = s[i * 4 + 3];
if (i < width - 1)
dy[i + 1] = s[i * 4 + 5];
if (i < width - 2)
dy[i + 2] = s[i * 4 + 9];
}
}
#define PACK_Y42B GST_VIDEO_FORMAT_AYUV, unpack_Y42B, 1, pack_Y42B
static void
unpack_Y42B (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
gpointer dest, const gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], gint x, gint y, gint width)
{
const guint8 *restrict sy = GET_Y_LINE (y);
const guint8 *restrict su = GET_U_LINE (y);
const guint8 *restrict sv = GET_V_LINE (y);
guint8 *restrict d = dest;
sy += x;
su += x >> 1;
sv += x >> 1;
if (x & 1) {
d[0] = 0xff;
d[1] = *sy++;
d[2] = *su++;
d[3] = *sv++;
width--;
d += 4;
}
if (IS_ALIGNED (d, 8))
video_orc_unpack_Y42B (d, sy, su, sv, width / 2);
else {
gint i;
for (i = 0; i < width / 2; i++) {
d[i * 8 + 0] = 0xff;
d[i * 8 + 1] = sy[i * 2 + 0];
d[i * 8 + 2] = su[i];
d[i * 8 + 3] = sv[i];
d[i * 8 + 4] = 0xff;
d[i * 8 + 5] = sy[i * 2 + 1];
d[i * 8 + 6] = su[i];
d[i * 8 + 7] = sv[i];
}
}
if (width & 1) {
gint i = width - 1;
d[i * 4 + 0] = 0xff;
d[i * 4 + 1] = sy[i];
d[i * 4 + 2] = su[i >> 1];
d[i * 4 + 3] = sv[i >> 1];
}
}
static void
pack_Y42B (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
const gpointer src, gint sstride, gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], GstVideoChromaSite chroma_site,
gint y, gint width)
{
guint8 *restrict dy = GET_Y_LINE (y);
guint8 *restrict du = GET_U_LINE (y);
guint8 *restrict dv = GET_V_LINE (y);
const guint8 *restrict s = src;
if (IS_ALIGNED (s, 8))
video_orc_pack_Y42B (dy, du, dv, s, width / 2);
else {
gint i;
for (i = 0; i < width / 2; i++) {
dy[i * 2 + 0] = s[i * 8 + 1];
dy[i * 2 + 1] = s[i * 8 + 5];
du[i] = s[i * 8 + 2];
dv[i] = s[i * 8 + 3];
}
}
if (width & 1) {
gint i = width - 1;
dy[i] = s[i * 4 + 1];
du[i >> 1] = s[i * 4 + 2];
dv[i >> 1] = s[i * 4 + 3];
}
}
#define PACK_Y444 GST_VIDEO_FORMAT_AYUV, unpack_Y444, 1, pack_Y444
static void
unpack_Y444 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
gpointer dest, const gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], gint x, gint y, gint width)
{
const guint8 *restrict sy = GET_Y_LINE (y);
const guint8 *restrict su = GET_U_LINE (y);
const guint8 *restrict sv = GET_V_LINE (y);
sy += x;
su += x;
sv += x;
video_orc_unpack_Y444 (dest, sy, su, sv, width);
}
static void
pack_Y444 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
const gpointer src, gint sstride, gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], GstVideoChromaSite chroma_site,
gint y, gint width)
{
guint8 *restrict dy = GET_Y_LINE (y);
guint8 *restrict du = GET_U_LINE (y);
guint8 *restrict dv = GET_V_LINE (y);
video_orc_pack_Y444 (dy, du, dv, src, width);
}
#define PACK_GBR GST_VIDEO_FORMAT_ARGB, unpack_GBR, 1, pack_GBR
static void
unpack_GBR (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
gpointer dest, const gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], gint x, gint y, gint width)
{
const guint8 *restrict sr = GET_R_LINE (y);
const guint8 *restrict sg = GET_G_LINE (y);
const guint8 *restrict sb = GET_B_LINE (y);
sr += x;
sg += x;
sb += x;
video_orc_unpack_Y444 (dest, sr, sg, sb, width);
}
static void
pack_GBR (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
const gpointer src, gint sstride, gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], GstVideoChromaSite chroma_site,
gint y, gint width)
{
guint8 *restrict dr = GET_R_LINE (y);
guint8 *restrict dg = GET_G_LINE (y);
guint8 *restrict db = GET_B_LINE (y);
video_orc_pack_Y444 (dr, dg, db, src, width);
}
#define PACK_GBRA GST_VIDEO_FORMAT_ARGB, unpack_GBRA, 1, pack_GBRA
static void
unpack_GBRA (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
gpointer dest, const gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], gint x, gint y, gint width)
{
int i;
const guint8 *sg = GET_G_LINE (y);
const guint8 *sb = GET_B_LINE (y);
const guint8 *sr = GET_R_LINE (y);
const guint8 *sa = GET_A_LINE (y);
guint8 *d = dest, G, B, R, A;
sg += x;
sb += x;
sr += x;
sa += x;
for (i = 0; i < width; i++) {
G = GST_READ_UINT8 (sg + i);
B = GST_READ_UINT8 (sb + i);
R = GST_READ_UINT8 (sr + i);
A = GST_READ_UINT8 (sa + i);
d[i * 4 + 0] = A;
d[i * 4 + 1] = R;
d[i * 4 + 2] = G;
d[i * 4 + 3] = B;
}
}
static void
pack_GBRA (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
const gpointer src, gint sstride, gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], GstVideoChromaSite chroma_site,
gint y, gint width)
{
int i;
guint8 *restrict dg = GET_G_LINE (y);
guint8 *restrict db = GET_B_LINE (y);
guint8 *restrict dr = GET_R_LINE (y);
guint8 *restrict da = GET_A_LINE (y);
guint8 G, B, R, A;
const guint8 *restrict s = src;
for (i = 0; i < width; i++) {
G = (s[i * 4 + 2]);
B = (s[i * 4 + 3]);
R = (s[i * 4 + 1]);
A = (s[i * 4 + 0]);
GST_WRITE_UINT8 (dg + i, G);
GST_WRITE_UINT8 (db + i, B);
GST_WRITE_UINT8 (dr + i, R);
GST_WRITE_UINT8 (da + i, A);
}
}
#define PACK_GRAY8 GST_VIDEO_FORMAT_AYUV, unpack_GRAY8, 1, pack_GRAY8
static void
unpack_GRAY8 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
gpointer dest, const gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], gint x, gint y, gint width)
{
const guint8 *restrict s = GET_LINE (y);
s += x;
video_orc_unpack_GRAY8 (dest, s, width);
}
static void
pack_GRAY8 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
const gpointer src, gint sstride, gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], GstVideoChromaSite chroma_site,
gint y, gint width)
{
guint8 *restrict d = GET_LINE (y);
video_orc_pack_GRAY8 (d, src, width);
}
#define PACK_GRAY16_BE GST_VIDEO_FORMAT_AYUV64, unpack_GRAY16_BE, 1, pack_GRAY16_BE
static void
unpack_GRAY16_BE (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
gpointer dest, const gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], gint x, gint y, gint width)
{
int i;
const guint16 *restrict s = GET_LINE (y);
guint16 *restrict d = dest;
s += x;
for (i = 0; i < width; i++) {
d[i * 4 + 0] = 0xffff;
d[i * 4 + 1] = GST_READ_UINT16_BE (s + i);
d[i * 4 + 2] = 0x8000;
d[i * 4 + 3] = 0x8000;
}
}
static void
pack_GRAY16_BE (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
const gpointer src, gint sstride, gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], GstVideoChromaSite chroma_site,
gint y, gint width)
{
int i;
guint16 *restrict d = GET_LINE (y);
const guint16 *restrict s = src;
for (i = 0; i < width; i++) {
GST_WRITE_UINT16_BE (d + i, s[i * 4 + 1]);
}
}
#define PACK_GRAY16_LE GST_VIDEO_FORMAT_AYUV64, unpack_GRAY16_LE, 1, pack_GRAY16_LE
static void
unpack_GRAY16_LE (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
gpointer dest, const gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], gint x, gint y, gint width)
{
int i;
const guint16 *restrict s = GET_LINE (y);
guint16 *restrict d = dest;
s += x;
for (i = 0; i < width; i++) {
d[i * 4 + 0] = 0xffff;
d[i * 4 + 1] = GST_READ_UINT16_LE (s + i);
d[i * 4 + 2] = 0x8000;
d[i * 4 + 3] = 0x8000;
}
}
static void
pack_GRAY16_LE (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
const gpointer src, gint sstride, gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], GstVideoChromaSite chroma_site,
gint y, gint width)
{
int i;
guint16 *restrict d = GET_LINE (y);
const guint16 *restrict s = src;
for (i = 0; i < width; i++) {
GST_WRITE_UINT16_LE (d + i, s[i * 4 + 1]);
}
}
#define PACK_RGB16 GST_VIDEO_FORMAT_ARGB, unpack_RGB16, 1, pack_RGB16
static void
unpack_RGB16 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
gpointer dest, const gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], gint x, gint y, gint width)
{
const guint16 *restrict s = GET_LINE (y);
if (flags & GST_VIDEO_PACK_FLAG_TRUNCATE_RANGE)
video_orc_unpack_RGB16_trunc (dest, s + x, width);
else
video_orc_unpack_RGB16 (dest, s + x, width);
}
static void
pack_RGB16 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
const gpointer src, gint sstride, gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], GstVideoChromaSite chroma_site,
gint y, gint width)
{
guint16 *restrict d = GET_LINE (y);
#if G_BYTE_ORDER == G_LITTLE_ENDIAN
video_orc_pack_RGB16_le (d, src, width);
#else
video_orc_pack_RGB16_be (d, src, width);
#endif
}
#define PACK_BGR16 GST_VIDEO_FORMAT_ARGB, unpack_BGR16, 1, pack_BGR16
static void
unpack_BGR16 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
gpointer dest, const gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], gint x, gint y, gint width)
{
const guint16 *restrict s = GET_LINE (y);
if (flags & GST_VIDEO_PACK_FLAG_TRUNCATE_RANGE)
video_orc_unpack_BGR16_trunc (dest, s + x, width);
else
video_orc_unpack_BGR16 (dest, s + x, width);
}
static void
pack_BGR16 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
const gpointer src, gint sstride, gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], GstVideoChromaSite chroma_site,
gint y, gint width)
{
guint16 *restrict d = GET_LINE (y);
#if G_BYTE_ORDER == G_LITTLE_ENDIAN
video_orc_pack_BGR16_le (d, src, width);
#else
video_orc_pack_BGR16_be (d, src, width);
#endif
}
#define PACK_RGB15 GST_VIDEO_FORMAT_ARGB, unpack_RGB15, 1, pack_RGB15
static void
unpack_RGB15 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
gpointer dest, const gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], gint x, gint y, gint width)
{
const guint16 *restrict s = GET_LINE (y);
#if G_BYTE_ORDER == G_LITTLE_ENDIAN
if (flags & GST_VIDEO_PACK_FLAG_TRUNCATE_RANGE)
video_orc_unpack_RGB15_le_trunc (dest, s + x, width);
else
video_orc_unpack_RGB15_le (dest, s + x, width);
#else
if (flags & GST_VIDEO_PACK_FLAG_TRUNCATE_RANGE)
video_orc_unpack_RGB15_be_trunc (dest, s + x, width);
else
video_orc_unpack_RGB15_be (dest, s + x, width);
#endif
}
static void
pack_RGB15 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
const gpointer src, gint sstride, gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], GstVideoChromaSite chroma_site,
gint y, gint width)
{
guint16 *restrict d = GET_LINE (y);
#if G_BYTE_ORDER == G_LITTLE_ENDIAN
video_orc_pack_RGB15_le (d, src, width);
#else
video_orc_pack_RGB15_be (d, src, width);
#endif
}
#define PACK_BGR15 GST_VIDEO_FORMAT_ARGB, unpack_BGR15, 1, pack_BGR15
static void
unpack_BGR15 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
gpointer dest, const gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], gint x, gint y, gint width)
{
const guint16 *restrict s = GET_LINE (y);
#if G_BYTE_ORDER == G_LITTLE_ENDIAN
if (flags & GST_VIDEO_PACK_FLAG_TRUNCATE_RANGE)
video_orc_unpack_BGR15_le_trunc (dest, s + x, width);
else
video_orc_unpack_BGR15_le (dest, s + x, width);
#else
if (flags & GST_VIDEO_PACK_FLAG_TRUNCATE_RANGE)
video_orc_unpack_BGR15_be_trunc (dest, s + x, width);
else
video_orc_unpack_BGR15_be (dest, s + x, width);
#endif
}
static void
pack_BGR15 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
const gpointer src, gint sstride, gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], GstVideoChromaSite chroma_site,
gint y, gint width)
{
guint16 *restrict d = GET_LINE (y);
#if G_BYTE_ORDER == G_LITTLE_ENDIAN
video_orc_pack_BGR15_le (d, src, width);
#else
video_orc_pack_BGR15_be (d, src, width);
#endif
}
#define PACK_BGRA GST_VIDEO_FORMAT_ARGB, unpack_BGRA, 1, pack_BGRA
static void
unpack_BGRA (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
gpointer dest, const gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], gint x, gint y, gint width)
{
const guint8 *restrict s = GET_LINE (y);
s += x * 4;
video_orc_unpack_BGRA (dest, s, width);
}
static void
pack_BGRA (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
const gpointer src, gint sstride, gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], GstVideoChromaSite chroma_site,
gint y, gint width)
{
guint8 *restrict d = GET_LINE (y);
video_orc_pack_BGRA (d, src, width);
}
#define PACK_ABGR GST_VIDEO_FORMAT_ARGB, unpack_ABGR, 1, pack_ABGR
static void
unpack_ABGR (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
gpointer dest, const gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], gint x, gint y, gint width)
{
const guint8 *restrict s = GET_LINE (y);
s += x * 4;
#if G_BYTE_ORDER == G_LITTLE_ENDIAN
video_orc_unpack_ABGR_le (dest, s, width);
#else
video_orc_unpack_ABGR_be (dest, s, width);
#endif
}
static void
pack_ABGR (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
const gpointer src, gint sstride, gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], GstVideoChromaSite chroma_site,
gint y, gint width)
{
guint8 *restrict d = GET_LINE (y);
#if G_BYTE_ORDER == G_LITTLE_ENDIAN
video_orc_pack_ABGR_le (d, src, width);
#else
video_orc_pack_ABGR_be (d, src, width);
#endif
}
#define PACK_RGBA GST_VIDEO_FORMAT_ARGB, unpack_RGBA, 1, pack_RGBA
static void
unpack_RGBA (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
gpointer dest, const gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], gint x, gint y, gint width)
{
const guint8 *restrict s = GET_LINE (y);
s += x * 4;
#if G_BYTE_ORDER == G_LITTLE_ENDIAN
video_orc_unpack_RGBA_le (dest, s, width);
#else
video_orc_unpack_RGBA_be (dest, s, width);
#endif
}
static void
pack_RGBA (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
const gpointer src, gint sstride, gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], GstVideoChromaSite chroma_site,
gint y, gint width)
{
guint8 *restrict d = GET_LINE (y);
#if G_BYTE_ORDER == G_LITTLE_ENDIAN
video_orc_pack_RGBA_le (d, src, width);
#else
video_orc_pack_RGBA_be (d, src, width);
#endif
}
#define PACK_RGB GST_VIDEO_FORMAT_ARGB, unpack_RGB, 1, pack_RGB
static void
unpack_RGB (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
gpointer dest, const gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], gint x, gint y, gint width)
{
int i;
const guint8 *restrict s = GET_LINE (y);
guint8 *restrict d = dest;
s += x * 3;
for (i = 0; i < width; i++) {
d[i * 4 + 0] = 0xff;
d[i * 4 + 1] = s[i * 3 + 0];
d[i * 4 + 2] = s[i * 3 + 1];
d[i * 4 + 3] = s[i * 3 + 2];
}
}
static void
pack_RGB (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
const gpointer src, gint sstride, gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], GstVideoChromaSite chroma_site,
gint y, gint width)
{
int i;
guint8 *restrict d = GET_LINE (y);
const guint8 *restrict s = src;
for (i = 0; i < width; i++) {
d[i * 3 + 0] = s[i * 4 + 1];
d[i * 3 + 1] = s[i * 4 + 2];
d[i * 3 + 2] = s[i * 4 + 3];
}
}
#define PACK_BGR GST_VIDEO_FORMAT_ARGB, unpack_BGR, 1, pack_BGR
static void
unpack_BGR (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
gpointer dest, const gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], gint x, gint y, gint width)
{
int i;
const guint8 *restrict s = GET_LINE (y);
guint8 *restrict d = dest;
s += x * 3;
for (i = 0; i < width; i++) {
d[i * 4 + 0] = 0xff;
d[i * 4 + 1] = s[i * 3 + 2];
d[i * 4 + 2] = s[i * 3 + 1];
d[i * 4 + 3] = s[i * 3 + 0];
}
}
static void
pack_BGR (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
const gpointer src, gint sstride, gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], GstVideoChromaSite chroma_site,
gint y, gint width)
{
int i;
guint8 *restrict d = GET_LINE (y);
const guint8 *restrict s = src;
for (i = 0; i < width; i++) {
d[i * 3 + 0] = s[i * 4 + 3];
d[i * 3 + 1] = s[i * 4 + 2];
d[i * 3 + 2] = s[i * 4 + 1];
}
}
#define PACK_NV12 GST_VIDEO_FORMAT_AYUV, unpack_NV12, 1, pack_NV12
static void
unpack_NV12 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
gpointer dest, const gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], gint x, gint y, gint width)
{
gint uv = GET_UV_420 (y, flags);
const guint8 *restrict sy = GET_PLANE_LINE (0, y);
const guint8 *restrict suv = GET_PLANE_LINE (1, uv);
guint8 *restrict d = dest;
sy += x;
suv += (x & ~1);
if (x & 1) {
d[0] = 0xff;
d[1] = *sy++;
d[2] = suv[0];
d[3] = suv[1];
width--;
d += 4;
suv += 2;
}
if (IS_ALIGNED (d, 8))
video_orc_unpack_NV12 (d, sy, suv, width / 2);
else {
gint i;
for (i = 0; i < width / 2; i++) {
d[i * 8 + 0] = 0xff;
d[i * 8 + 1] = sy[i * 2 + 0];
d[i * 8 + 2] = suv[i * 2 + 0];
d[i * 8 + 3] = suv[i * 2 + 1];
d[i * 8 + 4] = 0xff;
d[i * 8 + 5] = sy[i * 2 + 1];
d[i * 8 + 6] = suv[i * 2 + 0];
d[i * 8 + 7] = suv[i * 2 + 1];
}
}
if (width & 1) {
gint i = width - 1;
d[i * 4 + 0] = 0xff;
d[i * 4 + 1] = sy[i];
d[i * 4 + 2] = suv[i + 0];
d[i * 4 + 3] = suv[i + 1];
}
}
static void
pack_NV12 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
const gpointer src, gint sstride, gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], GstVideoChromaSite chroma_site,
gint y, gint width)
{
gint uv = GET_UV_420 (y, flags);
guint8 *restrict dy = GET_PLANE_LINE (0, y);
guint8 *restrict duv = GET_PLANE_LINE (1, uv);
const guint8 *restrict s = src;
if (IS_CHROMA_LINE_420 (y, flags)) {
if (IS_ALIGNED (s, 8))
video_orc_pack_NV12 (dy, duv, s, width / 2);
else {
gint i;
for (i = 0; i < width / 2; i++) {
dy[i * 2 + 0] = s[i * 8 + 1];
dy[i * 2 + 1] = s[i * 8 + 5];
duv[i * 2 + 0] = s[i * 8 + 2];
duv[i * 2 + 1] = s[i * 8 + 3];
}
}
if (width & 1) {
gint i = width - 1;
dy[i] = s[i * 4 + 1];
duv[i + 0] = s[i * 4 + 2];
duv[i + 1] = s[i * 4 + 3];
}
} else
video_orc_pack_Y (dy, s, width);
}
#define PACK_NV21 GST_VIDEO_FORMAT_AYUV, unpack_NV21, 1, pack_NV21
static void
unpack_NV21 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
gpointer dest, const gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], gint x, gint y, gint width)
{
gint uv = GET_UV_420 (y, flags);
const guint8 *restrict sy = GET_PLANE_LINE (0, y);
const guint8 *restrict suv = GET_PLANE_LINE (1, uv);
guint8 *restrict d = dest;
sy += x;
suv += (x & ~1);
if (x & 1) {
d[0] = 0xff;
d[1] = *sy++;
d[2] = suv[1];
d[3] = suv[0];
width--;
d += 4;
suv += 2;
}
if (IS_ALIGNED (d, 8))
video_orc_unpack_NV21 (d, sy, suv, width / 2);
else {
gint i;
for (i = 0; i < width / 2; i++) {
d[i * 8 + 0] = 0xff;
d[i * 8 + 1] = sy[i * 2 + 0];
d[i * 8 + 2] = suv[i * 2 + 1];
d[i * 8 + 3] = suv[i * 2 + 0];
d[i * 8 + 4] = 0xff;
d[i * 8 + 5] = sy[i * 2 + 1];
d[i * 8 + 6] = suv[i * 2 + 1];
d[i * 8 + 7] = suv[i * 2 + 0];
}
}
if (width & 1) {
gint i = width - 1;
d[i * 4 + 0] = 0xff;
d[i * 4 + 1] = sy[i];
d[i * 4 + 2] = suv[i + 1];
d[i * 4 + 3] = suv[i + 0];
}
}
static void
pack_NV21 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
const gpointer src, gint sstride, gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], GstVideoChromaSite chroma_site,
gint y, gint width)
{
gint uv = GET_UV_420 (y, flags);
guint8 *restrict dy = GET_PLANE_LINE (0, y);
guint8 *restrict duv = GET_PLANE_LINE (1, uv);
const guint8 *restrict s = src;
if (IS_CHROMA_LINE_420 (y, flags)) {
if (IS_ALIGNED (s, 8))
video_orc_pack_NV21 (dy, duv, s, width / 2);
else {
gint i;
for (i = 0; i < width / 2; i++) {
dy[i * 2 + 0] = s[i * 8 + 1];
dy[i * 2 + 1] = s[i * 8 + 5];
duv[i * 2 + 0] = s[i * 8 + 3];
duv[i * 2 + 1] = s[i * 8 + 2];
}
}
if (width & 1) {
gint i = width - 1;
dy[i] = s[i * 4 + 1];
duv[i + 0] = s[i * 4 + 3];
duv[i + 1] = s[i * 4 + 2];
}
} else
video_orc_pack_Y (dy, s, width);
}
#define PACK_NV16 GST_VIDEO_FORMAT_AYUV, unpack_NV16, 1, pack_NV16
static void
unpack_NV16 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
gpointer dest, const gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], gint x, gint y, gint width)
{
const guint8 *restrict sy = GET_PLANE_LINE (0, y);
const guint8 *restrict suv = GET_PLANE_LINE (1, y);
guint8 *restrict d = dest;
sy += x;
suv += (x & ~1);
if (x & 1) {
d[0] = 0xff;
d[1] = *sy++;
d[2] = suv[0];
d[3] = suv[1];
width--;
d += 4;
suv += 2;
}
if (IS_ALIGNED (d, 8))
video_orc_unpack_NV12 (d, sy, suv, width / 2);
else {
gint i;
for (i = 0; i < width / 2; i++) {
d[i * 8 + 0] = 0xff;
d[i * 8 + 1] = sy[i * 2 + 0];
d[i * 8 + 2] = suv[i * 2 + 0];
d[i * 8 + 3] = suv[i * 2 + 1];
d[i * 8 + 4] = 0xff;
d[i * 8 + 5] = sy[i * 2 + 1];
d[i * 8 + 6] = suv[i * 2 + 0];
d[i * 8 + 7] = suv[i * 2 + 1];
}
}
if (width & 1) {
gint i = width - 1;
d[i * 4 + 0] = 0xff;
d[i * 4 + 1] = sy[i];
d[i * 4 + 2] = suv[i + 0];
d[i * 4 + 3] = suv[i + 1];
}
}
static void
pack_NV16 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
const gpointer src, gint sstride, gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], GstVideoChromaSite chroma_site,
gint y, gint width)
{
guint8 *restrict dy = GET_PLANE_LINE (0, y);
guint8 *restrict duv = GET_PLANE_LINE (1, y);
const guint8 *restrict s = src;
if (IS_ALIGNED (s, 8))
video_orc_pack_NV12 (dy, duv, s, width / 2);
else {
gint i;
for (i = 0; i < width / 2; i++) {
dy[i * 2 + 0] = s[i * 8 + 1];
dy[i * 2 + 1] = s[i * 8 + 5];
duv[i * 2 + 0] = s[i * 8 + 2];
duv[i * 2 + 1] = s[i * 8 + 3];
}
}
if (width & 1) {
gint i = width - 1;
dy[i] = s[i * 4 + 1];
duv[i + 0] = s[i * 4 + 2];
duv[i + 1] = s[i * 4 + 3];
}
}
#define PACK_NV61 GST_VIDEO_FORMAT_AYUV, unpack_NV61, 1, pack_NV61
static void
unpack_NV61 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
gpointer dest, const gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], gint x, gint y, gint width)
{
const guint8 *restrict sy = GET_PLANE_LINE (0, y);
const guint8 *restrict svu = GET_PLANE_LINE (1, y);
guint8 *restrict d = dest;
sy += x;
svu += (x & ~1);
if (x & 1) {
d[0] = 0xff;
d[1] = *sy++;
d[2] = svu[1];
d[3] = svu[0];
width--;
d += 4;
svu += 2;
}
if (IS_ALIGNED (d, 8)) {
video_orc_unpack_NV21 (d, sy, svu, width / 2);
} else {
gint i;
for (i = 0; i < width / 2; i++) {
d[i * 8 + 0] = 0xff;
d[i * 8 + 1] = sy[i * 2 + 0];
d[i * 8 + 2] = svu[i * 2 + 1];
d[i * 8 + 3] = svu[i * 2 + 0];
d[i * 8 + 4] = 0xff;
d[i * 8 + 5] = sy[i * 2 + 1];
d[i * 8 + 6] = svu[i * 2 + 1];
d[i * 8 + 7] = svu[i * 2 + 0];
}
}
if (width & 1) {
gint i = width - 1;
d[i * 4 + 0] = 0xff;
d[i * 4 + 1] = sy[i];
d[i * 4 + 2] = svu[i + 1];
d[i * 4 + 3] = svu[i + 0];
}
}
static void
pack_NV61 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
const gpointer src, gint sstride, gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], GstVideoChromaSite chroma_site,
gint y, gint width)
{
const guint8 *restrict s = src;
guint8 *restrict dy = GET_PLANE_LINE (0, y);
guint8 *restrict dvu = GET_PLANE_LINE (1, y);
if (IS_ALIGNED (s, 8)) {
video_orc_pack_NV21 (dy, dvu, s, width / 2);
} else {
gint i;
for (i = 0; i < width / 2; i++) {
dy[i * 2 + 0] = s[i * 8 + 1];
dy[i * 2 + 1] = s[i * 8 + 5];
dvu[i * 2 + 0] = s[i * 8 + 3];
dvu[i * 2 + 1] = s[i * 8 + 2];
}
}
if (width & 1) {
gint i = width - 1;
dy[i] = s[i * 4 + 1];
dvu[i + 0] = s[i * 4 + 2];
dvu[i + 1] = s[i * 4 + 3];
}
}
#define PACK_NV24 GST_VIDEO_FORMAT_AYUV, unpack_NV24, 1, pack_NV24
static void
unpack_NV24 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
gpointer dest, const gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], gint x, gint y, gint width)
{
const guint8 *restrict sy = GET_PLANE_LINE (0, y);
const guint8 *restrict suv = GET_PLANE_LINE (1, y);
sy += x;
suv += x << 1;
video_orc_unpack_NV24 (dest, sy, suv, width);
}
static void
pack_NV24 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
const gpointer src, gint sstride, gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], GstVideoChromaSite chroma_site,
gint y, gint width)
{
guint8 *restrict dy = GET_PLANE_LINE (0, y);
guint8 *restrict duv = GET_PLANE_LINE (1, y);
video_orc_pack_NV24 (dy, duv, src, width);
}
#define PACK_UYVP GST_VIDEO_FORMAT_AYUV64, unpack_UYVP, 1, pack_UYVP
static void
unpack_UYVP (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
gpointer dest, const gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], gint x, gint y, gint width)
{
int i;
const guint8 *restrict s = GET_LINE (y);
guint16 *restrict d = dest;
/* FIXME */
s += x << 1;
for (i = 0; i < width; i += 2) {
guint16 y0, y1;
guint16 u0;
guint16 v0;
u0 = ((s[(i / 2) * 5 + 0] << 2) | (s[(i / 2) * 5 + 1] >> 6)) << 6;
y0 = (((s[(i / 2) * 5 + 1] & 0x3f) << 4) | (s[(i / 2) * 5 + 2] >> 4)) << 6;
v0 = (((s[(i / 2) * 5 + 2] & 0x0f) << 6) | (s[(i / 2) * 5 + 3] >> 2)) << 6;
y1 = (((s[(i / 2) * 5 + 3] & 0x03) << 8) | s[(i / 2) * 5 + 4]) << 6;
if (!(flags & GST_VIDEO_PACK_FLAG_TRUNCATE_RANGE)) {
y0 |= (y0 >> 10);
y1 |= (y1 >> 10);
u0 |= (u0 >> 10);
v0 |= (v0 >> 10);
}
d[i * 4 + 0] = 0xffff;
d[i * 4 + 1] = y0;
d[i * 4 + 2] = u0;
d[i * 4 + 3] = v0;
if (i < width - 1) {
d[i * 4 + 4] = 0xffff;
d[i * 4 + 5] = y1;
d[i * 4 + 6] = u0;
d[i * 4 + 7] = v0;
}
}
}
static void
pack_UYVP (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
const gpointer src, gint sstride, gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], GstVideoChromaSite chroma_site,
gint y, gint width)
{
int i;
guint8 *restrict d = GET_LINE (y);
const guint16 *restrict s = src;
for (i = 0; i < width; i += 2) {
guint16 y0, y1;
guint16 u0;
guint16 v0;
y0 = s[4 * (i + 0) + 1];
if (i < width - 1)
y1 = s[4 * (i + 1) + 1];
else
y1 = y0;
u0 = s[4 * (i + 0) + 2];
v0 = s[4 * (i + 0) + 3];
d[(i / 2) * 5 + 0] = u0 >> 8;
d[(i / 2) * 5 + 1] = (u0 & 0xc0) | y0 >> 10;
d[(i / 2) * 5 + 2] = ((y0 & 0x3c0) >> 2) | (v0 >> 12);
d[(i / 2) * 5 + 3] = ((v0 & 0xfc0) >> 4) | (y1 >> 14);
d[(i / 2) * 5 + 4] = (y1 >> 6);
}
}
#define PACK_A420 GST_VIDEO_FORMAT_AYUV, unpack_A420, 1, pack_A420
static void
unpack_A420 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
gpointer dest, const gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], gint x, gint y, gint width)
{
gint uv = GET_UV_420 (y, flags);
const guint8 *restrict sy = GET_Y_LINE (y);
const guint8 *restrict su = GET_U_LINE (uv);
const guint8 *restrict sv = GET_V_LINE (uv);
const guint8 *restrict sa = GET_A_LINE (y);
guint8 *restrict d = dest;
sy += x;
su += x >> 1;
sv += x >> 1;
sa += x;
if (x & 1) {
d[0] = *sa++;
d[1] = *sy++;
d[2] = *su++;
d[3] = *sv++;
width--;
d += 4;
}
video_orc_unpack_A420 (d, sy, su, sv, sa, width);
}
static void
pack_A420 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
const gpointer src, gint sstride, gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], GstVideoChromaSite chroma_site,
gint y, gint width)
{
gint uv = GET_UV_420 (y, flags);
guint8 *restrict dy = GET_Y_LINE (y);
guint8 *restrict du = GET_U_LINE (uv);
guint8 *restrict dv = GET_V_LINE (uv);
guint8 *restrict da = GET_A_LINE (y);
const guint8 *restrict s = src;
if (IS_CHROMA_LINE_420 (y, flags)) {
if (IS_ALIGNED (s, 8))
video_orc_pack_A420 (dy, du, dv, da, s, width / 2);
else {
gint i;
for (i = 0; i < width / 2; i++) {
da[i * 2 + 0] = s[i * 8 + 0];
dy[i * 2 + 0] = s[i * 8 + 1];
da[i * 2 + 1] = s[i * 8 + 4];
dy[i * 2 + 1] = s[i * 8 + 5];
du[i] = s[i * 8 + 2];
dv[i] = s[i * 8 + 3];
}
}
if (width & 1) {
gint i = width - 1;
da[i] = s[i * 4 + 0];
dy[i] = s[i * 4 + 1];
du[i >> 1] = s[i * 4 + 2];
dv[i >> 1] = s[i * 4 + 3];
}
} else
video_orc_pack_AY (dy, da, s, width);
}
#define PACK_RGB8P GST_VIDEO_FORMAT_ARGB, unpack_RGB8P, 1, pack_RGB8P
static void
unpack_RGB8P (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
gpointer dest, const gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], gint x, gint y, gint width)
{
int i;
const guint8 *restrict s = GET_LINE (y);
const guint32 *restrict p = data[1];
guint8 *restrict d = dest;
s += x;
for (i = 0; i < width; i++) {
guint32 v = p[s[i]];
d[i * 4 + 0] = (v >> 24) & 0xff;
d[i * 4 + 1] = (v >> 16) & 0xff;
d[i * 4 + 2] = (v >> 8) & 0xff;
d[i * 4 + 3] = (v) & 0xff;
}
}
static const guint32 std_palette_RGB8P[] = {
0xff000000, 0xff000033, 0xff000066, 0xff000099, 0xff0000cc, 0xff0000ff,
0xff003300, 0xff003333, 0xff003366, 0xff003399, 0xff0033cc, 0xff0033ff,
0xff006600, 0xff006633, 0xff006666, 0xff006699, 0xff0066cc, 0xff0066ff,
0xff009900, 0xff009933, 0xff009966, 0xff009999, 0xff0099cc, 0xff0099ff,
0xff00cc00, 0xff00cc33, 0xff00cc66, 0xff00cc99, 0xff00cccc, 0xff00ccff,
0xff00ff00, 0xff00ff33, 0xff00ff66, 0xff00ff99, 0xff00ffcc, 0xff00ffff,
0xff330000, 0xff330033, 0xff330066, 0xff330099, 0xff3300cc, 0xff3300ff,
0xff333300, 0xff333333, 0xff333366, 0xff333399, 0xff3333cc, 0xff3333ff,
0xff336600, 0xff336633, 0xff336666, 0xff336699, 0xff3366cc, 0xff3366ff,
0xff339900, 0xff339933, 0xff339966, 0xff339999, 0xff3399cc, 0xff3399ff,
0xff33cc00, 0xff33cc33, 0xff33cc66, 0xff33cc99, 0xff33cccc, 0xff33ccff,
0xff33ff00, 0xff33ff33, 0xff33ff66, 0xff33ff99, 0xff33ffcc, 0xff33ffff,
0xff660000, 0xff660033, 0xff660066, 0xff660099, 0xff6600cc, 0xff6600ff,
0xff663300, 0xff663333, 0xff663366, 0xff663399, 0xff6633cc, 0xff6633ff,
0xff666600, 0xff666633, 0xff666666, 0xff666699, 0xff6666cc, 0xff6666ff,
0xff669900, 0xff669933, 0xff669966, 0xff669999, 0xff6699cc, 0xff6699ff,
0xff66cc00, 0xff66cc33, 0xff66cc66, 0xff66cc99, 0xff66cccc, 0xff66ccff,
0xff66ff00, 0xff66ff33, 0xff66ff66, 0xff66ff99, 0xff66ffcc, 0xff66ffff,
0xff990000, 0xff990033, 0xff990066, 0xff990099, 0xff9900cc, 0xff9900ff,
0xff993300, 0xff993333, 0xff993366, 0xff993399, 0xff9933cc, 0xff9933ff,
0xff996600, 0xff996633, 0xff996666, 0xff996699, 0xff9966cc, 0xff9966ff,
0xff999900, 0xff999933, 0xff999966, 0xff999999, 0xff9999cc, 0xff9999ff,
0xff99cc00, 0xff99cc33, 0xff99cc66, 0xff99cc99, 0xff99cccc, 0xff99ccff,
0xff99ff00, 0xff99ff33, 0xff99ff66, 0xff99ff99, 0xff99ffcc, 0xff99ffff,
0xffcc0000, 0xffcc0033, 0xffcc0066, 0xffcc0099, 0xffcc00cc, 0xffcc00ff,
0xffcc3300, 0xffcc3333, 0xffcc3366, 0xffcc3399, 0xffcc33cc, 0xffcc33ff,
0xffcc6600, 0xffcc6633, 0xffcc6666, 0xffcc6699, 0xffcc66cc, 0xffcc66ff,
0xffcc9900, 0xffcc9933, 0xffcc9966, 0xffcc9999, 0xffcc99cc, 0xffcc99ff,
0xffcccc00, 0xffcccc33, 0xffcccc66, 0xffcccc99, 0xffcccccc, 0xffccccff,
0xffccff00, 0xffccff33, 0xffccff66, 0xffccff99, 0xffccffcc, 0xffccffff,
0xffff0000, 0xffff0033, 0xffff0066, 0xffff0099, 0xffff00cc, 0xffff00ff,
0xffff3300, 0xffff3333, 0xffff3366, 0xffff3399, 0xffff33cc, 0xffff33ff,
0xffff6600, 0xffff6633, 0xffff6666, 0xffff6699, 0xffff66cc, 0xffff66ff,
0xffff9900, 0xffff9933, 0xffff9966, 0xffff9999, 0xffff99cc, 0xffff99ff,
0xffffcc00, 0xffffcc33, 0xffffcc66, 0xffffcc99, 0xffffcccc, 0xffffccff,
0xffffff00, 0xffffff33, 0xffffff66, 0xffffff99, 0xffffffcc, 0xffffffff,
0x00000000, 0xff000000, 0xff000000, 0xff000000, 0xff000000, 0xff000000,
0xff000000, 0xff000000, 0xff000000, 0xff000000, 0xff000000, 0xff000000,
0xff000000, 0xff000000, 0xff000000, 0xff000000, 0xff000000, 0xff000000,
0xff000000, 0xff000000, 0xff000000, 0xff000000, 0xff000000, 0xff000000,
0xff000000, 0xff000000, 0xff000000, 0xff000000, 0xff000000, 0xff000000,
0xff000000, 0xff000000, 0xff000000, 0xff000000, 0xff000000, 0xff000000,
0xff000000, 0xff000000, 0xff000000, 0xff000000
};
static void
pack_RGB8P (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
const gpointer src, gint sstride, gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], GstVideoChromaSite chroma_site,
gint y, gint width)
{
int i;
guint8 *restrict d = GET_LINE (y);
const guint8 *restrict s = src;
/* Use our poor man's palette, taken from ffmpegcolorspace too */
for (i = 0; i < width; i++) {
/* crude approximation for alpha ! */
if (s[i * 4 + 0] < 0x80)
d[i] = 6 * 6 * 6;
else
d[i] =
((((s[i * 4 + 1]) / 47) % 6) * 6 * 6 + (((s[i * 4 +
2]) / 47) % 6) * 6 + (((s[i * 4 + 3]) / 47) % 6));
}
}
#define PACK_410 GST_VIDEO_FORMAT_AYUV, unpack_410, 1, pack_410
static void
unpack_410 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
gpointer dest, const gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], gint x, gint y, gint width)
{
gint uv = GET_UV_410 (y, flags);
const guint8 *restrict sy = GET_Y_LINE (y);
const guint8 *restrict su = GET_U_LINE (uv);
const guint8 *restrict sv = GET_V_LINE (uv);
guint8 *restrict d = dest;
sy += x;
su += x >> 2;
sv += x >> 2;
if (x & 3) {
for (; x & 3; x++) {
d[0] = 0xff;
d[1] = *sy++;
d[2] = *su;
d[3] = *sv;
width--;
d += 4;
}
su++;
sy++;
}
if (IS_ALIGNED (d, 8))
video_orc_unpack_YUV9 (d, sy, su, sv, width / 2);
else {
gint i;
for (i = 0; i < width / 2; i++) {
d[i * 8 + 0] = 0xff;
d[i * 8 + 1] = sy[i * 2 + 0];
d[i * 8 + 2] = su[i >> 1];
d[i * 8 + 3] = sv[i >> 1];
d[i * 8 + 4] = 0xff;
d[i * 8 + 5] = sy[i * 2 + 1];
d[i * 8 + 6] = su[i >> 1];
d[i * 8 + 7] = sv[i >> 1];
}
}
if (width & 1) {
gint i = width - 1;
d[i * 4 + 0] = 0xff;
d[i * 4 + 1] = sy[i];
d[i * 4 + 2] = su[i >> 2];
d[i * 4 + 3] = sv[i >> 2];
}
}
static void
pack_410 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
const gpointer src, gint sstride, gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], GstVideoChromaSite chroma_site,
gint y, gint width)
{
int i;
gint uv = GET_UV_410 (y, flags);
guint8 *restrict dy = GET_Y_LINE (y);
guint8 *restrict du = GET_U_LINE (uv);
guint8 *restrict dv = GET_V_LINE (uv);
const guint8 *restrict s = src;
for (i = 0; i < width - 3; i += 4) {
dy[i] = s[i * 4 + 1];
dy[i + 1] = s[i * 4 + 5];
dy[i + 2] = s[i * 4 + 9];
dy[i + 3] = s[i * 4 + 13];
if (IS_CHROMA_LINE_410 (y, flags)) {
du[i >> 2] = s[i * 4 + 2];
dv[i >> 2] = s[i * 4 + 3];
}
}
if (i < width) {
dy[i] = s[i * 4 + 1];
if (IS_CHROMA_LINE_410 (y, flags)) {
du[i >> 2] = s[i * 4 + 2];
dv[i >> 2] = s[i * 4 + 3];
}
if (i < width - 1)
dy[i + 1] = s[i * 4 + 5];
if (i < width - 2)
dy[i + 2] = s[i * 4 + 9];
}
}
#define PACK_IYU1 GST_VIDEO_FORMAT_AYUV, unpack_IYU1, 1, pack_IYU1
static void
unpack_IYU1 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
gpointer dest, const gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], gint x, gint y, gint width)
{
int i;
const guint8 *restrict s = GET_LINE (y);
guint8 *restrict d = dest;
guint8 y0, y1, y2, y3;
guint8 u0;
guint8 v0;
/* FIXME */
s += x * 4;
for (i = 0; i < width - 3; i += 4) {
y0 = s[(i >> 2) * 6 + 1];
y1 = s[(i >> 2) * 6 + 2];
y2 = s[(i >> 2) * 6 + 4];
y3 = s[(i >> 2) * 6 + 5];
u0 = s[(i >> 2) * 6 + 0];
v0 = s[(i >> 2) * 6 + 3];
d[i * 4 + 0] = 0xff;
d[i * 4 + 1] = y0;
d[i * 4 + 2] = u0;
d[i * 4 + 3] = v0;
d[i * 4 + 4] = 0xff;
d[i * 4 + 5] = y1;
d[i * 4 + 6] = u0;
d[i * 4 + 7] = v0;
d[i * 4 + 8] = 0xff;
d[i * 4 + 9] = y2;
d[i * 4 + 10] = u0;
d[i * 4 + 11] = v0;
d[i * 4 + 12] = 0xff;
d[i * 4 + 13] = y3;
d[i * 4 + 14] = u0;
d[i * 4 + 15] = v0;
}
if (i < width) {
u0 = s[(i >> 2) * 6 + 0];
v0 = s[(i >> 2) * 6 + 3];
d[i * 4 + 0] = 0xff;
d[i * 4 + 1] = s[(i >> 2) * 6 + 1];
d[i * 4 + 2] = u0;
d[i * 4 + 3] = v0;
if (i < width - 1) {
d[i * 4 + 4] = 0xff;
d[i * 4 + 5] = s[(i >> 2) * 6 + 2];
d[i * 4 + 6] = u0;
d[i * 4 + 7] = v0;
}
if (i < width - 2) {
d[i * 4 + 8] = 0xff;
d[i * 4 + 9] = s[(i >> 2) * 6 + 4];
d[i * 4 + 10] = u0;
d[i * 4 + 11] = v0;
}
}
}
static void
pack_IYU1 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
const gpointer src, gint sstride, gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], GstVideoChromaSite chroma_site,
gint y, gint width)
{
int i;
guint8 *restrict d = GET_LINE (y);
const guint8 *restrict s = src;
for (i = 0; i < width - 3; i += 4) {
d[(i >> 2) * 6 + 0] = s[i * 4 + 2];
d[(i >> 2) * 6 + 1] = s[i * 4 + 1];
d[(i >> 2) * 6 + 2] = s[i * 4 + 5];
d[(i >> 2) * 6 + 3] = s[i * 4 + 3];
d[(i >> 2) * 6 + 4] = s[i * 4 + 9];
d[(i >> 2) * 6 + 5] = s[i * 4 + 13];
}
if (i < width) {
d[(i >> 2) * 6 + 1] = s[i * 4 + 1];
d[(i >> 2) * 6 + 0] = s[i * 4 + 2];
d[(i >> 2) * 6 + 3] = s[i * 4 + 3];
if (i < width - 1)
d[(i >> 2) * 6 + 2] = s[i * 4 + 5];
if (i < width - 2)
d[(i >> 2) * 6 + 4] = s[i * 4 + 9];
}
}
#define PACK_ARGB64 GST_VIDEO_FORMAT_ARGB64, unpack_copy8, 1, pack_copy8
#define PACK_AYUV64 GST_VIDEO_FORMAT_AYUV64, unpack_copy8, 1, pack_copy8
static void
unpack_copy8 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
gpointer dest, const gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], gint x, gint y, gint width)
{
const guint8 *s = GET_LINE (y);
s += x * 8;
memcpy (dest, s, width * 8);
}
static void
pack_copy8 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
const gpointer src, gint sstride, gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], GstVideoChromaSite chroma_site,
gint y, gint width)
{
guint8 *restrict d = GET_LINE (y);
memcpy (d, src, width * 8);
}
#define PACK_r210 GST_VIDEO_FORMAT_ARGB64, unpack_r210, 1, pack_r210
static void
unpack_r210 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
gpointer dest, const gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], gint x, gint y, gint width)
{
int i;
const guint8 *restrict s = GET_LINE (y);
guint16 *restrict d = dest, R, G, B;
s += x * 4;
for (i = 0; i < width; i++) {
guint32 x = GST_READ_UINT32_BE (s + i * 4);
R = ((x >> 14) & 0xffc0);
G = ((x >> 4) & 0xffc0);
B = ((x << 6) & 0xffc0);
if (!(flags & GST_VIDEO_PACK_FLAG_TRUNCATE_RANGE)) {
R |= (R >> 10);
G |= (G >> 10);
B |= (B >> 10);
}
d[i * 4 + 0] = 0xffff;
d[i * 4 + 1] = R;
d[i * 4 + 2] = G;
d[i * 4 + 3] = B;
}
}
static void
pack_r210 (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
const gpointer src, gint sstride, gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], GstVideoChromaSite chroma_site,
gint y, gint width)
{
int i;
guint8 *restrict d = GET_LINE (y);
const guint16 *restrict s = src;
for (i = 0; i < width; i++) {
guint32 x = 0;
x |= (s[i * 4 + 1] & 0xffc0) << 14;
x |= (s[i * 4 + 2] & 0xffc0) << 4;
x |= (s[i * 4 + 3] & 0xffc0) >> 6;
GST_WRITE_UINT32_BE (d + i * 4, x);
}
}
#define PACK_GBR_10LE GST_VIDEO_FORMAT_ARGB64, unpack_GBR_10LE, 1, pack_GBR_10LE
static void
unpack_GBR_10LE (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
gpointer dest, const gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], gint x, gint y, gint width)
{
int i;
const guint16 *sg = GET_G_LINE (y);
const guint16 *sb = GET_B_LINE (y);
const guint16 *sr = GET_R_LINE (y);
guint16 *d = dest, G, B, R;
sg += x;
sb += x;
sr += x;
for (i = 0; i < width; i++) {
G = GST_READ_UINT16_LE (sg + i) << 6;
B = GST_READ_UINT16_LE (sb + i) << 6;
R = GST_READ_UINT16_LE (sr + i) << 6;
if (!(flags & GST_VIDEO_PACK_FLAG_TRUNCATE_RANGE)) {
R |= (R >> 10);
G |= (G >> 10);
B |= (B >> 10);
}
d[i * 4 + 0] = 0xffff;
d[i * 4 + 1] = R;
d[i * 4 + 2] = G;
d[i * 4 + 3] = B;
}
}
static void
pack_GBR_10LE (const GstVideoFormatInfo * info, GstVideoPackFlags flags,
const gpointer src, gint sstride, gpointer data[GST_VIDEO_MAX_PLANES],
const gint stride[GST_VIDEO_MAX_PLANES], GstVideoChromaSite chroma_site,
gint y, gint width)
{