rtp: h264: Move profile_level_id parsing to a function
[libav.git] / libavformat / rtpdec_h264.c
CommitLineData
1d1be919
RM
1/*
2 * RTP H264 Protocol (RFC3984)
406792e7 3 * Copyright (c) 2006 Ryan Martell
1d1be919 4 *
2912e87a 5 * This file is part of Libav.
1d1be919 6 *
2912e87a 7 * Libav is free software; you can redistribute it and/or
1d1be919
RM
8 * modify it under the terms of the GNU Lesser General Public
9 * License as published by the Free Software Foundation; either
10 * version 2.1 of the License, or (at your option) any later version.
11 *
2912e87a 12 * Libav is distributed in the hope that it will be useful,
1d1be919
RM
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
15 * Lesser General Public License for more details.
16 *
17 * You should have received a copy of the GNU Lesser General Public
2912e87a 18 * License along with Libav; if not, write to the Free Software
1d1be919
RM
19 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
20 */
21
22/**
f3d471f4 23 * @file
1d1be919
RM
24 * @brief H.264 / RTP Code (RFC3984)
25 * @author Ryan Martell <rdm4@martellventures.com>
26 *
27 * @note Notes:
28 * Notes:
29 * This currently supports packetization mode:
30 * Single Nal Unit Mode (0), or
31 * Non-Interleaved Mode (1). It currently does not support
f3d471f4
MS
32 * Interleaved Mode (2). (This requires implementing STAP-B, MTAP16, MTAP24,
33 * FU-B packet types)
1d1be919
RM
34 */
35
7abd35a1 36#include "libavutil/attributes.h"
245976da
DB
37#include "libavutil/base64.h"
38#include "libavutil/avstring.h"
9106a698 39#include "libavcodec/get_bits.h"
1d1be919 40#include "avformat.h"
1d1be919 41
42572ef5 42#include "network.h"
1d1be919 43#include <assert.h>
1d1be919 44
302879cb 45#include "rtpdec.h"
965a3ddb 46#include "rtpdec_formats.h"
1d1be919 47
ed0aacc7 48struct PayloadContext {
f3d471f4 49 // sdp setup parameters
8d43b8b8
MS
50 uint8_t profile_idc;
51 uint8_t profile_iop;
52 uint8_t level_idc;
53 int packetization_mode;
1d1be919
RM
54#ifdef DEBUG
55 int packet_types_received[32];
56#endif
ed0aacc7 57};
1d1be919 58
48666c2b
MS
59#ifdef DEBUG
60#define COUNT_NAL_TYPE(data, nal) data->packet_types_received[(nal) & 0x1f]++
61#else
62#define COUNT_NAL_TYPE(data, nal) do { } while (0)
63#endif
64
b3688617
MS
65static const uint8_t start_sequence[] = { 0, 0, 0, 1 };
66
b8df0b71
LB
67static void parse_profile_level_id(AVFormatContext *s,
68 PayloadContext *h264_data,
69 char *value)
70{
71 char buffer[3];
72 // 6 characters=3 bytes, in hex.
73 uint8_t profile_idc;
74 uint8_t profile_iop;
75 uint8_t level_idc;
76
77 buffer[0] = value[0];
78 buffer[1] = value[1];
79 buffer[2] = '\0';
80 profile_idc = strtol(buffer, NULL, 16);
81 buffer[0] = value[2];
82 buffer[1] = value[3];
83 profile_iop = strtol(buffer, NULL, 16);
84 buffer[0] = value[4];
85 buffer[1] = value[5];
86 level_idc = strtol(buffer, NULL, 16);
87
88 av_log(s, AV_LOG_DEBUG,
89 "RTP Profile IDC: %x Profile IOP: %x Level: %x\n",
90 profile_idc, profile_iop, level_idc);
91 h264_data->profile_idc = profile_idc;
92 h264_data->profile_iop = profile_iop;
93 h264_data->level_idc = level_idc;
94}
95
0307cc22
AK
96static int sdp_parse_fmtp_config_h264(AVFormatContext *s,
97 AVStream *stream,
0b3ac9fe 98 PayloadContext *h264_data,
1ed3cef5 99 char *attr, char *value)
1d1be919
RM
100{
101 AVCodecContext *codec = stream->codec;
36ef5369 102 assert(codec->codec_id == AV_CODEC_ID_H264);
1d1be919
RM
103 assert(h264_data != NULL);
104
105 if (!strcmp(attr, "packetization-mode")) {
0307cc22 106 av_log(s, AV_LOG_DEBUG, "RTP Packetization Mode: %d\n", atoi(value));
272872e4 107 h264_data->packetization_mode = atoi(value);
1d1be919 108 /*
f3d471f4
MS
109 * Packetization Mode:
110 * 0 or not present: Single NAL mode (Only nals from 1-23 are allowed)
111 * 1: Non-interleaved Mode: 1-23, 24 (STAP-A), 28 (FU-A) are allowed.
112 * 2: Interleaved Mode: 25 (STAP-B), 26 (MTAP16), 27 (MTAP24), 28 (FU-A),
113 * and 29 (FU-B) are allowed.
1d1be919
RM
114 */
115 if (h264_data->packetization_mode > 1)
0307cc22 116 av_log(s, AV_LOG_ERROR,
2ed503af 117 "Interleaved RTP mode is not supported yet.\n");
1d1be919 118 } else if (!strcmp(attr, "profile-level-id")) {
b8df0b71
LB
119 if (strlen(value) == 6)
120 parse_profile_level_id(s, h264_data, value);
0b3ac9fe 121 } else if (!strcmp(attr, "sprop-parameter-sets")) {
0b3ac9fe 122 codec->extradata_size = 0;
b97d21e4 123 av_freep(&codec->extradata);
1d1be919
RM
124
125 while (*value) {
126 char base64packet[1024];
127 uint8_t decoded_packet[1024];
dc6cf61e 128 int packet_size;
1d1be919
RM
129 char *dst = base64packet;
130
131 while (*value && *value != ','
132 && (dst - base64packet) < sizeof(base64packet) - 1) {
133 *dst++ = *value++;
134 }
135 *dst++ = '\0';
136
137 if (*value == ',')
138 value++;
139
0b3ac9fe
MS
140 packet_size = av_base64_decode(decoded_packet, base64packet,
141 sizeof(decoded_packet));
dc6cf61e 142 if (packet_size > 0) {
b9b8ed2a 143 uint8_t *dest = av_malloc(packet_size + sizeof(start_sequence) +
0b3ac9fe
MS
144 codec->extradata_size +
145 FF_INPUT_BUFFER_PADDING_SIZE);
3c148703 146 if (!dest) {
0307cc22 147 av_log(s, AV_LOG_ERROR,
2ed503af 148 "Unable to allocate memory for extradata!\n");
7aa0118c 149 return AVERROR(ENOMEM);
1d1be919 150 }
3c148703
MS
151 if (codec->extradata_size) {
152 memcpy(dest, codec->extradata, codec->extradata_size);
153 av_free(codec->extradata);
154 }
155
156 memcpy(dest + codec->extradata_size, start_sequence,
157 sizeof(start_sequence));
158 memcpy(dest + codec->extradata_size + sizeof(start_sequence),
159 decoded_packet, packet_size);
160 memset(dest + codec->extradata_size + sizeof(start_sequence) +
161 packet_size, 0, FF_INPUT_BUFFER_PADDING_SIZE);
162
163 codec->extradata = dest;
164 codec->extradata_size += sizeof(start_sequence) + packet_size;
1d1be919
RM
165 }
166 }
0307cc22 167 av_log(s, AV_LOG_DEBUG, "Extradata set to %p (size: %d)!\n",
0b3ac9fe 168 codec->extradata, codec->extradata_size);
1d1be919 169 }
7aa0118c 170 return 0;
1d1be919
RM
171}
172
f3d471f4 173// return 0 on packet, no more left, 1 on packet, 1 on partial packet
0b3ac9fe
MS
174static int h264_handle_packet(AVFormatContext *ctx, PayloadContext *data,
175 AVStream *st, AVPacket *pkt, uint32_t *timestamp,
90c784cc
MS
176 const uint8_t *buf, int len, uint16_t seq,
177 int flags)
1d1be919 178{
de26a4b6
IK
179 uint8_t nal;
180 uint8_t type;
0b3ac9fe 181 int result = 0;
1d1be919 182
de26a4b6
IK
183 if (!len) {
184 av_log(ctx, AV_LOG_ERROR, "Empty H264 RTP packet\n");
185 return AVERROR_INVALIDDATA;
186 }
187 nal = buf[0];
188 type = nal & 0x1f;
189
1d1be919 190 assert(data);
1d1be919
RM
191 assert(buf);
192
f3d471f4
MS
193 /* Simplify the case (these are all the nal types used internally by
194 * the h264 codec). */
1d1be919 195 if (type >= 1 && type <= 23)
f3d471f4 196 type = 1;
1d1be919 197 switch (type) {
86042de8 198 case 0: // undefined, but pass them through
1d1be919 199 case 1:
9aba0a6f
MN
200 if ((result = av_new_packet(pkt, len + sizeof(start_sequence))) < 0)
201 return result;
1d1be919 202 memcpy(pkt->data, start_sequence, sizeof(start_sequence));
0b3ac9fe 203 memcpy(pkt->data + sizeof(start_sequence), buf, len);
48666c2b 204 COUNT_NAL_TYPE(data, nal);
1d1be919
RM
205 break;
206
207 case 24: // STAP-A (one packet, multiple nals)
208 // consume the STAP-A NAL
209 buf++;
210 len--;
f3d471f4 211 // first we are going to figure out the total size
1d1be919 212 {
0b3ac9fe
MS
213 int pass = 0;
214 int total_length = 0;
215 uint8_t *dst = NULL;
1d1be919 216
0b3ac9fe
MS
217 for (pass = 0; pass < 2; pass++) {
218 const uint8_t *src = buf;
219 int src_len = len;
1d1be919 220
5245adb9 221 while (src_len > 2) {
8d43b8b8 222 uint16_t nal_size = AV_RB16(src);
1d1be919 223
f3d471f4 224 // consume the length of the aggregate
0b3ac9fe 225 src += 2;
1d1be919
RM
226 src_len -= 2;
227
228 if (nal_size <= src_len) {
0b3ac9fe 229 if (pass == 0) {
f3d471f4 230 // counting
0b3ac9fe 231 total_length += sizeof(start_sequence) + nal_size;
1d1be919
RM
232 } else {
233 // copying
234 assert(dst);
235 memcpy(dst, start_sequence, sizeof(start_sequence));
0b3ac9fe 236 dst += sizeof(start_sequence);
1d1be919 237 memcpy(dst, src, nal_size);
48666c2b 238 COUNT_NAL_TYPE(data, *src);
0b3ac9fe 239 dst += nal_size;
1d1be919
RM
240 }
241 } else {
2fddbb68 242 av_log(ctx, AV_LOG_ERROR,
1d1be919
RM
243 "nal size exceeds length: %d %d\n", nal_size, src_len);
244 }
245
f3d471f4 246 // eat what we handled
0b3ac9fe 247 src += nal_size;
1d1be919
RM
248 src_len -= nal_size;
249
250 if (src_len < 0)
2fddbb68 251 av_log(ctx, AV_LOG_ERROR,
1d1be919 252 "Consumed more bytes than we got! (%d)\n", src_len);
5245adb9 253 }
1d1be919 254
0b3ac9fe 255 if (pass == 0) {
f3d471f4
MS
256 /* now we know the total size of the packet (with the
257 * start sequences added) */
9aba0a6f
MN
258 if ((result = av_new_packet(pkt, total_length)) < 0)
259 return result;
0b3ac9fe 260 dst = pkt->data;
1d1be919 261 } else {
0b3ac9fe 262 assert(dst - pkt->data == total_length);
1d1be919
RM
263 }
264 }
265 }
266 break;
267
268 case 25: // STAP-B
269 case 26: // MTAP-16
270 case 27: // MTAP-24
271 case 29: // FU-B
2fddbb68 272 av_log(ctx, AV_LOG_ERROR,
1d1be919
RM
273 "Unhandled type (%d) (See RFC for implementation details\n",
274 type);
b7b7354c 275 result = AVERROR(ENOSYS);
1d1be919
RM
276 break;
277
278 case 28: // FU-A (fragmented nal)
279 buf++;
f3d471f4 280 len--; // skip the fu_indicator
de26a4b6 281 if (len > 1) {
f3d471f4 282 // these are the same as above, we just redo them here for clarity
0b3ac9fe
MS
283 uint8_t fu_indicator = nal;
284 uint8_t fu_header = *buf;
285 uint8_t start_bit = fu_header >> 7;
dee48d09 286 uint8_t av_unused end_bit = (fu_header & 0x40) >> 6;
0b3ac9fe 287 uint8_t nal_type = fu_header & 0x1f;
1d1be919
RM
288 uint8_t reconstructed_nal;
289
f3d471f4
MS
290 // Reconstruct this packet's true nal; only the data follows.
291 /* The original nal forbidden bit and NRI are stored in this
292 * packet's nal. */
0b3ac9fe 293 reconstructed_nal = fu_indicator & 0xe0;
7699645e 294 reconstructed_nal |= nal_type;
1d1be919 295
f3d471f4 296 // skip the fu_header
1d1be919
RM
297 buf++;
298 len--;
299
1d1be919 300 if (start_bit)
48666c2b 301 COUNT_NAL_TYPE(data, nal_type);
0b3ac9fe 302 if (start_bit) {
f3d471f4 303 /* copy in the start sequence, and the reconstructed nal */
9aba0a6f
MN
304 if ((result = av_new_packet(pkt, sizeof(start_sequence) + sizeof(nal) + len)) < 0)
305 return result;
1d1be919 306 memcpy(pkt->data, start_sequence, sizeof(start_sequence));
0b3ac9fe
MS
307 pkt->data[sizeof(start_sequence)] = reconstructed_nal;
308 memcpy(pkt->data + sizeof(start_sequence) + sizeof(nal), buf, len);
1d1be919 309 } else {
9aba0a6f
MN
310 if ((result = av_new_packet(pkt, len)) < 0)
311 return result;
1d1be919
RM
312 memcpy(pkt->data, buf, len);
313 }
de26a4b6
IK
314 } else {
315 av_log(ctx, AV_LOG_ERROR, "Too short data for FU-A H264 RTP packet\n");
316 result = AVERROR_INVALIDDATA;
1d1be919
RM
317 }
318 break;
319
320 case 30: // undefined
321 case 31: // undefined
322 default:
2ed503af 323 av_log(ctx, AV_LOG_ERROR, "Undefined type (%d)\n", type);
b7b7354c 324 result = AVERROR_INVALIDDATA;
1d1be919
RM
325 break;
326 }
327
eafb17d1
RB
328 pkt->stream_index = st->index;
329
1d1be919
RM
330 return result;
331}
332
202a6697 333static PayloadContext *h264_new_context(void)
1d1be919 334{
5a571d32 335 return av_mallocz(sizeof(PayloadContext) + FF_INPUT_BUFFER_PADDING_SIZE);
1d1be919
RM
336}
337
202a6697 338static void h264_free_context(PayloadContext *data)
1d1be919 339{
1d1be919
RM
340#ifdef DEBUG
341 int ii;
342
343 for (ii = 0; ii < 32; ii++) {
344 if (data->packet_types_received[ii])
345 av_log(NULL, AV_LOG_DEBUG, "Received %d packets of type %d\n",
346 data->packet_types_received[ii], ii);
347 }
348#endif
349
1d1be919
RM
350 av_free(data);
351}
352
7abd35a1
DB
353static av_cold int h264_init(AVFormatContext *s, int st_index,
354 PayloadContext *data)
c6f1dc8e
MS
355{
356 if (st_index < 0)
357 return 0;
358 s->streams[st_index]->need_parsing = AVSTREAM_PARSE_FULL;
359 return 0;
360}
361
7b2a0708
RB
362static int parse_h264_sdp_line(AVFormatContext *s, int st_index,
363 PayloadContext *h264_data, const char *line)
1d1be919 364{
45600148
MS
365 AVStream *stream;
366 AVCodecContext *codec;
1d1be919
RM
367 const char *p = line;
368
45600148
MS
369 if (st_index < 0)
370 return 0;
371
372 stream = s->streams[st_index];
0b3ac9fe 373 codec = stream->codec;
1d1be919 374
f7d78f36 375 if (av_strstart(p, "framesize:", &p)) {
1d1be919
RM
376 char buf1[50];
377 char *dst = buf1;
378
f3d471f4 379 // remove the protocol identifier
0b3ac9fe
MS
380 while (*p && *p == ' ')
381 p++; // strip spaces.
382 while (*p && *p != ' ')
383 p++; // eat protocol identifier
384 while (*p && *p == ' ')
385 p++; // strip trailing spaces.
386 while (*p && *p != '-' && (dst - buf1) < sizeof(buf1) - 1)
1d1be919 387 *dst++ = *p++;
1d1be919
RM
388 *dst = '\0';
389
390 // a='framesize:96 320-240'
f3d471f4 391 // set our parameters
0b3ac9fe
MS
392 codec->width = atoi(buf1);
393 codec->height = atoi(p + 1); // skip the -
f7d78f36 394 } else if (av_strstart(p, "fmtp:", &p)) {
0307cc22 395 return ff_parse_fmtp(s, stream, h264_data, p, sdp_parse_fmtp_config_h264);
f7d78f36 396 } else if (av_strstart(p, "cliprect:", &p)) {
1d1be919
RM
397 // could use this if we wanted.
398 }
399
8d43b8b8 400 return 0;
1d1be919
RM
401}
402
1d1be919 403RTPDynamicProtocolHandler ff_h264_dynamic_handler = {
202a6697 404 .enc_name = "H264",
72415b2a 405 .codec_type = AVMEDIA_TYPE_VIDEO,
36ef5369 406 .codec_id = AV_CODEC_ID_H264,
c6f1dc8e 407 .init = h264_init,
202a6697 408 .parse_sdp_a_line = parse_h264_sdp_line,
9261e6cf
MS
409 .alloc = h264_new_context,
410 .free = h264_free_context,
202a6697 411 .parse_packet = h264_handle_packet
1d1be919 412};