mpv/libvo/jpeg_enc.c

900 lines
26 KiB
C
Raw Normal View History

/* Straightforward (to be) optimized JPEG encoder for the YUV422 format
* based on mjpeg code from ffmpeg.
*
* Copyright (c) 2002, Rik Snel
* Parts from ffmpeg Copyright (c) 2000, 2001 Gerard Lantau
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; either version 2 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program; if not, write to the Free Software
* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
*
* For an excellent introduction to the JPEG format, see:
* http://www.ece.purdue.edu/~bourman/grad-labs/lab8/pdf/lab.pdf
*/
/* stuff from libavcodec/common.h */
#include <sys/types.h>
#include <stdio.h>
#include <stdlib.h>
#include "config.h"
#ifdef USE_FASTMEMCPY
#include "fastmemcpy.h"
#endif
#include "../mp_msg.h"
#include "../libavcodec/common.h"
#include "../libavcodec/dsputil.h"
static int height, width, fields, cheap_upsample, qscale, bw = 0, first = 1;
/* from dsputils.c */
static DCTELEM **blck;
extern void (*av_fdct)(DCTELEM *b);
static UINT8 zr_zigzag_direct[64] = {
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
};
/* bit output */
static PutBitContext pb;
/* from mpegvideo.c */
#define QMAT_SHIFT 25
#define QMAT_SHIFT_MMX 19
static const unsigned short aanscales[64] = {
/* precomputed values scaled up by 14 bits */
16384, 22725, 21407, 19266, 16384, 12873, 8867, 4520,
22725, 31521, 29692, 26722, 22725, 17855, 12299, 6270,
21407, 29692, 27969, 25172, 21407, 16819, 11585, 5906,
19266, 26722, 25172, 22654, 19266, 15137, 10426, 5315,
16384, 22725, 21407, 19266, 16384, 12873, 8867, 4520,
12873, 17855, 16819, 15137, 12873, 10114, 6967, 3552,
8867, 12299, 11585, 10426, 8867, 6967, 4799, 2446,
4520, 6270, 5906, 5315, 4520, 3552, 2446, 1247
};
static unsigned int simple_mmx_permutation[64]={
0x00, 0x08, 0x01, 0x09, 0x04, 0x0C, 0x05, 0x0D,
0x10, 0x18, 0x11, 0x19, 0x14, 0x1C, 0x15, 0x1D,
0x02, 0x0A, 0x03, 0x0B, 0x06, 0x0E, 0x07, 0x0F,
0x12, 0x1A, 0x13, 0x1B, 0x16, 0x1E, 0x17, 0x1F,
0x20, 0x28, 0x21, 0x29, 0x24, 0x2C, 0x25, 0x2D,
0x30, 0x38, 0x31, 0x39, 0x34, 0x3C, 0x35, 0x3D,
0x22, 0x2A, 0x23, 0x2B, 0x26, 0x2E, 0x27, 0x2F,
0x32, 0x3A, 0x33, 0x3B, 0x36, 0x3E, 0x37, 0x3F,
};
#if 0
void block_permute(short int *block)
{
int tmp1, tmp2, tmp3, tmp4, tmp5, tmp6;
int i;
for(i=0;i<8;i++) {
tmp1 = block[1];
tmp2 = block[2];
tmp3 = block[3];
tmp4 = block[4];
tmp5 = block[5];
tmp6 = block[6];
block[1] = tmp2;
block[2] = tmp4;
block[3] = tmp6;
block[4] = tmp1;
block[5] = tmp3;
block[6] = tmp5;
block += 8;
}
}
#endif
static int q_intra_matrix[64];
static int dct_quantize(DCTELEM *block, int n,
int qscale)
{
int i, j, level, last_non_zero, q;
const int *qmat;
av_fdct (block);
/* we need this permutation so that we correct the IDCT
permutation. will be moved into DCT code */
//block_permute(block);
/*if (n < 4)
q = s->y_dc_scale;
else
q = s->c_dc_scale;
q = q << 3;*/
q = 64;
/* note: block[0] is assumed to be positive */
block[0] = (block[0] + (q >> 1)) / q;
i = 1;
last_non_zero = 0;
qmat = q_intra_matrix;
for(;i<64;i++) {
j = zr_zigzag_direct[i];
level = block[j];
level = level * qmat[j];
/* XXX: slight error for the low range. Test should be equivalent to
(level <= -(1 << (QMAT_SHIFT - 3)) || level >= (1 <<
(QMAT_SHIFT - 3)))
*/
if (((level << (31 - (QMAT_SHIFT - 3))) >> (31 - (QMAT_SHIFT - 3))) !=
level) {
level = level / (1 << (QMAT_SHIFT - 3));
/* XXX: currently, this code is not optimal. the range should be:
mpeg1: -255..255
mpeg2: -2048..2047
h263: -128..127
mpeg4: -2048..2047
*/
if (level > 255)
level = 255;
else if (level < -255)
level = -255;
block[j] = level;
last_non_zero = i;
} else {
block[j] = 0;
}
}
return last_non_zero;
}
static int dct_quantize_mmx(DCTELEM *block, int n, int qscale)
{
int i, j, level, last_non_zero, q;
const int *qmat;
DCTELEM *b = block;
/*for (i = 0; i < 8; i++) {
printf("%i %i %i %i %i %i %i %i\n", b[8*i], b[8*i+1], b[8*i+2],
b[8*i+3], b[8*i+4], b[8*i+5], b[8*i+6], b[8*i+7]);
}*/
av_fdct (block);
/*for (i = 0; i < 8; i++) {
printf("%i %i %i %i %i %i %i %i\n", b[8*i], b[8*i+1], b[8*i+2],
b[8*i+3], b[8*i+4], b[8*i+5], b[8*i+6], b[8*i+7]);
}*/
/* we need this permutation so that we correct the IDCT
permutation. will be moved into DCT code */
//block_permute(block);
//if (n < 2)
q = 8;
/*else
q = 8;*/
/* note: block[0] is assumed to be positive */
block[0] = (block[0] + (q >> 1)) / q;
i = 1;
last_non_zero = 0;
qmat = q_intra_matrix;
for(;i<64;i++) {
j = zr_zigzag_direct[i];
level = block[j];
level = level * qmat[j];
/* XXX: slight error for the low range. Test should be equivalent to
(level <= -(1 << (QMAT_SHIFT_MMX - 3)) || level >= (1 <<
(QMAT_SHIFT_MMX - 3)))
*/
if (((level << (31 - (QMAT_SHIFT_MMX - 3))) >> (31 - (QMAT_SHIFT_MMX - 3))) !=
level) {
level = level / (1 << (QMAT_SHIFT_MMX - 3));
/* XXX: currently, this code is not optimal. the range should be:
mpeg1: -255..255
mpeg2: -2048..2047
h263: -128..127
mpeg4: -2048..2047
* jpeg: -1024..1023 11 bit */
if (level > 1023)
level = 1023;
else if (level < -1024)
level = -1024;
block[j] = level;
last_non_zero = i;
} else {
block[j] = 0;
}
}
/*for (i = 0; i < 8; i++) {
printf("%i %i %i %i %i %i %i %i\n", b[8*i], b[8*i+1], b[8*i+2],
b[8*i+3], b[8*i+4], b[8*i+5], b[8*i+6], b[8*i+7]);
}*/
return last_non_zero;
}
static void convert_matrix(int *qmat, const unsigned short *quant_matrix,
int qscale)
{
int i;
if (av_fdct == jpeg_fdct_ifast) {
for(i=0;i<64;i++) {
/* 16 <= qscale * quant_matrix[i] <= 7905 */
/* 19952 <= aanscales[i] * qscale * quant_matrix[i] <= 249205026 */
qmat[i] = (int)(((unsigned long long)1 << (QMAT_SHIFT + 11)) /
(aanscales[i] * qscale * quant_matrix[i]));
}
} else {
for(i=0;i<64;i++) {
/* We can safely suppose that 16 <= quant_matrix[i] <= 255
So 16 <= qscale * quant_matrix[i] <= 7905
so (1 << QMAT_SHIFT) / 16 >= qmat[i] >= (1 << QMAT_SHIFT) / 7905
*/
qmat[i] = (1 << QMAT_SHIFT_MMX) / (qscale * quant_matrix[i]);
}
}
}
#define SOF0 0xC0
#define SOI 0xD8
#define EOI 0xD9
#define DQT 0xDB
#define DHT 0xC4
#define SOS 0xDA
/* this is almost the quantisation table, used for luminance and chrominance */
/*short int zr_default_intra_matrix[64] = {
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
};*/
/*
short int default_intra_matrix[64] = {
8, 16, 19, 22, 26, 27, 29, 34,
16, 16, 22, 24, 27, 29, 34, 37,
19, 22, 26, 27, 29, 34, 34, 38,
22, 22, 26, 27, 29, 34, 37, 40,
22, 26, 27, 29, 32, 35, 40, 48,
26, 27, 29, 32, 35, 40, 48, 58,
26, 27, 29, 34, 38, 46, 56, 69,
27, 29, 35, 38, 46, 56, 69, 83
};
*/
extern short int default_intra_matrix[64];
static short int intra_matrix[64];
/* Set up the standard Huffman tables (cf. JPEG standard section K.3) */
/* IMPORTANT: these are only valid for 8-bit data precision! */
static const unsigned char bits_dc_luminance[17] =
{ /* 0-base */ 0, 0, 1, 5, 1, 1, 1, 1, 1, 1, 0, 0, 0, 0, 0, 0, 0 };
static const unsigned char val_dc_luminance[] =
{ 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11 };
#if 0
static const unsigned char bits_dc_chrominance[17] =
{ /* 0-base */ 0, 0, 3, 1, 1, 1, 1, 1, 1, 1, 1, 1, 0, 0, 0, 0, 0 };
static const unsigned char val_dc_chrominance[] =
{ 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11 };
#endif
static const unsigned char bits_ac_luminance[17] =
{ /* 0-base */ 0, 0, 2, 1, 3, 3, 2, 4, 3, 5, 5, 4, 4, 0, 0, 1, 0x7d };
static const unsigned char val_ac_luminance[] =
{ 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
};
#if 0
static const unsigned char bits_ac_chrominance[17] =
{ /* 0-base */ 0, 0, 2, 1, 2, 4, 4, 3, 4, 7, 5, 4, 4, 0, 1, 2, 0x77 };
static const unsigned char val_ac_chrominance[] =
{ 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
};
#endif
static unsigned char huff_size_dc_luminance[12];
static unsigned short huff_code_dc_luminance[12];
#if 0
unsigned char huff_size_dc_chrominance[12];
unsigned short huff_code_dc_chrominance[12];
#endif
static unsigned char huff_size_ac_luminance[256];
static unsigned short huff_code_ac_luminance[256];
#if 0
unsigned char huff_size_ac_chrominance[256];
unsigned short huff_code_ac_chrominance[256];
#endif
static int last_dc[3];
static int block_last_index[4];
/* isn't this function nicer than the one in the libjpeg ? */
static void build_huffman_codes(unsigned char *huff_size,
unsigned short *huff_code, const unsigned char *bits_table,
const unsigned char *val_table)
{
int i, j, k,nb, code, sym;
code = 0;
k = 0;
for(i=1;i<=16;i++) {
nb = bits_table[i];
for(j=0;j<nb;j++) {
sym = val_table[k++];
huff_size[sym] = i;
huff_code[sym] = code;
code++;
}
code <<= 1;
}
}
static int zr_mjpeg_init()
{
/* build all the huffman tables */
build_huffman_codes(huff_size_dc_luminance, huff_code_dc_luminance,
bits_dc_luminance, val_dc_luminance);
//build_huffman_codes(huff_size_dc_chrominance, huff_code_dc_chrominance,
// bits_dc_chrominance, val_dc_chrominance);
build_huffman_codes(huff_size_ac_luminance, huff_code_ac_luminance,
bits_ac_luminance, val_ac_luminance);
//build_huffman_codes(huff_size_ac_chrominance, huff_code_ac_chrominance,
// bits_ac_chrominance, val_ac_chrominance);
return 0;
}
static void zr_mjpeg_close()
{
}
static inline void put_marker(PutBitContext *p, int code)
{
put_bits(p, 8, 0xff);
put_bits(p, 8, code);
}
/* table_class: 0 = DC coef, 1 = AC coefs */
static int put_huffman_table(int table_class, int table_id,
const unsigned char *bits_table,
const unsigned char *value_table)
{
PutBitContext *p = &pb;
int n, i;
put_bits(p, 4, table_class);
put_bits(p, 4, table_id);
n = 0;
for(i=1;i<=16;i++) {
n += bits_table[i];
put_bits(p, 8, bits_table[i]);
}
for(i=0;i<n;i++)
put_bits(p, 8, value_table[i]);
return n + 17;
}
static void jpeg_qtable_header()
{
PutBitContext *p = &pb;
int i, j, size;
/* quant matrixes */
put_marker(p, DQT);
put_bits(p, 16, 2 + 1 * (1 + 64));
put_bits(p, 4, 0); /* 8 bit precision */
put_bits(p, 4, 0); /* table 0 */
for(i=0;i<64;i++) {
j = zr_zigzag_direct[i];
put_bits(p, 8, intra_matrix[j]);
}
}
static void jpeg_htable_header() {
PutBitContext *p = &pb;
int i, j, size;
unsigned char *ptr;
/* huffman table */
put_marker(p, DHT);
flush_put_bits(p);
ptr = p->buf_ptr;
put_bits(p, 16, 0); /* patched later */
size = 2;
size += put_huffman_table(0, 0, bits_dc_luminance, val_dc_luminance);
// size += put_huffman_table(0, 1, bits_dc_chrominance, val_dc_chrominance);
ptr[0] = size >> 8;
ptr[1] = size;
put_marker(p, DHT);
flush_put_bits(p);
ptr = p->buf_ptr;
put_bits(p, 16, 0); /* patched later */
size = 2;
size += put_huffman_table(1, 0, bits_ac_luminance, val_ac_luminance);
// size += put_huffman_table(1, 1, bits_ac_chrominance, val_ac_chrominance);
ptr[0] = size >> 8;
ptr[1] = size;
}
static void zr_mjpeg_picture_header()
{
put_marker(&pb, SOI);
if (first) {
jpeg_qtable_header();
jpeg_htable_header();
first = 0;
}
put_marker(&pb, SOF0);
put_bits(&pb, 16, 17);
put_bits(&pb, 8, 8); /* 8 bits/component */
put_bits(&pb, 16, height);
put_bits(&pb, 16, width);
put_bits(&pb, 8, 3); /* 3 components */
/* Y component */
put_bits(&pb, 8, 0); /* component number */
put_bits(&pb, 4, 2); /* H factor */
put_bits(&pb, 4, 1); /* V factor */
put_bits(&pb, 8, 0); /* select matrix */
/* Cb component */
put_bits(&pb, 8, 1); /* component number */
put_bits(&pb, 4, 1); /* H factor */
put_bits(&pb, 4, 1); /* V factor */
put_bits(&pb, 8, 0); /* select matrix */
/* Cr component */
put_bits(&pb, 8, 2); /* component number */
put_bits(&pb, 4, 1); /* H factor */
put_bits(&pb, 4, 1); /* V factor */
put_bits(&pb, 8, 0); /* select matrix */
/* scan header */
put_marker(&pb, SOS);
put_bits(&pb, 16, 12); /* length */
put_bits(&pb, 8, 3); /* 3 components */
/* Y component */
put_bits(&pb, 8, 0); /* index */
put_bits(&pb, 4, 0); /* DC huffman table index */
put_bits(&pb, 4, 0); /* AC huffman table index */
/* Cb component */
put_bits(&pb, 8, 1); /* index */
put_bits(&pb, 4, 0); /* DC huffman table index */
put_bits(&pb, 4, 0); /* AC huffman table index */
/* Cr component */
put_bits(&pb, 8, 2); /* index */
put_bits(&pb, 4, 0); /* DC huffman table index */
put_bits(&pb, 4, 0); /* AC huffman table index */
put_bits(&pb, 8, 0); /* Ss (not used) */
put_bits(&pb, 8, 63); /* Se (not used) */
put_bits(&pb, 8, 0); /* (not used) */
}
static void zr_flush_buffer(PutBitContext *s)
{
int size;
if (s->write_data) {
size = s->buf_ptr - s->buf;
if (size > 0)
s->write_data(s->opaque, s->buf, size);
s->buf_ptr = s->buf;
s->data_out_size += size;
}
}
/* pad the end of the output stream with ones */
static void zr_jflush_put_bits(PutBitContext *s)
{
unsigned int b;
s->bit_buf |= ~1U >> s->bit_cnt; /* set all the unused bits to one */
while (s->bit_cnt > 0) {
b = s->bit_buf >> 24;
*s->buf_ptr++ = b;
if (b == 0xff)
*s->buf_ptr++ = 0;
s->bit_buf<<=8;
s->bit_cnt-=8;
}
zr_flush_buffer(s);
s->bit_cnt=0;
s->bit_buf=0;
}
static void zr_mjpeg_picture_trailer()
{
zr_jflush_put_bits(&pb);
put_marker(&pb, EOI);
}
static inline void encode_dc(int val, unsigned char *huff_size,
unsigned short *huff_code)
{
int mant, nbits;
if (val == 0) {
// printf("dc val=0 ");
jput_bits(&pb, huff_size[0], huff_code[0]);
//printf("dc encoding %d %d\n", huff_size[0], huff_code[0]);
} else {
mant = val;
if (val < 0) {
val = -val;
mant--;
}
/* compute the log (XXX: optimize) */
nbits = 0;
while (val != 0) {
val = val >> 1;
nbits++;
}
/*nbits = av_log2(val);*/
//printf("dc ");
jput_bits(&pb, huff_size[nbits], huff_code[nbits]);
//printf("dc encoding %d %d\n", huff_size[nbits], huff_code[nbits]);
//printf("dc ");
jput_bits(&pb, nbits, mant & ((1 << nbits) - 1));
//printf("dc encoding %d %d\n", huff_size[nbits], huff_code[nbits]);
}
}
static void encode_block(DCTELEM *b, int n)
{
int mant, nbits, code, i, j;
int component, dc, run, last_index, val;
unsigned char *huff_size_ac;
unsigned short *huff_code_ac;
/* DC coef */
component = (n <= 1 ? 0 : n - 2 + 1);
dc = b[0]; /* overflow is impossible */
/*for (i = 0; i < 8; i++) {
printf("%i %i %i %i %i %i %i %i\n", b[8*i], b[8*i+1], b[8*i+2],
b[8*i+3], b[8*i+4], b[8+i*5], b[8+i*6], b[8+i*7]);
}*/
val = dc - last_dc[component];
//if (n < 2) {
encode_dc(val, huff_size_dc_luminance, huff_code_dc_luminance);
huff_size_ac = huff_size_ac_luminance;
huff_code_ac = huff_code_ac_luminance;
//} else {
// encode_dc(val, huff_size_dc_chrominance, huff_code_dc_chrominance);
// huff_size_ac = huff_size_ac_chrominance;
// huff_code_ac = huff_code_ac_chrominance;
//}
last_dc[component] = dc;
/* AC coefs */
run = 0;
last_index = block_last_index[n];
for(i=1;i<=last_index;i++) {
j = zr_zigzag_direct[i];
val = b[j];
if (val == 0) {
run++;
} else {
while (run >= 16) {
//printf("ac 16 white ");
jput_bits(&pb, huff_size_ac[0xf0], huff_code_ac[0xf0]);
run -= 16;
}
mant = val;
if (val < 0) {
val = -val;
mant--;
}
/* compute the log (XXX: optimize) */
nbits = 0;
while (val != 0) {
val = val >> 1;
nbits++;
}
code = (run << 4) | nbits;
//printf("ac ");
jput_bits(&pb, huff_size_ac[code], huff_code_ac[code]);
//printf("ac ");
jput_bits(&pb, nbits, mant & ((1 << nbits) - 1));
run = 0;
}
}
/* output EOB only if not already 64 values */
if (last_index < 63 || run != 0) {
//printf("ac EOB ");
jput_bits(&pb, huff_size_ac[0], huff_code_ac[0]);
}
}
static void zr_mjpeg_encode_mb(DCTELEM **bla)
{
encode_block(*(bla), 0);
encode_block(*(bla+1), 1);
if (bw) {
jput_bits(&pb, 12, 512+128+8+2); /* 2 times code for 'no color'
* 001010001010 */
} else {
encode_block(*(bla+2), 2);
encode_block(*(bla+3), 3);
}
}
static int mb_width, mb_height, mb_x, mb_y;
static unsigned char *y_data, *u_data, *v_data;
static int y_ps, u_ps, v_ps, y_rs, u_rs, v_rs;
static char code[256*1024]; // 256kb!
/* this function can take all kinds of YUV colorspaces
* YV12, YVYU, UYVY. The necesary parameters must be set up by te caller
* y_ps means "y pixel size", y_rs means "y row size".
* For YUYV, for example, is u = y + 1, v = y + 3, y_ps = 2, u_ps = 4
* v_ps = 4, y_rs = u_rs = v_rs.
*
* The data is straightened out at the moment it is put in DCT
* blocks, there are therefore no spurious memcopies involved */
/* Notice that w must be a multiple of 16 and h must be a multiple of
* fields*8 */
/* We produce YUV422 jpegs, the colors must be subsampled horizontally,
* if the colors are also subsampled vertically, then this function
* performs cheap upsampling (better solution will be: a DCT that is
* optimized in the case that every two rows are the same) */
/* cu = 0 means 'No cheap upsampling'
* cu = 1 means 'perform cheap upsampling' */
void mjpeg_encoder_init(int w, int h,
unsigned char* y, int y_psize, int y_rsize,
unsigned char* u, int u_psize, int u_rsize,
unsigned char* v, int v_psize, int v_rsize,
int f, int cu, int q, int b) {
int i;
mp_msg(MSGT_VO, MSGL_V, "JPEnc init: %dx%d %p %d %d %p %d %d %p %d %d\n",
w, h, y, y_psize, y_rsize,
u, u_psize, u_rsize,
v, v_psize, v_rsize);
y_data = y; u_data = u; v_data = v;
y_ps = y_psize; u_ps = u_psize; v_ps = v_psize;
y_rs = y_rsize*f;
u_rs = u_rsize*f;
v_rs = v_rsize*f;
width = w;
height = h/f;
fields = f;
qscale = q;
cheap_upsample = cu;
mb_width = width/16;
mb_height = height/8;
bw = b;
zr_mjpeg_init();
i = 0;
intra_matrix[0] = default_intra_matrix[0];
for (i = 1; i < 64; i++) {
intra_matrix[i] = (default_intra_matrix[i]*qscale) >> 3;
}
if (
#ifdef HAVE_MMX
av_fdct != fdct_mmx &&
#endif
av_fdct != jpeg_fdct_ifast) {
/* libavcodec is probably not yet initialized */
av_fdct = jpeg_fdct_ifast;
#ifdef HAVE_MMX
dsputil_init_mmx();
#endif
}
convert_matrix(q_intra_matrix, intra_matrix, 8);
blck = malloc(4*sizeof(DCTELEM*));
blck[0] = malloc(64*sizeof(DCTELEM));
blck[1] = malloc(64*sizeof(DCTELEM));
blck[2] = malloc(64*sizeof(DCTELEM));
blck[3] = malloc(64*sizeof(DCTELEM));
}
int mjpeg_encode_frame(char *bufr, int field) {
int i, j, k, l;
short int *dest;
unsigned char *source;
/* initialize the buffer */
if (field == 1) {
y_data += y_rs/2;
u_data += u_rs/2;
v_data += v_rs/2;
}
init_put_bits(&pb, bufr, 1024*256, NULL, NULL);
zr_mjpeg_picture_header();
last_dc[0] = 128; last_dc[1] = 128; last_dc[2] = 128;
mb_x = 0;
mb_y = 0;
for (mb_y = 0; mb_y < mb_height; mb_y++) {
for (mb_x = 0; mb_x < mb_width; mb_x++) {
//printf("Processing macroblock mb_x=%d, mb_y=%d, mb_width=%d, mb_height=%d, size=%d\n", mb_x, mb_y, mb_width, mb_height, pb.buf_ptr - pb.buf);
/* fill 2 Y macroblocks and one U and one V */
source = mb_y * 8 * y_rs + 16 * y_ps * mb_x + y_data;
dest = blck[0];
for (i = 0; i < 8; i++) {
for (j = 0; j < 8; j++) {
dest[j] = source[j*y_ps];
}
dest += 8;
source += y_rs;
}
source = mb_y * 8 * y_rs + (16*mb_x + 8)*y_ps + y_data;
dest = blck[1];
for (i = 0; i < 8; i++) {
for (j = 0; j < 8; j++) {
dest[j] = source[j*y_ps];
}
dest += 8;
source += y_rs;
}
if (!bw) {
if (cheap_upsample) {
source = mb_y*4*u_rs + 8*mb_x*u_ps + u_data;
dest = blck[2];
for (i = 0; i < 4; i++) {
for (j = 0; j < 8; j++) {
dest[j] = source[j*u_ps];
dest[j+8] = source[j*u_ps];
}
dest += 16;
source += u_rs;
}
source = mb_y*4*v_rs + 8*mb_x*v_ps + v_data;
dest = blck[3];
for (i = 0; i < 4; i++) {
for (j = 0; j < 8; j++) {
dest[j] = source[j*v_ps];
dest[j+8] = source[j*v_ps];
}
dest += 16;
source += u_rs;
}
} else {
source = mb_y*8*u_rs + 8*mb_x*u_ps + u_data;
dest = blck[2];
for (i = 0; i < 8; i++) {
for (j = 0; j < 8; j++) {
dest[j] = source[j*u_ps];
}
dest += 8;
source += u_rs;
}
source = mb_y*8*v_rs + 8*mb_x*v_ps + v_data;
dest = blck[3];
for (i = 0; i < 8; i++) {
for (j = 0; j < 8; j++) {
dest[j] = source[j*v_ps];
}
dest += 8;
source += u_rs;
}
}
}
/* so, **blck is filled now... */
for(i = 0; i < 2; i++) {
if (av_fdct == jpeg_fdct_ifast)
block_last_index[i] =
dct_quantize(blck[i],
i, qscale);
else
block_last_index[i] =
dct_quantize_mmx(blck[i],
i, qscale);
}
if (!bw) {
for(i = 2; i < 4; i++) {
if (av_fdct == jpeg_fdct_ifast)
block_last_index[i] =
dct_quantize(blck[i],
i, qscale);
else
block_last_index[i] =
dct_quantize_mmx(blck[i],
i, qscale);
}
}
zr_mjpeg_encode_mb(blck);
}
}
emms_c();
zr_mjpeg_picture_trailer();
flush_put_bits(&pb);
zr_mjpeg_close();
if (field == 1) {
y_data -= y_rs/2;
u_data -= u_rs/2;
v_data -= v_rs/2;
}
return pb.buf_ptr - pb.buf;
}