4xm.c 27.4 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;
Michael Niedermayer's avatar
Michael Niedermayer committed
135 136
    const uint8_t *bytestream;
    const uint16_t *wordstream;
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

Michael Niedermayer's avatar
Michael Niedermayer committed
280 281 282 283 284 285 286 287 288 289 290 291 292 293
static inline void mcdc(uint16_t *dst, uint16_t *src, int log2w, int h, int stride, int scale, int dc){
   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 331
    assert(code>=0 && code<=6);

    if(code == 0){
        src += f->mv[ *f->bytestream++ ];
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 348
    }else if(code == 4){
        src += f->mv[ *f->bytestream++ ];
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, av_le2ne16(*f->wordstream++));
Michael Niedermayer's avatar
Michael Niedermayer committed
354
    }else if(code == 5){
355
        mcdc(dst, src, log2w, h, stride, 0, av_le2ne16(*f->wordstream++));
Michael Niedermayer's avatar
Michael Niedermayer committed
356 357
    }else if(code == 6){
        if(log2w){
358 359
            dst[0] = av_le2ne16(*f->wordstream++);
            dst[1] = av_le2ne16(*f->wordstream++);
Michael Niedermayer's avatar
Michael Niedermayer committed
360
        }else{
361 362
            dst[0     ] = av_le2ne16(*f->wordstream++);
            dst[stride] = av_le2ne16(*f->wordstream++);
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 375
    unsigned int bitstream_size, bytestream_size, wordstream_size, extra;

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);
Michael Niedermayer's avatar
Michael Niedermayer committed
402 403
    init_get_bits(&f->gb, f->bitstream_buffer, 8*bitstream_size);

Michael Niedermayer's avatar
Michael Niedermayer committed
404
    f->wordstream= (const uint16_t*)(buf + extra + bitstream_size);
405
    f->bytestream= buf + extra + bitstream_size + wordstream_size;
406

Michael Niedermayer's avatar
Michael Niedermayer committed
407
    init_mv(f);
408

Michael Niedermayer's avatar
Michael Niedermayer committed
409 410 411 412
    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);
        }
413 414
        src += 8*stride;
        dst += 8*stride;
Michael Niedermayer's avatar
Michael Niedermayer committed
415
    }
416

417
    if(   bitstream_size != (get_bits_count(&f->gb)+31)/32*4
Michael Niedermayer's avatar
Michael Niedermayer committed
418 419
       || (((const char*)f->wordstream - (const char*)buf + 2)&~2) != extra + bitstream_size + wordstream_size
       || (((const char*)f->bytestream - (const char*)buf + 3)&~3) != extra + bitstream_size + wordstream_size + bytestream_size)
420 421
        av_log(f->avctx, AV_LOG_ERROR, " %d %td %td bytes left\n",
            bitstream_size - (get_bits_count(&f->gb)+31)/32*4,
Michael Niedermayer's avatar
Michael Niedermayer committed
422 423
            -(((const char*)f->bytestream - (const char*)buf + 3)&~3) + (extra + bitstream_size + wordstream_size + bytestream_size),
            -(((const char*)f->wordstream - (const char*)buf + 2)&~2) + (extra + bitstream_size + wordstream_size)
Michael Niedermayer's avatar
Michael Niedermayer committed
424
        );
425

Michael Niedermayer's avatar
Michael Niedermayer committed
426 427 428 429 430
    return 0;
}

/**
 * decode block and dequantize.
Diego Biurrun's avatar
Diego Biurrun committed
431
 * Note this is almost identical to MJPEG.
Michael Niedermayer's avatar
Michael Niedermayer committed
432 433 434 435 436 437 438
 */
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){
439
        av_log(f->avctx, AV_LOG_ERROR, "error dc run != 0\n");
Michael Niedermayer's avatar
Michael Niedermayer committed
440 441 442 443 444 445 446 447 448 449 450 451
    }

    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);
452

Michael Niedermayer's avatar
Michael Niedermayer committed
453 454 455 456 457 458 459 460 461
        /* EOB */
        if (code == 0)
            break;
        if (code == 0xf0) {
            i += 16;
        } else {
            level = get_xbits(&f->gb, code & 0xf);
            i += code >> 4;
            if (i >= 64) {
462
                av_log(f->avctx, AV_LOG_ERROR, "run %d oveflow\n", i);
Michael Niedermayer's avatar
Michael Niedermayer committed
463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481
                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;
482

483 484 485 486
    for(i=0; i<4; i++){
        block[i][0] += 0x80*8*8;
        idct(block[i]);
    }
Michael Niedermayer's avatar
Michael Niedermayer committed
487

488 489 490
    if(!(f->avctx->flags&CODEC_FLAG_GRAY)){
        for(i=4; i<6; i++) idct(block[i]);
    }
Michael Niedermayer's avatar
Michael Niedermayer committed
491

492 493 494 495
/* Note transform is:
y= ( 1b + 4g + 2r)/14
cb=( 3b - 2g - 1r)/14
cr=(-1b - 4g + 5r)/14
496
*/
Michael Niedermayer's avatar
Michael Niedermayer committed
497 498 499
    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
500 501
            int cb= block[4][x + 8*y];
            int cr= block[5][x + 8*y];
Michael Niedermayer's avatar
Michael Niedermayer committed
502 503
            int cg= (cb + cr)>>1;
            int y;
504

505
            cb+=cb;
506

Michael Niedermayer's avatar
Michael Niedermayer committed
507
            y = temp[0];
508
            dst[0       ]= ((y+cb)>>3) + (((y-cg)&0xFC)<<3) + (((y+cr)&0xF8)<<8);
Michael Niedermayer's avatar
Michael Niedermayer committed
509
            y = temp[1];
510
            dst[1       ]= ((y+cb)>>3) + (((y-cg)&0xFC)<<3) + (((y+cr)&0xF8)<<8);
Michael Niedermayer's avatar
Michael Niedermayer committed
511
            y = temp[8];
512
            dst[  stride]= ((y+cb)>>3) + (((y-cg)&0xFC)<<3) + (((y+cr)&0xF8)<<8);
Michael Niedermayer's avatar
Michael Niedermayer committed
513
            y = temp[9];
514
            dst[1+stride]= ((y+cb)>>3) + (((y-cg)&0xFC)<<3) + (((y+cr)&0xF8)<<8);
Michael Niedermayer's avatar
Michael Niedermayer committed
515 516 517 518 519 520 521 522
            dst += 2;
        }
        dst += 2*stride - 2*8;
    }
}

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

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

Michael Niedermayer's avatar
Michael Niedermayer committed
526 527 528 529
    for(i=0; i<6; i++){
        if(decode_i_block(f, f->block[i]) < 0)
            return -1;
    }
530

Michael Niedermayer's avatar
Michael Niedermayer committed
531 532 533
    return 0;
}

Michael Niedermayer's avatar
Michael Niedermayer committed
534
static const uint8_t *read_huffman_tables(FourXContext *f, const uint8_t * const buf){
Michael Niedermayer's avatar
Michael Niedermayer committed
535 536 537 538 539 540
    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
541
    const uint8_t *ptr= buf;
Michael Niedermayer's avatar
Michael Niedermayer committed
542
    int j;
543

Michael Niedermayer's avatar
Michael Niedermayer committed
544 545 546 547 548 549 550
    memset(frequency, 0, sizeof(frequency));
    memset(up, -1, sizeof(up));

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

Michael Niedermayer's avatar
Michael Niedermayer committed
552 553 554 555 556
        for(i=start; i<=end; i++){
            frequency[i]= *ptr++;
        }
        start= *ptr++;
        if(start==0) break;
557

Michael Niedermayer's avatar
Michael Niedermayer committed
558 559 560 561
        end= *ptr++;
    }
    frequency[256]=1;

562
    while((ptr - buf)&3) ptr++; // 4byte align
Michael Niedermayer's avatar
Michael Niedermayer committed
563 564

    for(j=257; j<512; j++){
565 566
        int min_freq[2]= {256*256, 256*256};
        int smallest[2]= {0, 0};
Michael Niedermayer's avatar
Michael Niedermayer committed
567 568 569
        int i;
        for(i=0; i<j; i++){
            if(frequency[i] == 0) continue;
570 571 572 573 574 575 576
            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
577 578
            }
        }
579
        if(min_freq[1] == 256*256) break;
580

581
        frequency[j]= min_freq[0] + min_freq[1];
Michael Niedermayer's avatar
Michael Niedermayer committed
582 583
        flag[ smallest[0] ]= 0;
        flag[ smallest[1] ]= 1;
584
        up[ smallest[0] ]=
Michael Niedermayer's avatar
Michael Niedermayer committed
585 586 587 588 589 590 591 592 593 594 595 596
        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++;
597
            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
598
        }
599

Michael Niedermayer's avatar
Michael Niedermayer committed
600 601 602
        bits_tab[j]= bits;
        len_tab[j]= len;
    }
603 604

    init_vlc(&f->pre_vlc, ACDC_VLC_BITS, 257,
Michael Niedermayer's avatar
Michael Niedermayer committed
605
             len_tab , 1, 1,
606
             bits_tab, 4, 4, 0);
607

Michael Niedermayer's avatar
Michael Niedermayer committed
608 609 610
    return ptr;
}

611 612 613 614 615 616 617
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
618
static int decode_i2_frame(FourXContext *f, const uint8_t *buf, int length){
619 620 621 622 623 624 625 626 627 628 629
    int x, y, x2, y2;
    const int width= f->avctx->width;
    const int height= f->avctx->height;
    uint16_t *dst= (uint16_t*)f->current_picture.data[0];
    const int stride= f->current_picture.linesize[0]>>1;

    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 ...
630 631
            color[0]= bytestream_get_le16(&buf);
            color[1]= bytestream_get_le16(&buf);
632 633 634 635 636 637 638

            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]);

639
            bits= bytestream_get_le32(&buf);
640 641 642 643 644 645 646 647 648 649 650 651 652 653
            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;
        }
        dst += 16*stride - width;
    }

    return 0;
}

Michael Niedermayer's avatar
Michael Niedermayer committed
654
static int decode_i_frame(FourXContext *f, const uint8_t *buf, int length){
Michael Niedermayer's avatar
Michael Niedermayer committed
655 656 657 658 659
    int x, y;
    const int width= f->avctx->width;
    const int height= f->avctx->height;
    uint16_t *dst= (uint16_t*)f->current_picture.data[0];
    const int stride= f->current_picture.linesize[0]>>1;
660 661 662
    const unsigned int bitstream_size= AV_RL32(buf);
    const int token_count av_unused = AV_RL32(buf + bitstream_size + 8);
    unsigned int prestream_size= 4*AV_RL32(buf + bitstream_size + 4);
Michael Niedermayer's avatar
Michael Niedermayer committed
663
    const uint8_t *prestream= buf + bitstream_size + 12;
664

665 666 667
    if(prestream_size + bitstream_size + 12 != length
       || bitstream_size > (1<<26)
       || prestream_size > (1<<26)){
668
        av_log(f->avctx, AV_LOG_ERROR, "size mismatch %d %d %d\n", prestream_size, bitstream_size, length);
669 670
        return -1;
    }
671

Michael Niedermayer's avatar
Michael Niedermayer committed
672 673 674 675 676
    prestream= read_huffman_tables(f, prestream);

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

    prestream_size= length + buf - prestream;
677

678 679 680
    av_fast_malloc(&f->bitstream_buffer, &f->bitstream_buffer_size, prestream_size + FF_INPUT_BUFFER_PADDING_SIZE);
    if (!f->bitstream_buffer)
        return AVERROR(ENOMEM);
681
    f->dsp.bswap_buf(f->bitstream_buffer, (const uint32_t*)prestream, prestream_size/4);
Michael Niedermayer's avatar
Michael Niedermayer committed
682 683 684
    init_get_bits(&f->pre_gb, f->bitstream_buffer, 8*prestream_size);

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

Michael Niedermayer's avatar
Michael Niedermayer committed
686 687 688 689 690 691 692
    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);
        }
693
        dst += 16*stride;
Michael Niedermayer's avatar
Michael Niedermayer committed
694 695 696
    }

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

Michael Niedermayer's avatar
Michael Niedermayer committed
699 700 701
    return 0;
}

702
static int decode_frame(AVCodecContext *avctx,
Michael Niedermayer's avatar
Michael Niedermayer committed
703
                        void *data, int *data_size,
704
                        AVPacket *avpkt)
Michael Niedermayer's avatar
Michael Niedermayer committed
705
{
706 707
    const uint8_t *buf = avpkt->data;
    int buf_size = avpkt->size;
Michael Niedermayer's avatar
Michael Niedermayer committed
708 709 710 711 712
    FourXContext * const f = avctx->priv_data;
    AVFrame *picture = data;
    AVFrame *p, temp;
    int i, frame_4cc, frame_size;

713 714 715
    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
716 717
    }

718
    if(frame_4cc == AV_RL32("cfrm")){
Michael Niedermayer's avatar
Michael Niedermayer committed
719 720
        int free_index=-1;
        const int data_size= buf_size - 20;
721 722
        const int id= AV_RL32(buf+12);
        const int whole_size= AV_RL32(buf+16);
Michael Niedermayer's avatar
Michael Niedermayer committed
723 724 725 726
        CFrameBuffer *cfrm;

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

Michael Niedermayer's avatar
Michael Niedermayer committed
730 731 732 733 734 735 736 737 738 739
        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];
740

Michael Niedermayer's avatar
Michael Niedermayer committed
741
        cfrm->data= av_fast_realloc(cfrm->data, &cfrm->allocated_size, cfrm->size + data_size + FF_INPUT_BUFFER_PADDING_SIZE);
742 743 744 745
        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;
        }
746

Michael Niedermayer's avatar
Michael Niedermayer committed
747 748
        memcpy(cfrm->data + cfrm->size, buf+20, data_size);
        cfrm->size += data_size;
749

Michael Niedermayer's avatar
Michael Niedermayer committed
750 751 752
        if(cfrm->size >= whole_size){
            buf= cfrm->data;
            frame_size= cfrm->size;
753

Michael Niedermayer's avatar
Michael Niedermayer committed
754
            if(id != avctx->frame_number){
755
                av_log(f->avctx, AV_LOG_ERROR, "cframe id mismatch %d %d\n", id, avctx->frame_number);
Michael Niedermayer's avatar
Michael Niedermayer committed
756
            }
757

Michael Niedermayer's avatar
Michael Niedermayer committed
758
            cfrm->size= cfrm->id= 0;
759
            frame_4cc= AV_RL32("pfrm");
Michael Niedermayer's avatar
Michael Niedermayer committed
760 761 762 763 764
        }else
            return buf_size;
    }else{
        buf= buf + 12;
        frame_size= buf_size - 12;
765
    }
Michael Niedermayer's avatar
Michael Niedermayer committed
766 767 768 769 770 771 772 773 774 775 776 777 778 779 780

    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){
781
        av_log(avctx, AV_LOG_ERROR, "get_buffer() failed\n");
Michael Niedermayer's avatar
Michael Niedermayer committed
782 783 784
        return -1;
    }

785
    if(frame_4cc == AV_RL32("ifr2")){
786
        p->pict_type= AV_PICTURE_TYPE_I;
787 788
        if(decode_i2_frame(f, buf-4, frame_size) < 0)
            return -1;
789
    }else if(frame_4cc == AV_RL32("ifrm")){
790
        p->pict_type= AV_PICTURE_TYPE_I;
Michael Niedermayer's avatar
Michael Niedermayer committed
791 792
        if(decode_i_frame(f, buf, frame_size) < 0)
            return -1;
793
    }else if(frame_4cc == AV_RL32("pfrm") || frame_4cc == AV_RL32("pfr2")){
794 795 796 797 798 799 800 801
        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;
            }
        }

802
        p->pict_type= AV_PICTURE_TYPE_P;
Michael Niedermayer's avatar
Michael Niedermayer committed
803 804
        if(decode_p_frame(f, buf, frame_size) < 0)
            return -1;
805
    }else if(frame_4cc == AV_RL32("snd_")){
806
        av_log(avctx, AV_LOG_ERROR, "ignoring snd_ chunk length:%d\n", buf_size);
Michael Niedermayer's avatar
Michael Niedermayer committed
807
    }else{
808
        av_log(avctx, AV_LOG_ERROR, "ignoring unknown chunk length:%d\n", buf_size);
Michael Niedermayer's avatar
Michael Niedermayer committed
809 810
    }

811
    p->key_frame= p->pict_type == AV_PICTURE_TYPE_I;
Michael Niedermayer's avatar
Michael Niedermayer committed
812 813 814 815 816

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

    emms_c();
817

Michael Niedermayer's avatar
Michael Niedermayer committed
818 819 820 821
    return buf_size;
}


822
static av_cold void common_init(AVCodecContext *avctx){
Michael Niedermayer's avatar
Michael Niedermayer committed
823 824 825 826 827 828 829
    FourXContext * const f = avctx->priv_data;

    dsputil_init(&f->dsp, avctx);

    f->avctx= avctx;
}

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

833 834 835 836 837
    if(avctx->extradata_size != 4 || !avctx->extradata) {
        av_log(avctx, AV_LOG_ERROR, "extradata wrong or missing\n");
        return 1;
    }

838
    f->version= AV_RL32(avctx->extradata)>>16;
Michael Niedermayer's avatar
Michael Niedermayer committed
839 840 841
    common_init(avctx);
    init_vlcs(f);

842
    if(f->version>2) avctx->pix_fmt= PIX_FMT_RGB565;
843
    else             avctx->pix_fmt= PIX_FMT_BGR555;
Michael Niedermayer's avatar
Michael Niedermayer committed
844 845 846 847 848

    return 0;
}


849
static av_cold int decode_end(AVCodecContext *avctx){
Michael Niedermayer's avatar
Michael Niedermayer committed
850 851 852 853 854 855 856 857 858 859
    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);
860 861 862 863
    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);
864

Michael Niedermayer's avatar
Michael Niedermayer committed
865 866 867
    return 0;
}

868
AVCodec ff_fourxm_decoder = {
Michael Niedermayer's avatar
Michael Niedermayer committed
869
    "4xm",
870
    AVMEDIA_TYPE_VIDEO,
Michael Niedermayer's avatar
Michael Niedermayer committed
871 872 873 874 875 876
    CODEC_ID_4XM,
    sizeof(FourXContext),
    decode_init,
    NULL,
    decode_end,
    decode_frame,
877
    CODEC_CAP_DR1,
878
    .long_name = NULL_IF_CONFIG_SMALL("4X Movie"),
Michael Niedermayer's avatar
Michael Niedermayer committed
879 880
};