| Line | Branch | Exec | Source |
|---|---|---|---|
| 1 | /* | ||
| 2 | * RTP parser for loss tolerant payload format for MP3 audio (RFC 5219) | ||
| 3 | * Copyright (c) 2015 Gilles Chanteperdrix <gch@xenomai.org> | ||
| 4 | * | ||
| 5 | * This file is part of FFmpeg. | ||
| 6 | * | ||
| 7 | * FFmpeg is free software; you can redistribute it and/or | ||
| 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 | * | ||
| 12 | * FFmpeg is distributed in the hope that it will be useful, | ||
| 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 | ||
| 18 | * License along with FFmpeg; if not, write to the Free Software | ||
| 19 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA | ||
| 20 | */ | ||
| 21 | |||
| 22 | #include "libavutil/attributes.h" | ||
| 23 | #include "libavutil/intreadwrite.h" | ||
| 24 | #include "libavutil/mem.h" | ||
| 25 | |||
| 26 | #include "avio_internal.h" | ||
| 27 | #include "rtpdec_formats.h" | ||
| 28 | |||
| 29 | struct PayloadContext { | ||
| 30 | unsigned adu_size; | ||
| 31 | unsigned cur_size; | ||
| 32 | uint32_t timestamp; | ||
| 33 | uint8_t *split_buf; | ||
| 34 | int split_pos, split_buf_size, split_pkts; | ||
| 35 | AVIOContext *fragment; | ||
| 36 | }; | ||
| 37 | |||
| 38 | ✗ | static void mpa_robust_close_context(PayloadContext *data) | |
| 39 | { | ||
| 40 | ✗ | ffio_free_dyn_buf(&data->fragment); | |
| 41 | ✗ | av_free(data->split_buf); | |
| 42 | ✗ | } | |
| 43 | |||
| 44 | ✗ | static int mpa_robust_parse_rtp_header(AVFormatContext *ctx, | |
| 45 | const uint8_t *buf, int len, | ||
| 46 | unsigned *adu_size, unsigned *cont) | ||
| 47 | { | ||
| 48 | unsigned header_size; | ||
| 49 | |||
| 50 | ✗ | if (len < 2) { | |
| 51 | ✗ | av_log(ctx, AV_LOG_ERROR, "Invalid %d bytes packet\n", len); | |
| 52 | ✗ | return AVERROR_INVALIDDATA; | |
| 53 | } | ||
| 54 | |||
| 55 | ✗ | *cont = !!(buf[0] & 0x80); | |
| 56 | ✗ | if (!(buf[0] & 0x40)) { | |
| 57 | ✗ | header_size = 1; | |
| 58 | ✗ | *adu_size = buf[0] & ~0xc0; | |
| 59 | } else { | ||
| 60 | ✗ | header_size = 2; | |
| 61 | ✗ | *adu_size = AV_RB16(buf) & ~0xc000; | |
| 62 | } | ||
| 63 | |||
| 64 | ✗ | return header_size; | |
| 65 | } | ||
| 66 | |||
| 67 | ✗ | static int mpa_robust_parse_packet(AVFormatContext *ctx, PayloadContext *data, | |
| 68 | AVStream *st, AVPacket *pkt, | ||
| 69 | uint32_t *timestamp, const uint8_t *buf, | ||
| 70 | int len, uint16_t seq, int flags) | ||
| 71 | { | ||
| 72 | unsigned adu_size, continuation; | ||
| 73 | int err, header_size; | ||
| 74 | |||
| 75 | ✗ | if (!buf) { | |
| 76 | ✗ | buf = &data->split_buf[data->split_pos]; | |
| 77 | ✗ | len = data->split_buf_size - data->split_pos; | |
| 78 | |||
| 79 | ✗ | header_size = mpa_robust_parse_rtp_header(ctx, buf, len, &adu_size, | |
| 80 | &continuation); | ||
| 81 | ✗ | if (header_size < 0) { | |
| 82 | ✗ | av_freep(&data->split_buf); | |
| 83 | ✗ | return header_size; | |
| 84 | } | ||
| 85 | ✗ | buf += header_size; | |
| 86 | ✗ | len -= header_size; | |
| 87 | |||
| 88 | ✗ | if (continuation || adu_size > len) { | |
| 89 | ✗ | av_freep(&data->split_buf); | |
| 90 | ✗ | av_log(ctx, AV_LOG_ERROR, "Invalid frame\n"); | |
| 91 | ✗ | return AVERROR_INVALIDDATA; | |
| 92 | } | ||
| 93 | |||
| 94 | ✗ | if ((err = av_new_packet(pkt, adu_size)) < 0) { | |
| 95 | ✗ | av_log(ctx, AV_LOG_ERROR, "Out of memory.\n"); | |
| 96 | ✗ | return err; | |
| 97 | } | ||
| 98 | |||
| 99 | ✗ | pkt->stream_index = st->index; | |
| 100 | ✗ | memcpy(pkt->data, buf, adu_size); | |
| 101 | |||
| 102 | ✗ | data->split_pos += header_size + adu_size; | |
| 103 | |||
| 104 | ✗ | if (data->split_pos == data->split_buf_size) { | |
| 105 | ✗ | av_freep(&data->split_buf); | |
| 106 | ✗ | return 0; | |
| 107 | } | ||
| 108 | |||
| 109 | ✗ | return 1; | |
| 110 | } | ||
| 111 | |||
| 112 | |||
| 113 | ✗ | header_size = mpa_robust_parse_rtp_header(ctx, buf, len, &adu_size, | |
| 114 | &continuation); | ||
| 115 | ✗ | if (header_size < 0) | |
| 116 | ✗ | return header_size; | |
| 117 | |||
| 118 | ✗ | buf += header_size; | |
| 119 | ✗ | len -= header_size; | |
| 120 | |||
| 121 | ✗ | if (!continuation && adu_size <= len) { | |
| 122 | /* One or more complete frames */ | ||
| 123 | |||
| 124 | ✗ | if ((err = av_new_packet(pkt, adu_size)) < 0) { | |
| 125 | ✗ | av_log(ctx, AV_LOG_ERROR, "Out of memory.\n"); | |
| 126 | ✗ | return err; | |
| 127 | } | ||
| 128 | |||
| 129 | ✗ | pkt->stream_index = st->index; | |
| 130 | ✗ | memcpy(pkt->data, buf, adu_size); | |
| 131 | |||
| 132 | ✗ | buf += adu_size; | |
| 133 | ✗ | len -= adu_size; | |
| 134 | ✗ | if (len) { | |
| 135 | ✗ | data->split_buf_size = len; | |
| 136 | ✗ | data->split_buf = av_malloc(data->split_buf_size); | |
| 137 | ✗ | data->split_pos = 0; | |
| 138 | ✗ | if (!data->split_buf) { | |
| 139 | ✗ | av_log(ctx, AV_LOG_ERROR, "Out of memory.\n"); | |
| 140 | ✗ | av_packet_unref(pkt); | |
| 141 | ✗ | return AVERROR(ENOMEM); | |
| 142 | } | ||
| 143 | ✗ | memcpy(data->split_buf, buf, data->split_buf_size); | |
| 144 | ✗ | return 1; | |
| 145 | } | ||
| 146 | ✗ | return 0; | |
| 147 | ✗ | } else if (!continuation) { /* && adu_size > len */ | |
| 148 | /* First fragment */ | ||
| 149 | ✗ | ffio_free_dyn_buf(&data->fragment); | |
| 150 | |||
| 151 | ✗ | data->adu_size = adu_size; | |
| 152 | ✗ | data->cur_size = len; | |
| 153 | ✗ | data->timestamp = *timestamp; | |
| 154 | |||
| 155 | ✗ | err = avio_open_dyn_buf(&data->fragment); | |
| 156 | ✗ | if (err < 0) | |
| 157 | ✗ | return err; | |
| 158 | |||
| 159 | ✗ | avio_write(data->fragment, buf, len); | |
| 160 | ✗ | return AVERROR(EAGAIN); | |
| 161 | } | ||
| 162 | /* else continuation == 1 */ | ||
| 163 | |||
| 164 | /* Fragment other than first */ | ||
| 165 | ✗ | if (!data->fragment) { | |
| 166 | ✗ | av_log(ctx, AV_LOG_WARNING, | |
| 167 | "Received packet without a start fragment; dropping.\n"); | ||
| 168 | ✗ | return AVERROR(EAGAIN); | |
| 169 | } | ||
| 170 | ✗ | if (adu_size != data->adu_size || | |
| 171 | ✗ | data->timestamp != *timestamp) { | |
| 172 | ✗ | ffio_free_dyn_buf(&data->fragment); | |
| 173 | ✗ | av_log(ctx, AV_LOG_ERROR, "Invalid packet received\n"); | |
| 174 | ✗ | return AVERROR_INVALIDDATA; | |
| 175 | } | ||
| 176 | |||
| 177 | ✗ | avio_write(data->fragment, buf, len); | |
| 178 | ✗ | data->cur_size += len; | |
| 179 | |||
| 180 | ✗ | if (data->cur_size < data->adu_size) | |
| 181 | ✗ | return AVERROR(EAGAIN); | |
| 182 | |||
| 183 | ✗ | err = ff_rtp_finalize_packet(pkt, &data->fragment, st->index); | |
| 184 | ✗ | if (err < 0) { | |
| 185 | ✗ | av_log(ctx, AV_LOG_ERROR, | |
| 186 | "Error occurred when getting fragment buffer.\n"); | ||
| 187 | ✗ | return err; | |
| 188 | } | ||
| 189 | |||
| 190 | ✗ | return 0; | |
| 191 | } | ||
| 192 | |||
| 193 | const RTPDynamicProtocolHandler ff_mpeg_audio_robust_dynamic_handler = { | ||
| 194 | .enc_name = "mpa-robust", | ||
| 195 | .codec_type = AVMEDIA_TYPE_AUDIO, | ||
| 196 | .codec_id = AV_CODEC_ID_MP3ADU, | ||
| 197 | .need_parsing = AVSTREAM_PARSE_HEADERS, | ||
| 198 | .priv_data_size = sizeof(PayloadContext), | ||
| 199 | .close = mpa_robust_close_context, | ||
| 200 | .parse_packet = mpa_robust_parse_packet, | ||
| 201 | }; | ||
| 202 |