Merge branch 'tizen_gst_upgrade' into tizen
[platform/upstream/gst-plugins-good.git] / gst / rtp / gstrtph265depay.c
1 /* GStreamer
2  * Copyright (C) <2006> Wim Taymans <wim.taymans@gmail.com>
3  * Copyright (C) <2014> Jurgen Slowack <jurgenslowack@gmail.com>
4  *
5  * This library is free software; you can redistribute it and/or
6  * modify it under the terms of the GNU Library General Public
7  * License as published by the Free Software Foundation; either
8  * version 2 of the License, or (at your option) any later version.
9  *
10  * This library is distributed in the hope that it will be useful,
11  * but WITHOUT ANY WARRANTY; without even the implied warranty of
12  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
13  * Library General Public License for more details.
14  *
15  * You should have received a copy of the GNU Library General Public
16  * License along with this library; if not, write to the
17  * Free Software Foundation, Inc., 51 Franklin St, Fifth Floor,
18  * Boston, MA 02110-1301, USA.
19  */
20
21 #ifdef HAVE_CONFIG_H
22 #  include "config.h"
23 #endif
24
25 #include <stdio.h>
26 #include <string.h>
27
28 #include <gst/base/gstbitreader.h>
29 #include <gst/rtp/gstrtpbuffer.h>
30 #include <gst/video/video.h>
31 #include "gstrtph265depay.h"
32 #include "gstrtputils.h"
33
34 GST_DEBUG_CATEGORY_STATIC (rtph265depay_debug);
35 #define GST_CAT_DEFAULT (rtph265depay_debug)
36
37 /* This is what we'll default to when downstream hasn't
38  * expressed a restriction or preference via caps */
39 #define DEFAULT_BYTE_STREAM   TRUE
40 #define DEFAULT_ACCESS_UNIT   FALSE
41
42 /* 3 zero bytes syncword */
43 static const guint8 sync_bytes[] = { 0, 0, 0, 1 };
44
45 static GstStaticPadTemplate gst_rtp_h265_depay_src_template =
46     GST_STATIC_PAD_TEMPLATE ("src",
47     GST_PAD_SRC,
48     GST_PAD_ALWAYS,
49     GST_STATIC_CAPS (
50         /* FIXME - hvc1 and hev1 formats are not supported yet */
51         /*"video/x-h265, "
52            "stream-format = (string) hvc1, alignment = (string) au; "
53            "video/x-h265, "
54            "stream-format = (string) hev1, alignment = (string) au; " */
55         "video/x-h265, "
56         "stream-format = (string) byte-stream, alignment = (string) { nal, au }")
57     );
58
59 static GstStaticPadTemplate gst_rtp_h265_depay_sink_template =
60 GST_STATIC_PAD_TEMPLATE ("sink",
61     GST_PAD_SINK,
62     GST_PAD_ALWAYS,
63     GST_STATIC_CAPS ("application/x-rtp, "
64         "media = (string) \"video\", "
65         "clock-rate = (int) 90000, " "encoding-name = (string) \"H265\"")
66         /** optional parameters **/
67     /* "profile-space = (int) [ 0, 3 ], " */
68     /* "profile-id = (int) [ 0, 31 ], " */
69     /* "tier-flag = (int) [ 0, 1 ], " */
70     /* "level-id = (int) [ 0, 255 ], " */
71     /* "interop-constraints = (string) ANY, " */
72     /* "profile-compatibility-indicator = (string) ANY, " */
73     /* "sprop-sub-layer-id = (int) [ 0, 6 ], " */
74     /* "recv-sub-layer-id = (int) [ 0, 6 ], " */
75     /* "max-recv-level-id = (int) [ 0, 255 ], " */
76     /* "tx-mode = (string) {MST , SST}, " */
77     /* "sprop-vps = (string) ANY, " */
78     /* "sprop-sps = (string) ANY, " */
79     /* "sprop-pps = (string) ANY, " */
80     /* "sprop-sei = (string) ANY, " */
81     /* "max-lsr = (int) ANY, " *//* MUST be in the range of MaxLumaSR to 16 * MaxLumaSR, inclusive */
82     /* "max-lps = (int) ANY, " *//* MUST be in the range of MaxLumaPS to 16 * MaxLumaPS, inclusive */
83     /* "max-cpb = (int) ANY, " *//* MUST be in the range of MaxCPB to 16 * MaxCPB, inclusive */
84     /* "max-dpb = (int) [1, 16], " */
85     /* "max-br = (int) ANY, " *//* MUST be in the range of MaxBR to 16 * MaxBR, inclusive, for the highest level */
86     /* "max-tr = (int) ANY, " *//* MUST be in the range of MaxTileRows to 16 * MaxTileRows, inclusive, for the highest level */
87     /* "max-tc = (int) ANY, " *//* MUST be in the range of MaxTileCols to 16 * MaxTileCols, inclusive, for the highest level */
88     /* "max-fps = (int) ANY, " */
89     /* "sprop-max-don-diff = (int) [0, 32767], " */
90     /* "sprop-depack-buf-nalus = (int) [0, 32767], " */
91     /* "sprop-depack-buf-nalus = (int) [0, 4294967295], " */
92     /* "depack-buf-cap = (int) [1, 4294967295], " */
93     /* "sprop-segmentation-id = (int) [0, 3], " */
94     /* "sprop-spatial-segmentation-idc = (string) ANY, " */
95     /* "dec-parallel-cap = (string) ANY, " */
96     );
97
98 #define gst_rtp_h265_depay_parent_class parent_class
99 G_DEFINE_TYPE (GstRtpH265Depay, gst_rtp_h265_depay,
100     GST_TYPE_RTP_BASE_DEPAYLOAD);
101
102 static void gst_rtp_h265_depay_finalize (GObject * object);
103
104 static GstStateChangeReturn gst_rtp_h265_depay_change_state (GstElement *
105     element, GstStateChange transition);
106
107 static GstBuffer *gst_rtp_h265_depay_process (GstRTPBaseDepayload * depayload,
108     GstRTPBuffer * rtp);
109 static gboolean gst_rtp_h265_depay_setcaps (GstRTPBaseDepayload * filter,
110     GstCaps * caps);
111 static gboolean gst_rtp_h265_depay_handle_event (GstRTPBaseDepayload * depay,
112     GstEvent * event);
113
114 static void
115 gst_rtp_h265_depay_class_init (GstRtpH265DepayClass * klass)
116 {
117   GObjectClass *gobject_class;
118   GstElementClass *gstelement_class;
119   GstRTPBaseDepayloadClass *gstrtpbasedepayload_class;
120
121   gobject_class = (GObjectClass *) klass;
122   gstelement_class = (GstElementClass *) klass;
123   gstrtpbasedepayload_class = (GstRTPBaseDepayloadClass *) klass;
124
125   gobject_class->finalize = gst_rtp_h265_depay_finalize;
126
127   gst_element_class_add_static_pad_template (gstelement_class,
128       &gst_rtp_h265_depay_src_template);
129   gst_element_class_add_static_pad_template (gstelement_class,
130       &gst_rtp_h265_depay_sink_template);
131
132   gst_element_class_set_static_metadata (gstelement_class,
133       "RTP H265 depayloader", "Codec/Depayloader/Network/RTP",
134       "Extracts H265 video from RTP packets (RFC 7798)",
135       "Jurgen Slowack <jurgenslowack@gmail.com>");
136   gstelement_class->change_state = gst_rtp_h265_depay_change_state;
137
138   gstrtpbasedepayload_class->process_rtp_packet = gst_rtp_h265_depay_process;
139   gstrtpbasedepayload_class->set_caps = gst_rtp_h265_depay_setcaps;
140   gstrtpbasedepayload_class->handle_event = gst_rtp_h265_depay_handle_event;
141 }
142
143 static void
144 gst_rtp_h265_depay_init (GstRtpH265Depay * rtph265depay)
145 {
146   rtph265depay->adapter = gst_adapter_new ();
147   rtph265depay->picture_adapter = gst_adapter_new ();
148   rtph265depay->byte_stream = DEFAULT_BYTE_STREAM;
149   rtph265depay->stream_format = NULL;
150   rtph265depay->merge = DEFAULT_ACCESS_UNIT;
151   rtph265depay->vps = g_ptr_array_new_with_free_func (
152       (GDestroyNotify) gst_buffer_unref);
153   rtph265depay->sps = g_ptr_array_new_with_free_func (
154       (GDestroyNotify) gst_buffer_unref);
155   rtph265depay->pps = g_ptr_array_new_with_free_func (
156       (GDestroyNotify) gst_buffer_unref);
157 }
158
159 static void
160 gst_rtp_h265_depay_reset (GstRtpH265Depay * rtph265depay)
161 {
162   gst_adapter_clear (rtph265depay->adapter);
163   rtph265depay->wait_start = TRUE;
164   gst_adapter_clear (rtph265depay->picture_adapter);
165   rtph265depay->picture_start = FALSE;
166   rtph265depay->last_keyframe = FALSE;
167   rtph265depay->last_ts = 0;
168   rtph265depay->current_fu_type = 0;
169   rtph265depay->new_codec_data = FALSE;
170   g_ptr_array_set_size (rtph265depay->vps, 0);
171   g_ptr_array_set_size (rtph265depay->sps, 0);
172   g_ptr_array_set_size (rtph265depay->pps, 0);
173 }
174
175 static void
176 gst_rtp_h265_depay_finalize (GObject * object)
177 {
178   GstRtpH265Depay *rtph265depay;
179
180   rtph265depay = GST_RTP_H265_DEPAY (object);
181
182   if (rtph265depay->codec_data)
183     gst_buffer_unref (rtph265depay->codec_data);
184
185   g_free (rtph265depay->stream_format);
186
187   g_object_unref (rtph265depay->adapter);
188   g_object_unref (rtph265depay->picture_adapter);
189
190   g_ptr_array_free (rtph265depay->vps, TRUE);
191   g_ptr_array_free (rtph265depay->sps, TRUE);
192   g_ptr_array_free (rtph265depay->pps, TRUE);
193
194   G_OBJECT_CLASS (parent_class)->finalize (object);
195 }
196
197 static void
198 gst_rtp_h265_depay_negotiate (GstRtpH265Depay * rtph265depay)
199 {
200   GstCaps *caps;
201   gint byte_stream = -1;
202   gint merge = -1;
203
204   caps =
205       gst_pad_get_allowed_caps (GST_RTP_BASE_DEPAYLOAD_SRCPAD (rtph265depay));
206
207   GST_DEBUG_OBJECT (rtph265depay, "allowed caps: %" GST_PTR_FORMAT, caps);
208
209   if (caps) {
210     if (gst_caps_get_size (caps) > 0) {
211       GstStructure *s = gst_caps_get_structure (caps, 0);
212       const gchar *str = NULL;
213
214       if ((str = gst_structure_get_string (s, "stream-format"))) {
215         g_free (rtph265depay->stream_format);
216         rtph265depay->stream_format = g_strdup (str);
217
218         if (strcmp (str, "hev1") == 0) {
219           byte_stream = FALSE;
220         } else if (strcmp (str, "hvc1") == 0) {
221           byte_stream = FALSE;
222         } else if (strcmp (str, "byte-stream") == 0) {
223           byte_stream = TRUE;
224         } else {
225           GST_DEBUG_OBJECT (rtph265depay, "unknown stream-format: %s", str);
226         }
227       }
228
229       if ((str = gst_structure_get_string (s, "alignment"))) {
230         if (strcmp (str, "au") == 0) {
231           merge = TRUE;
232         } else if (strcmp (str, "nal") == 0) {
233           merge = FALSE;
234         } else {
235           GST_DEBUG_OBJECT (rtph265depay, "unknown alignment: %s", str);
236         }
237       }
238     }
239     gst_caps_unref (caps);
240   }
241
242   if (byte_stream != -1) {
243     GST_DEBUG_OBJECT (rtph265depay, "downstream requires byte-stream %d",
244         byte_stream);
245     rtph265depay->byte_stream = byte_stream;
246   } else {
247     GST_DEBUG_OBJECT (rtph265depay, "defaulting to byte-stream %d",
248         DEFAULT_BYTE_STREAM);
249     g_free (rtph265depay->stream_format);
250     rtph265depay->stream_format = g_strdup ("byte-stream");
251     rtph265depay->byte_stream = DEFAULT_BYTE_STREAM;
252   }
253   if (merge != -1) {
254     GST_DEBUG_OBJECT (rtph265depay, "downstream requires merge %d", merge);
255     rtph265depay->merge = merge;
256   } else {
257     GST_DEBUG_OBJECT (rtph265depay, "defaulting to merge %d",
258         DEFAULT_ACCESS_UNIT);
259     rtph265depay->merge = DEFAULT_ACCESS_UNIT;
260   }
261 }
262
263 static gboolean
264 parse_sps (GstMapInfo * map, guint32 * sps_id)
265 {                               /* To parse seq_parameter_set_id */
266   GstBitReader br = GST_BIT_READER_INIT (map->data + 15,
267       map->size - 15);
268
269   if (map->size < 16)
270     return FALSE;
271
272   if (!gst_rtp_read_golomb (&br, sps_id))
273     return FALSE;
274
275   return TRUE;
276 }
277
278 static gboolean
279 parse_pps (GstMapInfo * map, guint32 * sps_id, guint32 * pps_id)
280 {                               /* To parse picture_parameter_set_id */
281   GstBitReader br = GST_BIT_READER_INIT (map->data + 2,
282       map->size - 2);
283
284   if (map->size < 3)
285     return FALSE;
286
287   if (!gst_rtp_read_golomb (&br, pps_id))
288     return FALSE;
289   if (!gst_rtp_read_golomb (&br, sps_id))
290     return FALSE;
291
292   return TRUE;
293 }
294
295
296 static gboolean
297 gst_rtp_h265_set_src_caps (GstRtpH265Depay * rtph265depay)
298 {
299   gboolean res;
300   GstCaps *old_caps;
301   GstCaps *srccaps;
302
303   if (!rtph265depay->byte_stream &&
304       (!rtph265depay->new_codec_data ||
305           rtph265depay->vps->len == 0 || rtph265depay->sps->len == 0
306           || rtph265depay->pps->len == 0))
307     return TRUE;
308
309   srccaps = gst_caps_new_simple ("video/x-h265",
310       "stream-format", G_TYPE_STRING, rtph265depay->stream_format,
311       "alignment", G_TYPE_STRING, rtph265depay->merge ? "au" : "nal", NULL);
312
313   if (!rtph265depay->byte_stream) {
314     GstBuffer *codec_data;
315     gint i = 0;
316     gint len;
317     guint num_vps = rtph265depay->vps->len;
318     guint num_sps = rtph265depay->sps->len;
319     guint num_pps = rtph265depay->pps->len;
320     GstMapInfo map, nalmap;
321     guint8 *data;
322     gint nl;
323     guint8 num_arrays = 0;
324     guint new_size;
325     GstBitReader br;
326     guint32 tmp;
327     guint8 tmp8 = 0;
328     guint32 max_sub_layers_minus1, temporal_id_nesting_flag, chroma_format_idc,
329         bit_depth_luma_minus8, bit_depth_chroma_minus8,
330         min_spatial_segmentation_idc;
331
332     /* Fixme: Current implementation is not embedding SEI in codec_data */
333
334     if (num_sps == 0)
335       return FALSE;
336
337     /* start with 23 bytes header */
338     len = 23;
339
340     num_arrays = (num_vps > 0) + (num_sps > 0) + (num_pps > 0);
341     len += num_arrays;
342
343     /* add size of vps, sps & pps */
344     for (i = 0; i < num_vps; i++)
345       len += 2 + gst_buffer_get_size (g_ptr_array_index (rtph265depay->vps, i));
346     for (i = 0; i < num_sps; i++)
347       len += 2 + gst_buffer_get_size (g_ptr_array_index (rtph265depay->sps, i));
348     for (i = 0; i < num_pps; i++)
349       len += 2 + gst_buffer_get_size (g_ptr_array_index (rtph265depay->pps, i));
350
351     GST_DEBUG_OBJECT (rtph265depay,
352         "constructing codec_data: num_vps =%d num_sps=%d, num_pps=%d", num_vps,
353         num_sps, num_pps);
354
355     codec_data = gst_buffer_new_and_alloc (len);
356     gst_buffer_map (codec_data, &map, GST_MAP_READWRITE);
357     data = map.data;
358
359     memset (data, 0, map.size);
360
361     /* Parsing sps to get the info required further on */
362
363     gst_buffer_map (g_ptr_array_index (rtph265depay->sps, 0), &nalmap,
364         GST_MAP_READ);
365
366     max_sub_layers_minus1 = ((nalmap.data[2]) >> 1) & 0x07;
367     temporal_id_nesting_flag = nalmap.data[2] & 0x01;
368
369     gst_bit_reader_init (&br, nalmap.data + 15, nalmap.size - 15);
370
371     gst_rtp_read_golomb (&br, &tmp);    /* sps_seq_parameter_set_id */
372     gst_rtp_read_golomb (&br, &chroma_format_idc);      /* chroma_format_idc */
373
374     if (chroma_format_idc == 3)
375
376       gst_bit_reader_get_bits_uint8 (&br, &tmp8, 1);    /* separate_colour_plane_flag */
377
378     gst_rtp_read_golomb (&br, &tmp);    /* pic_width_in_luma_samples */
379     gst_rtp_read_golomb (&br, &tmp);    /* pic_height_in_luma_samples */
380
381     gst_bit_reader_get_bits_uint8 (&br, &tmp8, 1);      /* conformance_window_flag */
382     if (tmp8) {
383       gst_rtp_read_golomb (&br, &tmp);  /* conf_win_left_offset */
384       gst_rtp_read_golomb (&br, &tmp);  /* conf_win_right_offset */
385       gst_rtp_read_golomb (&br, &tmp);  /* conf_win_top_offset */
386       gst_rtp_read_golomb (&br, &tmp);  /* conf_win_bottom_offset */
387     }
388
389     gst_rtp_read_golomb (&br, &bit_depth_luma_minus8);  /* bit_depth_luma_minus8 */
390     gst_rtp_read_golomb (&br, &bit_depth_chroma_minus8);        /* bit_depth_chroma_minus8 */
391
392     GST_DEBUG_OBJECT (rtph265depay,
393         "Ignoring min_spatial_segmentation for now (assuming zero)");
394
395     min_spatial_segmentation_idc = 0;   /* NOTE - we ignore this for now, but in a perfect world, we should continue parsing to obtain the real value */
396
397     nl = nalmap.size;
398
399     gst_buffer_unmap (g_ptr_array_index (rtph265depay->sps, 0), &nalmap);
400
401     /* HEVCDecoderConfigurationVersion = 1 */
402     data[0] = 1;
403
404     /* Copy from profile_tier_level (Rec. ITU-T H.265 (04/2013) section 7.3.3
405      *
406      * profile_space | tier_flat | profile_idc |
407      * profile_compatibility_flags | constraint_indicator_flags |
408      * level_idc | progressive_source_flag | interlaced_source_flag
409      * non_packed_constraint_flag | frame_only_constraint_flag
410      * reserved_zero_44bits | level_idc */
411     gst_buffer_map (g_ptr_array_index (rtph265depay->sps, 0), &nalmap,
412         GST_MAP_READ);
413     for (i = 0; i < 12; i++)
414       data[i + 1] = nalmap.data[i];
415     gst_buffer_unmap (g_ptr_array_index (rtph265depay->sps, 0), &nalmap);
416
417     /* min_spatial_segmentation_idc */
418     GST_WRITE_UINT16_BE (data + 13, min_spatial_segmentation_idc);
419     data[13] |= 0xf0;
420     data[15] = 0xfc;            /* keeping parrallelismType as zero (unknown) */
421     data[16] = 0xfc | chroma_format_idc;
422     data[17] = 0xf8 | bit_depth_luma_minus8;
423     data[18] = 0xf8 | bit_depth_chroma_minus8;
424     data[19] = 0x00;            /* keep avgFrameRate as unspecified */
425     data[20] = 0x00;            /* keep avgFrameRate as unspecified */
426     /* constFrameRate(2 bits): 0, stream may or may not be of constant framerate
427      * numTemporalLayers (3 bits): number of temporal layers, value from SPS
428      * TemporalIdNested (1 bit): sps_temporal_id_nesting_flag from SPS
429      * lengthSizeMinusOne (2 bits): plus 1 indicates the length of the NALUnitLength */
430     data[21] =
431         0x00 | ((max_sub_layers_minus1 +
432             1) << 3) | (temporal_id_nesting_flag << 2) | (nl - 1);
433     GST_WRITE_UINT8 (data + 22, num_arrays);    /* numOfArrays */
434
435     data += 23;
436
437     /* copy all VPS */
438     if (num_vps > 0) {
439       /* array_completeness | reserved_zero bit | nal_unit_type */
440       data[0] = 0x00 | 0x20;
441       data++;
442
443       GST_WRITE_UINT16_BE (data, num_vps);
444       data += 2;
445
446       for (i = 0; i < num_vps; i++) {
447         gsize nal_size =
448             gst_buffer_get_size (g_ptr_array_index (rtph265depay->vps, i));
449         GST_WRITE_UINT16_BE (data, nal_size);
450         gst_buffer_extract (g_ptr_array_index (rtph265depay->vps, i), 0,
451             data + 2, nal_size);
452         data += 2 + nal_size;
453         GST_DEBUG_OBJECT (rtph265depay, "Copied VPS %d of length %u", i,
454             (guint) nal_size);
455       }
456     }
457
458     /* copy all SPS */
459     if (num_sps > 0) {
460       /* array_completeness | reserved_zero bit | nal_unit_type */
461       data[0] = 0x00 | 0x21;
462       data++;
463
464       GST_WRITE_UINT16_BE (data, num_sps);
465       data += 2;
466
467       for (i = 0; i < num_sps; i++) {
468         gsize nal_size =
469             gst_buffer_get_size (g_ptr_array_index (rtph265depay->sps, i));
470         GST_WRITE_UINT16_BE (data, nal_size);
471         gst_buffer_extract (g_ptr_array_index (rtph265depay->sps, i), 0,
472             data + 2, nal_size);
473         data += 2 + nal_size;
474         GST_DEBUG_OBJECT (rtph265depay, "Copied SPS %d of length %u", i,
475             (guint) nal_size);
476       }
477     }
478
479     /* copy all PPS */
480     if (num_pps > 0) {
481       /* array_completeness | reserved_zero bit | nal_unit_type */
482       data[0] = 0x00 | 0x22;
483       data++;
484
485       GST_WRITE_UINT16_BE (data, num_pps);
486       data += 2;
487
488       for (i = 0; i < num_pps; i++) {
489         gsize nal_size =
490             gst_buffer_get_size (g_ptr_array_index (rtph265depay->pps, i));
491         GST_WRITE_UINT16_BE (data, nal_size);
492         gst_buffer_extract (g_ptr_array_index (rtph265depay->pps, i), 0,
493             data + 2, nal_size);
494         data += 2 + nal_size;
495         GST_DEBUG_OBJECT (rtph265depay, "Copied PPS %d of length %u", i,
496             (guint) nal_size);
497       }
498     }
499
500     new_size = data - map.data;
501     gst_buffer_unmap (codec_data, &map);
502     gst_buffer_set_size (codec_data, new_size);
503
504     gst_caps_set_simple (srccaps,
505         "codec_data", GST_TYPE_BUFFER, codec_data, NULL);
506     gst_buffer_unref (codec_data);
507   }
508
509   old_caps =
510       gst_pad_get_current_caps (GST_RTP_BASE_DEPAYLOAD_SRCPAD (rtph265depay));
511   if (old_caps != NULL) {
512
513     /* Only update the caps if they are not equal. For
514      * AVC we don't update caps if only the codec_data
515      * changes. This is the same behaviour as in h264parse
516      * and gstrtph264depay
517      */
518     if (rtph265depay->byte_stream) {
519       if (!gst_caps_is_equal (srccaps, old_caps))
520         res =
521             gst_pad_set_caps (GST_RTP_BASE_DEPAYLOAD_SRCPAD (rtph265depay),
522             srccaps);
523       else
524         res = TRUE;
525     } else {
526       GstCaps *tmp_caps = gst_caps_copy (srccaps);
527       GstStructure *old_s, *tmp_s;
528
529       old_s = gst_caps_get_structure (old_caps, 0);
530       tmp_s = gst_caps_get_structure (tmp_caps, 0);
531       if (gst_structure_has_field (old_s, "codec_data"))
532         gst_structure_set_value (tmp_s, "codec_data",
533             gst_structure_get_value (old_s, "codec_data"));
534
535       if (!gst_caps_is_equal (old_caps, tmp_caps))
536         res =
537             gst_pad_set_caps (GST_RTP_BASE_DEPAYLOAD_SRCPAD (rtph265depay),
538             srccaps);
539       else
540         res = TRUE;
541
542       gst_caps_unref (tmp_caps);
543     }
544     gst_caps_unref (old_caps);
545   } else {
546     res =
547         gst_pad_set_caps (GST_RTP_BASE_DEPAYLOAD_SRCPAD (rtph265depay),
548         srccaps);
549   }
550
551   gst_caps_unref (srccaps);
552
553   /* Insert SPS and PPS into the stream on next opportunity */
554   if (rtph265depay->sps->len > 0 || rtph265depay->pps->len > 0) {
555     gint i;
556     GstBuffer *codec_data;
557     GstMapInfo map;
558     guint8 *data;
559     guint len = 0;
560
561     for (i = 0; i < rtph265depay->sps->len; i++) {
562       len += 4 + gst_buffer_get_size (g_ptr_array_index (rtph265depay->sps, i));
563     }
564
565     for (i = 0; i < rtph265depay->pps->len; i++) {
566       len += 4 + gst_buffer_get_size (g_ptr_array_index (rtph265depay->pps, i));
567     }
568
569     codec_data = gst_buffer_new_and_alloc (len);
570     gst_buffer_map (codec_data, &map, GST_MAP_WRITE);
571     data = map.data;
572
573     for (i = 0; i < rtph265depay->sps->len; i++) {
574       GstBuffer *sps_buf = g_ptr_array_index (rtph265depay->sps, i);
575       guint sps_size = gst_buffer_get_size (sps_buf);
576
577       if (rtph265depay->byte_stream)
578         memcpy (data, sync_bytes, sizeof (sync_bytes));
579       else
580         GST_WRITE_UINT32_BE (data, sps_size);
581       gst_buffer_extract (sps_buf, 0, data + 4, -1);
582       data += 4 + sps_size;
583     }
584
585     for (i = 0; i < rtph265depay->pps->len; i++) {
586       GstBuffer *pps_buf = g_ptr_array_index (rtph265depay->pps, i);
587       guint pps_size = gst_buffer_get_size (pps_buf);
588
589       if (rtph265depay->byte_stream)
590         memcpy (data, sync_bytes, sizeof (sync_bytes));
591       else
592         GST_WRITE_UINT32_BE (data, pps_size);
593       gst_buffer_extract (pps_buf, 0, data + 4, -1);
594       data += 4 + pps_size;
595     }
596
597     gst_buffer_unmap (codec_data, &map);
598     if (rtph265depay->codec_data)
599       gst_buffer_unref (rtph265depay->codec_data);
600     rtph265depay->codec_data = codec_data;
601   }
602
603   if (res)
604     rtph265depay->new_codec_data = FALSE;
605
606   return res;
607 }
608
609 gboolean
610 gst_rtp_h265_add_vps_sps_pps (GstElement * rtph265, GPtrArray * vps_array,
611     GPtrArray * sps_array, GPtrArray * pps_array, GstBuffer * nal)
612 {
613   GstMapInfo map;
614   guchar type;
615   guint i;
616
617   gst_buffer_map (nal, &map, GST_MAP_READ);
618
619   type = (map.data[0] >> 1) & 0x3f;
620
621   if (type == GST_H265_VPS_NUT) {
622     guint32 vps_id = (map.data[2] >> 4) & 0x0f;
623
624     for (i = 0; i < vps_array->len; i++) {
625       GstBuffer *vps = g_ptr_array_index (vps_array, i);
626       GstMapInfo vpsmap;
627       guint32 tmp_vps_id;
628
629       gst_buffer_map (vps, &vpsmap, GST_MAP_READ);
630       tmp_vps_id = (vpsmap.data[2] >> 4) & 0x0f;
631
632       if (vps_id == tmp_vps_id) {
633         if (map.size == vpsmap.size &&
634             memcmp (map.data, vpsmap.data, vpsmap.size) == 0) {
635           GST_LOG_OBJECT (rtph265, "Unchanged VPS %u, not updating", vps_id);
636           gst_buffer_unmap (vps, &vpsmap);
637           goto drop;
638         } else {
639           gst_buffer_unmap (vps, &vpsmap);
640           g_ptr_array_remove_index_fast (vps_array, i);
641           g_ptr_array_add (vps_array, nal);
642           GST_LOG_OBJECT (rtph265, "Modified VPS %u, replacing", vps_id);
643           goto done;
644         }
645       }
646       gst_buffer_unmap (vps, &vpsmap);
647     }
648     GST_LOG_OBJECT (rtph265, "Adding new VPS %u", vps_id);
649     g_ptr_array_add (vps_array, nal);
650   } else if (type == GST_H265_SPS_NUT) {
651     guint32 sps_id;
652
653     if (!parse_sps (&map, &sps_id)) {
654       GST_WARNING_OBJECT (rtph265, "Invalid SPS,"
655           " can't parse seq_parameter_set_id");
656       goto drop;
657     }
658
659     for (i = 0; i < sps_array->len; i++) {
660       GstBuffer *sps = g_ptr_array_index (sps_array, i);
661       GstMapInfo spsmap;
662       guint32 tmp_sps_id;
663
664       gst_buffer_map (sps, &spsmap, GST_MAP_READ);
665       parse_sps (&spsmap, &tmp_sps_id);
666
667       if (sps_id == tmp_sps_id) {
668         if (map.size == spsmap.size &&
669             memcmp (map.data, spsmap.data, spsmap.size) == 0) {
670           GST_LOG_OBJECT (rtph265, "Unchanged SPS %u, not updating", sps_id);
671           gst_buffer_unmap (sps, &spsmap);
672           goto drop;
673         } else {
674           gst_buffer_unmap (sps, &spsmap);
675           g_ptr_array_remove_index_fast (sps_array, i);
676           g_ptr_array_add (sps_array, nal);
677           GST_LOG_OBJECT (rtph265, "Modified SPS %u, replacing", sps_id);
678           goto done;
679         }
680       }
681       gst_buffer_unmap (sps, &spsmap);
682     }
683     GST_LOG_OBJECT (rtph265, "Adding new SPS %u", sps_id);
684     g_ptr_array_add (sps_array, nal);
685   } else if (type == GST_H265_PPS_NUT) {
686     guint32 sps_id;
687     guint32 pps_id;
688
689     if (!parse_pps (&map, &sps_id, &pps_id)) {
690       GST_WARNING_OBJECT (rtph265, "Invalid PPS,"
691           " can't parse seq_parameter_set_id or pic_parameter_set_id");
692       goto drop;
693     }
694
695     for (i = 0; i < pps_array->len; i++) {
696       GstBuffer *pps = g_ptr_array_index (pps_array, i);
697       GstMapInfo ppsmap;
698       guint32 tmp_sps_id;
699       guint32 tmp_pps_id;
700
701
702       gst_buffer_map (pps, &ppsmap, GST_MAP_READ);
703       parse_pps (&ppsmap, &tmp_sps_id, &tmp_pps_id);
704
705       if (pps_id == tmp_pps_id) {
706         if (map.size == ppsmap.size &&
707             memcmp (map.data, ppsmap.data, ppsmap.size) == 0) {
708           GST_LOG_OBJECT (rtph265, "Unchanged PPS %u:%u, not updating", sps_id,
709               pps_id);
710           gst_buffer_unmap (pps, &ppsmap);
711           goto drop;
712         } else {
713           gst_buffer_unmap (pps, &ppsmap);
714           g_ptr_array_remove_index_fast (pps_array, i);
715           g_ptr_array_add (pps_array, nal);
716           GST_LOG_OBJECT (rtph265, "Modified PPS %u:%u, replacing",
717               sps_id, pps_id);
718           goto done;
719         }
720       }
721       gst_buffer_unmap (pps, &ppsmap);
722     }
723     GST_LOG_OBJECT (rtph265, "Adding new PPS %u:%i", sps_id, pps_id);
724     g_ptr_array_add (pps_array, nal);
725   } else {
726     goto drop;
727   }
728
729 done:
730   gst_buffer_unmap (nal, &map);
731
732   return TRUE;
733
734 drop:
735   gst_buffer_unmap (nal, &map);
736   gst_buffer_unref (nal);
737
738   return FALSE;
739 }
740
741
742 static void
743 gst_rtp_h265_depay_add_vps_sps_pps (GstRtpH265Depay * rtph265depay,
744     GstBuffer * nal)
745 {
746   if (gst_rtp_h265_add_vps_sps_pps (GST_ELEMENT (rtph265depay),
747           rtph265depay->vps, rtph265depay->sps, rtph265depay->pps, nal))
748     rtph265depay->new_codec_data = TRUE;
749 }
750
751 static gboolean
752 gst_rtp_h265_depay_setcaps (GstRTPBaseDepayload * depayload, GstCaps * caps)
753 {
754   gint clock_rate;
755   GstStructure *structure = gst_caps_get_structure (caps, 0);
756   GstRtpH265Depay *rtph265depay;
757   const gchar *vps;
758   const gchar *sps;
759   const gchar *pps;
760   gchar *ps;
761   GstMapInfo map;
762   guint8 *ptr;
763
764   rtph265depay = GST_RTP_H265_DEPAY (depayload);
765
766   if (!gst_structure_get_int (structure, "clock-rate", &clock_rate))
767     clock_rate = 90000;
768   depayload->clock_rate = clock_rate;
769
770   /* Base64 encoded, comma separated config NALs */
771   vps = gst_structure_get_string (structure, "sprop-vps");
772   sps = gst_structure_get_string (structure, "sprop-sps");
773   pps = gst_structure_get_string (structure, "sprop-pps");
774   if (vps == NULL || sps == NULL || pps == NULL) {
775     ps = NULL;
776   } else {
777     ps = g_strdup_printf ("%s,%s,%s", vps, sps, pps);
778   }
779
780   /* negotiate with downstream w.r.t. output format and alignment */
781   gst_rtp_h265_depay_negotiate (rtph265depay);
782
783   if (rtph265depay->byte_stream && ps != NULL) {
784     /* for bytestream we only need the parameter sets but we don't error out
785      * when they are not there, we assume they are in the stream. */
786     gchar **params;
787     GstBuffer *codec_data;
788     guint len, total;
789     gint i;
790
791     params = g_strsplit (ps, ",", 0);
792
793     /* count total number of bytes in base64. Also include the sync bytes in
794      * front of the params. */
795     len = 0;
796     for (i = 0; params[i]; i++) {
797       len += strlen (params[i]);
798       len += sizeof (sync_bytes);
799     }
800     /* we seriously overshoot the length, but it's fine. */
801     codec_data = gst_buffer_new_and_alloc (len);
802
803     gst_buffer_map (codec_data, &map, GST_MAP_WRITE);
804     ptr = map.data;
805     total = 0;
806     for (i = 0; params[i]; i++) {
807       guint save = 0;
808       gint state = 0;
809
810       GST_DEBUG_OBJECT (depayload, "decoding param %d (%s)", i, params[i]);
811       memcpy (ptr, sync_bytes, sizeof (sync_bytes));
812       ptr += sizeof (sync_bytes);
813       len =
814           g_base64_decode_step (params[i], strlen (params[i]), ptr, &state,
815           &save);
816       GST_DEBUG_OBJECT (depayload, "decoded %d bytes", len);
817       total += len + sizeof (sync_bytes);
818       ptr += len;
819     }
820     gst_buffer_unmap (codec_data, &map);
821     gst_buffer_resize (codec_data, 0, total);
822     g_strfreev (params);
823
824     /* keep the codec_data, we need to send it as the first buffer. We cannot
825      * push it in the adapter because the adapter might be flushed on discont.
826      */
827     if (rtph265depay->codec_data)
828       gst_buffer_unref (rtph265depay->codec_data);
829     rtph265depay->codec_data = codec_data;
830   } else if (!rtph265depay->byte_stream) {
831     gchar **params;
832     gint i;
833
834     if (ps == NULL)
835       goto incomplete_caps;
836
837     params = g_strsplit (ps, ",", 0);
838
839     GST_DEBUG_OBJECT (depayload, "we have %d params", g_strv_length (params));
840
841     /* start with 23 bytes header */
842     for (i = 0; params[i]; i++) {
843       GstBuffer *nal;
844       GstMapInfo nalmap;
845       gsize nal_len;
846       guint save = 0;
847       gint state = 0;
848
849       nal_len = strlen (params[i]);
850       nal = gst_buffer_new_and_alloc (nal_len);
851       gst_buffer_map (nal, &nalmap, GST_MAP_READWRITE);
852
853       nal_len =
854           g_base64_decode_step (params[i], nal_len, nalmap.data, &state, &save);
855
856       GST_DEBUG_OBJECT (depayload, "adding param %d as %s", i,
857           (((nalmap.data[0] >> 1) & 0x3f) ==
858               32) ? "VPS" : (((nalmap.data[0] >> 1) & 0x3f) ==
859               33) ? "SPS" : "PPS");
860
861       gst_buffer_unmap (nal, &nalmap);
862       gst_buffer_set_size (nal, nal_len);
863
864       gst_rtp_h265_depay_add_vps_sps_pps (rtph265depay, nal);
865     }
866     g_strfreev (params);
867
868     if (rtph265depay->vps->len == 0 || rtph265depay->sps->len == 0 ||
869         rtph265depay->pps->len == 0) {
870       goto incomplete_caps;
871     }
872   }
873
874   g_free (ps);
875
876   return gst_rtp_h265_set_src_caps (rtph265depay);
877
878   /* ERRORS */
879 incomplete_caps:
880   {
881     GST_DEBUG_OBJECT (depayload, "we have incomplete caps,"
882         " doing setcaps later");
883     g_free (ps);
884     return TRUE;
885   }
886 }
887
888 static GstBuffer *
889 gst_rtp_h265_complete_au (GstRtpH265Depay * rtph265depay,
890     GstClockTime * out_timestamp, gboolean * out_keyframe)
891 {
892   guint outsize;
893   GstBuffer *outbuf;
894
895   /* we had a picture in the adapter and we completed it */
896   GST_DEBUG_OBJECT (rtph265depay, "taking completed AU");
897   outsize = gst_adapter_available (rtph265depay->picture_adapter);
898   outbuf = gst_adapter_take_buffer (rtph265depay->picture_adapter, outsize);
899
900   *out_timestamp = rtph265depay->last_ts;
901   *out_keyframe = rtph265depay->last_keyframe;
902
903   rtph265depay->last_keyframe = FALSE;
904   rtph265depay->picture_start = FALSE;
905
906   return outbuf;
907 }
908
909 /* VPS/SPS/PPS/RADL/TSA/RASL/IDR/CRA is considered key, all others DELTA;
910  * so downstream waiting for keyframe can pick up at VPS/SPS/PPS/IDR */
911
912 #define NAL_TYPE_IS_PARAMETER_SET(nt) (         ((nt) == GST_H265_VPS_NUT)\
913                                                                                 ||  ((nt) == GST_H265_SPS_NUT)\
914                                                                                 ||  ((nt) == GST_H265_PPS_NUT)                          )
915
916 #define NAL_TYPE_IS_CODED_SLICE_SEGMENT(nt) (           ((nt) == GST_H265_NAL_SLICE_TRAIL_N)\
917                                                                                                 ||      ((nt) == GST_H265_NAL_SLICE_TRAIL_R)\
918                                                                                                 ||  ((nt) == GST_H265_NAL_SLICE_TSA_N)\
919                                                                                                 ||  ((nt) == GST_H265_NAL_SLICE_TSA_R)\
920                                                                                                 ||  ((nt) == GST_H265_NAL_SLICE_STSA_N)\
921                                                                                                 ||  ((nt) == GST_H265_NAL_SLICE_STSA_R)\
922                                                                                                 ||  ((nt) == GST_H265_NAL_SLICE_RASL_N)\
923                                                                                                 ||  ((nt) == GST_H265_NAL_SLICE_RASL_R)\
924                                                                                                 ||  ((nt) == GST_H265_NAL_SLICE_BLA_W_LP)\
925                                                                                                 ||  ((nt) == GST_H265_NAL_SLICE_BLA_W_RADL)\
926                                                                                                 ||  ((nt) == GST_H265_NAL_SLICE_BLA_N_LP)\
927                                                                                                 ||  ((nt) == GST_H265_NAL_SLICE_IDR_W_RADL)\
928                                                                                                 ||  ((nt) == GST_H265_NAL_SLICE_IDR_N_LP)\
929                                                                                                 ||  ((nt) == GST_H265_NAL_SLICE_CRA_NUT)                )
930
931 #define NAL_TYPE_IS_KEY(nt) (NAL_TYPE_IS_PARAMETER_SET(nt) || NAL_TYPE_IS_CODED_SLICE_SEGMENT(nt))
932
933 static GstBuffer *
934 gst_rtp_h265_depay_handle_nal (GstRtpH265Depay * rtph265depay, GstBuffer * nal,
935     GstClockTime in_timestamp, gboolean marker)
936 {
937   GstRTPBaseDepayload *depayload = GST_RTP_BASE_DEPAYLOAD (rtph265depay);
938   gint nal_type;
939   GstMapInfo map;
940   GstBuffer *outbuf = NULL;
941   GstClockTime out_timestamp;
942   gboolean keyframe, out_keyframe;
943
944   gst_buffer_map (nal, &map, GST_MAP_READ);
945   if (G_UNLIKELY (map.size < 5))
946     goto short_nal;
947
948   nal_type = (map.data[4] >> 1) & 0x3f;
949   GST_DEBUG_OBJECT (rtph265depay, "handle NAL type %d (RTP marker bit %d)",
950       nal_type, marker);
951
952   keyframe = NAL_TYPE_IS_KEY (nal_type);
953
954   out_keyframe = keyframe;
955   out_timestamp = in_timestamp;
956
957   if (!rtph265depay->byte_stream) {
958     if (NAL_TYPE_IS_PARAMETER_SET (nal_type)) {
959       gst_rtp_h265_depay_add_vps_sps_pps (rtph265depay,
960           gst_buffer_copy_region (nal, GST_BUFFER_COPY_ALL,
961               4, gst_buffer_get_size (nal) - 4));
962       gst_buffer_unmap (nal, &map);
963       gst_buffer_unref (nal);
964       return NULL;
965     } else if (rtph265depay->sps->len == 0 || rtph265depay->pps->len == 0) {
966       /* Down push down any buffer in non-bytestream mode if the SPS/PPS haven't
967        * go through yet
968        */
969       gst_pad_push_event (GST_RTP_BASE_DEPAYLOAD_SINKPAD (depayload),
970           gst_event_new_custom (GST_EVENT_CUSTOM_UPSTREAM,
971               gst_structure_new ("GstForceKeyUnit",
972                   "all-headers", G_TYPE_BOOLEAN, TRUE, NULL)));
973       gst_buffer_unmap (nal, &map);
974       gst_buffer_unref (nal);
975       return NULL;
976     }
977
978     if (rtph265depay->new_codec_data &&
979         rtph265depay->sps->len > 0 && rtph265depay->pps->len > 0)
980       gst_rtp_h265_set_src_caps (rtph265depay);
981   }
982
983   if (rtph265depay->merge) {
984     gboolean start = FALSE, complete = FALSE;
985
986     /* marker bit isn't mandatory so in the following code we try to detect
987      * an AU boundary (see H.265 spec section 7.4.2.4.4) */
988     if (!marker) {
989       if (NAL_TYPE_IS_CODED_SLICE_SEGMENT (nal_type)) {
990         /* A NAL unit (X) ends an access unit if the next-occurring VCL NAL unit (Y) has the high-order bit of the first byte after its NAL unit header equal to 1 */
991         start = TRUE;
992         if (((map.data[6] >> 7) & 0x01) == 1) {
993           complete = TRUE;
994         }
995       } else if ((nal_type >= 32 && nal_type <= 35)
996           || nal_type == 39 || (nal_type >= 41 && nal_type <= 44)
997           || (nal_type >= 48 && nal_type <= 55)) {
998         /* VPS, SPS, PPS, SEI, ... terminate an access unit */
999         complete = TRUE;
1000       }
1001       GST_DEBUG_OBJECT (depayload, "start %d, complete %d", start, complete);
1002
1003       if (complete && rtph265depay->picture_start)
1004         outbuf = gst_rtp_h265_complete_au (rtph265depay, &out_timestamp,
1005             &out_keyframe);
1006     }
1007     /* add to adapter */
1008     gst_buffer_unmap (nal, &map);
1009
1010     GST_DEBUG_OBJECT (depayload, "adding NAL to picture adapter");
1011     gst_adapter_push (rtph265depay->picture_adapter, nal);
1012     rtph265depay->last_ts = in_timestamp;
1013     rtph265depay->last_keyframe |= keyframe;
1014     rtph265depay->picture_start |= start;
1015
1016     if (marker)
1017       outbuf = gst_rtp_h265_complete_au (rtph265depay, &out_timestamp,
1018           &out_keyframe);
1019   } else {
1020     /* no merge, output is input nal */
1021     GST_DEBUG_OBJECT (depayload, "using NAL as output");
1022     outbuf = nal;
1023     gst_buffer_unmap (nal, &map);
1024   }
1025
1026   if (outbuf) {
1027     /* prepend codec_data */
1028     if (rtph265depay->codec_data) {
1029       GST_DEBUG_OBJECT (depayload, "prepending codec_data");
1030       gst_rtp_copy_meta (GST_ELEMENT_CAST (rtph265depay),
1031           rtph265depay->codec_data, outbuf,
1032           g_quark_from_static_string (GST_META_TAG_VIDEO_STR));
1033       outbuf = gst_buffer_append (rtph265depay->codec_data, outbuf);
1034       rtph265depay->codec_data = NULL;
1035       out_keyframe = TRUE;
1036     }
1037     outbuf = gst_buffer_make_writable (outbuf);
1038
1039     gst_rtp_drop_meta (GST_ELEMENT_CAST (rtph265depay), outbuf,
1040         g_quark_from_static_string (GST_META_TAG_VIDEO_STR));
1041
1042     GST_BUFFER_PTS (outbuf) = out_timestamp;
1043
1044     if (out_keyframe)
1045       GST_BUFFER_FLAG_UNSET (outbuf, GST_BUFFER_FLAG_DELTA_UNIT);
1046     else
1047       GST_BUFFER_FLAG_SET (outbuf, GST_BUFFER_FLAG_DELTA_UNIT);
1048   }
1049
1050   return outbuf;
1051
1052   /* ERRORS */
1053 short_nal:
1054   {
1055     GST_WARNING_OBJECT (depayload, "dropping short NAL");
1056     gst_buffer_unmap (nal, &map);
1057     gst_buffer_unref (nal);
1058     return NULL;
1059   }
1060 }
1061
1062 static GstBuffer *
1063 gst_rtp_h265_push_fragmentation_unit (GstRtpH265Depay * rtph265depay,
1064     gboolean send)
1065 {
1066   guint outsize;
1067   GstMapInfo map;
1068   GstBuffer *outbuf;
1069
1070   outsize = gst_adapter_available (rtph265depay->adapter);
1071   outbuf = gst_adapter_take_buffer (rtph265depay->adapter, outsize);
1072
1073   gst_buffer_map (outbuf, &map, GST_MAP_WRITE);
1074   GST_DEBUG_OBJECT (rtph265depay, "output %d bytes", outsize);
1075
1076   if (rtph265depay->byte_stream) {
1077     memcpy (map.data, sync_bytes, sizeof (sync_bytes));
1078   } else {
1079     goto not_implemented;
1080   }
1081   gst_buffer_unmap (outbuf, &map);
1082
1083   rtph265depay->current_fu_type = 0;
1084
1085   outbuf = gst_rtp_h265_depay_handle_nal (rtph265depay, outbuf,
1086       rtph265depay->fu_timestamp, rtph265depay->fu_marker);
1087
1088   if (send && outbuf) {
1089     gst_rtp_base_depayload_push (GST_RTP_BASE_DEPAYLOAD (rtph265depay), outbuf);
1090     outbuf = NULL;
1091   }
1092   return outbuf;
1093
1094 not_implemented:
1095   {
1096     GST_ERROR_OBJECT (rtph265depay,
1097         ("Only bytestream format is currently supported."));
1098     gst_buffer_unmap (outbuf, &map);
1099     return NULL;
1100   }
1101 }
1102
1103 static GstBuffer *
1104 gst_rtp_h265_depay_process (GstRTPBaseDepayload * depayload, GstRTPBuffer * rtp)
1105 {
1106   GstRtpH265Depay *rtph265depay;
1107   GstBuffer *outbuf = NULL;
1108   guint8 nal_unit_type;
1109
1110   rtph265depay = GST_RTP_H265_DEPAY (depayload);
1111
1112   /* flush remaining data on discont */
1113   if (GST_BUFFER_IS_DISCONT (rtp->buffer)) {
1114     gst_adapter_clear (rtph265depay->adapter);
1115     rtph265depay->wait_start = TRUE;
1116     rtph265depay->current_fu_type = 0;
1117   }
1118
1119   {
1120     gint payload_len;
1121     guint8 *payload;
1122     guint header_len;
1123     GstMapInfo map;
1124     guint outsize, nalu_size;
1125     GstClockTime timestamp;
1126     gboolean marker;
1127     guint8 nuh_layer_id, nuh_temporal_id_plus1;
1128     guint8 S, E;
1129     guint16 nal_header;
1130 #if 0
1131     gboolean donl_present = FALSE;
1132 #endif
1133
1134     timestamp = GST_BUFFER_PTS (rtp->buffer);
1135
1136     payload_len = gst_rtp_buffer_get_payload_len (rtp);
1137     payload = gst_rtp_buffer_get_payload (rtp);
1138     marker = gst_rtp_buffer_get_marker (rtp);
1139
1140     GST_DEBUG_OBJECT (rtph265depay, "receiving %d bytes", payload_len);
1141
1142     if (payload_len == 0)
1143       goto empty_packet;
1144
1145     /* +---------------+---------------+
1146      * |0|1|2|3|4|5|6|7|0|1|2|3|4|5|6|7|
1147      * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
1148      * |F|   Type    |  LayerId  | TID |
1149      * +-------------+-----------------+
1150      *
1151      * F must be 0.
1152      *
1153      */
1154     nal_unit_type = (payload[0] >> 1) & 0x3f;
1155     nuh_layer_id = ((payload[0] & 0x01) << 5) | (payload[1] >> 3);      /* should be zero for now but this could change in future HEVC extensions */
1156     nuh_temporal_id_plus1 = payload[1] & 0x03;
1157
1158     /* At least two byte header with type */
1159     header_len = 2;
1160
1161     GST_DEBUG_OBJECT (rtph265depay,
1162         "NAL header nal_unit_type %d, nuh_temporal_id_plus1 %d", nal_unit_type,
1163         nuh_temporal_id_plus1);
1164
1165     GST_FIXME_OBJECT (rtph265depay, "Assuming DONL field is not present");
1166
1167     /* FIXME - assuming DONL field is not present for now */
1168     /*donl_present = (tx-mode == "MST") || (sprop-max-don-diff > 0); */
1169
1170     /* If FU unit was being processed, but the current nal is of a different
1171      * type.  Assume that the remote payloader is buggy (didn't set the end bit
1172      * when the FU ended) and send out what we gathered thusfar */
1173     if (G_UNLIKELY (rtph265depay->current_fu_type != 0 &&
1174             nal_unit_type != rtph265depay->current_fu_type))
1175       gst_rtp_h265_push_fragmentation_unit (rtph265depay, TRUE);
1176
1177     switch (nal_unit_type) {
1178       case 48:
1179       {
1180         GST_DEBUG_OBJECT (rtph265depay, "Processing aggregation packet");
1181
1182         /* Aggregation packet (section 4.7) */
1183
1184         /*  An example of an AP packet containing two aggregation units
1185            without the DONL and DOND fields
1186
1187            0                   1                   2                   3
1188            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
1189            +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
1190            |                          RTP Header                           |
1191            +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
1192            |   PayloadHdr (Type=48)        |         NALU 1 Size           |
1193            +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
1194            |          NALU 1 HDR           |                               |
1195            +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+         NALU 1 Data           |
1196            |                   . . .                                       |
1197            |                                                               |
1198            +               +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
1199            |  . . .        | NALU 2 Size                   | NALU 2 HDR    |
1200            +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
1201            | NALU 2 HDR    |                                               |
1202            +-+-+-+-+-+-+-+-+              NALU 2 Data                      |
1203            |                   . . .                                       |
1204            |                               +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
1205            |                               :...OPTIONAL RTP padding        |
1206            +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
1207          */
1208
1209         /* strip headers */
1210         payload += header_len;
1211         payload_len -= header_len;
1212
1213         rtph265depay->wait_start = FALSE;
1214
1215 #if 0
1216         if (donl_present)
1217           goto not_implemented_donl_present;
1218 #endif
1219
1220         while (payload_len > 2) {
1221
1222           nalu_size = (payload[0] << 8) | payload[1];
1223
1224           /* dont include nalu_size */
1225           if (nalu_size > (payload_len - 2))
1226             nalu_size = payload_len - 2;
1227
1228           outsize = nalu_size + sizeof (sync_bytes);
1229           outbuf = gst_buffer_new_and_alloc (outsize);
1230
1231           gst_buffer_map (outbuf, &map, GST_MAP_WRITE);
1232           if (rtph265depay->byte_stream) {
1233             memcpy (map.data, sync_bytes, sizeof (sync_bytes));
1234           } else {
1235             goto not_implemented;
1236           }
1237
1238           /* strip NALU size */
1239           payload += 2;
1240           payload_len -= 2;
1241
1242           memcpy (map.data + sizeof (sync_bytes), payload, nalu_size);
1243           gst_buffer_unmap (outbuf, &map);
1244
1245           gst_rtp_copy_meta (GST_ELEMENT_CAST (rtph265depay), outbuf,
1246               rtp->buffer, g_quark_from_static_string (GST_META_TAG_VIDEO_STR));
1247
1248           outbuf =
1249               gst_rtp_h265_depay_handle_nal (rtph265depay, outbuf, timestamp,
1250               marker);
1251           if (outbuf)
1252             gst_adapter_push (rtph265depay->adapter, outbuf);
1253
1254           payload += nalu_size;
1255           payload_len -= nalu_size;
1256         }
1257
1258         outsize = gst_adapter_available (rtph265depay->adapter);
1259         if (outsize > 0)
1260           outbuf = gst_adapter_take_buffer (rtph265depay->adapter, outsize);
1261         break;
1262       }
1263       case 49:
1264       {
1265         GST_DEBUG_OBJECT (rtph265depay, "Processing Fragmentation Unit");
1266
1267         /* Fragmentation units (FUs)  Section 4.8 */
1268
1269         /*    The structure of a Fragmentation Unit (FU)
1270          *
1271          *    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
1272          +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
1273          |    PayloadHdr (Type=49)       |   FU header   | DONL (cond)   |
1274          +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-|
1275          | DONL (cond)   |                                               |
1276          |-+-+-+-+-+-+-+-+                                               |
1277          |                         FU payload                            |
1278          |                                                               |
1279          |                               +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
1280          |                               :...OPTIONAL RTP padding        |
1281          +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
1282          *
1283          *
1284          */
1285
1286         /* strip headers */
1287         payload += header_len;
1288         payload_len -= header_len;
1289
1290         /* processing FU header */
1291         S = (payload[0] & 0x80) == 0x80;
1292         E = (payload[0] & 0x40) == 0x40;
1293
1294         GST_DEBUG_OBJECT (rtph265depay,
1295             "FU header with S %d, E %d, nal_unit_type %d", S, E,
1296             payload[0] & 0x3f);
1297
1298         if (rtph265depay->wait_start && !S)
1299           goto waiting_start;
1300
1301 #if 0
1302         if (donl_present)
1303           goto not_implemented_donl_present;
1304 #endif
1305
1306         if (S) {
1307
1308           GST_DEBUG_OBJECT (rtph265depay, "Start of Fragmentation Unit");
1309
1310           /* If a new FU unit started, while still processing an older one.
1311            * Assume that the remote payloader is buggy (doesn't set the end
1312            * bit) and send out what we've gathered thusfar */
1313           if (G_UNLIKELY (rtph265depay->current_fu_type != 0))
1314             gst_rtp_h265_push_fragmentation_unit (rtph265depay, TRUE);
1315
1316           rtph265depay->current_fu_type = nal_unit_type;
1317           rtph265depay->fu_timestamp = timestamp;
1318
1319           rtph265depay->wait_start = FALSE;
1320
1321           /* reconstruct NAL header */
1322           nal_header =
1323               ((payload[0] & 0x3f) << 9) | (nuh_layer_id << 3) |
1324               nuh_temporal_id_plus1;
1325
1326           /* go back one byte so we can copy the payload + two bytes more in the front which
1327            * will be overwritten by the nal_header
1328            */
1329           payload -= 1;
1330           payload_len += 1;
1331
1332           nalu_size = payload_len;
1333           outsize = nalu_size + sizeof (sync_bytes);
1334           outbuf = gst_buffer_new_and_alloc (outsize);
1335
1336           gst_buffer_map (outbuf, &map, GST_MAP_WRITE);
1337           memcpy (map.data + sizeof (sync_bytes), payload, nalu_size);
1338           map.data[sizeof (sync_bytes)] = nal_header >> 8;
1339           map.data[sizeof (sync_bytes) + 1] = nal_header & 0xff;
1340           gst_buffer_unmap (outbuf, &map);
1341
1342           gst_rtp_copy_meta (GST_ELEMENT_CAST (rtph265depay), outbuf,
1343               rtp->buffer, g_quark_from_static_string (GST_META_TAG_VIDEO_STR));
1344
1345           GST_DEBUG_OBJECT (rtph265depay, "queueing %d bytes", outsize);
1346
1347           /* and assemble in the adapter */
1348           gst_adapter_push (rtph265depay->adapter, outbuf);
1349         } else {
1350
1351           GST_DEBUG_OBJECT (rtph265depay,
1352               "Following part of Fragmentation Unit");
1353
1354           /* strip off FU header byte */
1355           payload += 1;
1356           payload_len -= 1;
1357
1358           outsize = payload_len;
1359           outbuf = gst_buffer_new_and_alloc (outsize);
1360           gst_buffer_fill (outbuf, 0, payload, outsize);
1361
1362           gst_rtp_copy_meta (GST_ELEMENT_CAST (rtph265depay), outbuf,
1363               rtp->buffer, g_quark_from_static_string (GST_META_TAG_VIDEO_STR));
1364
1365           GST_DEBUG_OBJECT (rtph265depay, "queueing %d bytes", outsize);
1366
1367           /* and assemble in the adapter */
1368           gst_adapter_push (rtph265depay->adapter, outbuf);
1369         }
1370
1371         outbuf = NULL;
1372         rtph265depay->fu_marker = marker;
1373
1374         /* if NAL unit ends, flush the adapter */
1375         if (E) {
1376           outbuf = gst_rtp_h265_push_fragmentation_unit (rtph265depay, FALSE);
1377           GST_DEBUG_OBJECT (rtph265depay, "End of Fragmentation Unit");
1378         }
1379         break;
1380       }
1381       case 50:
1382         goto not_implemented;   /* PACI packets  Section 4.9 */
1383       default:
1384       {
1385         rtph265depay->wait_start = FALSE;
1386
1387         /* All other cases: Single NAL unit packet   Section 4.6 */
1388         /* the entire payload is the output buffer */
1389
1390 #if 0
1391         if (donl_present)
1392           goto not_implemented_donl_present;
1393 #endif
1394
1395         nalu_size = payload_len;
1396         outsize = nalu_size + sizeof (sync_bytes);
1397         outbuf = gst_buffer_new_and_alloc (outsize);
1398
1399         gst_buffer_map (outbuf, &map, GST_MAP_WRITE);
1400         if (rtph265depay->byte_stream) {
1401           memcpy (map.data, sync_bytes, sizeof (sync_bytes));
1402         } else {
1403           goto not_implemented;
1404         }
1405         memcpy (map.data + sizeof (sync_bytes), payload, nalu_size);
1406         gst_buffer_unmap (outbuf, &map);
1407
1408         gst_rtp_copy_meta (GST_ELEMENT_CAST (rtph265depay), outbuf,
1409             rtp->buffer, g_quark_from_static_string (GST_META_TAG_VIDEO_STR));
1410
1411         outbuf = gst_rtp_h265_depay_handle_nal (rtph265depay, outbuf, timestamp,
1412             marker);
1413         break;
1414       }
1415     }
1416   }
1417
1418   return outbuf;
1419
1420   /* ERRORS */
1421 empty_packet:
1422   {
1423     GST_DEBUG_OBJECT (rtph265depay, "empty packet");
1424     return NULL;
1425   }
1426 waiting_start:
1427   {
1428     GST_DEBUG_OBJECT (rtph265depay, "waiting for start");
1429     return NULL;
1430   }
1431 #if 0
1432 not_implemented_donl_present:
1433   {
1434     GST_ELEMENT_ERROR (rtph265depay, STREAM, FORMAT,
1435         (NULL), ("DONL field present not supported yet"));
1436     return NULL;
1437   }
1438 #endif
1439 not_implemented:
1440   {
1441     GST_ELEMENT_ERROR (rtph265depay, STREAM, FORMAT,
1442         (NULL), ("NAL unit type %d not supported yet", nal_unit_type));
1443     return NULL;
1444   }
1445 }
1446
1447 static gboolean
1448 gst_rtp_h265_depay_handle_event (GstRTPBaseDepayload * depay, GstEvent * event)
1449 {
1450   GstRtpH265Depay *rtph265depay;
1451
1452   rtph265depay = GST_RTP_H265_DEPAY (depay);
1453
1454   switch (GST_EVENT_TYPE (event)) {
1455     case GST_EVENT_FLUSH_STOP:
1456       gst_rtp_h265_depay_reset (rtph265depay);
1457       break;
1458     default:
1459       break;
1460   }
1461
1462   return
1463       GST_RTP_BASE_DEPAYLOAD_CLASS (parent_class)->handle_event (depay, event);
1464 }
1465
1466 static GstStateChangeReturn
1467 gst_rtp_h265_depay_change_state (GstElement * element,
1468     GstStateChange transition)
1469 {
1470   GstRtpH265Depay *rtph265depay;
1471   GstStateChangeReturn ret;
1472
1473   rtph265depay = GST_RTP_H265_DEPAY (element);
1474
1475   switch (transition) {
1476     case GST_STATE_CHANGE_NULL_TO_READY:
1477       break;
1478     case GST_STATE_CHANGE_READY_TO_PAUSED:
1479       gst_rtp_h265_depay_reset (rtph265depay);
1480       break;
1481     default:
1482       break;
1483   }
1484
1485   ret = GST_ELEMENT_CLASS (parent_class)->change_state (element, transition);
1486
1487   switch (transition) {
1488     case GST_STATE_CHANGE_READY_TO_NULL:
1489       break;
1490     default:
1491       break;
1492   }
1493   return ret;
1494 }
1495
1496 gboolean
1497 gst_rtp_h265_depay_plugin_init (GstPlugin * plugin)
1498 {
1499   GST_DEBUG_CATEGORY_INIT (rtph265depay_debug, "rtph265depay", 0,
1500       "H265 Video RTP Depayloader");
1501
1502   return gst_element_register (plugin, "rtph265depay",
1503       GST_RANK_SECONDARY, GST_TYPE_RTP_H265_DEPAY);
1504 }