rtpdec hevc: implement aggregation packets (untested)

Author: MartinPulec

src/rtp/rtpdec_h264.c

@@ -281,6 +281,56 @@ decode_hevc_nal_unit(struct video_frame *frame, int *total_length, int pass,
                 memcpy(*dst, start_sequence, sizeof(start_sequence));
                 memcpy(*dst + sizeof(start_sequence), data, data_len);
             }
+    } else if (type == NAL_RTP_HEVC_AP) {
+            // untested (copy from decode_h264_nal_unit)
+            int nal_sizes[100];
+            unsigned nal_count = 0;
+            data += 2;
+            data_len -= 2;
+
+            while (data_len > 2) {
+                uint16_t nal_size;
+                memcpy(&nal_size, data, sizeof(uint16_t));
+                nal_size = ntohs(nal_size);
+
+                data += 2;
+                data_len -= 2;
+
+                log_msg(LOG_LEVEL_DEBUG2,
+                        "HEVC AP subpacket NAL type %d\n",
+                        (int) HEVC_NALU_HDR_GET_TYPE(data));
+
+                if (nal_size <= data_len) {
+                    if (pass == 0) {
+                        *total_length += sizeof(start_sequence) + nal_size;
+                        process_hevc_nal(data, frame, data, data_len);
+                    } else {
+                        assert(nal_count < sizeof nal_sizes / sizeof nal_sizes[0] - 1);
+                        nal_sizes[nal_count++] = nal_size;
+                    }
+                } else {
+                    error_msg("NAL size exceeds length: %u %d\n", nal_size, data_len);
+                    return false;
+                }
+                data += nal_size;
+                data_len -= nal_size;
+
+                if (data_len < 0) {
+                    error_msg("Consumed more bytes than we got! (%d)\n", data_len);
+                    return false;
+                }
+
+            }
+            if (pass > 0) {
+                for (int i = nal_count - 1; i >= 0; i--) {
+                    int nal_size = nal_sizes[i];
+                    data -= nal_size;
+                    *dst -= nal_size + sizeof(start_sequence);
+                    memcpy(*dst, start_sequence, sizeof(start_sequence));
+                    memcpy(*dst + sizeof(start_sequence), data, nal_size);
+                    data -= 2;
+                }
+            }
     } else if (type == NAL_RTP_HEVC_FU) {
             data += 2;
             data_len -= 2;