mirror of
https://gitlab.freedesktop.org/gstreamer/gstreamer.git
synced 2024-12-05 16:06:43 +00:00
445 lines
13 KiB
C
445 lines
13 KiB
C
|
/* GStreamer
|
||
|
* Copyright (C) <2020> Mathieu Duponchelle <mathieu@centricular.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.
|
||
|
*/
|
||
|
|
||
|
#include <gst/check/gstcheck.h>
|
||
|
#include <gst/check/gstharness.h>
|
||
|
#include <gst/rtp/gstrtpbuffer.h>
|
||
|
#include <gst/base/base.h>
|
||
|
|
||
|
static GstBuffer *
|
||
|
make_fec_sample (guint16 seq, guint32 ts, guint16 seq_base, gboolean row,
|
||
|
guint8 offset, guint8 NA, guint32 ts_recovery, guint8 * fec_payload,
|
||
|
guint fec_payload_len, guint16 length_recovery)
|
||
|
{
|
||
|
GstBuffer *ret;
|
||
|
GstRTPBuffer rtp = GST_RTP_BUFFER_INIT;
|
||
|
GstBitWriter bits;
|
||
|
guint8 *data;
|
||
|
|
||
|
ret = gst_rtp_buffer_new_allocate (16 + fec_payload_len, 0, 0);
|
||
|
|
||
|
fail_unless (gst_rtp_buffer_map (ret, GST_MAP_WRITE, &rtp));
|
||
|
|
||
|
data = gst_rtp_buffer_get_payload (&rtp);
|
||
|
memset (data, 0x00, 16);
|
||
|
|
||
|
gst_bit_writer_init_with_data (&bits, data, 17, FALSE);
|
||
|
|
||
|
gst_bit_writer_put_bits_uint16 (&bits, seq_base, 16); /* SNBase low bits */
|
||
|
gst_bit_writer_put_bits_uint16 (&bits, length_recovery, 16); /* Length Recovery */
|
||
|
gst_bit_writer_put_bits_uint8 (&bits, 1, 1); /* E */
|
||
|
gst_bit_writer_put_bits_uint8 (&bits, 0x21, 7); /* PT recovery */
|
||
|
gst_bit_writer_put_bits_uint32 (&bits, 0, 24); /* Mask */
|
||
|
gst_bit_writer_put_bits_uint32 (&bits, ts_recovery, 32); /* TS recovery */
|
||
|
gst_bit_writer_put_bits_uint8 (&bits, 0, 1); /* N */
|
||
|
gst_bit_writer_put_bits_uint8 (&bits, row ? 1 : 0, 1); /* D */
|
||
|
gst_bit_writer_put_bits_uint8 (&bits, 0, 3); /* type */
|
||
|
gst_bit_writer_put_bits_uint8 (&bits, 0, 3); /* index */
|
||
|
gst_bit_writer_put_bits_uint8 (&bits, offset, 8); /* Offset */
|
||
|
gst_bit_writer_put_bits_uint8 (&bits, NA, 8); /* NA */
|
||
|
gst_bit_writer_put_bits_uint8 (&bits, 0, 8); /* SNBase ext bits */
|
||
|
|
||
|
memcpy (data + 16, fec_payload, fec_payload_len);
|
||
|
|
||
|
gst_bit_writer_reset (&bits);
|
||
|
|
||
|
GST_MEMDUMP ("fec", data, 16 + fec_payload_len);
|
||
|
|
||
|
gst_rtp_buffer_set_payload_type (&rtp, 96);
|
||
|
gst_rtp_buffer_set_seq (&rtp, seq);
|
||
|
gst_rtp_buffer_set_timestamp (&rtp, ts);
|
||
|
gst_rtp_buffer_unmap (&rtp);
|
||
|
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
static GstBuffer *
|
||
|
make_media_sample (guint16 seq, guint32 ts, guint8 * payload, guint payload_len)
|
||
|
{
|
||
|
GstBuffer *ret;
|
||
|
GstRTPBuffer rtp = GST_RTP_BUFFER_INIT;
|
||
|
guint8 *data;
|
||
|
|
||
|
ret = gst_rtp_buffer_new_allocate (payload_len, 0, 0);
|
||
|
|
||
|
gst_rtp_buffer_map (ret, GST_MAP_WRITE, &rtp);
|
||
|
gst_rtp_buffer_set_payload_type (&rtp, 33);
|
||
|
gst_rtp_buffer_set_seq (&rtp, seq);
|
||
|
gst_rtp_buffer_set_timestamp (&rtp, ts);
|
||
|
data = gst_rtp_buffer_get_payload (&rtp);
|
||
|
memcpy (data, payload, payload_len);
|
||
|
gst_rtp_buffer_unmap (&rtp);
|
||
|
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
static void
|
||
|
pull_and_check (GstHarness * h, guint16 seq, guint32 ts, guint8 * payload,
|
||
|
guint payload_len, guint n_in_queue)
|
||
|
{
|
||
|
GstBuffer *buffer;
|
||
|
GstRTPBuffer rtp = GST_RTP_BUFFER_INIT;
|
||
|
guint8 *data;
|
||
|
guint i;
|
||
|
|
||
|
fail_unless_equals_int (gst_harness_buffers_in_queue (h), n_in_queue);
|
||
|
buffer = gst_harness_pull (h);
|
||
|
|
||
|
fail_unless (gst_rtp_buffer_map (buffer, GST_MAP_READ, &rtp));
|
||
|
|
||
|
fail_unless_equals_int (gst_rtp_buffer_get_seq (&rtp), seq);
|
||
|
fail_unless_equals_int (gst_rtp_buffer_get_timestamp (&rtp), ts);
|
||
|
fail_unless_equals_int (gst_rtp_buffer_get_payload_type (&rtp), 33);
|
||
|
fail_unless_equals_int (gst_rtp_buffer_get_payload_len (&rtp), payload_len);
|
||
|
data = gst_rtp_buffer_get_payload (&rtp);
|
||
|
|
||
|
for (i = 0; i < payload_len; i++)
|
||
|
fail_unless_equals_int (data[i], payload[i]);
|
||
|
|
||
|
gst_rtp_buffer_unmap (&rtp);
|
||
|
|
||
|
gst_buffer_unref (buffer);
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* +--------------+
|
||
|
* | 9 | 10 | x | l1
|
||
|
* | 12 | 13 | x | l2
|
||
|
* | x | x | x |
|
||
|
* +--------------+
|
||
|
* x x x
|
||
|
*
|
||
|
* Missing values:
|
||
|
* 11: 0xc5
|
||
|
* 14: 0xb8
|
||
|
*/
|
||
|
GST_START_TEST (test_row)
|
||
|
{
|
||
|
guint8 payload;
|
||
|
GstHarness *h =
|
||
|
gst_harness_new_with_padnames ("rtpst2022-1-fecdec", NULL, "src");
|
||
|
GstHarness *h0 = gst_harness_new_with_element (h->element, "sink", NULL);
|
||
|
GstHarness *h_fec_1 =
|
||
|
gst_harness_new_with_element (h->element, "fec_1", NULL);
|
||
|
|
||
|
gst_harness_set_src_caps_str (h0, "application/x-rtp");
|
||
|
gst_harness_set_src_caps_str (h_fec_1, "application/x-rtp");
|
||
|
|
||
|
payload = 0x37;
|
||
|
gst_harness_push (h0, make_media_sample (9, 0, &payload, 1));
|
||
|
payload = 0x28;
|
||
|
gst_harness_push (h0, make_media_sample (10, 0, &payload, 1));
|
||
|
payload = 0xff;
|
||
|
gst_harness_push (h0, make_media_sample (12, 0, &payload, 1));
|
||
|
|
||
|
/* We receive 9, 10 and 12 */
|
||
|
fail_unless_equals_int (gst_harness_buffers_in_queue (h), 3);
|
||
|
while (gst_harness_buffers_in_queue (h)) {
|
||
|
gst_buffer_unref (gst_harness_pull (h));
|
||
|
}
|
||
|
|
||
|
payload = 0xda;
|
||
|
gst_harness_push (h_fec_1, make_fec_sample (0, 0, 9, TRUE, 1, 3, 0, &payload,
|
||
|
1, 1));
|
||
|
|
||
|
/* After pushing l1, we should have enough info to reconstruct 11 */
|
||
|
payload = 0xc5;
|
||
|
pull_and_check (h, 11, 0, &payload, 1, 1);
|
||
|
|
||
|
/* Now we try to push l2 before 13, to verify that 14 is eventually
|
||
|
* reconstructed once 13 is pushed */
|
||
|
payload = 0x02;
|
||
|
gst_harness_push (h_fec_1, make_fec_sample (1, 0, 12, TRUE, 1, 3, 0, &payload,
|
||
|
1, 1));
|
||
|
fail_unless_equals_int (gst_harness_buffers_in_queue (h), 0);
|
||
|
payload = 0x45;
|
||
|
gst_harness_push (h0, make_media_sample (13, 0, &payload, 1));
|
||
|
fail_unless_equals_int (gst_harness_buffers_in_queue (h), 2);
|
||
|
payload = 0xb8;
|
||
|
pull_and_check (h, 14, 0, &payload, 1, 2);
|
||
|
payload = 0x45;
|
||
|
pull_and_check (h, 13, 0, &payload, 1, 1);
|
||
|
|
||
|
gst_harness_teardown (h);
|
||
|
gst_harness_teardown (h0);
|
||
|
gst_harness_teardown (h_fec_1);
|
||
|
}
|
||
|
|
||
|
GST_END_TEST;
|
||
|
|
||
|
/**
|
||
|
* +--------------+
|
||
|
* | 7 | 8 | x | x
|
||
|
* | 10 | 11 | x | x
|
||
|
* | x | x | x |
|
||
|
* +--------------+
|
||
|
* d1 d2 x
|
||
|
*
|
||
|
* Missing values:
|
||
|
* 13: 0xc5
|
||
|
* 14: 0x51
|
||
|
*/
|
||
|
GST_START_TEST (test_column)
|
||
|
{
|
||
|
guint8 payload;
|
||
|
GstHarness *h =
|
||
|
gst_harness_new_with_padnames ("rtpst2022-1-fecdec", NULL, "src");
|
||
|
GstHarness *h0 = gst_harness_new_with_element (h->element, "sink", NULL);
|
||
|
GstHarness *h_fec_0 =
|
||
|
gst_harness_new_with_element (h->element, "fec_0", NULL);
|
||
|
|
||
|
gst_harness_set_src_caps_str (h0, "application/x-rtp");
|
||
|
gst_harness_set_src_caps_str (h_fec_0, "application/x-rtp");
|
||
|
|
||
|
payload = 0x37;
|
||
|
gst_harness_push (h0, make_media_sample (7, 0, &payload, 1));
|
||
|
payload = 0x28;
|
||
|
gst_harness_push (h0, make_media_sample (10, 0, &payload, 1));
|
||
|
|
||
|
fail_unless_equals_int (gst_harness_buffers_in_queue (h), 2);
|
||
|
while (gst_harness_buffers_in_queue (h))
|
||
|
gst_buffer_unref (gst_harness_pull (h));
|
||
|
|
||
|
payload = 0xda;
|
||
|
gst_harness_push (h_fec_0, make_fec_sample (0, 0, 7, FALSE, 3, 3, 0, &payload,
|
||
|
1, 1));
|
||
|
|
||
|
/* After pushing d1, we should have enough info to reconstruct 13 */
|
||
|
payload = 0xc5;
|
||
|
pull_and_check (h, 13, 0, &payload, 1, 1);
|
||
|
|
||
|
/* Now we try to push d2 before 8 and 11, to verify that 14 is eventually
|
||
|
* reconstructed once 11 is pushed */
|
||
|
payload = 0x04;
|
||
|
gst_harness_push (h_fec_0, make_fec_sample (1, 0, 8, FALSE, 3, 3, 0, &payload,
|
||
|
1, 1));
|
||
|
payload = 0x21;
|
||
|
gst_harness_push (h0, make_media_sample (8, 0, &payload, 1));
|
||
|
|
||
|
fail_unless_equals_int (gst_harness_buffers_in_queue (h), 1);
|
||
|
while (gst_harness_buffers_in_queue (h))
|
||
|
gst_buffer_unref (gst_harness_pull (h));
|
||
|
|
||
|
payload = 0x74;
|
||
|
gst_harness_push (h0, make_media_sample (11, 0, &payload, 1));
|
||
|
payload = 0x51;
|
||
|
pull_and_check (h, 14, 0, &payload, 1, 2);
|
||
|
payload = 0x74;
|
||
|
pull_and_check (h, 11, 0, &payload, 1, 1);
|
||
|
|
||
|
gst_harness_teardown (h);
|
||
|
gst_harness_teardown (h0);
|
||
|
gst_harness_teardown (h_fec_0);
|
||
|
}
|
||
|
|
||
|
GST_END_TEST;
|
||
|
|
||
|
|
||
|
/*
|
||
|
* +-----------+
|
||
|
* | 0 | 1 | x | x
|
||
|
* | 3 | 4 | x | l1
|
||
|
* | 6 | x | x | l2
|
||
|
* +-----------+
|
||
|
* d0 d1 d2
|
||
|
*
|
||
|
* We should be able to retrieve 2 by retrieving 5 7 and 8 first.
|
||
|
*
|
||
|
* Missing values:
|
||
|
* 2: 0xfc
|
||
|
* 5: 0x3a
|
||
|
* 7: 0x5f
|
||
|
* 8: 0x21
|
||
|
*/
|
||
|
|
||
|
GST_START_TEST (test_2d)
|
||
|
{
|
||
|
guint8 payload;
|
||
|
GstHarness *h =
|
||
|
gst_harness_new_with_padnames ("rtpst2022-1-fecdec", NULL, "src");
|
||
|
GstHarness *h0 = gst_harness_new_with_element (h->element, "sink", NULL);
|
||
|
GstHarness *h_fec_0 =
|
||
|
gst_harness_new_with_element (h->element, "fec_0", NULL);
|
||
|
GstHarness *h_fec_1 =
|
||
|
gst_harness_new_with_element (h->element, "fec_1", NULL);
|
||
|
|
||
|
gst_harness_set_src_caps_str (h0, "application/x-rtp");
|
||
|
gst_harness_set_src_caps_str (h_fec_0, "application/x-rtp");
|
||
|
gst_harness_set_src_caps_str (h_fec_1, "application/x-rtp");
|
||
|
|
||
|
payload = 0xde;
|
||
|
gst_harness_push (h0, make_media_sample (0, 0, &payload, 1));
|
||
|
payload = 0xad;
|
||
|
gst_harness_push (h0, make_media_sample (1, 0, &payload, 1));
|
||
|
payload = 0xbe;
|
||
|
gst_harness_push (h0, make_media_sample (3, 0, &payload, 1));
|
||
|
payload = 0xef;
|
||
|
gst_harness_push (h0, make_media_sample (4, 0, &payload, 1));
|
||
|
payload = 0x42;
|
||
|
gst_harness_push (h0, make_media_sample (6, 0, &payload, 1));
|
||
|
|
||
|
/* row FEC */
|
||
|
/* l1 0xbe ^ 0xef ^ 0x3a */
|
||
|
payload = 0x6b;
|
||
|
gst_harness_push (h_fec_1, make_fec_sample (0, 0, 3, TRUE, 1, 3, 0, &payload,
|
||
|
1, 1));
|
||
|
/* l2 0x42 ^ 0x5f ^ 0x21 */
|
||
|
payload = 0x3c;
|
||
|
gst_harness_push (h_fec_1, make_fec_sample (0, 0, 6, TRUE, 1, 3, 0, &payload,
|
||
|
1, 1));
|
||
|
|
||
|
/* column FEC */
|
||
|
/* d0 0xde ^ 0xbe ^ 0x42 */
|
||
|
payload = 0x22;
|
||
|
gst_harness_push (h_fec_0, make_fec_sample (0, 0, 0, FALSE, 3, 3, 0, &payload,
|
||
|
1, 1));
|
||
|
/* d1 0xad ^ 0xef ^ 0x5f */
|
||
|
payload = 0x1d;
|
||
|
gst_harness_push (h_fec_0, make_fec_sample (1, 0, 1, FALSE, 3, 3, 0, &payload,
|
||
|
1, 1));
|
||
|
/* d2 0xfc ^ 0x3a ^ 0x21 */
|
||
|
payload = 0xe7;
|
||
|
gst_harness_push (h_fec_0, make_fec_sample (2, 0, 2, FALSE, 3, 3, 0, &payload,
|
||
|
1, 1));
|
||
|
|
||
|
/* We should retrieve all 9 packets despite dropping 4! */
|
||
|
payload = 0xde;
|
||
|
pull_and_check (h, 0, 0, &payload, 1, 9);
|
||
|
payload = 0xad;
|
||
|
pull_and_check (h, 1, 0, &payload, 1, 8);
|
||
|
payload = 0xbe;
|
||
|
pull_and_check (h, 3, 0, &payload, 1, 7);
|
||
|
payload = 0xef;
|
||
|
pull_and_check (h, 4, 0, &payload, 1, 6);
|
||
|
payload = 0x42;
|
||
|
pull_and_check (h, 6, 0, &payload, 1, 5);
|
||
|
payload = 0x3a;
|
||
|
pull_and_check (h, 5, 0, &payload, 1, 4);
|
||
|
payload = 0x21;
|
||
|
pull_and_check (h, 8, 0, &payload, 1, 3);
|
||
|
payload = 0x5f;
|
||
|
pull_and_check (h, 7, 0, &payload, 1, 2);
|
||
|
payload = 0xfc;
|
||
|
pull_and_check (h, 2, 0, &payload, 1, 1);
|
||
|
|
||
|
gst_harness_teardown (h);
|
||
|
gst_harness_teardown (h0);
|
||
|
gst_harness_teardown (h_fec_0);
|
||
|
gst_harness_teardown (h_fec_1);
|
||
|
}
|
||
|
|
||
|
GST_END_TEST;
|
||
|
|
||
|
static void
|
||
|
_xor_mem (guint8 * restrict dst, const guint8 * restrict src, gsize length)
|
||
|
{
|
||
|
guint i;
|
||
|
|
||
|
for (i = 0; i < (length / sizeof (guint64)); ++i) {
|
||
|
#if G_BYTE_ORDER == G_LITTLE_ENDIAN
|
||
|
GST_WRITE_UINT64_LE (dst,
|
||
|
GST_READ_UINT64_LE (dst) ^ GST_READ_UINT64_LE (src));
|
||
|
#else
|
||
|
GST_WRITE_UINT64_BE (dst,
|
||
|
GST_READ_UINT64_BE (dst) ^ GST_READ_UINT64_BE (src));
|
||
|
#endif
|
||
|
dst += sizeof (guint64);
|
||
|
src += sizeof (guint64);
|
||
|
}
|
||
|
for (i = 0; i < (length % sizeof (guint64)); ++i)
|
||
|
dst[i] ^= src[i];
|
||
|
}
|
||
|
|
||
|
/**
|
||
|
* +-----------------+
|
||
|
* | 0-1 | 1-3 | x-4 | l1
|
||
|
* +-----------------+
|
||
|
* x x x
|
||
|
*
|
||
|
* Missing values:
|
||
|
* 2: 0xc5b74108
|
||
|
*/
|
||
|
GST_START_TEST (test_variable_length)
|
||
|
{
|
||
|
guint8 payload[4];
|
||
|
guint8 fec_payload[4];
|
||
|
GstHarness *h =
|
||
|
gst_harness_new_with_padnames ("rtpst2022-1-fecdec", NULL, "src");
|
||
|
GstHarness *h0 = gst_harness_new_with_element (h->element, "sink", NULL);
|
||
|
GstHarness *h_fec_1 =
|
||
|
gst_harness_new_with_element (h->element, "fec_1", NULL);
|
||
|
|
||
|
gst_harness_set_src_caps_str (h0, "application/x-rtp");
|
||
|
gst_harness_set_src_caps_str (h_fec_1, "application/x-rtp");
|
||
|
|
||
|
memset (fec_payload, 0x00, 4);
|
||
|
|
||
|
payload[0] = 0x37;
|
||
|
_xor_mem (fec_payload, payload, 1);
|
||
|
gst_harness_push (h0, make_media_sample (0, 0, payload, 1));
|
||
|
|
||
|
payload[0] = 0x28;
|
||
|
payload[1] = 0x39;
|
||
|
payload[2] = 0x56;
|
||
|
_xor_mem (fec_payload, payload, 3);
|
||
|
gst_harness_push (h0, make_media_sample (1, 0, payload, 3));
|
||
|
|
||
|
/* We receive 0 and 1 */
|
||
|
fail_unless_equals_int (gst_harness_buffers_in_queue (h), 2);
|
||
|
while (gst_harness_buffers_in_queue (h)) {
|
||
|
gst_buffer_unref (gst_harness_pull (h));
|
||
|
}
|
||
|
|
||
|
payload[0] = 0xc5;
|
||
|
payload[1] = 0xb7;
|
||
|
payload[2] = 0x41;
|
||
|
payload[3] = 0x08;
|
||
|
|
||
|
_xor_mem (fec_payload, payload, 4);
|
||
|
gst_harness_push (h_fec_1, make_fec_sample (0, 0, 0, TRUE, 1, 3, 0,
|
||
|
fec_payload, 4, 1 ^ 3 ^ 4));
|
||
|
|
||
|
pull_and_check (h, 2, 0, payload, 4, 1);
|
||
|
|
||
|
gst_harness_teardown (h);
|
||
|
gst_harness_teardown (h0);
|
||
|
gst_harness_teardown (h_fec_1);
|
||
|
}
|
||
|
|
||
|
GST_END_TEST;
|
||
|
|
||
|
|
||
|
static Suite *
|
||
|
st2022_1_dec_suite (void)
|
||
|
{
|
||
|
Suite *s = suite_create ("rtpst2022-1-fecdec");
|
||
|
TCase *tc_chain = tcase_create ("general");
|
||
|
|
||
|
suite_add_tcase (s, tc_chain);
|
||
|
|
||
|
tcase_add_test (tc_chain, test_row);
|
||
|
tcase_add_test (tc_chain, test_column);
|
||
|
tcase_add_test (tc_chain, test_2d);
|
||
|
tcase_add_test (tc_chain, test_variable_length);
|
||
|
|
||
|
return s;
|
||
|
}
|
||
|
|
||
|
GST_CHECK_MAIN (st2022_1_dec)
|