mirror of
https://gitlab.freedesktop.org/gstreamer/gstreamer.git
synced 2024-11-24 10:41:04 +00:00
523 lines
16 KiB
C
523 lines
16 KiB
C
/* GStreamer
|
|
* Copyright (C) <2008> Wim Taymans <wim.taymans@gmail.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 <string.h>
|
|
|
|
#include <gst/rtp/gstrtpbuffer.h>
|
|
|
|
#include "gstrtpvrawpay.h"
|
|
|
|
GST_DEBUG_CATEGORY_STATIC (rtpvrawpay_debug);
|
|
#define GST_CAT_DEFAULT (rtpvrawpay_debug)
|
|
|
|
static GstStaticPadTemplate gst_rtp_vraw_pay_sink_template =
|
|
GST_STATIC_PAD_TEMPLATE ("sink",
|
|
GST_PAD_SINK,
|
|
GST_PAD_ALWAYS,
|
|
GST_STATIC_CAPS ("video/x-raw, "
|
|
"format = (string) { RGB, RGBA, BGR, BGRA, AYUYV, UYVY, I420, Y41B, UYVP, I420, Y42B, Y444 }, "
|
|
"width = (int) [ 1, 32767 ], " "height = (int) [ 1, 32767 ]; ")
|
|
);
|
|
|
|
static GstStaticPadTemplate gst_rtp_vraw_pay_src_template =
|
|
GST_STATIC_PAD_TEMPLATE ("src",
|
|
GST_PAD_SRC,
|
|
GST_PAD_ALWAYS,
|
|
GST_STATIC_CAPS ("application/x-rtp, "
|
|
"media = (string) \"video\", "
|
|
"payload = (int) " GST_RTP_PAYLOAD_DYNAMIC_STRING ", "
|
|
"clock-rate = (int) 90000, "
|
|
"encoding-name = (string) \"RAW\","
|
|
"sampling = (string) { \"RGB\", \"RGBA\", \"BGR\", \"BGRA\", "
|
|
"\"YCbCr-4:4:4\", \"YCbCr-4:2:2\", \"YCbCr-4:2:0\", "
|
|
"\"YCbCr-4:1:1\" },"
|
|
/* we cannot express these as strings
|
|
* "width = (string) [1 32767],"
|
|
* "height = (string) [1 32767],"
|
|
*/
|
|
"depth = (string) { \"8\", \"10\", \"12\", \"16\" },"
|
|
"colorimetry = (string) { \"BT601-5\", \"BT709-2\", \"SMPTE240M\" }"
|
|
/* optional
|
|
* interlace =
|
|
* top-field-first =
|
|
* chroma-position = (string)
|
|
* gamma = (float)
|
|
*/
|
|
)
|
|
);
|
|
|
|
static gboolean gst_rtp_vraw_pay_setcaps (GstRTPBasePayload * payload,
|
|
GstCaps * caps);
|
|
static GstFlowReturn gst_rtp_vraw_pay_handle_buffer (GstRTPBasePayload *
|
|
payload, GstBuffer * buffer);
|
|
|
|
G_DEFINE_TYPE (GstRtpVRawPay, gst_rtp_vraw_pay, GST_TYPE_RTP_BASE_PAYLOAD)
|
|
|
|
static void gst_rtp_vraw_pay_class_init (GstRtpVRawPayClass * klass)
|
|
{
|
|
GstRTPBasePayloadClass *gstrtpbasepayload_class;
|
|
GstElementClass *gstelement_class;
|
|
|
|
gstelement_class = (GstElementClass *) klass;
|
|
gstrtpbasepayload_class = (GstRTPBasePayloadClass *) klass;
|
|
|
|
gstrtpbasepayload_class->set_caps = gst_rtp_vraw_pay_setcaps;
|
|
gstrtpbasepayload_class->handle_buffer = gst_rtp_vraw_pay_handle_buffer;
|
|
|
|
gst_element_class_add_pad_template (gstelement_class,
|
|
gst_static_pad_template_get (&gst_rtp_vraw_pay_src_template));
|
|
gst_element_class_add_pad_template (gstelement_class,
|
|
gst_static_pad_template_get (&gst_rtp_vraw_pay_sink_template));
|
|
|
|
gst_element_class_set_static_metadata (gstelement_class,
|
|
"RTP Raw Video payloader", "Codec/Payloader/Network/RTP",
|
|
"Payload raw video as RTP packets (RFC 4175)",
|
|
"Wim Taymans <wim.taymans@gmail.com>");
|
|
|
|
GST_DEBUG_CATEGORY_INIT (rtpvrawpay_debug, "rtpvrawpay", 0,
|
|
"Raw video RTP Payloader");
|
|
}
|
|
|
|
static void
|
|
gst_rtp_vraw_pay_init (GstRtpVRawPay * rtpvrawpay)
|
|
{
|
|
}
|
|
|
|
static gboolean
|
|
gst_rtp_vraw_pay_setcaps (GstRTPBasePayload * payload, GstCaps * caps)
|
|
{
|
|
GstRtpVRawPay *rtpvrawpay;
|
|
gboolean res;
|
|
gint pgroup, xinc, yinc;
|
|
const gchar *depthstr, *samplingstr, *colorimetrystr;
|
|
gchar *wstr, *hstr;
|
|
gint depth;
|
|
GstVideoInfo info;
|
|
|
|
rtpvrawpay = GST_RTP_VRAW_PAY (payload);
|
|
|
|
if (!gst_video_info_from_caps (&info, caps))
|
|
goto invalid_caps;
|
|
|
|
rtpvrawpay->vinfo = info;
|
|
|
|
if (gst_video_colorimetry_matches (&info.colorimetry,
|
|
GST_VIDEO_COLORIMETRY_BT601)) {
|
|
colorimetrystr = "BT601-5";
|
|
} else if (gst_video_colorimetry_matches (&info.colorimetry,
|
|
GST_VIDEO_COLORIMETRY_BT709)) {
|
|
colorimetrystr = "BT709-2";
|
|
} else if (gst_video_colorimetry_matches (&info.colorimetry,
|
|
GST_VIDEO_COLORIMETRY_SMPTE240M)) {
|
|
colorimetrystr = "SMPTE240M";
|
|
} else {
|
|
colorimetrystr = "SMPTE240M";
|
|
}
|
|
|
|
xinc = yinc = 1;
|
|
|
|
/* these values are the only thing we can do */
|
|
depthstr = "8";
|
|
depth = 8;
|
|
|
|
switch (GST_VIDEO_INFO_FORMAT (&info)) {
|
|
case GST_VIDEO_FORMAT_RGBA:
|
|
samplingstr = "RGBA";
|
|
pgroup = 4;
|
|
break;
|
|
case GST_VIDEO_FORMAT_BGRA:
|
|
samplingstr = "BGRA";
|
|
pgroup = 4;
|
|
break;
|
|
case GST_VIDEO_FORMAT_RGB:
|
|
samplingstr = "RGB";
|
|
pgroup = 3;
|
|
case GST_VIDEO_FORMAT_BGR:
|
|
samplingstr = "BGR";
|
|
pgroup = 3;
|
|
break;
|
|
case GST_VIDEO_FORMAT_AYUV:
|
|
samplingstr = "YCbCr-4:4:4";
|
|
pgroup = 3;
|
|
break;
|
|
case GST_VIDEO_FORMAT_UYVY:
|
|
samplingstr = "YCbCr-4:2:2";
|
|
pgroup = 4;
|
|
xinc = 2;
|
|
break;
|
|
case GST_VIDEO_FORMAT_Y41B:
|
|
samplingstr = "YCbCr-4:1:1";
|
|
pgroup = 6;
|
|
xinc = 4;
|
|
break;
|
|
case GST_VIDEO_FORMAT_I420:
|
|
samplingstr = "YCbCr-4:2:0";
|
|
pgroup = 6;
|
|
xinc = yinc = 2;
|
|
break;
|
|
case GST_VIDEO_FORMAT_UYVP:
|
|
samplingstr = "YCbCr-4:2:2";
|
|
pgroup = 4;
|
|
xinc = 2;
|
|
depth = 10;
|
|
depthstr = "10";
|
|
break;
|
|
default:
|
|
goto unknown_format;
|
|
break;
|
|
}
|
|
|
|
if (GST_VIDEO_INFO_IS_INTERLACED (&info)) {
|
|
yinc *= 2;
|
|
}
|
|
|
|
rtpvrawpay->pgroup = pgroup;
|
|
rtpvrawpay->xinc = xinc;
|
|
rtpvrawpay->yinc = yinc;
|
|
rtpvrawpay->depth = depth;
|
|
|
|
GST_DEBUG_OBJECT (payload, "width %d, height %d, sampling %s",
|
|
GST_VIDEO_INFO_WIDTH (&info), GST_VIDEO_INFO_HEIGHT (&info), samplingstr);
|
|
GST_DEBUG_OBJECT (payload, "xinc %d, yinc %d, pgroup %d", xinc, yinc, pgroup);
|
|
|
|
wstr = g_strdup_printf ("%d", GST_VIDEO_INFO_WIDTH (&info));
|
|
hstr = g_strdup_printf ("%d", GST_VIDEO_INFO_HEIGHT (&info));
|
|
|
|
gst_rtp_base_payload_set_options (payload, "video", TRUE, "RAW", 90000);
|
|
if (GST_VIDEO_INFO_IS_INTERLACED (&info)) {
|
|
res = gst_rtp_base_payload_set_outcaps (payload, "sampling", G_TYPE_STRING,
|
|
samplingstr, "depth", G_TYPE_STRING, depthstr, "width", G_TYPE_STRING,
|
|
wstr, "height", G_TYPE_STRING, hstr, "colorimetry", G_TYPE_STRING,
|
|
colorimetrystr, "interlace", G_TYPE_STRING, "true", NULL);
|
|
} else {
|
|
res = gst_rtp_base_payload_set_outcaps (payload, "sampling", G_TYPE_STRING,
|
|
samplingstr, "depth", G_TYPE_STRING, depthstr, "width", G_TYPE_STRING,
|
|
wstr, "height", G_TYPE_STRING, hstr, "colorimetry", G_TYPE_STRING,
|
|
colorimetrystr, NULL);
|
|
}
|
|
g_free (wstr);
|
|
g_free (hstr);
|
|
|
|
return res;
|
|
|
|
/* ERRORS */
|
|
invalid_caps:
|
|
{
|
|
GST_ERROR_OBJECT (payload, "could not parse caps");
|
|
return FALSE;
|
|
}
|
|
unknown_format:
|
|
{
|
|
GST_ERROR_OBJECT (payload, "unknown caps format");
|
|
return FALSE;
|
|
}
|
|
}
|
|
|
|
static GstFlowReturn
|
|
gst_rtp_vraw_pay_handle_buffer (GstRTPBasePayload * payload, GstBuffer * buffer)
|
|
{
|
|
GstRtpVRawPay *rtpvrawpay;
|
|
GstFlowReturn ret = GST_FLOW_OK;
|
|
guint line, offset;
|
|
guint8 *yp, *up, *vp;
|
|
guint ystride, uvstride;
|
|
guint pgroup;
|
|
guint mtu;
|
|
guint width, height;
|
|
gint field;
|
|
GstVideoFrame frame;
|
|
gint interlaced;
|
|
GstRTPBuffer rtp = { NULL, };
|
|
|
|
rtpvrawpay = GST_RTP_VRAW_PAY (payload);
|
|
|
|
gst_video_frame_map (&frame, &rtpvrawpay->vinfo, buffer, GST_MAP_READ);
|
|
|
|
GST_LOG_OBJECT (rtpvrawpay, "new frame of %" G_GSIZE_FORMAT " bytes",
|
|
gst_buffer_get_size (buffer));
|
|
|
|
/* get pointer and strides of the planes */
|
|
yp = GST_VIDEO_FRAME_COMP_DATA (&frame, 0);
|
|
up = GST_VIDEO_FRAME_COMP_DATA (&frame, 1);
|
|
vp = GST_VIDEO_FRAME_COMP_DATA (&frame, 2);
|
|
|
|
ystride = GST_VIDEO_FRAME_COMP_STRIDE (&frame, 0);
|
|
uvstride = GST_VIDEO_FRAME_COMP_STRIDE (&frame, 1);
|
|
|
|
mtu = GST_RTP_BASE_PAYLOAD_MTU (payload);
|
|
|
|
/* amount of bytes for one pixel */
|
|
pgroup = rtpvrawpay->pgroup;
|
|
width = GST_VIDEO_INFO_WIDTH (&rtpvrawpay->vinfo);
|
|
height = GST_VIDEO_INFO_HEIGHT (&rtpvrawpay->vinfo);
|
|
|
|
interlaced = GST_VIDEO_INFO_IS_INTERLACED (&rtpvrawpay->vinfo);
|
|
|
|
/* start with line 0, offset 0 */
|
|
for (field = 0; field < 1 + interlaced; field++) {
|
|
line = field;
|
|
offset = 0;
|
|
|
|
/* write all lines */
|
|
while (line < height) {
|
|
guint left;
|
|
GstBuffer *out;
|
|
guint8 *outdata, *headers;
|
|
gboolean next_line;
|
|
guint length, cont, pixels;
|
|
|
|
/* get the max allowed payload length size, we try to fill the complete MTU */
|
|
left = gst_rtp_buffer_calc_payload_len (mtu, 0, 0);
|
|
out = gst_rtp_buffer_new_allocate (left, 0, 0);
|
|
|
|
if (field == 0) {
|
|
GST_BUFFER_TIMESTAMP (out) = GST_BUFFER_TIMESTAMP (buffer);
|
|
} else {
|
|
GST_BUFFER_TIMESTAMP (out) = GST_BUFFER_TIMESTAMP (buffer) +
|
|
GST_BUFFER_DURATION (buffer) / 2;
|
|
}
|
|
|
|
gst_rtp_buffer_map (out, GST_MAP_WRITE, &rtp);
|
|
outdata = gst_rtp_buffer_get_payload (&rtp);
|
|
|
|
GST_LOG_OBJECT (rtpvrawpay, "created buffer of size %u for MTU %u", left,
|
|
mtu);
|
|
|
|
/*
|
|
* 0 1 2 3
|
|
* 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1
|
|
* +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
|
|
* | Extended Sequence Number | Length |
|
|
* +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
|
|
* |F| Line No |C| Offset |
|
|
* +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
|
|
* | Length |F| Line No |
|
|
* +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
|
|
* |C| Offset | .
|
|
* +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ .
|
|
* . .
|
|
* . Two (partial) lines of video data .
|
|
* . .
|
|
* +---------------------------------------------------------------+
|
|
*/
|
|
|
|
/* need 2 bytes for the extended sequence number */
|
|
*outdata++ = 0;
|
|
*outdata++ = 0;
|
|
left -= 2;
|
|
|
|
/* the headers start here */
|
|
headers = outdata;
|
|
|
|
/* while we can fit at least one header and one pixel */
|
|
while (left > (6 + pgroup)) {
|
|
/* we need a 6 bytes header */
|
|
left -= 6;
|
|
|
|
/* get how may bytes we need for the remaining pixels */
|
|
pixels = width - offset;
|
|
length = (pixels * pgroup) / rtpvrawpay->xinc;
|
|
|
|
if (left >= length) {
|
|
/* pixels and header fit completely, we will write them and skip to the
|
|
* next line. */
|
|
next_line = TRUE;
|
|
} else {
|
|
/* line does not fit completely, see how many pixels fit */
|
|
pixels = (left / pgroup) * rtpvrawpay->xinc;
|
|
length = (pixels * pgroup) / rtpvrawpay->xinc;
|
|
next_line = FALSE;
|
|
}
|
|
GST_LOG_OBJECT (rtpvrawpay, "filling %u bytes in %u pixels", length,
|
|
pixels);
|
|
left -= length;
|
|
|
|
/* write length */
|
|
*outdata++ = (length >> 8) & 0xff;
|
|
*outdata++ = length & 0xff;
|
|
|
|
/* write line no */
|
|
*outdata++ = ((line >> 8) & 0x7f) | ((field << 7) & 0x80);
|
|
*outdata++ = line & 0xff;
|
|
|
|
if (next_line) {
|
|
/* go to next line we do this here to make the check below easier */
|
|
line += rtpvrawpay->yinc;
|
|
}
|
|
|
|
/* calculate continuation marker */
|
|
cont = (left > (6 + pgroup) && line < height) ? 0x80 : 0x00;
|
|
|
|
/* write offset and continuation marker */
|
|
*outdata++ = ((offset >> 8) & 0x7f) | cont;
|
|
*outdata++ = offset & 0xff;
|
|
|
|
if (next_line) {
|
|
/* reset offset */
|
|
offset = 0;
|
|
GST_LOG_OBJECT (rtpvrawpay, "go to next line %u", line);
|
|
} else {
|
|
offset += pixels;
|
|
GST_LOG_OBJECT (rtpvrawpay, "next offset %u", offset);
|
|
}
|
|
|
|
if (!cont)
|
|
break;
|
|
}
|
|
GST_LOG_OBJECT (rtpvrawpay, "consumed %u bytes",
|
|
(guint) (outdata - headers));
|
|
|
|
/* second pass, read headers and write the data */
|
|
while (TRUE) {
|
|
guint offs, lin;
|
|
|
|
/* read length and cont */
|
|
length = (headers[0] << 8) | headers[1];
|
|
lin = ((headers[2] & 0x7f) << 8) | headers[3];
|
|
offs = ((headers[4] & 0x7f) << 8) | headers[5];
|
|
cont = headers[4] & 0x80;
|
|
pixels = length / pgroup;
|
|
headers += 6;
|
|
|
|
GST_LOG_OBJECT (payload,
|
|
"writing length %u, line %u, offset %u, cont %d", length, lin, offs,
|
|
cont);
|
|
|
|
switch (GST_VIDEO_INFO_FORMAT (&rtpvrawpay->vinfo)) {
|
|
case GST_VIDEO_FORMAT_RGB:
|
|
case GST_VIDEO_FORMAT_RGBA:
|
|
case GST_VIDEO_FORMAT_BGR:
|
|
case GST_VIDEO_FORMAT_BGRA:
|
|
case GST_VIDEO_FORMAT_UYVY:
|
|
offs /= rtpvrawpay->xinc;
|
|
memcpy (outdata, yp + (lin * ystride) + (offs * pgroup), length);
|
|
outdata += length;
|
|
break;
|
|
case GST_VIDEO_FORMAT_AYUV:
|
|
{
|
|
gint i;
|
|
guint8 *datap;
|
|
|
|
datap = yp + (lin * ystride) + (offs * 4);
|
|
|
|
for (i = 0; i < pixels; i++) {
|
|
*outdata++ = datap[2];
|
|
*outdata++ = datap[1];
|
|
*outdata++ = datap[3];
|
|
datap += 4;
|
|
}
|
|
break;
|
|
}
|
|
case GST_VIDEO_FORMAT_I420:
|
|
{
|
|
gint i;
|
|
guint uvoff;
|
|
guint8 *yd1p, *yd2p, *udp, *vdp;
|
|
|
|
yd1p = yp + (lin * ystride) + (offs);
|
|
yd2p = yd1p + ystride;
|
|
uvoff =
|
|
(lin / rtpvrawpay->yinc * uvstride) + (offs / rtpvrawpay->xinc);
|
|
udp = up + uvoff;
|
|
vdp = vp + uvoff;
|
|
|
|
for (i = 0; i < pixels; i++) {
|
|
*outdata++ = *yd1p++;
|
|
*outdata++ = *yd1p++;
|
|
*outdata++ = *yd2p++;
|
|
*outdata++ = *yd2p++;
|
|
*outdata++ = *udp++;
|
|
*outdata++ = *vdp++;
|
|
}
|
|
break;
|
|
}
|
|
case GST_VIDEO_FORMAT_Y41B:
|
|
{
|
|
gint i;
|
|
guint uvoff;
|
|
guint8 *ydp, *udp, *vdp;
|
|
|
|
ydp = yp + (lin * ystride) + offs;
|
|
uvoff =
|
|
(lin / rtpvrawpay->yinc * uvstride) + (offs / rtpvrawpay->xinc);
|
|
udp = up + uvoff;
|
|
vdp = vp + uvoff;
|
|
|
|
for (i = 0; i < pixels; i++) {
|
|
*outdata++ = *udp++;
|
|
*outdata++ = *ydp++;
|
|
*outdata++ = *ydp++;
|
|
*outdata++ = *vdp++;
|
|
*outdata++ = *ydp++;
|
|
*outdata++ = *ydp++;
|
|
}
|
|
break;
|
|
}
|
|
default:
|
|
gst_rtp_buffer_unmap (&rtp);
|
|
gst_buffer_unref (out);
|
|
goto unknown_sampling;
|
|
}
|
|
|
|
if (!cont)
|
|
break;
|
|
}
|
|
|
|
if (line >= height) {
|
|
GST_LOG_OBJECT (rtpvrawpay, "field/frame complete, set marker");
|
|
gst_rtp_buffer_set_marker (&rtp, TRUE);
|
|
}
|
|
gst_rtp_buffer_unmap (&rtp);
|
|
if (left > 0) {
|
|
GST_LOG_OBJECT (rtpvrawpay, "we have %u bytes left", left);
|
|
gst_buffer_resize (out, 0, gst_buffer_get_size (out) - left);
|
|
}
|
|
|
|
/* push buffer */
|
|
ret = gst_rtp_base_payload_push (payload, out);
|
|
}
|
|
|
|
}
|
|
|
|
gst_video_frame_unmap (&frame);
|
|
gst_buffer_unref (buffer);
|
|
|
|
return ret;
|
|
|
|
/* ERRORS */
|
|
unknown_sampling:
|
|
{
|
|
GST_ELEMENT_ERROR (payload, STREAM, FORMAT,
|
|
(NULL), ("unimplemented sampling"));
|
|
gst_video_frame_unmap (&frame);
|
|
gst_buffer_unref (buffer);
|
|
return GST_FLOW_NOT_SUPPORTED;
|
|
}
|
|
}
|
|
|
|
gboolean
|
|
gst_rtp_vraw_pay_plugin_init (GstPlugin * plugin)
|
|
{
|
|
return gst_element_register (plugin, "rtpvrawpay",
|
|
GST_RANK_SECONDARY, GST_TYPE_RTP_VRAW_PAY);
|
|
}
|