794 lines
21 KiB
C
794 lines
21 KiB
C
// SPDX-License-Identifier: GPL-2.0-only
|
|
/*
|
|
* V4L2 JPEG header parser helpers.
|
|
*
|
|
* Copyright (C) 2019 Pengutronix, Philipp Zabel <kernel@pengutronix.de>
|
|
*
|
|
* For reference, see JPEG ITU-T.81 (ISO/IEC 10918-1) [1]
|
|
*
|
|
* [1] https://www.w3.org/Graphics/JPEG/itu-t81.pdf
|
|
*/
|
|
|
|
#include <linux/unaligned.h>
|
|
#include <linux/errno.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/module.h>
|
|
#include <linux/types.h>
|
|
#include <media/v4l2-jpeg.h>
|
|
|
|
MODULE_DESCRIPTION("V4L2 JPEG header parser helpers");
|
|
MODULE_AUTHOR("Philipp Zabel <kernel@pengutronix.de>");
|
|
MODULE_LICENSE("GPL");
|
|
|
|
/* Table B.1 - Marker code assignments */
|
|
#define SOF0 0xffc0 /* start of frame */
|
|
#define SOF1 0xffc1
|
|
#define SOF2 0xffc2
|
|
#define SOF3 0xffc3
|
|
#define SOF5 0xffc5
|
|
#define SOF7 0xffc7
|
|
#define JPG 0xffc8 /* extensions */
|
|
#define SOF9 0xffc9
|
|
#define SOF11 0xffcb
|
|
#define SOF13 0xffcd
|
|
#define SOF15 0xffcf
|
|
#define DHT 0xffc4 /* huffman table */
|
|
#define DAC 0xffcc /* arithmetic coding conditioning */
|
|
#define RST0 0xffd0 /* restart */
|
|
#define RST7 0xffd7
|
|
#define SOI 0xffd8 /* start of image */
|
|
#define EOI 0xffd9 /* end of image */
|
|
#define SOS 0xffda /* start of stream */
|
|
#define DQT 0xffdb /* quantization table */
|
|
#define DNL 0xffdc /* number of lines */
|
|
#define DRI 0xffdd /* restart interval */
|
|
#define DHP 0xffde /* hierarchical progression */
|
|
#define EXP 0xffdf /* expand reference */
|
|
#define APP0 0xffe0 /* application data */
|
|
#define APP14 0xffee /* application data for colour encoding */
|
|
#define APP15 0xffef
|
|
#define JPG0 0xfff0 /* extensions */
|
|
#define JPG13 0xfffd
|
|
#define COM 0xfffe /* comment */
|
|
#define TEM 0xff01 /* temporary */
|
|
|
|
/* Luma and chroma qp tables to achieve 50% compression quality
|
|
* This is as per example in Annex K.1 of ITU-T.81
|
|
*/
|
|
const u8 v4l2_jpeg_ref_table_luma_qt[V4L2_JPEG_PIXELS_IN_BLOCK] = {
|
|
16, 11, 10, 16, 24, 40, 51, 61,
|
|
12, 12, 14, 19, 26, 58, 60, 55,
|
|
14, 13, 16, 24, 40, 57, 69, 56,
|
|
14, 17, 22, 29, 51, 87, 80, 62,
|
|
18, 22, 37, 56, 68, 109, 103, 77,
|
|
24, 35, 55, 64, 81, 104, 113, 92,
|
|
49, 64, 78, 87, 103, 121, 120, 101,
|
|
72, 92, 95, 98, 112, 100, 103, 99
|
|
};
|
|
EXPORT_SYMBOL_GPL(v4l2_jpeg_ref_table_luma_qt);
|
|
|
|
const u8 v4l2_jpeg_ref_table_chroma_qt[V4L2_JPEG_PIXELS_IN_BLOCK] = {
|
|
17, 18, 24, 47, 99, 99, 99, 99,
|
|
18, 21, 26, 66, 99, 99, 99, 99,
|
|
24, 26, 56, 99, 99, 99, 99, 99,
|
|
47, 66, 99, 99, 99, 99, 99, 99,
|
|
99, 99, 99, 99, 99, 99, 99, 99,
|
|
99, 99, 99, 99, 99, 99, 99, 99,
|
|
99, 99, 99, 99, 99, 99, 99, 99,
|
|
99, 99, 99, 99, 99, 99, 99, 99
|
|
};
|
|
EXPORT_SYMBOL_GPL(v4l2_jpeg_ref_table_chroma_qt);
|
|
|
|
/* Zigzag scan pattern indexes */
|
|
const u8 v4l2_jpeg_zigzag_scan_index[V4L2_JPEG_PIXELS_IN_BLOCK] = {
|
|
0, 1, 8, 16, 9, 2, 3, 10,
|
|
17, 24, 32, 25, 18, 11, 4, 5,
|
|
12, 19, 26, 33, 40, 48, 41, 34,
|
|
27, 20, 13, 6, 7, 14, 21, 28,
|
|
35, 42, 49, 56, 57, 50, 43, 36,
|
|
29, 22, 15, 23, 30, 37, 44, 51,
|
|
58, 59, 52, 45, 38, 31, 39, 46,
|
|
53, 60, 61, 54, 47, 55, 62, 63
|
|
};
|
|
EXPORT_SYMBOL_GPL(v4l2_jpeg_zigzag_scan_index);
|
|
|
|
/*
|
|
* Contains the data that needs to be sent in the marker segment of an
|
|
* interchange format JPEG stream or an abbreviated format table specification
|
|
* data stream. Specifies the huffman table used for encoding the luminance DC
|
|
* coefficient differences. The table represents Table K.3 of ITU-T.81
|
|
*/
|
|
const u8 v4l2_jpeg_ref_table_luma_dc_ht[V4L2_JPEG_REF_HT_DC_LEN] = {
|
|
0x00, 0x01, 0x05, 0x01, 0x01, 0x01, 0x01, 0x01,
|
|
0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
|
|
0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B
|
|
};
|
|
EXPORT_SYMBOL_GPL(v4l2_jpeg_ref_table_luma_dc_ht);
|
|
|
|
/*
|
|
* Contains the data that needs to be sent in the marker segment of an
|
|
* interchange format JPEG stream or an abbreviated format table specification
|
|
* data stream. Specifies the huffman table used for encoding the luminance AC
|
|
* coefficients. The table represents Table K.5 of ITU-T.81
|
|
*/
|
|
const u8 v4l2_jpeg_ref_table_luma_ac_ht[V4L2_JPEG_REF_HT_AC_LEN] = {
|
|
0x00, 0x02, 0x01, 0x03, 0x03, 0x02, 0x04, 0x03, 0x05, 0x05, 0x04, 0x04,
|
|
0x00, 0x00, 0x01, 0x7D, 0x01, 0x02, 0x03, 0x00, 0x04, 0x11, 0x05, 0x12,
|
|
0x21, 0x31, 0x41, 0x06, 0x13, 0x51, 0x61, 0x07, 0x22, 0x71, 0x14, 0x32,
|
|
0x81, 0x91, 0xA1, 0x08, 0x23, 0x42, 0xB1, 0xC1, 0x15, 0x52, 0xD1, 0xF0,
|
|
0x24, 0x33, 0x62, 0x72, 0x82, 0x09, 0x0A, 0x16, 0x17, 0x18, 0x19, 0x1A,
|
|
0x25, 0x26, 0x27, 0x28, 0x29, 0x2A, 0x34, 0x35, 0x36, 0x37, 0x38, 0x39,
|
|
0x3A, 0x43, 0x44, 0x45, 0x46, 0x47, 0x48, 0x49, 0x4A, 0x53, 0x54, 0x55,
|
|
0x56, 0x57, 0x58, 0x59, 0x5A, 0x63, 0x64, 0x65, 0x66, 0x67, 0x68, 0x69,
|
|
0x6A, 0x73, 0x74, 0x75, 0x76, 0x77, 0x78, 0x79, 0x7A, 0x83, 0x84, 0x85,
|
|
0x86, 0x87, 0x88, 0x89, 0x8A, 0x92, 0x93, 0x94, 0x95, 0x96, 0x97, 0x98,
|
|
0x99, 0x9A, 0xA2, 0xA3, 0xA4, 0xA5, 0xA6, 0xA7, 0xA8, 0xA9, 0xAA, 0xB2,
|
|
0xB3, 0xB4, 0xB5, 0xB6, 0xB7, 0xB8, 0xB9, 0xBA, 0xC2, 0xC3, 0xC4, 0xC5,
|
|
0xC6, 0xC7, 0xC8, 0xC9, 0xCA, 0xD2, 0xD3, 0xD4, 0xD5, 0xD6, 0xD7, 0xD8,
|
|
0xD9, 0xDA, 0xE1, 0xE2, 0xE3, 0xE4, 0xE5, 0xE6, 0xE7, 0xE8, 0xE9, 0xEA,
|
|
0xF1, 0xF2, 0xF3, 0xF4, 0xF5, 0xF6, 0xF7, 0xF8, 0xF9, 0xFA
|
|
};
|
|
EXPORT_SYMBOL_GPL(v4l2_jpeg_ref_table_luma_ac_ht);
|
|
|
|
/*
|
|
* Contains the data that needs to be sent in the marker segment of an interchange format JPEG
|
|
* stream or an abbreviated format table specification data stream.
|
|
* Specifies the huffman table used for encoding the chrominance DC coefficient differences.
|
|
* The table represents Table K.4 of ITU-T.81
|
|
*/
|
|
const u8 v4l2_jpeg_ref_table_chroma_dc_ht[V4L2_JPEG_REF_HT_DC_LEN] = {
|
|
0x00, 0x03, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01,
|
|
0x01, 0x01, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00,
|
|
0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0A, 0x0B
|
|
};
|
|
EXPORT_SYMBOL_GPL(v4l2_jpeg_ref_table_chroma_dc_ht);
|
|
|
|
/*
|
|
* Contains the data that needs to be sent in the marker segment of an
|
|
* interchange format JPEG stream or an abbreviated format table specification
|
|
* data stream. Specifies the huffman table used for encoding the chrominance
|
|
* AC coefficients. The table represents Table K.6 of ITU-T.81
|
|
*/
|
|
const u8 v4l2_jpeg_ref_table_chroma_ac_ht[V4L2_JPEG_REF_HT_AC_LEN] = {
|
|
0x00, 0x02, 0x01, 0x02, 0x04, 0x04, 0x03, 0x04, 0x07, 0x05, 0x04, 0x04,
|
|
0x00, 0x01, 0x02, 0x77, 0x00, 0x01, 0x02, 0x03, 0x11, 0x04, 0x05, 0x21,
|
|
0x31, 0x06, 0x12, 0x41, 0x51, 0x07, 0x61, 0x71, 0x13, 0x22, 0x32, 0x81,
|
|
0x08, 0x14, 0x42, 0x91, 0xA1, 0xB1, 0xC1, 0x09, 0x23, 0x33, 0x52, 0xF0,
|
|
0x15, 0x62, 0x72, 0xD1, 0x0A, 0x16, 0x24, 0x34, 0xE1, 0x25, 0xF1, 0x17,
|
|
0x18, 0x19, 0x1A, 0x26, 0x27, 0x28, 0x29, 0x2A, 0x35, 0x36, 0x37, 0x38,
|
|
0x39, 0x3A, 0x43, 0x44, 0x45, 0x46, 0x47, 0x48, 0x49, 0x4A, 0x53, 0x54,
|
|
0x55, 0x56, 0x57, 0x58, 0x59, 0x5A, 0x63, 0x64, 0x65, 0x66, 0x67, 0x68,
|
|
0x69, 0x6A, 0x73, 0x74, 0x75, 0x76, 0x77, 0x78, 0x79, 0x7A, 0x82, 0x83,
|
|
0x84, 0x85, 0x86, 0x87, 0x88, 0x89, 0x8A, 0x92, 0x93, 0x94, 0x95, 0x96,
|
|
0x97, 0x98, 0x99, 0x9A, 0xA2, 0xA3, 0xA4, 0xA5, 0xA6, 0xA7, 0xA8, 0xA9,
|
|
0xAA, 0xB2, 0xB3, 0xB4, 0xB5, 0xB6, 0xB7, 0xB8, 0xB9, 0xBA, 0xC2, 0xC3,
|
|
0xC4, 0xC5, 0xC6, 0xC7, 0xC8, 0xC9, 0xCA, 0xD2, 0xD3, 0xD4, 0xD5, 0xD6,
|
|
0xD7, 0xD8, 0xD9, 0xDA, 0xE2, 0xE3, 0xE4, 0xE5, 0xE6, 0xE7, 0xE8, 0xE9,
|
|
0xEA, 0xF2, 0xF3, 0xF4, 0xF5, 0xF6, 0xF7, 0xF8, 0xF9, 0xFA
|
|
};
|
|
EXPORT_SYMBOL_GPL(v4l2_jpeg_ref_table_chroma_ac_ht);
|
|
|
|
/**
|
|
* struct jpeg_stream - JPEG byte stream
|
|
* @curr: current position in stream
|
|
* @end: end position, after last byte
|
|
*/
|
|
struct jpeg_stream {
|
|
u8 *curr;
|
|
u8 *end;
|
|
};
|
|
|
|
/* returns a value that fits into u8, or negative error */
|
|
static int jpeg_get_byte(struct jpeg_stream *stream)
|
|
{
|
|
if (stream->curr >= stream->end)
|
|
return -EINVAL;
|
|
|
|
return *stream->curr++;
|
|
}
|
|
|
|
/* returns a value that fits into u16, or negative error */
|
|
static int jpeg_get_word_be(struct jpeg_stream *stream)
|
|
{
|
|
u16 word;
|
|
|
|
if (stream->curr + sizeof(__be16) > stream->end)
|
|
return -EINVAL;
|
|
|
|
word = get_unaligned_be16(stream->curr);
|
|
stream->curr += sizeof(__be16);
|
|
|
|
return word;
|
|
}
|
|
|
|
static int jpeg_skip(struct jpeg_stream *stream, size_t len)
|
|
{
|
|
if (stream->curr + len > stream->end)
|
|
return -EINVAL;
|
|
|
|
stream->curr += len;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int jpeg_next_marker(struct jpeg_stream *stream)
|
|
{
|
|
int byte;
|
|
u16 marker = 0;
|
|
|
|
while ((byte = jpeg_get_byte(stream)) >= 0) {
|
|
marker = (marker << 8) | byte;
|
|
/* skip stuffing bytes and REServed markers */
|
|
if (marker == TEM || (marker > 0xffbf && marker < 0xffff))
|
|
return marker;
|
|
}
|
|
|
|
return byte;
|
|
}
|
|
|
|
/* this does not advance the current position in the stream */
|
|
static int jpeg_reference_segment(struct jpeg_stream *stream,
|
|
struct v4l2_jpeg_reference *segment)
|
|
{
|
|
u16 len;
|
|
|
|
if (stream->curr + sizeof(__be16) > stream->end)
|
|
return -EINVAL;
|
|
|
|
len = get_unaligned_be16(stream->curr);
|
|
if (stream->curr + len > stream->end)
|
|
return -EINVAL;
|
|
|
|
segment->start = stream->curr;
|
|
segment->length = len;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int v4l2_jpeg_decode_subsampling(u8 nf, u8 h_v)
|
|
{
|
|
if (nf == 1)
|
|
return V4L2_JPEG_CHROMA_SUBSAMPLING_GRAY;
|
|
|
|
/* no chroma subsampling for 4-component images */
|
|
if (nf == 4 && h_v != 0x11)
|
|
return -EINVAL;
|
|
|
|
switch (h_v) {
|
|
case 0x11:
|
|
return V4L2_JPEG_CHROMA_SUBSAMPLING_444;
|
|
case 0x21:
|
|
return V4L2_JPEG_CHROMA_SUBSAMPLING_422;
|
|
case 0x22:
|
|
return V4L2_JPEG_CHROMA_SUBSAMPLING_420;
|
|
case 0x41:
|
|
return V4L2_JPEG_CHROMA_SUBSAMPLING_411;
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
}
|
|
|
|
static int jpeg_parse_frame_header(struct jpeg_stream *stream, u16 sof_marker,
|
|
struct v4l2_jpeg_frame_header *frame_header)
|
|
{
|
|
int len = jpeg_get_word_be(stream);
|
|
|
|
if (len < 0)
|
|
return len;
|
|
/* Lf = 8 + 3 * Nf, Nf >= 1 */
|
|
if (len < 8 + 3)
|
|
return -EINVAL;
|
|
|
|
if (frame_header) {
|
|
/* Table B.2 - Frame header parameter sizes and values */
|
|
int p, y, x, nf;
|
|
int i;
|
|
|
|
p = jpeg_get_byte(stream);
|
|
if (p < 0)
|
|
return p;
|
|
/*
|
|
* Baseline DCT only supports 8-bit precision.
|
|
* Extended sequential DCT also supports 12-bit precision.
|
|
*/
|
|
if (p != 8 && (p != 12 || sof_marker != SOF1))
|
|
return -EINVAL;
|
|
|
|
y = jpeg_get_word_be(stream);
|
|
if (y < 0)
|
|
return y;
|
|
if (y == 0)
|
|
return -EINVAL;
|
|
|
|
x = jpeg_get_word_be(stream);
|
|
if (x < 0)
|
|
return x;
|
|
if (x == 0)
|
|
return -EINVAL;
|
|
|
|
nf = jpeg_get_byte(stream);
|
|
if (nf < 0)
|
|
return nf;
|
|
/*
|
|
* The spec allows 1 <= Nf <= 255, but we only support up to 4
|
|
* components.
|
|
*/
|
|
if (nf < 1 || nf > V4L2_JPEG_MAX_COMPONENTS)
|
|
return -EINVAL;
|
|
if (len != 8 + 3 * nf)
|
|
return -EINVAL;
|
|
|
|
frame_header->precision = p;
|
|
frame_header->height = y;
|
|
frame_header->width = x;
|
|
frame_header->num_components = nf;
|
|
|
|
for (i = 0; i < nf; i++) {
|
|
struct v4l2_jpeg_frame_component_spec *component;
|
|
int c, h_v, tq;
|
|
|
|
c = jpeg_get_byte(stream);
|
|
if (c < 0)
|
|
return c;
|
|
|
|
h_v = jpeg_get_byte(stream);
|
|
if (h_v < 0)
|
|
return h_v;
|
|
if (i == 0) {
|
|
int subs;
|
|
|
|
subs = v4l2_jpeg_decode_subsampling(nf, h_v);
|
|
if (subs < 0)
|
|
return subs;
|
|
frame_header->subsampling = subs;
|
|
} else if (h_v != 0x11) {
|
|
/* all chroma sampling factors must be 1 */
|
|
return -EINVAL;
|
|
}
|
|
|
|
tq = jpeg_get_byte(stream);
|
|
if (tq < 0)
|
|
return tq;
|
|
|
|
component = &frame_header->component[i];
|
|
component->component_identifier = c;
|
|
component->horizontal_sampling_factor =
|
|
(h_v >> 4) & 0xf;
|
|
component->vertical_sampling_factor = h_v & 0xf;
|
|
component->quantization_table_selector = tq;
|
|
}
|
|
} else {
|
|
return jpeg_skip(stream, len - 2);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int jpeg_parse_scan_header(struct jpeg_stream *stream,
|
|
struct v4l2_jpeg_scan_header *scan_header)
|
|
{
|
|
size_t skip;
|
|
int len = jpeg_get_word_be(stream);
|
|
|
|
if (len < 0)
|
|
return len;
|
|
/* Ls = 8 + 3 * Ns, Ns >= 1 */
|
|
if (len < 6 + 2)
|
|
return -EINVAL;
|
|
|
|
if (scan_header) {
|
|
int ns;
|
|
int i;
|
|
|
|
ns = jpeg_get_byte(stream);
|
|
if (ns < 0)
|
|
return ns;
|
|
if (ns < 1 || ns > 4 || len != 6 + 2 * ns)
|
|
return -EINVAL;
|
|
|
|
scan_header->num_components = ns;
|
|
|
|
for (i = 0; i < ns; i++) {
|
|
struct v4l2_jpeg_scan_component_spec *component;
|
|
int cs, td_ta;
|
|
|
|
cs = jpeg_get_byte(stream);
|
|
if (cs < 0)
|
|
return cs;
|
|
|
|
td_ta = jpeg_get_byte(stream);
|
|
if (td_ta < 0)
|
|
return td_ta;
|
|
|
|
component = &scan_header->component[i];
|
|
component->component_selector = cs;
|
|
component->dc_entropy_coding_table_selector =
|
|
(td_ta >> 4) & 0xf;
|
|
component->ac_entropy_coding_table_selector =
|
|
td_ta & 0xf;
|
|
}
|
|
|
|
skip = 3; /* skip Ss, Se, Ah, and Al */
|
|
} else {
|
|
skip = len - 2;
|
|
}
|
|
|
|
return jpeg_skip(stream, skip);
|
|
}
|
|
|
|
/* B.2.4.1 Quantization table-specification syntax */
|
|
static int jpeg_parse_quantization_tables(struct jpeg_stream *stream,
|
|
u8 precision,
|
|
struct v4l2_jpeg_reference *tables)
|
|
{
|
|
int len = jpeg_get_word_be(stream);
|
|
|
|
if (len < 0)
|
|
return len;
|
|
/* Lq = 2 + n * 65 (for baseline DCT), n >= 1 */
|
|
if (len < 2 + 65)
|
|
return -EINVAL;
|
|
|
|
len -= 2;
|
|
while (len >= 65) {
|
|
u8 pq, tq, *qk;
|
|
int ret;
|
|
int pq_tq = jpeg_get_byte(stream);
|
|
|
|
if (pq_tq < 0)
|
|
return pq_tq;
|
|
|
|
/* quantization table element precision */
|
|
pq = (pq_tq >> 4) & 0xf;
|
|
/*
|
|
* Only 8-bit Qk values for 8-bit sample precision. Extended
|
|
* sequential DCT with 12-bit sample precision also supports
|
|
* 16-bit Qk values.
|
|
*/
|
|
if (pq != 0 && (pq != 1 || precision != 12))
|
|
return -EINVAL;
|
|
|
|
/* quantization table destination identifier */
|
|
tq = pq_tq & 0xf;
|
|
if (tq > 3)
|
|
return -EINVAL;
|
|
|
|
/* quantization table element */
|
|
qk = stream->curr;
|
|
ret = jpeg_skip(stream, pq ? 128 : 64);
|
|
if (ret < 0)
|
|
return -EINVAL;
|
|
|
|
if (tables) {
|
|
tables[tq].start = qk;
|
|
tables[tq].length = pq ? 128 : 64;
|
|
}
|
|
|
|
len -= pq ? 129 : 65;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* B.2.4.2 Huffman table-specification syntax */
|
|
static int jpeg_parse_huffman_tables(struct jpeg_stream *stream,
|
|
struct v4l2_jpeg_reference *tables)
|
|
{
|
|
int mt;
|
|
int len = jpeg_get_word_be(stream);
|
|
|
|
if (len < 0)
|
|
return len;
|
|
/* Table B.5 - Huffman table specification parameter sizes and values */
|
|
if (len < 2 + 17)
|
|
return -EINVAL;
|
|
|
|
for (len -= 2; len >= 17; len -= 17 + mt) {
|
|
u8 tc, th, *table;
|
|
int tc_th = jpeg_get_byte(stream);
|
|
int i, ret;
|
|
|
|
if (tc_th < 0)
|
|
return tc_th;
|
|
|
|
/* table class - 0 = DC, 1 = AC */
|
|
tc = (tc_th >> 4) & 0xf;
|
|
if (tc > 1)
|
|
return -EINVAL;
|
|
|
|
/* huffman table destination identifier */
|
|
th = tc_th & 0xf;
|
|
/* only two Huffman tables for baseline DCT */
|
|
if (th > 1)
|
|
return -EINVAL;
|
|
|
|
/* BITS - number of Huffman codes with length i */
|
|
table = stream->curr;
|
|
mt = 0;
|
|
for (i = 0; i < 16; i++) {
|
|
int li;
|
|
|
|
li = jpeg_get_byte(stream);
|
|
if (li < 0)
|
|
return li;
|
|
|
|
mt += li;
|
|
}
|
|
/* HUFFVAL - values associated with each Huffman code */
|
|
ret = jpeg_skip(stream, mt);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
if (tables) {
|
|
tables[(tc << 1) | th].start = table;
|
|
tables[(tc << 1) | th].length = stream->curr - table;
|
|
}
|
|
}
|
|
|
|
return jpeg_skip(stream, len - 2);
|
|
}
|
|
|
|
/* B.2.4.4 Restart interval definition syntax */
|
|
static int jpeg_parse_restart_interval(struct jpeg_stream *stream,
|
|
u16 *restart_interval)
|
|
{
|
|
int len = jpeg_get_word_be(stream);
|
|
int ri;
|
|
|
|
if (len < 0)
|
|
return len;
|
|
if (len != 4)
|
|
return -EINVAL;
|
|
|
|
ri = jpeg_get_word_be(stream);
|
|
if (ri < 0)
|
|
return ri;
|
|
|
|
*restart_interval = ri;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int jpeg_skip_segment(struct jpeg_stream *stream)
|
|
{
|
|
int len = jpeg_get_word_be(stream);
|
|
|
|
if (len < 0)
|
|
return len;
|
|
if (len < 2)
|
|
return -EINVAL;
|
|
|
|
return jpeg_skip(stream, len - 2);
|
|
}
|
|
|
|
/* Rec. ITU-T T.872 (06/2012) 6.5.3 */
|
|
static int jpeg_parse_app14_data(struct jpeg_stream *stream,
|
|
enum v4l2_jpeg_app14_tf *tf)
|
|
{
|
|
int ret;
|
|
int lp;
|
|
int skip;
|
|
|
|
lp = jpeg_get_word_be(stream);
|
|
if (lp < 0)
|
|
return lp;
|
|
|
|
/* Check for "Adobe\0" in Ap1..6 */
|
|
if (stream->curr + 6 > stream->end ||
|
|
strncmp(stream->curr, "Adobe\0", 6))
|
|
return jpeg_skip(stream, lp - 2);
|
|
|
|
/* get to Ap12 */
|
|
ret = jpeg_skip(stream, 11);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
ret = jpeg_get_byte(stream);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
*tf = ret;
|
|
|
|
/* skip the rest of the segment, this ensures at least it is complete */
|
|
skip = lp - 2 - 11 - 1;
|
|
return jpeg_skip(stream, skip);
|
|
}
|
|
|
|
/**
|
|
* v4l2_jpeg_parse_header - locate marker segments and optionally parse headers
|
|
* @buf: address of the JPEG buffer, should start with a SOI marker
|
|
* @len: length of the JPEG buffer
|
|
* @out: returns marker segment positions and optionally parsed headers
|
|
*
|
|
* The out->scan_header pointer must be initialized to NULL or point to a valid
|
|
* v4l2_jpeg_scan_header structure. The out->huffman_tables and
|
|
* out->quantization_tables pointers must be initialized to NULL or point to a
|
|
* valid array of 4 v4l2_jpeg_reference structures each.
|
|
*
|
|
* Returns 0 or negative error if parsing failed.
|
|
*/
|
|
int v4l2_jpeg_parse_header(void *buf, size_t len, struct v4l2_jpeg_header *out)
|
|
{
|
|
struct jpeg_stream stream;
|
|
int marker;
|
|
int ret = 0;
|
|
|
|
stream.curr = buf;
|
|
stream.end = stream.curr + len;
|
|
|
|
out->num_dht = 0;
|
|
out->num_dqt = 0;
|
|
|
|
/* the first bytes must be SOI, B.2.1 High-level syntax */
|
|
if (jpeg_get_word_be(&stream) != SOI)
|
|
return -EINVAL;
|
|
|
|
/* init value to signal if this marker is not present */
|
|
out->app14_tf = V4L2_JPEG_APP14_TF_UNKNOWN;
|
|
|
|
/* loop through marker segments */
|
|
while ((marker = jpeg_next_marker(&stream)) >= 0) {
|
|
switch (marker) {
|
|
/* baseline DCT, extended sequential DCT */
|
|
case SOF0 ... SOF1:
|
|
ret = jpeg_reference_segment(&stream, &out->sof);
|
|
if (ret < 0)
|
|
return ret;
|
|
ret = jpeg_parse_frame_header(&stream, marker,
|
|
&out->frame);
|
|
break;
|
|
/* progressive, lossless */
|
|
case SOF2 ... SOF3:
|
|
/* differential coding */
|
|
case SOF5 ... SOF7:
|
|
/* arithmetic coding */
|
|
case SOF9 ... SOF11:
|
|
case SOF13 ... SOF15:
|
|
case DAC:
|
|
case TEM:
|
|
return -EINVAL;
|
|
|
|
case DHT:
|
|
ret = jpeg_reference_segment(&stream,
|
|
&out->dht[out->num_dht++ % 4]);
|
|
if (ret < 0)
|
|
return ret;
|
|
if (!out->huffman_tables) {
|
|
ret = jpeg_skip_segment(&stream);
|
|
break;
|
|
}
|
|
ret = jpeg_parse_huffman_tables(&stream,
|
|
out->huffman_tables);
|
|
break;
|
|
case DQT:
|
|
ret = jpeg_reference_segment(&stream,
|
|
&out->dqt[out->num_dqt++ % 4]);
|
|
if (ret < 0)
|
|
return ret;
|
|
if (!out->quantization_tables) {
|
|
ret = jpeg_skip_segment(&stream);
|
|
break;
|
|
}
|
|
ret = jpeg_parse_quantization_tables(&stream,
|
|
out->frame.precision,
|
|
out->quantization_tables);
|
|
break;
|
|
case DRI:
|
|
ret = jpeg_parse_restart_interval(&stream,
|
|
&out->restart_interval);
|
|
break;
|
|
case APP14:
|
|
ret = jpeg_parse_app14_data(&stream,
|
|
&out->app14_tf);
|
|
break;
|
|
case SOS:
|
|
ret = jpeg_reference_segment(&stream, &out->sos);
|
|
if (ret < 0)
|
|
return ret;
|
|
ret = jpeg_parse_scan_header(&stream, out->scan);
|
|
/*
|
|
* stop parsing, the scan header marks the beginning of
|
|
* the entropy coded segment
|
|
*/
|
|
out->ecs_offset = stream.curr - (u8 *)buf;
|
|
return ret;
|
|
|
|
/* markers without parameters */
|
|
case RST0 ... RST7: /* restart */
|
|
case SOI: /* start of image */
|
|
case EOI: /* end of image */
|
|
break;
|
|
|
|
/* skip unknown or unsupported marker segments */
|
|
default:
|
|
ret = jpeg_skip_segment(&stream);
|
|
break;
|
|
}
|
|
if (ret < 0)
|
|
return ret;
|
|
}
|
|
|
|
return marker;
|
|
}
|
|
EXPORT_SYMBOL_GPL(v4l2_jpeg_parse_header);
|
|
|
|
/**
|
|
* v4l2_jpeg_parse_frame_header - parse frame header
|
|
* @buf: address of the frame header, after the SOF0 marker
|
|
* @len: length of the frame header
|
|
* @frame_header: returns the parsed frame header
|
|
*
|
|
* Returns 0 or negative error if parsing failed.
|
|
*/
|
|
int v4l2_jpeg_parse_frame_header(void *buf, size_t len,
|
|
struct v4l2_jpeg_frame_header *frame_header)
|
|
{
|
|
struct jpeg_stream stream;
|
|
|
|
stream.curr = buf;
|
|
stream.end = stream.curr + len;
|
|
return jpeg_parse_frame_header(&stream, SOF0, frame_header);
|
|
}
|
|
EXPORT_SYMBOL_GPL(v4l2_jpeg_parse_frame_header);
|
|
|
|
/**
|
|
* v4l2_jpeg_parse_scan_header - parse scan header
|
|
* @buf: address of the scan header, after the SOS marker
|
|
* @len: length of the scan header
|
|
* @scan_header: returns the parsed scan header
|
|
*
|
|
* Returns 0 or negative error if parsing failed.
|
|
*/
|
|
int v4l2_jpeg_parse_scan_header(void *buf, size_t len,
|
|
struct v4l2_jpeg_scan_header *scan_header)
|
|
{
|
|
struct jpeg_stream stream;
|
|
|
|
stream.curr = buf;
|
|
stream.end = stream.curr + len;
|
|
return jpeg_parse_scan_header(&stream, scan_header);
|
|
}
|
|
EXPORT_SYMBOL_GPL(v4l2_jpeg_parse_scan_header);
|
|
|
|
/**
|
|
* v4l2_jpeg_parse_quantization_tables - parse quantization tables segment
|
|
* @buf: address of the quantization table segment, after the DQT marker
|
|
* @len: length of the quantization table segment
|
|
* @precision: sample precision (P) in bits per component
|
|
* @q_tables: returns four references into the buffer for the
|
|
* four possible quantization table destinations
|
|
*
|
|
* Returns 0 or negative error if parsing failed.
|
|
*/
|
|
int v4l2_jpeg_parse_quantization_tables(void *buf, size_t len, u8 precision,
|
|
struct v4l2_jpeg_reference *q_tables)
|
|
{
|
|
struct jpeg_stream stream;
|
|
|
|
stream.curr = buf;
|
|
stream.end = stream.curr + len;
|
|
return jpeg_parse_quantization_tables(&stream, precision, q_tables);
|
|
}
|
|
EXPORT_SYMBOL_GPL(v4l2_jpeg_parse_quantization_tables);
|
|
|
|
/**
|
|
* v4l2_jpeg_parse_huffman_tables - parse huffman tables segment
|
|
* @buf: address of the Huffman table segment, after the DHT marker
|
|
* @len: length of the Huffman table segment
|
|
* @huffman_tables: returns four references into the buffer for the
|
|
* four possible Huffman table destinations, in
|
|
* the order DC0, DC1, AC0, AC1
|
|
*
|
|
* Returns 0 or negative error if parsing failed.
|
|
*/
|
|
int v4l2_jpeg_parse_huffman_tables(void *buf, size_t len,
|
|
struct v4l2_jpeg_reference *huffman_tables)
|
|
{
|
|
struct jpeg_stream stream;
|
|
|
|
stream.curr = buf;
|
|
stream.end = stream.curr + len;
|
|
return jpeg_parse_huffman_tables(&stream, huffman_tables);
|
|
}
|
|
EXPORT_SYMBOL_GPL(v4l2_jpeg_parse_huffman_tables);
|