]> git.sesse.net Git - ffmpeg/blob - libavformat/rtpdec_qcelp.c
Merge remote-tracking branch 'qatar/master'
[ffmpeg] / libavformat / rtpdec_qcelp.c
1 /**
2  * RTP Depacketization of QCELP/PureVoice, RFC 2658
3  * Copyright (c) 2010 Martin Storsjo
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 "rtpdec_formats.h"
23
24 static const uint8_t frame_sizes[] = {
25     1, 4, 8, 17, 35
26 };
27
28 typedef struct {
29     int pos;
30     int size;
31     /* The largest frame is 35 bytes, only 10 frames are allowed per
32      * packet, and we return the first one immediately, so allocate
33      * space for 9 frames */
34     uint8_t data[35*9];
35 } InterleavePacket;
36
37 struct PayloadContext {
38     int interleave_size;
39     int interleave_index;
40     InterleavePacket group[6];
41     int group_finished;
42
43     /* The maximum packet size, 10 frames of 35 bytes each, and one
44      * packet header byte. */
45     uint8_t  next_data[1 + 35*10];
46     int      next_size;
47     uint32_t next_timestamp;
48 };
49
50 static PayloadContext *qcelp_new_context(void)
51 {
52     return av_mallocz(sizeof(PayloadContext));
53 }
54
55 static void qcelp_free_context(PayloadContext *data)
56 {
57     av_free(data);
58 }
59
60 static int return_stored_frame(AVFormatContext *ctx, PayloadContext *data,
61                                AVStream *st, AVPacket *pkt, uint32_t *timestamp,
62                                const uint8_t *buf, int len);
63
64 static int store_packet(AVFormatContext *ctx, PayloadContext *data,
65                         AVStream *st, AVPacket *pkt, uint32_t *timestamp,
66                         const uint8_t *buf, int len)
67 {
68     int interleave_size, interleave_index;
69     int frame_size, ret;
70     InterleavePacket* ip;
71
72     if (len < 2)
73         return AVERROR_INVALIDDATA;
74
75     interleave_size  = buf[0] >> 3 & 7;
76     interleave_index = buf[0]      & 7;
77
78     if (interleave_size > 5) {
79         av_log(ctx, AV_LOG_ERROR, "Invalid interleave size %d\n",
80                                    interleave_size);
81         return AVERROR_INVALIDDATA;
82     }
83     if (interleave_index > interleave_size) {
84         av_log(ctx, AV_LOG_ERROR, "Invalid interleave index %d/%d\n",
85                                    interleave_index, interleave_size);
86         return AVERROR_INVALIDDATA;
87     }
88     if (interleave_size != data->interleave_size) {
89         int i;
90         /* First packet, or changed interleave size */
91         data->interleave_size = interleave_size;
92         data->interleave_index = 0;
93         for (i = 0; i < 6; i++)
94             data->group[i].size = 0;
95     }
96
97     if (interleave_index < data->interleave_index) {
98         /* Wrapped around - missed the last packet of the previous group. */
99         if (data->group_finished) {
100             /* No more data in the packets in this interleaving group, just
101              * start processing the next one */
102             data->interleave_index = 0;
103         } else {
104             /* Stash away the current packet, emit everything we have of the
105              * previous group. */
106             for (; data->interleave_index <= interleave_size;
107                  data->interleave_index++)
108                 data->group[data->interleave_index].size = 0;
109
110             if (len > sizeof(data->next_data))
111                 return AVERROR_INVALIDDATA;
112             memcpy(data->next_data, buf, len);
113             data->next_size = len;
114             data->next_timestamp = *timestamp;
115             *timestamp = RTP_NOTS_VALUE;
116
117             data->interleave_index = 0;
118             return return_stored_frame(ctx, data, st, pkt, timestamp, buf, len);
119         }
120     }
121     if (interleave_index > data->interleave_index) {
122         /* We missed a packet */
123         for (; data->interleave_index < interleave_index;
124              data->interleave_index++)
125             data->group[data->interleave_index].size = 0;
126     }
127     data->interleave_index = interleave_index;
128
129     if (buf[1] >= FF_ARRAY_ELEMS(frame_sizes))
130         return AVERROR_INVALIDDATA;
131     frame_size = frame_sizes[buf[1]];
132     if (1 + frame_size > len)
133         return AVERROR_INVALIDDATA;
134
135     if (len - 1 - frame_size > sizeof(data->group[0].data))
136         return AVERROR_INVALIDDATA;
137
138     if ((ret = av_new_packet(pkt, frame_size)) < 0)
139         return ret;
140     memcpy(pkt->data, &buf[1], frame_size);
141     pkt->stream_index = st->index;
142
143     ip = &data->group[data->interleave_index];
144     ip->size = len - 1 - frame_size;
145     ip->pos = 0;
146     memcpy(ip->data, &buf[1 + frame_size], ip->size);
147     /* Each packet must contain the same number of frames according to the
148      * RFC. If there's no data left in this packet, there shouldn't be any
149      * in any of the other frames in the interleaving group either. */
150     data->group_finished = ip->size == 0;
151
152     if (interleave_index == interleave_size) {
153         data->interleave_index = 0;
154         return !data->group_finished;
155     } else {
156         data->interleave_index++;
157         return 0;
158     }
159 }
160
161 static int return_stored_frame(AVFormatContext *ctx, PayloadContext *data,
162                                AVStream *st, AVPacket *pkt, uint32_t *timestamp,
163                                const uint8_t *buf, int len)
164 {
165     InterleavePacket* ip = &data->group[data->interleave_index];
166     int frame_size, ret;
167
168     if (data->group_finished && data->interleave_index == 0) {
169         *timestamp = data->next_timestamp;
170         ret = store_packet(ctx, data, st, pkt, timestamp, data->next_data,
171                            data->next_size);
172         data->next_size = 0;
173         return ret;
174     }
175
176     if (ip->size == 0) {
177         /* No stored data for this interleave block, output an empty packet */
178         if ((ret = av_new_packet(pkt, 1)) < 0)
179             return ret;
180         pkt->data[0] = 0; // Blank - could also be 14, Erasure
181     } else {
182         if (ip->pos >= ip->size)
183             return AVERROR_INVALIDDATA;
184         if (ip->data[ip->pos] >= FF_ARRAY_ELEMS(frame_sizes))
185             return AVERROR_INVALIDDATA;
186         frame_size = frame_sizes[ip->data[ip->pos]];
187         if (ip->pos + frame_size > ip->size)
188             return AVERROR_INVALIDDATA;
189
190         if ((ret = av_new_packet(pkt, frame_size)) < 0)
191             return ret;
192         memcpy(pkt->data, &ip->data[ip->pos], frame_size);
193
194         ip->pos += frame_size;
195         data->group_finished = ip->pos >= ip->size;
196     }
197     pkt->stream_index = st->index;
198
199     if (data->interleave_index == data->interleave_size) {
200         data->interleave_index = 0;
201         if (!data->group_finished)
202             return 1;
203         else
204             return data->next_size > 0;
205     } else {
206         data->interleave_index++;
207         return 1;
208     }
209 }
210
211 static int qcelp_parse_packet(AVFormatContext *ctx, PayloadContext *data,
212                               AVStream *st, AVPacket *pkt, uint32_t *timestamp,
213                               const uint8_t *buf, int len, int flags)
214 {
215     if (buf)
216         return store_packet(ctx, data, st, pkt, timestamp, buf, len);
217     else
218         return return_stored_frame(ctx, data, st, pkt, timestamp, buf, len);
219 }
220
221 RTPDynamicProtocolHandler ff_qcelp_dynamic_handler = {
222     .enc_name           = "x-Purevoice",
223     .codec_type         = AVMEDIA_TYPE_AUDIO,
224     .codec_id           = CODEC_ID_QCELP,
225     .static_payload_id  = 12,
226     .alloc              = qcelp_new_context,
227     .free               = qcelp_free_context,
228     .parse_packet       = qcelp_parse_packet
229 };