4xm.c 27.6 KB
Newer Older
Michael Niedermayer's avatar
Michael Niedermayer committed
1 2 3 4
/*
 * 4XM codec
 * Copyright (c) 2003 Michael Niedermayer
 *
5
 * This file is part of Libav.
6
 *
7
 * Libav is free software; you can redistribute it and/or
Michael Niedermayer's avatar
Michael Niedermayer committed
8 9
 * modify it under the terms of the GNU Lesser General Public
 * License as published by the Free Software Foundation; either
10
 * version 2.1 of the License, or (at your option) any later version.
Michael Niedermayer's avatar
Michael Niedermayer committed
11
 *
12
 * Libav is distributed in the hope that it will be useful,
Michael Niedermayer's avatar
Michael Niedermayer committed
13 14 15 16 17
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * Lesser General Public License for more details.
 *
 * You should have received a copy of the GNU Lesser General Public
18
 * License along with Libav; if not, write to the Free Software
19
 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
Michael Niedermayer's avatar
Michael Niedermayer committed
20
 */
21

Michael Niedermayer's avatar
Michael Niedermayer committed
22
/**
23
 * @file
Michael Niedermayer's avatar
Michael Niedermayer committed
24 25
 * 4XM codec.
 */
26

27
#include "libavutil/intreadwrite.h"
Michael Niedermayer's avatar
Michael Niedermayer committed
28 29
#include "avcodec.h"
#include "dsputil.h"
30
#include "get_bits.h"
31
#include "bytestream.h"
Michael Niedermayer's avatar
Michael Niedermayer committed
32 33 34 35 36 37 38 39 40

//#undef NDEBUG
//#include <assert.h>

#define BLOCK_TYPE_VLC_BITS 5
#define ACDC_VLC_BITS 9

#define CFRAME_BUFFER_COUNT 100

41 42
static const uint8_t block_type_tab[2][4][8][2]={
 {
Michael Niedermayer's avatar
Michael Niedermayer committed
43 44 45 46 47 48 49 50 51
  {   //{8,4,2}x{8,4,2}
    { 0,1}, { 2,2}, { 6,3}, {14,4}, {30,5}, {31,5}, { 0,0}
  },{ //{8,4}x1
    { 0,1}, { 0,0}, { 2,2}, { 6,3}, {14,4}, {15,4}, { 0,0}
  },{ //1x{8,4}
    { 0,1}, { 2,2}, { 0,0}, { 6,3}, {14,4}, {15,4}, { 0,0}
  },{ //1x2, 2x1
    { 0,1}, { 0,0}, { 0,0}, { 2,2}, { 6,3}, {14,4}, {15,4}
  }
52 53 54 55 56 57 58 59 60 61 62
 },{
  {  //{8,4,2}x{8,4,2}
    { 1,2}, { 4,3}, { 5,3}, {0,2}, {6,3}, {7,3}, {0,0}
  },{//{8,4}x1
    { 1,2}, { 0,0}, { 2,2}, {0,2}, {6,3}, {7,3}, {0,0}
  },{//1x{8,4}
    { 1,2}, { 2,2}, { 0,0}, {0,2}, {6,3}, {7,3}, {0,0}
  },{//1x2, 2x1
    { 1,2}, { 0,0}, { 0,0}, {0,2}, {2,2}, {6,3}, {7,3}
  }
 }
Michael Niedermayer's avatar
Michael Niedermayer committed
63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118
};

static const uint8_t size2index[4][4]={
  {-1, 3, 1, 1},
  { 3, 0, 0, 0},
  { 2, 0, 0, 0},
  { 2, 0, 0, 0},
};

static const int8_t mv[256][2]={
{  0,  0},{  0, -1},{ -1,  0},{  1,  0},{  0,  1},{ -1, -1},{  1, -1},{ -1,  1},
{  1,  1},{  0, -2},{ -2,  0},{  2,  0},{  0,  2},{ -1, -2},{  1, -2},{ -2, -1},
{  2, -1},{ -2,  1},{  2,  1},{ -1,  2},{  1,  2},{ -2, -2},{  2, -2},{ -2,  2},
{  2,  2},{  0, -3},{ -3,  0},{  3,  0},{  0,  3},{ -1, -3},{  1, -3},{ -3, -1},
{  3, -1},{ -3,  1},{  3,  1},{ -1,  3},{  1,  3},{ -2, -3},{  2, -3},{ -3, -2},
{  3, -2},{ -3,  2},{  3,  2},{ -2,  3},{  2,  3},{  0, -4},{ -4,  0},{  4,  0},
{  0,  4},{ -1, -4},{  1, -4},{ -4, -1},{  4, -1},{  4,  1},{ -1,  4},{  1,  4},
{ -3, -3},{ -3,  3},{  3,  3},{ -2, -4},{ -4, -2},{  4, -2},{ -4,  2},{ -2,  4},
{  2,  4},{ -3, -4},{  3, -4},{  4, -3},{ -5,  0},{ -4,  3},{ -3,  4},{  3,  4},
{ -1, -5},{ -5, -1},{ -5,  1},{ -1,  5},{ -2, -5},{  2, -5},{  5, -2},{  5,  2},
{ -4, -4},{ -4,  4},{ -3, -5},{ -5, -3},{ -5,  3},{  3,  5},{ -6,  0},{  0,  6},
{ -6, -1},{ -6,  1},{  1,  6},{  2, -6},{ -6,  2},{  2,  6},{ -5, -4},{  5,  4},
{  4,  5},{ -6, -3},{  6,  3},{ -7,  0},{ -1, -7},{  5, -5},{ -7,  1},{ -1,  7},
{  4, -6},{  6,  4},{ -2, -7},{ -7,  2},{ -3, -7},{  7, -3},{  3,  7},{  6, -5},
{  0, -8},{ -1, -8},{ -7, -4},{ -8,  1},{  4,  7},{  2, -8},{ -2,  8},{  6,  6},
{ -8,  3},{  5, -7},{ -5,  7},{  8, -4},{  0, -9},{ -9, -1},{  1,  9},{  7, -6},
{ -7,  6},{ -5, -8},{ -5,  8},{ -9,  3},{  9, -4},{  7, -7},{  8, -6},{  6,  8},
{ 10,  1},{-10,  2},{  9, -5},{ 10, -3},{ -8, -7},{-10, -4},{  6, -9},{-11,  0},
{ 11,  1},{-11, -2},{ -2, 11},{  7, -9},{ -7,  9},{ 10,  6},{ -4, 11},{  8, -9},
{  8,  9},{  5, 11},{  7,-10},{ 12, -3},{ 11,  6},{ -9, -9},{  8, 10},{  5, 12},
{-11,  7},{ 13,  2},{  6,-12},{ 10,  9},{-11,  8},{ -7, 12},{  0, 14},{ 14, -2},
{ -9, 11},{ -6, 13},{-14, -4},{ -5,-14},{  5, 14},{-15, -1},{-14, -6},{  3,-15},
{ 11,-11},{ -7, 14},{ -5, 15},{  8,-14},{ 15,  6},{  3, 16},{  7,-15},{-16,  5},
{  0, 17},{-16, -6},{-10, 14},{-16,  7},{ 12, 13},{-16,  8},{-17,  6},{-18,  3},
{ -7, 17},{ 15, 11},{ 16, 10},{  2,-19},{  3,-19},{-11,-16},{-18,  8},{-19, -6},
{  2,-20},{-17,-11},{-10,-18},{  8, 19},{-21, -1},{-20,  7},{ -4, 21},{ 21,  5},
{ 15, 16},{  2,-22},{-10,-20},{-22,  5},{ 20,-11},{ -7,-22},{-12, 20},{ 23, -5},
{ 13,-20},{ 24, -2},{-15, 19},{-11, 22},{ 16, 19},{ 23,-10},{-18,-18},{ -9,-24},
{ 24,-10},{ -3, 26},{-23, 13},{-18,-20},{ 17, 21},{ -4, 27},{ 27,  6},{  1,-28},
{-11, 26},{-17,-23},{  7, 28},{ 11,-27},{ 29,  5},{-23,-19},{-28,-11},{-21, 22},
{-30,  7},{-17, 26},{-27, 16},{ 13, 29},{ 19,-26},{ 10,-31},{-14,-30},{ 20,-27},
{-29, 18},{-16,-31},{-28,-22},{ 21,-30},{-25, 28},{ 26,-29},{ 25,-32},{-32,-32}
};

// this is simply the scaled down elementwise product of the standard jpeg quantizer table and the AAN premul table
static const uint8_t dequant_table[64]={
 16, 15, 13, 19, 24, 31, 28, 17,
 17, 23, 25, 31, 36, 63, 45, 21,
 18, 24, 27, 37, 52, 59, 49, 20,
 16, 28, 34, 40, 60, 80, 51, 20,
 18, 31, 48, 66, 68, 86, 56, 21,
 19, 38, 56, 59, 64, 64, 48, 20,
 27, 48, 55, 55, 56, 51, 35, 15,
 20, 35, 34, 32, 31, 22, 15,  8,
};

119
static VLC block_type_vlc[2][4];
Michael Niedermayer's avatar
Michael Niedermayer committed
120 121 122


typedef struct CFrameBuffer{
123 124
    unsigned int allocated_size;
    unsigned int size;
Michael Niedermayer's avatar
Michael Niedermayer committed
125 126 127 128 129 130 131 132 133 134
    int id;
    uint8_t *data;
}CFrameBuffer;

typedef struct FourXContext{
    AVCodecContext *avctx;
    DSPContext dsp;
    AVFrame current_picture, last_picture;
    GetBitContext pre_gb;          ///< ac/dc prefix
    GetBitContext gb;
135 136
    GetByteContext g;
    GetByteContext g2;
Michael Niedermayer's avatar
Michael Niedermayer committed
137 138 139
    int mv[256];
    VLC pre_vlc;
    int last_dc;
140
    DECLARE_ALIGNED(16, DCTELEM, block)[6][64];
141
    void *bitstream_buffer;
142
    unsigned int bitstream_buffer_size;
143
    int version;
Michael Niedermayer's avatar
Michael Niedermayer committed
144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160
    CFrameBuffer cfrm[CFRAME_BUFFER_COUNT];
} FourXContext;


#define FIX_1_082392200  70936
#define FIX_1_414213562  92682
#define FIX_1_847759065 121095
#define FIX_2_613125930 171254

#define MULTIPLY(var,const)  (((var)*(const)) >> 16)

static void idct(DCTELEM block[64]){
    int tmp0, tmp1, tmp2, tmp3, tmp4, tmp5, tmp6, tmp7;
    int tmp10, tmp11, tmp12, tmp13;
    int z5, z10, z11, z12, z13;
    int i;
    int temp[64];
161

Michael Niedermayer's avatar
Michael Niedermayer committed
162 163 164 165 166 167 168 169 170 171 172
    for(i=0; i<8; i++){
        tmp10 = block[8*0 + i] + block[8*4 + i];
        tmp11 = block[8*0 + i] - block[8*4 + i];

        tmp13 =          block[8*2 + i] + block[8*6 + i];
        tmp12 = MULTIPLY(block[8*2 + i] - block[8*6 + i], FIX_1_414213562) - tmp13;

        tmp0 = tmp10 + tmp13;
        tmp3 = tmp10 - tmp13;
        tmp1 = tmp11 + tmp12;
        tmp2 = tmp11 - tmp12;
173

Michael Niedermayer's avatar
Michael Niedermayer committed
174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198
        z13 = block[8*5 + i] + block[8*3 + i];
        z10 = block[8*5 + i] - block[8*3 + i];
        z11 = block[8*1 + i] + block[8*7 + i];
        z12 = block[8*1 + i] - block[8*7 + i];

        tmp7  =          z11 + z13;
        tmp11 = MULTIPLY(z11 - z13, FIX_1_414213562);

        z5    = MULTIPLY(z10 + z12, FIX_1_847759065);
        tmp10 = MULTIPLY(z12, FIX_1_082392200) - z5;
        tmp12 = MULTIPLY(z10, - FIX_2_613125930) + z5;

        tmp6 = tmp12 - tmp7;
        tmp5 = tmp11 - tmp6;
        tmp4 = tmp10 + tmp5;

        temp[8*0 + i] = tmp0 + tmp7;
        temp[8*7 + i] = tmp0 - tmp7;
        temp[8*1 + i] = tmp1 + tmp6;
        temp[8*6 + i] = tmp1 - tmp6;
        temp[8*2 + i] = tmp2 + tmp5;
        temp[8*5 + i] = tmp2 - tmp5;
        temp[8*4 + i] = tmp3 + tmp4;
        temp[8*3 + i] = tmp3 - tmp4;
    }
199

Michael Niedermayer's avatar
Michael Niedermayer committed
200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238
    for(i=0; i<8*8; i+=8){
        tmp10 = temp[0 + i] + temp[4 + i];
        tmp11 = temp[0 + i] - temp[4 + i];

        tmp13 = temp[2 + i] + temp[6 + i];
        tmp12 = MULTIPLY(temp[2 + i] - temp[6 + i], FIX_1_414213562) - tmp13;

        tmp0 = tmp10 + tmp13;
        tmp3 = tmp10 - tmp13;
        tmp1 = tmp11 + tmp12;
        tmp2 = tmp11 - tmp12;

        z13 = temp[5 + i] + temp[3 + i];
        z10 = temp[5 + i] - temp[3 + i];
        z11 = temp[1 + i] + temp[7 + i];
        z12 = temp[1 + i] - temp[7 + i];

        tmp7 = z11 + z13;
        tmp11 = MULTIPLY(z11 - z13, FIX_1_414213562);

        z5 = MULTIPLY(z10 + z12, FIX_1_847759065);
        tmp10 = MULTIPLY(z12, FIX_1_082392200) - z5;
        tmp12 = MULTIPLY(z10, - FIX_2_613125930) + z5;

        tmp6 = tmp12 - tmp7;
        tmp5 = tmp11 - tmp6;
        tmp4 = tmp10 + tmp5;

        block[0 + i] = (tmp0 + tmp7)>>6;
        block[7 + i] = (tmp0 - tmp7)>>6;
        block[1 + i] = (tmp1 + tmp6)>>6;
        block[6 + i] = (tmp1 - tmp6)>>6;
        block[2 + i] = (tmp2 + tmp5)>>6;
        block[5 + i] = (tmp2 - tmp5)>>6;
        block[4 + i] = (tmp3 + tmp4)>>6;
        block[3 + i] = (tmp3 - tmp4)>>6;
    }
}

239
static av_cold void init_vlcs(FourXContext *f){
240
    static VLC_TYPE table[8][32][2];
Michael Niedermayer's avatar
Michael Niedermayer committed
241 242
    int i;

243
    for(i=0; i<8; i++){
244 245
        block_type_vlc[0][i].table= table[i];
        block_type_vlc[0][i].table_allocated= 32;
246 247
        init_vlc(&block_type_vlc[0][i], BLOCK_TYPE_VLC_BITS, 7,
                 &block_type_tab[0][i][0][1], 2, 1,
248
                 &block_type_tab[0][i][0][0], 2, 1, INIT_VLC_USE_NEW_STATIC);
Michael Niedermayer's avatar
Michael Niedermayer committed
249 250 251 252 253 254 255
    }
}

static void init_mv(FourXContext *f){
    int i;

    for(i=0; i<256; i++){
256
        if(f->version>1)
257 258 259
            f->mv[i] = mv[i][0]   + mv[i][1]  *f->current_picture.linesize[0]/2;
        else
            f->mv[i] = (i&15) - 8 + ((i>>4)-8)*f->current_picture.linesize[0]/2;
Michael Niedermayer's avatar
Michael Niedermayer committed
260 261 262
    }
}

263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279
#if HAVE_BIGENDIAN
#define LE_CENTRIC_MUL(dst, src, scale, dc) \
    { \
        unsigned tmpval = AV_RN32(src);                 \
        tmpval = (tmpval <<  16) | (tmpval >>  16);     \
        tmpval = tmpval * (scale) + (dc);               \
        tmpval = (tmpval <<  16) | (tmpval >>  16);     \
        AV_WN32A(dst, tmpval);                          \
    }
#else
#define LE_CENTRIC_MUL(dst, src, scale, dc) \
    { \
        unsigned tmpval = AV_RN32(src) * (scale) + (dc); \
        AV_WN32A(dst, tmpval);                           \
    }
#endif

Mans Rullgard's avatar
Mans Rullgard committed
280
static inline void mcdc(uint16_t *dst, uint16_t *src, int log2w, int h, int stride, int scale, unsigned dc){
Michael Niedermayer's avatar
Michael Niedermayer committed
281 282 283 284 285 286 287 288 289 290 291 292 293
   int i;
   dc*= 0x10001;

   switch(log2w){
   case 0:
        for(i=0; i<h; i++){
            dst[0] = scale*src[0] + dc;
            if(scale) src += stride;
            dst += stride;
        }
        break;
    case 1:
        for(i=0; i<h; i++){
294
            LE_CENTRIC_MUL(dst, src, scale, dc);
Michael Niedermayer's avatar
Michael Niedermayer committed
295 296 297 298 299 300
            if(scale) src += stride;
            dst += stride;
        }
        break;
    case 2:
        for(i=0; i<h; i++){
301 302
            LE_CENTRIC_MUL(dst,     src,     scale, dc);
            LE_CENTRIC_MUL(dst + 2, src + 2, scale, dc);
Michael Niedermayer's avatar
Michael Niedermayer committed
303 304 305 306 307 308
            if(scale) src += stride;
            dst += stride;
        }
        break;
    case 3:
        for(i=0; i<h; i++){
309 310 311 312
            LE_CENTRIC_MUL(dst,     src,     scale, dc);
            LE_CENTRIC_MUL(dst + 2, src + 2, scale, dc);
            LE_CENTRIC_MUL(dst + 4, src + 4, scale, dc);
            LE_CENTRIC_MUL(dst + 6, src + 6, scale, dc);
Michael Niedermayer's avatar
Michael Niedermayer committed
313 314 315 316 317 318 319 320 321 322 323
            if(scale) src += stride;
            dst += stride;
        }
        break;
    default: assert(0);
    }
}

static void decode_p_block(FourXContext *f, uint16_t *dst, uint16_t *src, int log2w, int log2h, int stride){
    const int index= size2index[log2h][log2w];
    const int h= 1<<log2h;
324
    int code= get_vlc2(&f->gb, block_type_vlc[1-(f->version>1)][index].table, BLOCK_TYPE_VLC_BITS, 1);
325
    uint16_t *start= (uint16_t*)f->last_picture.data[0];
326
    uint16_t *end= start + stride*(f->avctx->height-h+1) - (1<<log2w);
327

Michael Niedermayer's avatar
Michael Niedermayer committed
328 329 330
    assert(code>=0 && code<=6);

    if(code == 0){
331
        src += f->mv[bytestream2_get_byte(&f->g)];
332 333 334 335
        if(start > src || src > end){
            av_log(f->avctx, AV_LOG_ERROR, "mv out of pic\n");
            return;
        }
Michael Niedermayer's avatar
Michael Niedermayer committed
336 337 338 339 340 341 342 343 344
        mcdc(dst, src, log2w, h, stride, 1, 0);
    }else if(code == 1){
        log2h--;
        decode_p_block(f, dst                  , src                  , log2w, log2h, stride);
        decode_p_block(f, dst + (stride<<log2h), src + (stride<<log2h), log2w, log2h, stride);
    }else if(code == 2){
        log2w--;
        decode_p_block(f, dst             , src             , log2w, log2h, stride);
        decode_p_block(f, dst + (1<<log2w), src + (1<<log2w), log2w, log2h, stride);
345
    }else if(code == 3 && f->version<2){
346
        mcdc(dst, src, log2w, h, stride, 1, 0);
Michael Niedermayer's avatar
Michael Niedermayer committed
347
    }else if(code == 4){
348
        src += f->mv[bytestream2_get_byte(&f->g)];
349 350 351 352
        if(start > src || src > end){
            av_log(f->avctx, AV_LOG_ERROR, "mv out of pic\n");
            return;
        }
353
        mcdc(dst, src, log2w, h, stride, 1, bytestream2_get_le16(&f->g2));
Michael Niedermayer's avatar
Michael Niedermayer committed
354
    }else if(code == 5){
355
        mcdc(dst, src, log2w, h, stride, 0, bytestream2_get_le16(&f->g2));
Michael Niedermayer's avatar
Michael Niedermayer committed
356 357
    }else if(code == 6){
        if(log2w){
358 359
            dst[0] = bytestream2_get_le16(&f->g2);
            dst[1] = bytestream2_get_le16(&f->g2);
Michael Niedermayer's avatar
Michael Niedermayer committed
360
        }else{
361 362
            dst[0     ] = bytestream2_get_le16(&f->g2);
            dst[stride] = bytestream2_get_le16(&f->g2);
Michael Niedermayer's avatar
Michael Niedermayer committed
363 364 365 366
        }
    }
}

Michael Niedermayer's avatar
Michael Niedermayer committed
367
static int decode_p_frame(FourXContext *f, const uint8_t *buf, int length){
Michael Niedermayer's avatar
Michael Niedermayer committed
368 369 370 371 372 373
    int x, y;
    const int width= f->avctx->width;
    const int height= f->avctx->height;
    uint16_t *src= (uint16_t*)f->last_picture.data[0];
    uint16_t *dst= (uint16_t*)f->current_picture.data[0];
    const int stride= f->current_picture.linesize[0]>>1;
374
    unsigned int bitstream_size, bytestream_size, wordstream_size, extra, bytestream_offset, wordstream_offset;
375

376
    if(f->version>1){
377
        extra=20;
378 379 380
        bitstream_size= AV_RL32(buf+8);
        wordstream_size= AV_RL32(buf+12);
        bytestream_size= AV_RL32(buf+16);
381 382 383 384 385 386
    }else{
        extra=0;
        bitstream_size = AV_RL16(buf-4);
        wordstream_size= AV_RL16(buf-2);
        bytestream_size= FFMAX(length - bitstream_size - wordstream_size, 0);
    }
387

388
    if(bitstream_size+ bytestream_size+ wordstream_size + extra != length
389 390 391 392
       || bitstream_size  > (1<<26)
       || bytestream_size > (1<<26)
       || wordstream_size > (1<<26)
       ){
393
        av_log(f->avctx, AV_LOG_ERROR, "lengths %d %d %d %d\n", bitstream_size, bytestream_size, wordstream_size,
Michael Niedermayer's avatar
Michael Niedermayer committed
394
        bitstream_size+ bytestream_size+ wordstream_size - length);
395 396
        return -1;
    }
397

398 399 400
    av_fast_malloc(&f->bitstream_buffer, &f->bitstream_buffer_size, bitstream_size + FF_INPUT_BUFFER_PADDING_SIZE);
    if (!f->bitstream_buffer)
        return AVERROR(ENOMEM);
401
    f->dsp.bswap_buf(f->bitstream_buffer, (const uint32_t*)(buf + extra), bitstream_size/4);
402
    memset((uint8_t*)f->bitstream_buffer + bitstream_size, 0, FF_INPUT_BUFFER_PADDING_SIZE);
Michael Niedermayer's avatar
Michael Niedermayer committed
403 404
    init_get_bits(&f->gb, f->bitstream_buffer, 8*bitstream_size);

405 406 407 408
    wordstream_offset = extra + bitstream_size;
    bytestream_offset = extra + bitstream_size + wordstream_size;
    bytestream2_init(&f->g2, buf + wordstream_offset, length - wordstream_offset);
    bytestream2_init(&f->g,  buf + bytestream_offset, length - bytestream_offset);
409

Michael Niedermayer's avatar
Michael Niedermayer committed
410
    init_mv(f);
411

Michael Niedermayer's avatar
Michael Niedermayer committed
412 413 414 415
    for(y=0; y<height; y+=8){
        for(x=0; x<width; x+=8){
            decode_p_block(f, dst + x, src + x, 3, 3, stride);
        }
416 417
        src += 8*stride;
        dst += 8*stride;
Michael Niedermayer's avatar
Michael Niedermayer committed
418
    }
419

Michael Niedermayer's avatar
Michael Niedermayer committed
420 421 422 423 424
    return 0;
}

/**
 * decode block and dequantize.
Diego Biurrun's avatar
Diego Biurrun committed
425
 * Note this is almost identical to MJPEG.
Michael Niedermayer's avatar
Michael Niedermayer committed
426 427 428 429 430 431 432
 */
static int decode_i_block(FourXContext *f, DCTELEM *block){
    int code, i, j, level, val;

    /* DC coef */
    val = get_vlc2(&f->pre_gb, f->pre_vlc.table, ACDC_VLC_BITS, 3);
    if (val>>4){
433
        av_log(f->avctx, AV_LOG_ERROR, "error dc run != 0\n");
Michael Niedermayer's avatar
Michael Niedermayer committed
434 435 436 437 438 439 440 441 442 443 444 445
    }

    if(val)
        val = get_xbits(&f->gb, val);

    val = val * dequant_table[0] + f->last_dc;
    f->last_dc =
    block[0] = val;
    /* AC coefs */
    i = 1;
    for(;;) {
        code = get_vlc2(&f->pre_gb, f->pre_vlc.table, ACDC_VLC_BITS, 3);
446

Michael Niedermayer's avatar
Michael Niedermayer committed
447 448 449 450 451 452 453 454 455
        /* EOB */
        if (code == 0)
            break;
        if (code == 0xf0) {
            i += 16;
        } else {
            level = get_xbits(&f->gb, code & 0xf);
            i += code >> 4;
            if (i >= 64) {
456
                av_log(f->avctx, AV_LOG_ERROR, "run %d oveflow\n", i);
Michael Niedermayer's avatar
Michael Niedermayer committed
457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475
                return 0;
            }

            j= ff_zigzag_direct[i];
            block[j] = level * dequant_table[j];
            i++;
            if (i >= 64)
                break;
        }
    }

    return 0;
}

static inline void idct_put(FourXContext *f, int x, int y){
    DCTELEM (*block)[64]= f->block;
    int stride= f->current_picture.linesize[0]>>1;
    int i;
    uint16_t *dst = ((uint16_t*)f->current_picture.data[0]) + y * stride + x;
476

477 478 479 480
    for(i=0; i<4; i++){
        block[i][0] += 0x80*8*8;
        idct(block[i]);
    }
Michael Niedermayer's avatar
Michael Niedermayer committed
481

482 483 484
    if(!(f->avctx->flags&CODEC_FLAG_GRAY)){
        for(i=4; i<6; i++) idct(block[i]);
    }
Michael Niedermayer's avatar
Michael Niedermayer committed
485

486 487 488 489
/* Note transform is:
y= ( 1b + 4g + 2r)/14
cb=( 3b - 2g - 1r)/14
cr=(-1b - 4g + 5r)/14
490
*/
Michael Niedermayer's avatar
Michael Niedermayer committed
491 492 493
    for(y=0; y<8; y++){
        for(x=0; x<8; x++){
            DCTELEM *temp= block[(x>>2) + 2*(y>>2)] + 2*(x&3) + 2*8*(y&3); //FIXME optimize
494 495
            int cb= block[4][x + 8*y];
            int cr= block[5][x + 8*y];
Michael Niedermayer's avatar
Michael Niedermayer committed
496 497
            int cg= (cb + cr)>>1;
            int y;
498

499
            cb+=cb;
500

Michael Niedermayer's avatar
Michael Niedermayer committed
501
            y = temp[0];
502
            dst[0       ]= ((y+cb)>>3) + (((y-cg)&0xFC)<<3) + (((y+cr)&0xF8)<<8);
Michael Niedermayer's avatar
Michael Niedermayer committed
503
            y = temp[1];
504
            dst[1       ]= ((y+cb)>>3) + (((y-cg)&0xFC)<<3) + (((y+cr)&0xF8)<<8);
Michael Niedermayer's avatar
Michael Niedermayer committed
505
            y = temp[8];
506
            dst[  stride]= ((y+cb)>>3) + (((y-cg)&0xFC)<<3) + (((y+cr)&0xF8)<<8);
Michael Niedermayer's avatar
Michael Niedermayer committed
507
            y = temp[9];
508
            dst[1+stride]= ((y+cb)>>3) + (((y-cg)&0xFC)<<3) + (((y+cr)&0xF8)<<8);
Michael Niedermayer's avatar
Michael Niedermayer committed
509 510 511 512 513 514 515 516
            dst += 2;
        }
        dst += 2*stride - 2*8;
    }
}

static int decode_i_mb(FourXContext *f){
    int i;
517

Michael Niedermayer's avatar
Michael Niedermayer committed
518
    f->dsp.clear_blocks(f->block[0]);
519

Michael Niedermayer's avatar
Michael Niedermayer committed
520 521 522 523
    for(i=0; i<6; i++){
        if(decode_i_block(f, f->block[i]) < 0)
            return -1;
    }
524

Michael Niedermayer's avatar
Michael Niedermayer committed
525 526 527
    return 0;
}

Michael Niedermayer's avatar
Michael Niedermayer committed
528
static const uint8_t *read_huffman_tables(FourXContext *f, const uint8_t * const buf){
Michael Niedermayer's avatar
Michael Niedermayer committed
529 530 531 532 533 534
    int frequency[512];
    uint8_t flag[512];
    int up[512];
    uint8_t len_tab[257];
    int bits_tab[257];
    int start, end;
Michael Niedermayer's avatar
Michael Niedermayer committed
535
    const uint8_t *ptr= buf;
Michael Niedermayer's avatar
Michael Niedermayer committed
536
    int j;
537

Michael Niedermayer's avatar
Michael Niedermayer committed
538 539 540 541 542 543 544
    memset(frequency, 0, sizeof(frequency));
    memset(up, -1, sizeof(up));

    start= *ptr++;
    end= *ptr++;
    for(;;){
        int i;
545

Michael Niedermayer's avatar
Michael Niedermayer committed
546 547 548 549 550
        for(i=start; i<=end; i++){
            frequency[i]= *ptr++;
        }
        start= *ptr++;
        if(start==0) break;
551

Michael Niedermayer's avatar
Michael Niedermayer committed
552 553 554 555
        end= *ptr++;
    }
    frequency[256]=1;

556
    while((ptr - buf)&3) ptr++; // 4byte align
Michael Niedermayer's avatar
Michael Niedermayer committed
557 558

    for(j=257; j<512; j++){
559 560
        int min_freq[2]= {256*256, 256*256};
        int smallest[2]= {0, 0};
Michael Niedermayer's avatar
Michael Niedermayer committed
561 562 563
        int i;
        for(i=0; i<j; i++){
            if(frequency[i] == 0) continue;
564 565 566 567 568 569 570
            if(frequency[i] < min_freq[1]){
                if(frequency[i] < min_freq[0]){
                    min_freq[1]= min_freq[0]; smallest[1]= smallest[0];
                    min_freq[0]= frequency[i];smallest[0]= i;
                }else{
                    min_freq[1]= frequency[i];smallest[1]= i;
                }
Michael Niedermayer's avatar
Michael Niedermayer committed
571 572
            }
        }
573
        if(min_freq[1] == 256*256) break;
574

575
        frequency[j]= min_freq[0] + min_freq[1];
Michael Niedermayer's avatar
Michael Niedermayer committed
576 577
        flag[ smallest[0] ]= 0;
        flag[ smallest[1] ]= 1;
578
        up[ smallest[0] ]=
Michael Niedermayer's avatar
Michael Niedermayer committed
579 580 581 582 583 584 585 586 587 588 589 590
        up[ smallest[1] ]= j;
        frequency[ smallest[0] ]= frequency[ smallest[1] ]= 0;
    }

    for(j=0; j<257; j++){
        int node;
        int len=0;
        int bits=0;

        for(node= j; up[node] != -1; node= up[node]){
            bits += flag[node]<<len;
            len++;
591
            if(len > 31) av_log(f->avctx, AV_LOG_ERROR, "vlc length overflow\n"); //can this happen at all ?
Michael Niedermayer's avatar
Michael Niedermayer committed
592
        }
593

Michael Niedermayer's avatar
Michael Niedermayer committed
594 595 596
        bits_tab[j]= bits;
        len_tab[j]= len;
    }
597

598 599 600 601
    if (init_vlc(&f->pre_vlc, ACDC_VLC_BITS, 257,
                 len_tab , 1, 1,
                 bits_tab, 4, 4, 0))
        return NULL;
602

Michael Niedermayer's avatar
Michael Niedermayer committed
603 604 605
    return ptr;
}

606 607 608 609 610 611 612
static int mix(int c0, int c1){
    int blue = 2*(c0&0x001F) + (c1&0x001F);
    int green= (2*(c0&0x03E0) + (c1&0x03E0))>>5;
    int red  = 2*(c0>>10) + (c1>>10);
    return red/3*1024 + green/3*32 + blue/3;
}

Michael Niedermayer's avatar
Michael Niedermayer committed
613
static int decode_i2_frame(FourXContext *f, const uint8_t *buf, int length){
614 615 616
    int x, y, x2, y2;
    const int width= f->avctx->width;
    const int height= f->avctx->height;
617
    const int mbs = (FFALIGN(width, 16) >> 4) * (FFALIGN(height, 16) >> 4);
618 619
    uint16_t *dst= (uint16_t*)f->current_picture.data[0];
    const int stride= f->current_picture.linesize[0]>>1;
620 621 622 623 624 625 626
    GetByteContext g3;

    if(length < mbs * 8) {
        av_log(f->avctx, AV_LOG_ERROR, "packet size too small\n");
        return AVERROR_INVALIDDATA;
    }
    bytestream2_init(&g3, buf, length);
627 628 629 630 631 632

    for(y=0; y<height; y+=16){
        for(x=0; x<width; x+=16){
            unsigned int color[4], bits;
            memset(color, 0, sizeof(color));
//warning following is purely guessed ...
633 634
            color[0]= bytestream2_get_le16u(&g3);
            color[1]= bytestream2_get_le16u(&g3);
635 636 637 638 639 640 641

            if(color[0]&0x8000) av_log(NULL, AV_LOG_ERROR, "unk bit 1\n");
            if(color[1]&0x8000) av_log(NULL, AV_LOG_ERROR, "unk bit 2\n");

            color[2]= mix(color[0], color[1]);
            color[3]= mix(color[1], color[0]);

642
            bits= bytestream2_get_le32u(&g3);
643 644 645 646 647 648 649 650
            for(y2=0; y2<16; y2++){
                for(x2=0; x2<16; x2++){
                    int index= 2*(x2>>2) + 8*(y2>>2);
                    dst[y2*stride+x2]= color[(bits>>index)&3];
                }
            }
            dst+=16;
        }
651
        dst += 16 * stride - x;
652 653 654 655 656
    }

    return 0;
}

Michael Niedermayer's avatar
Michael Niedermayer committed
657
static int decode_i_frame(FourXContext *f, const uint8_t *buf, int length){
Michael Niedermayer's avatar
Michael Niedermayer committed
658 659 660
    int x, y;
    const int width= f->avctx->width;
    const int height= f->avctx->height;
661
    const unsigned int bitstream_size= AV_RL32(buf);
662 663 664 665 666 667 668 669 670 671 672 673
    int token_count av_unused;
    unsigned int prestream_size;
    const uint8_t *prestream;

    if (length < bitstream_size + 12) {
        av_log(f->avctx, AV_LOG_ERROR, "packet size too small\n");
        return AVERROR_INVALIDDATA;
    }

    token_count    = AV_RL32(buf + bitstream_size + 8);
    prestream_size = 4 * AV_RL32(buf + bitstream_size + 4);
    prestream      = buf + bitstream_size + 12;
674

675 676 677
    if(prestream_size + bitstream_size + 12 != length
       || bitstream_size > (1<<26)
       || prestream_size > (1<<26)){
678
        av_log(f->avctx, AV_LOG_ERROR, "size mismatch %d %d %d\n", prestream_size, bitstream_size, length);
679 680
        return -1;
    }
681

Michael Niedermayer's avatar
Michael Niedermayer committed
682 683 684 685 686
    prestream= read_huffman_tables(f, prestream);

    init_get_bits(&f->gb, buf + 4, 8*bitstream_size);

    prestream_size= length + buf - prestream;
687

688 689 690
    av_fast_malloc(&f->bitstream_buffer, &f->bitstream_buffer_size, prestream_size + FF_INPUT_BUFFER_PADDING_SIZE);
    if (!f->bitstream_buffer)
        return AVERROR(ENOMEM);
691
    f->dsp.bswap_buf(f->bitstream_buffer, (const uint32_t*)prestream, prestream_size/4);
692
    memset((uint8_t*)f->bitstream_buffer + prestream_size, 0, FF_INPUT_BUFFER_PADDING_SIZE);
Michael Niedermayer's avatar
Michael Niedermayer committed
693 694 695
    init_get_bits(&f->pre_gb, f->bitstream_buffer, 8*prestream_size);

    f->last_dc= 0*128*8*8;
696

Michael Niedermayer's avatar
Michael Niedermayer committed
697 698 699 700 701 702 703 704 705 706
    for(y=0; y<height; y+=16){
        for(x=0; x<width; x+=16){
            if(decode_i_mb(f) < 0)
                return -1;

            idct_put(f, x, y);
        }
    }

    if(get_vlc2(&f->pre_gb, f->pre_vlc.table, ACDC_VLC_BITS, 3) != 256)
707
        av_log(f->avctx, AV_LOG_ERROR, "end mismatch\n");
708

Michael Niedermayer's avatar
Michael Niedermayer committed
709 710 711
    return 0;
}

712
static int decode_frame(AVCodecContext *avctx,
Michael Niedermayer's avatar
Michael Niedermayer committed
713
                        void *data, int *data_size,
714
                        AVPacket *avpkt)
Michael Niedermayer's avatar
Michael Niedermayer committed
715
{
716 717
    const uint8_t *buf = avpkt->data;
    int buf_size = avpkt->size;
Michael Niedermayer's avatar
Michael Niedermayer committed
718 719 720 721 722
    FourXContext * const f = avctx->priv_data;
    AVFrame *picture = data;
    AVFrame *p, temp;
    int i, frame_4cc, frame_size;

723 724 725
    frame_4cc= AV_RL32(buf);
    if(buf_size != AV_RL32(buf+4)+8 || buf_size < 20){
        av_log(f->avctx, AV_LOG_ERROR, "size mismatch %d %d\n", buf_size, AV_RL32(buf+4));
Michael Niedermayer's avatar
Michael Niedermayer committed
726 727
    }

728
    if(frame_4cc == AV_RL32("cfrm")){
Michael Niedermayer's avatar
Michael Niedermayer committed
729 730
        int free_index=-1;
        const int data_size= buf_size - 20;
731 732
        const int id= AV_RL32(buf+12);
        const int whole_size= AV_RL32(buf+16);
Michael Niedermayer's avatar
Michael Niedermayer committed
733 734 735 736
        CFrameBuffer *cfrm;

        for(i=0; i<CFRAME_BUFFER_COUNT; i++){
            if(f->cfrm[i].id && f->cfrm[i].id < avctx->frame_number)
737
                av_log(f->avctx, AV_LOG_ERROR, "lost c frame %d\n", f->cfrm[i].id);
Michael Niedermayer's avatar
Michael Niedermayer committed
738
        }
739

Michael Niedermayer's avatar
Michael Niedermayer committed
740 741 742 743 744 745 746 747 748 749
        for(i=0; i<CFRAME_BUFFER_COUNT; i++){
            if(f->cfrm[i].id   == id) break;
            if(f->cfrm[i].size == 0 ) free_index= i;
        }

        if(i>=CFRAME_BUFFER_COUNT){
            i= free_index;
            f->cfrm[i].id= id;
        }
        cfrm= &f->cfrm[i];
750

Michael Niedermayer's avatar
Michael Niedermayer committed
751
        cfrm->data= av_fast_realloc(cfrm->data, &cfrm->allocated_size, cfrm->size + data_size + FF_INPUT_BUFFER_PADDING_SIZE);
752 753 754 755
        if(!cfrm->data){ //explicit check needed as memcpy below might not catch a NULL
            av_log(f->avctx, AV_LOG_ERROR, "realloc falure");
            return -1;
        }
756

Michael Niedermayer's avatar
Michael Niedermayer committed
757 758
        memcpy(cfrm->data + cfrm->size, buf+20, data_size);
        cfrm->size += data_size;
759

Michael Niedermayer's avatar
Michael Niedermayer committed
760 761 762
        if(cfrm->size >= whole_size){
            buf= cfrm->data;
            frame_size= cfrm->size;
763

Michael Niedermayer's avatar
Michael Niedermayer committed
764
            if(id != avctx->frame_number){
765
                av_log(f->avctx, AV_LOG_ERROR, "cframe id mismatch %d %d\n", id, avctx->frame_number);
Michael Niedermayer's avatar
Michael Niedermayer committed
766
            }
767

Michael Niedermayer's avatar
Michael Niedermayer committed
768
            cfrm->size= cfrm->id= 0;
769
            frame_4cc= AV_RL32("pfrm");
Michael Niedermayer's avatar
Michael Niedermayer committed
770 771 772 773 774
        }else
            return buf_size;
    }else{
        buf= buf + 12;
        frame_size= buf_size - 12;
775
    }
Michael Niedermayer's avatar
Michael Niedermayer committed
776 777 778 779 780 781 782 783 784 785 786 787 788 789 790

    temp= f->current_picture;
    f->current_picture= f->last_picture;
    f->last_picture= temp;

    p= &f->current_picture;
    avctx->coded_frame= p;

    avctx->flags |= CODEC_FLAG_EMU_EDGE; // alternatively we would have to use our own buffer management

    if(p->data[0])
        avctx->release_buffer(avctx, p);

    p->reference= 1;
    if(avctx->get_buffer(avctx, p) < 0){
791
        av_log(avctx, AV_LOG_ERROR, "get_buffer() failed\n");
Michael Niedermayer's avatar
Michael Niedermayer committed
792 793 794
        return -1;
    }

795
    if(frame_4cc == AV_RL32("ifr2")){
796
        p->pict_type= AV_PICTURE_TYPE_I;
797
        if(decode_i2_frame(f, buf-4, frame_size + 4) < 0)
798
            return -1;
799
    }else if(frame_4cc == AV_RL32("ifrm")){
800
        p->pict_type= AV_PICTURE_TYPE_I;
Michael Niedermayer's avatar
Michael Niedermayer committed
801 802
        if(decode_i_frame(f, buf, frame_size) < 0)
            return -1;
803
    }else if(frame_4cc == AV_RL32("pfrm") || frame_4cc == AV_RL32("pfr2")){
804 805 806 807 808 809 810 811
        if(!f->last_picture.data[0]){
            f->last_picture.reference= 1;
            if(avctx->get_buffer(avctx, &f->last_picture) < 0){
                av_log(avctx, AV_LOG_ERROR, "get_buffer() failed\n");
                return -1;
            }
        }

812
        p->pict_type= AV_PICTURE_TYPE_P;
Michael Niedermayer's avatar
Michael Niedermayer committed
813 814
        if(decode_p_frame(f, buf, frame_size) < 0)
            return -1;
815
    }else if(frame_4cc == AV_RL32("snd_")){
816
        av_log(avctx, AV_LOG_ERROR, "ignoring snd_ chunk length:%d\n", buf_size);
Michael Niedermayer's avatar
Michael Niedermayer committed
817
    }else{
818
        av_log(avctx, AV_LOG_ERROR, "ignoring unknown chunk length:%d\n", buf_size);
Michael Niedermayer's avatar
Michael Niedermayer committed
819 820
    }

821
    p->key_frame= p->pict_type == AV_PICTURE_TYPE_I;
Michael Niedermayer's avatar
Michael Niedermayer committed
822 823 824 825 826

    *picture= *p;
    *data_size = sizeof(AVPicture);

    emms_c();
827

Michael Niedermayer's avatar
Michael Niedermayer committed
828 829 830 831
    return buf_size;
}


832
static av_cold void common_init(AVCodecContext *avctx){
Michael Niedermayer's avatar
Michael Niedermayer committed
833 834 835 836 837 838 839
    FourXContext * const f = avctx->priv_data;

    dsputil_init(&f->dsp, avctx);

    f->avctx= avctx;
}

840
static av_cold int decode_init(AVCodecContext *avctx){
Michael Niedermayer's avatar
Michael Niedermayer committed
841
    FourXContext * const f = avctx->priv_data;
842

843 844 845 846 847
    if(avctx->extradata_size != 4 || !avctx->extradata) {
        av_log(avctx, AV_LOG_ERROR, "extradata wrong or missing\n");
        return 1;
    }

848
    f->version= AV_RL32(avctx->extradata)>>16;
Michael Niedermayer's avatar
Michael Niedermayer committed
849 850 851
    common_init(avctx);
    init_vlcs(f);

852
    if(f->version>2) avctx->pix_fmt= PIX_FMT_RGB565;
853
    else             avctx->pix_fmt= PIX_FMT_BGR555;
Michael Niedermayer's avatar
Michael Niedermayer committed
854 855 856 857 858

    return 0;
}


859
static av_cold int decode_end(AVCodecContext *avctx){
Michael Niedermayer's avatar
Michael Niedermayer committed
860 861 862 863 864 865 866 867 868 869
    FourXContext * const f = avctx->priv_data;
    int i;

    av_freep(&f->bitstream_buffer);
    f->bitstream_buffer_size=0;
    for(i=0; i<CFRAME_BUFFER_COUNT; i++){
        av_freep(&f->cfrm[i].data);
        f->cfrm[i].allocated_size= 0;
    }
    free_vlc(&f->pre_vlc);
870 871 872 873
    if(f->current_picture.data[0])
        avctx->release_buffer(avctx, &f->current_picture);
    if(f->last_picture.data[0])
        avctx->release_buffer(avctx, &f->last_picture);
874

Michael Niedermayer's avatar
Michael Niedermayer committed
875 876 877
    return 0;
}

878
AVCodec ff_fourxm_decoder = {
879 880 881 882 883 884 885 886
    .name           = "4xm",
    .type           = AVMEDIA_TYPE_VIDEO,
    .id             = CODEC_ID_4XM,
    .priv_data_size = sizeof(FourXContext),
    .init           = decode_init,
    .close          = decode_end,
    .decode         = decode_frame,
    .capabilities   = CODEC_CAP_DR1,
887
    .long_name = NULL_IF_CONFIG_SMALL("4X Movie"),
Michael Niedermayer's avatar
Michael Niedermayer committed
888 889
};