gstreamer/subprojects/gst-plugins-bad/gst/bayer/gstrgb2bayer.c

359 lines
11 KiB
C
Raw Normal View History

/* GStreamer
* Copyright (C) 2010 David Schleef <ds@entropywave.com>
*
* 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 <gst/gst.h>
#include <gst/base/gstbasetransform.h>
#include <gst/video/video.h>
#include "gstbayerelements.h"
#include "gstrgb2bayer.h"
#define DIV_ROUND_UP(s,v) (((s) + ((v)-1)) / (v))
#define GST_CAT_DEFAULT gst_rgb2bayer_debug
GST_DEBUG_CATEGORY_STATIC (GST_CAT_DEFAULT);
static void gst_rgb2bayer_finalize (GObject * object);
static GstCaps *gst_rgb2bayer_transform_caps (GstBaseTransform * trans,
2011-10-16 14:28:58 +00:00
GstPadDirection direction, GstCaps * caps, GstCaps * filter);
static gboolean
gst_rgb2bayer_get_unit_size (GstBaseTransform * trans, GstCaps * caps,
2011-10-16 14:28:58 +00:00
gsize * size);
static gboolean
gst_rgb2bayer_set_caps (GstBaseTransform * trans, GstCaps * incaps,
GstCaps * outcaps);
static GstFlowReturn gst_rgb2bayer_transform (GstBaseTransform * trans,
GstBuffer * inbuf, GstBuffer * outbuf);
static GstStaticPadTemplate gst_rgb2bayer_sink_template =
GST_STATIC_PAD_TEMPLATE ("sink",
GST_PAD_SINK,
GST_PAD_ALWAYS,
2011-10-16 14:28:58 +00:00
GST_STATIC_CAPS (GST_VIDEO_CAPS_MAKE ("ARGB"))
);
#if 0
/* do these later */
static GstStaticPadTemplate gst_rgb2bayer_sink_template =
GST_STATIC_PAD_TEMPLATE ("sink",
GST_PAD_SINK,
GST_PAD_ALWAYS,
GST_STATIC_CAPS (GST_VIDEO_CAPS_RGBx ";" GST_VIDEO_CAPS_xRGB ";"
GST_VIDEO_CAPS_BGRx ";" GST_VIDEO_CAPS_xBGR ";"
GST_VIDEO_CAPS_RGBA ";" GST_VIDEO_CAPS_ARGB ";"
GST_VIDEO_CAPS_BGRA ";" GST_VIDEO_CAPS_ABGR)
);
#endif
#define BAYER_CAPS_GEN(mask, bits, endian) \
" "#mask#bits#endian
#define BAYER_CAPS_ORD(bits, endian) \
BAYER_CAPS_GEN(bggr, bits, endian)"," \
BAYER_CAPS_GEN(rggb, bits, endian)"," \
BAYER_CAPS_GEN(grbg, bits, endian)"," \
BAYER_CAPS_GEN(gbrg, bits, endian)
#define BAYER_CAPS_BITS(bits) \
BAYER_CAPS_ORD(bits, le)"," \
BAYER_CAPS_ORD(bits, be)
#define BAYER_CAPS_ALL \
BAYER_CAPS_ORD(,)"," \
BAYER_CAPS_BITS(10)"," \
BAYER_CAPS_BITS(12)"," \
BAYER_CAPS_BITS(14)"," \
BAYER_CAPS_BITS(16)
static GstStaticPadTemplate gst_rgb2bayer_src_template =
GST_STATIC_PAD_TEMPLATE ("src",
GST_PAD_SRC,
GST_PAD_ALWAYS,
2012-03-05 11:43:42 +00:00
GST_STATIC_CAPS ("video/x-bayer,"
"format=(string){" BAYER_CAPS_ALL " },"
"width=[1,MAX],height=[1,MAX]," "framerate=(fraction)[0/1,MAX]")
);
/* class initialization */
2011-10-16 14:28:58 +00:00
#define gst_rgb2bayer_parent_class parent_class
G_DEFINE_TYPE (GstRGB2Bayer, gst_rgb2bayer, GST_TYPE_BASE_TRANSFORM);
GST_ELEMENT_REGISTER_DEFINE (rgb2bayer, "rgb2bayer", GST_RANK_NONE,
gst_rgb2bayer_get_type ());
static void
2011-10-16 14:28:58 +00:00
gst_rgb2bayer_class_init (GstRGB2BayerClass * klass)
{
2011-10-16 14:28:58 +00:00
GObjectClass *gobject_class = G_OBJECT_CLASS (klass);
GstElementClass *element_class = GST_ELEMENT_CLASS (klass);
GstBaseTransformClass *base_transform_class =
GST_BASE_TRANSFORM_CLASS (klass);
gobject_class->finalize = gst_rgb2bayer_finalize;
gst_element_class_add_static_pad_template (element_class,
&gst_rgb2bayer_src_template);
gst_element_class_add_static_pad_template (element_class,
&gst_rgb2bayer_sink_template);
gst_element_class_set_static_metadata (element_class,
"RGB to Bayer converter",
"Filter/Converter/Video",
2012-03-05 11:43:42 +00:00
"Converts video/x-raw to video/x-bayer",
"David Schleef <ds@entropywave.com>");
base_transform_class->transform_caps =
GST_DEBUG_FUNCPTR (gst_rgb2bayer_transform_caps);
base_transform_class->get_unit_size =
GST_DEBUG_FUNCPTR (gst_rgb2bayer_get_unit_size);
base_transform_class->set_caps = GST_DEBUG_FUNCPTR (gst_rgb2bayer_set_caps);
base_transform_class->transform = GST_DEBUG_FUNCPTR (gst_rgb2bayer_transform);
2011-10-16 14:28:58 +00:00
GST_DEBUG_CATEGORY_INIT (gst_rgb2bayer_debug, "rgb2bayer", 0,
"rgb2bayer element");
}
static void
2011-10-16 14:28:58 +00:00
gst_rgb2bayer_init (GstRGB2Bayer * rgb2bayer)
{
}
void
gst_rgb2bayer_finalize (GObject * object)
{
G_OBJECT_CLASS (parent_class)->finalize (object);
}
static GstCaps *
gst_rgb2bayer_transform_caps (GstBaseTransform * trans,
2011-10-16 14:28:58 +00:00
GstPadDirection direction, GstCaps * caps, GstCaps * filter)
{
GstRGB2Bayer *rgb2bayer;
GstCaps *res_caps, *tmp_caps;
GstStructure *structure;
guint i, caps_size;
rgb2bayer = GST_RGB_2_BAYER (trans);
res_caps = gst_caps_copy (caps);
caps_size = gst_caps_get_size (res_caps);
for (i = 0; i < caps_size; i++) {
structure = gst_caps_get_structure (res_caps, i);
if (direction == GST_PAD_SRC) {
gst_structure_set_name (structure, "video/x-raw");
gst_structure_remove_field (structure, "format");
} else {
gst_structure_set_name (structure, "video/x-bayer");
gst_structure_remove_fields (structure, "format", "colorimetry",
"chroma-site", NULL);
}
}
if (filter) {
tmp_caps = res_caps;
res_caps =
gst_caps_intersect_full (filter, tmp_caps, GST_CAPS_INTERSECT_FIRST);
gst_caps_unref (tmp_caps);
}
GST_DEBUG_OBJECT (rgb2bayer, "transformed %" GST_PTR_FORMAT " into %"
GST_PTR_FORMAT, caps, res_caps);
return res_caps;
}
static gboolean
gst_rgb2bayer_get_unit_size (GstBaseTransform * trans, GstCaps * caps,
2011-10-16 14:28:58 +00:00
gsize * size)
{
GstRGB2Bayer *rgb2bayer = GST_RGB_2_BAYER (trans);
GstStructure *structure;
int width;
int height;
const char *name;
structure = gst_caps_get_structure (caps, 0);
if (gst_structure_get_int (structure, "width", &width) &&
gst_structure_get_int (structure, "height", &height)) {
name = gst_structure_get_name (structure);
2012-03-05 11:43:42 +00:00
/* Our name must be either video/x-bayer video/x-raw */
if (g_str_equal (name, "video/x-bayer")) {
*size =
GST_ROUND_UP_4 (width) * height * DIV_ROUND_UP (rgb2bayer->bpp, 8);
return TRUE;
} else {
/* For output, calculate according to format */
2011-10-16 14:28:58 +00:00
*size = width * height * 4;
return TRUE;
}
}
return FALSE;
}
static gboolean
gst_rgb2bayer_set_caps (GstBaseTransform * trans, GstCaps * incaps,
GstCaps * outcaps)
{
GstRGB2Bayer *rgb2bayer = GST_RGB_2_BAYER (trans);
GstStructure *structure;
const char *format;
2011-10-16 14:28:58 +00:00
GstVideoInfo info;
GST_DEBUG ("in caps %" GST_PTR_FORMAT " out caps %" GST_PTR_FORMAT, incaps,
outcaps);
2011-10-16 14:28:58 +00:00
if (!gst_video_info_from_caps (&info, incaps))
return FALSE;
rgb2bayer->info = info;
structure = gst_caps_get_structure (outcaps, 0);
gst_structure_get_int (structure, "width", &rgb2bayer->width);
gst_structure_get_int (structure, "height", &rgb2bayer->height);
format = gst_structure_get_string (structure, "format");
if (g_str_has_prefix (format, "bggr")) {
rgb2bayer->format = GST_RGB_2_BAYER_FORMAT_BGGR;
} else if (g_str_has_prefix (format, "gbrg")) {
rgb2bayer->format = GST_RGB_2_BAYER_FORMAT_GBRG;
} else if (g_str_has_prefix (format, "grbg")) {
rgb2bayer->format = GST_RGB_2_BAYER_FORMAT_GRBG;
} else if (g_str_has_prefix (format, "rggb")) {
rgb2bayer->format = GST_RGB_2_BAYER_FORMAT_RGGB;
} else {
return FALSE;
}
if (strlen (format) == 4) { /* 8bit bayer */
rgb2bayer->bpp = 8;
} else if (strlen (format) == 8) { /* 10/12/14/16 le/be bayer */
rgb2bayer->bpp = (gint) g_ascii_strtoull (format + 4, NULL, 10);
if (rgb2bayer->bpp & 1) /* odd rgb2bayer->bpp bayer formats not supported */
return FALSE;
if (rgb2bayer->bpp < 10 || rgb2bayer->bpp > 16) /* bayer 10,12,14,16 only */
return FALSE;
if (g_str_has_suffix (format, "le"))
rgb2bayer->bigendian = 0;
else if (g_str_has_suffix (format, "be"))
rgb2bayer->bigendian = 1;
else
return FALSE;
} else
return FALSE;
return TRUE;
}
static guint16
bayer_scale_and_swap (GstRGB2Bayer * rgb2bayer, guint8 r8)
{
guint16 r16 = (r8 << (rgb2bayer->bpp - 8)) | (r8 >> (16 - rgb2bayer->bpp));
#if G_BYTE_ORDER == G_LITTLE_ENDIAN
if (rgb2bayer->bigendian)
r16 = GUINT16_SWAP_LE_BE (r16);
#else
if (!rgb2bayer->bigendian)
r16 = GUINT16_SWAP_LE_BE (r16);
#endif
return r16;
}
static GstFlowReturn
gst_rgb2bayer_transform (GstBaseTransform * trans, GstBuffer * inbuf,
GstBuffer * outbuf)
{
GstRGB2Bayer *rgb2bayer = GST_RGB_2_BAYER (trans);
2012-01-25 13:50:50 +00:00
GstMapInfo map;
guint8 *dest;
guint8 *src;
int i, j;
int height = rgb2bayer->height;
int width = rgb2bayer->width;
2011-10-16 14:28:58 +00:00
GstVideoFrame frame;
int bayer16 = (rgb2bayer->bpp > 8);
2011-10-16 14:28:58 +00:00
2015-08-06 22:11:53 +00:00
if (!gst_video_frame_map (&frame, &rgb2bayer->info, inbuf, GST_MAP_READ))
goto map_failed;
if (!gst_buffer_map (outbuf, &map, GST_MAP_READ)) {
gst_video_frame_unmap (&frame);
goto map_failed;
}
2012-01-25 13:50:50 +00:00
dest = map.data;
2011-10-16 14:28:58 +00:00
src = GST_VIDEO_FRAME_PLANE_DATA (&frame, 0);
if (bayer16) {
for (j = 0; j < height; j++) {
guint16 *dest_line16 = (guint16 *)
(dest + GST_ROUND_UP_4 (width) * j * DIV_ROUND_UP (rgb2bayer->bpp,
8));
guint8 *src_line = src + frame.info.stride[0] * j;
for (i = 0; i < width; i++) {
int is_blue = ((j & 1) << 1) | (i & 1);
if (is_blue == rgb2bayer->format) {
dest_line16[i] =
bayer_scale_and_swap (rgb2bayer, src_line[i * 4 + 3]);
} else if ((is_blue ^ 3) == rgb2bayer->format) {
dest_line16[i] =
bayer_scale_and_swap (rgb2bayer, src_line[i * 4 + 1]);
} else {
dest_line16[i] =
bayer_scale_and_swap (rgb2bayer, src_line[i * 4 + 2]);
}
}
}
} else {
for (j = 0; j < height; j++) {
guint8 *dest_line = dest + GST_ROUND_UP_4 (width) * j;
guint8 *src_line = src + frame.info.stride[0] * j;
for (i = 0; i < width; i++) {
int is_blue = ((j & 1) << 1) | (i & 1);
if (is_blue == rgb2bayer->format) {
dest_line[i] = src_line[i * 4 + 3];
} else if ((is_blue ^ 3) == rgb2bayer->format) {
dest_line[i] = src_line[i * 4 + 1];
} else {
dest_line[i] = src_line[i * 4 + 2];
}
}
}
}
2015-08-06 22:11:53 +00:00
2012-01-25 13:50:50 +00:00
gst_buffer_unmap (outbuf, &map);
2011-10-16 14:28:58 +00:00
gst_video_frame_unmap (&frame);
return GST_FLOW_OK;
2015-08-06 22:11:53 +00:00
map_failed:
GST_WARNING_OBJECT (trans, "Could not map buffer, skipping");
return GST_FLOW_OK;
}