Ticket #3780: rtpdec_jpeg.c

File rtpdec_jpeg.c, 13.4 KB (added by iRidium_mobile, 12 years ago)

correction of the problem

Line 
1/*
2 * RTP JPEG-compressed Video Depacketizer, RFC 2435
3 * Copyright (c) 2012 Samuel Pitoiset
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 "avformat.h"
23#include "rtpdec.h"
24#include "rtpdec_formats.h"
25#include "libavutil/intreadwrite.h"
26#include "libavcodec/mjpeg.h"
27#include "libavcodec/bytestream.h"
28
29/**
30 * RTP/JPEG specific private data.
31 */
32struct PayloadContext {
33 AVIOContext *frame; ///< current frame buffer
34 uint32_t timestamp; ///< current frame timestamp
35 int hdr_size; ///< size of the current frame header
36 uint8_t qtables[128][128];
37 uint8_t qtables_len[128];
38};
39
40static const uint8_t default_quantizers[128] = {
41 /* luma table */
42 16, 11, 12, 14, 12, 10, 16, 14,
43 13, 14, 18, 17, 16, 19, 24, 40,
44 26, 24, 22, 22, 24, 49, 35, 37,
45 29, 40, 58, 51, 61, 60, 57, 51,
46 56, 55, 64, 72, 92, 78, 64, 68,
47 87, 69, 55, 56, 80, 109, 81, 87,
48 95, 98, 103, 104, 103, 62, 77, 113,
49 121, 112, 100, 120, 92, 101, 103, 99,
50
51 /* chroma table */
52 17, 18, 18, 24, 21, 24, 47, 26,
53 26, 47, 99, 66, 56, 66, 99, 99,
54 99, 99, 99, 99, 99, 99, 99, 99,
55 99, 99, 99, 99, 99, 99, 99, 99,
56 99, 99, 99, 99, 99, 99, 99, 99,
57 99, 99, 99, 99, 99, 99, 99, 99,
58 99, 99, 99, 99, 99, 99, 99, 99,
59 99, 99, 99, 99, 99, 99, 99, 99
60};
61
62static PayloadContext *jpeg_new_context(void)
63{
64 return av_mallocz(sizeof(PayloadContext));
65}
66
67static inline void free_frame_if_needed(PayloadContext *jpeg)
68{
69 if (jpeg->frame) {
70 uint8_t *p;
71 avio_close_dyn_buf(jpeg->frame, &p);
72 av_free(p);
73 jpeg->frame = NULL;
74 }
75}
76
77static void jpeg_free_context(PayloadContext *jpeg)
78{
79 free_frame_if_needed(jpeg);
80 av_free(jpeg);
81}
82
83static int jpeg_create_huffman_table(PutByteContext *p, int table_class,
84 int table_id, const uint8_t *bits_table,
85 const uint8_t *value_table)
86{
87 int i, n = 0;
88
89 bytestream2_put_byte(p, table_class << 4 | table_id);
90
91 for (i = 1; i <= 16; i++) {
92 n += bits_table[i];
93 bytestream2_put_byte(p, bits_table[i]);
94 }
95
96 for (i = 0; i < n; i++) {
97 bytestream2_put_byte(p, value_table[i]);
98 }
99 return n + 17;
100}
101
102static void jpeg_put_marker(PutByteContext *pbc, int code)
103{
104 bytestream2_put_byte(pbc, 0xff);
105 bytestream2_put_byte(pbc, code);
106}
107
108static int jpeg_create_header(uint8_t *buf, int size, uint32_t type, uint32_t w,
109 uint32_t h, const uint8_t *qtable, int nb_qtable, uint32_t dri)
110{
111 PutByteContext pbc;
112 uint8_t *dht_size_ptr;
113 int dht_size, i;
114
115 bytestream2_init_writer(&pbc, buf, size);
116
117 /* Convert from blocks to pixels. */
118 w <<= 3;
119 h <<= 3;
120
121 /* SOI */
122 jpeg_put_marker(&pbc, SOI);
123
124 /* JFIF header */
125 jpeg_put_marker(&pbc, APP0);
126 bytestream2_put_be16(&pbc, 16);
127 bytestream2_put_buffer(&pbc, "JFIF", 5);
128 bytestream2_put_be16(&pbc, 0x0201);
129 bytestream2_put_byte(&pbc, 0);
130 bytestream2_put_be16(&pbc, 1);
131 bytestream2_put_be16(&pbc, 1);
132 bytestream2_put_byte(&pbc, 0);
133 bytestream2_put_byte(&pbc, 0);
134
135 /* DRI */
136 if(dri > 0)
137 {
138 jpeg_put_marker(&pbc, DRI);
139 bytestream2_put_be16(&pbc, 4);
140 bytestream2_put_be16(&pbc, dri);
141 }
142
143 /* DQT */
144 jpeg_put_marker(&pbc, DQT);
145 bytestream2_put_be16(&pbc, 2 + nb_qtable * (1 + 64));
146
147 for (i = 0; i < nb_qtable; i++) {
148 bytestream2_put_byte(&pbc, i);
149
150 /* Each table is an array of 64 values given in zig-zag
151 * order, identical to the format used in a JFIF DQT
152 * marker segment. */
153 bytestream2_put_buffer(&pbc, qtable + 64 * i, 64);
154 }
155
156 /* DHT */
157 jpeg_put_marker(&pbc, DHT);
158 dht_size_ptr = pbc.buffer;
159 bytestream2_put_be16(&pbc, 0);
160
161 dht_size = 2;
162 dht_size += jpeg_create_huffman_table(&pbc, 0, 0,avpriv_mjpeg_bits_dc_luminance,
163 avpriv_mjpeg_val_dc);
164 dht_size += jpeg_create_huffman_table(&pbc, 0, 1, avpriv_mjpeg_bits_dc_chrominance,
165 avpriv_mjpeg_val_dc);
166 dht_size += jpeg_create_huffman_table(&pbc, 1, 0, avpriv_mjpeg_bits_ac_luminance,
167 avpriv_mjpeg_val_ac_luminance);
168 dht_size += jpeg_create_huffman_table(&pbc, 1, 1, avpriv_mjpeg_bits_ac_chrominance,
169 avpriv_mjpeg_val_ac_chrominance);
170 AV_WB16(dht_size_ptr, dht_size);
171
172 /* SOF0 */
173 jpeg_put_marker(&pbc, SOF0);
174 bytestream2_put_be16(&pbc, 17); /* size */
175 bytestream2_put_byte(&pbc, 8); /* bits per component */
176 bytestream2_put_be16(&pbc, h);
177 bytestream2_put_be16(&pbc, w);
178 bytestream2_put_byte(&pbc, 3); /* number of components */
179 bytestream2_put_byte(&pbc, 1); /* component number */
180 bytestream2_put_byte(&pbc, (2 << 4) | (type ? 2 : 1)); /* hsample/vsample */
181 bytestream2_put_byte(&pbc, 0); /* matrix number */
182 bytestream2_put_byte(&pbc, 2); /* component number */
183 bytestream2_put_byte(&pbc, 1 << 4 | 1); /* hsample/vsample */
184 bytestream2_put_byte(&pbc, nb_qtable == 2 ? 1 : 0); /* matrix number */
185 bytestream2_put_byte(&pbc, 3); /* component number */
186 bytestream2_put_byte(&pbc, 1 << 4 | 1); /* hsample/vsample */
187 bytestream2_put_byte(&pbc, nb_qtable == 2 ? 1 : 0); /* matrix number */
188
189 /* SOS */
190 jpeg_put_marker(&pbc, SOS);
191 bytestream2_put_be16(&pbc, 12);
192 bytestream2_put_byte(&pbc, 3);
193 bytestream2_put_byte(&pbc, 1);
194 bytestream2_put_byte(&pbc, 0);
195 bytestream2_put_byte(&pbc, 2);
196 bytestream2_put_byte(&pbc, 17);
197 bytestream2_put_byte(&pbc, 3);
198 bytestream2_put_byte(&pbc, 17);
199 bytestream2_put_byte(&pbc, 0);
200 bytestream2_put_byte(&pbc, 63);
201 bytestream2_put_byte(&pbc, 0);
202
203 /* Return the length in bytes of the JPEG header. */
204 return bytestream2_tell_p(&pbc);
205}
206
207static void create_default_qtables(uint8_t *qtables, uint8_t q)
208{
209 int factor = q;
210 int i;
211
212 factor = av_clip(q, 1, 99);
213
214 if (q < 50)
215 q = 5000 / factor;
216 else
217 q = 200 - factor * 2;
218
219 for (i = 0; i < 128; i++) {
220 int val = (default_quantizers[i] * q + 50) / 100;
221
222 /* Limit the quantizers to 1 <= q <= 255. */
223 val = av_clip(val, 1, 255);
224 qtables[i] = val;
225 }
226}
227
228static int jpeg_parse_packet(AVFormatContext *ctx, PayloadContext *jpeg,
229 AVStream *st, AVPacket *pkt, uint32_t *timestamp,
230 const uint8_t *buf, int len, uint16_t seq,
231 int flags)
232{
233 uint8_t type, q, width, height;
234 const uint8_t *qtables = NULL;
235 uint16_t qtable_len;
236 uint32_t off, dri;
237 int ret;
238
239 if (len < 8) {
240 av_log(ctx, AV_LOG_ERROR, "Too short RTP/JPEG packet.\n");
241 return AVERROR_INVALIDDATA;
242 }
243
244 /* Parse the main JPEG header. */
245 off = AV_RB24(buf + 1); /* fragment byte offset */
246 type = AV_RB8(buf + 4); /* id of jpeg decoder params */
247 q = AV_RB8(buf + 5); /* quantization factor (or table id) */
248 width = AV_RB8(buf + 6); /* frame width in 8 pixel blocks */
249 height = AV_RB8(buf + 7); /* frame height in 8 pixel blocks */
250 dri = 0;
251 buf += 8;
252 len -= 8;
253
254 /* Parse the restart marker header. */
255 /*
256 if (type > 63) {
257 av_log(ctx, AV_LOG_ERROR,
258 "Unimplemented RTP/JPEG restart marker header.\n");
259 return AVERROR_PATCHWELCOME;
260 }
261
262 if (type > 1) {
263 av_log(ctx, AV_LOG_ERROR, "Unimplemented RTP/JPEG type %d\n", type);
264 return AVERROR_PATCHWELCOME;
265 }
266 */
267 if(type > 63)
268 {
269 if (len < 4) {
270 av_log(ctx, AV_LOG_ERROR, "Too short RTP/JPEG packet.\n");
271 return AVERROR_INVALIDDATA;
272 }
273
274 dri = AV_RB16(buf);
275 buf += 4;
276 len -= 4;
277 }
278
279 type &= 1;
280
281 /* Parse the quantization table header. */
282 if (off == 0) {
283 /* Start of JPEG data packet. */
284 uint8_t new_qtables[128];
285 uint8_t hdr[1024];
286
287 if (q > 127) {
288 uint8_t precision;
289 if (len < 4) {
290 av_log(ctx, AV_LOG_ERROR, "Too short RTP/JPEG packet.\n");
291 return AVERROR_INVALIDDATA;
292 }
293
294 /* The first byte is reserved for future use. */
295 precision = AV_RB8(buf + 1); /* size of coefficients */
296 qtable_len = AV_RB16(buf + 2); /* length in bytes */
297 buf += 4;
298 len -= 4;
299
300 if (precision)
301 av_log(ctx, AV_LOG_WARNING, "Only 8-bit precision is supported.\n");
302
303 if (qtable_len > 0) {
304 if (len < qtable_len) {
305 av_log(ctx, AV_LOG_ERROR, "Too short RTP/JPEG packet.\n");
306 return AVERROR_INVALIDDATA;
307 }
308 qtables = buf;
309 buf += qtable_len;
310 len -= qtable_len;
311 if (q < 255) {
312 if (jpeg->qtables_len[q - 128] &&
313 (jpeg->qtables_len[q - 128] != qtable_len ||
314 memcmp(qtables, &jpeg->qtables[q - 128][0], qtable_len))) {
315 av_log(ctx, AV_LOG_WARNING,
316 "Quantization tables for q=%d changed\n", q);
317 } else if (!jpeg->qtables_len[q - 128] && qtable_len <= 128) {
318 memcpy(&jpeg->qtables[q - 128][0], qtables,
319 qtable_len);
320 jpeg->qtables_len[q - 128] = qtable_len;
321 }
322 }
323 } else {
324 if (q == 255) {
325 av_log(ctx, AV_LOG_ERROR,
326 "Invalid RTP/JPEG packet. Quantization tables not found.\n");
327 return AVERROR_INVALIDDATA;
328 }
329 if (!jpeg->qtables_len[q - 128]) {
330 av_log(ctx, AV_LOG_ERROR,
331 "No quantization tables known for q=%d yet.\n", q);
332 return AVERROR_INVALIDDATA;
333 }
334 qtables = &jpeg->qtables[q - 128][0];
335 qtable_len = jpeg->qtables_len[q - 128];
336 }
337 } else { /* q <= 127 */
338 if (q == 0 || q > 99) {
339 av_log(ctx, AV_LOG_ERROR, "Reserved q value %d\n", q);
340 return AVERROR_INVALIDDATA;
341 }
342 create_default_qtables(new_qtables, q);
343 qtables = new_qtables;
344 qtable_len = sizeof(new_qtables);
345 }
346
347 /* Skip the current frame in case of the end packet
348 * has been lost somewhere. */
349 free_frame_if_needed(jpeg);
350
351 if ((ret = avio_open_dyn_buf(&jpeg->frame)) < 0)
352 return ret;
353 jpeg->timestamp = *timestamp;
354
355 /* Generate a frame and scan headers that can be prepended to the
356 * RTP/JPEG data payload to produce a JPEG compressed image in
357 * interchange format. */
358 jpeg->hdr_size = jpeg_create_header(hdr, sizeof(hdr), type, width,
359 height, qtables,
360 qtable_len / 64, dri);
361
362 /* Copy JPEG header to frame buffer. */
363 avio_write(jpeg->frame, hdr, jpeg->hdr_size);
364 }
365
366 if (!jpeg->frame) {
367 av_log(ctx, AV_LOG_ERROR,
368 "Received packet without a start chunk; dropping frame.\n");
369 return AVERROR(EAGAIN);
370 }
371
372 if (jpeg->timestamp != *timestamp) {
373 /* Skip the current frame if timestamp is incorrect.
374 * A start packet has been lost somewhere. */
375 free_frame_if_needed(jpeg);
376 av_log(ctx, AV_LOG_ERROR, "RTP timestamps don't match.\n");
377 return AVERROR_INVALIDDATA;
378 }
379
380 if (off != avio_tell(jpeg->frame) - jpeg->hdr_size) {
381 av_log(ctx, AV_LOG_ERROR,
382 "Missing packets; dropping frame.\n");
383 return AVERROR(EAGAIN);
384 }
385
386 /* Copy data to frame buffer. */
387 avio_write(jpeg->frame, buf, len);
388
389 if (flags & RTP_FLAG_MARKER) {
390 /* End of JPEG data packet. */
391 uint8_t buf[2] = { 0xff, EOI };
392
393 /* Put EOI marker. */
394 avio_write(jpeg->frame, buf, sizeof(buf));
395
396 /* Prepare the JPEG packet. */
397 if ((ret = ff_rtp_finalize_packet(pkt, &jpeg->frame, st->index)) < 0) {
398 av_log(ctx, AV_LOG_ERROR,
399 "Error occurred when getting frame buffer.\n");
400 return ret;
401 }
402
403 return 0;
404 }
405
406 return AVERROR(EAGAIN);
407}
408
409RTPDynamicProtocolHandler ff_jpeg_dynamic_handler = {
410 .enc_name = "JPEG",
411 .codec_type = AVMEDIA_TYPE_VIDEO,
412 .codec_id = AV_CODEC_ID_MJPEG,
413 .alloc = jpeg_new_context,
414 .free = jpeg_free_context,
415 .parse_packet = jpeg_parse_packet,
416 .static_payload_id = 26,
417};