Subversion Repositories Kolibri OS

/*

 * Motion Pixels Video Decoder

 * Copyright (c) 2008 Gregory Montoir (cyx@users.sourceforge.net)

 *

 * This file is part of FFmpeg.

 *

 * FFmpeg is free software; you can redistribute it and/or

 * modify it under the terms of the GNU Lesser General Public

 * License as published by the Free Software Foundation; either

 * version 2.1 of the License, or (at your option) any later version.

 *

 * FFmpeg 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

 * Lesser General Public License for more details.

 *

 * You should have received a copy of the GNU Lesser General Public

 * License along with FFmpeg; if not, write to the Free Software

 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA

 */

#include "avcodec.h"

#include "get_bits.h"

#include "bswapdsp.h"

#include "internal.h"

#define MAX_HUFF_CODES 16

#include "motionpixels_tablegen.h"

typedef struct HuffCode {

    int code;

    uint8_t size;

    uint8_t delta;

} HuffCode;

typedef struct MotionPixelsContext {

    AVCodecContext *avctx;

    AVFrame *frame;

    BswapDSPContext bdsp;

    uint8_t *changes_map;

    int offset_bits_len;

    int codes_count, current_codes_count;

    int max_codes_bits;

    HuffCode codes[MAX_HUFF_CODES];

    VLC vlc;

    YuvPixel *vpt, *hpt;

    uint8_t gradient_scale[3];

    uint8_t *bswapbuf;

    int bswapbuf_size;

} MotionPixelsContext;

static av_cold int mp_decode_end(AVCodecContext *avctx)

{

    MotionPixelsContext *mp = avctx->priv_data;

    av_freep(&mp->changes_map);

    av_freep(&mp->vpt);

    av_freep(&mp->hpt);

    av_freep(&mp->bswapbuf);

    av_frame_free(&mp->frame);

    return 0;

}

static av_cold int mp_decode_init(AVCodecContext *avctx)

{

    MotionPixelsContext *mp = avctx->priv_data;

    int w4 = (avctx->width  + 3) & ~3;

    int h4 = (avctx->height + 3) & ~3;

    if(avctx->extradata_size < 2){

        av_log(avctx, AV_LOG_ERROR, "extradata too small\n");

        return AVERROR_INVALIDDATA;

    }

    motionpixels_tableinit();

    mp->avctx = avctx;

    ff_bswapdsp_init(&mp->bdsp);

    mp->changes_map = av_mallocz_array(avctx->width, h4);

    mp->offset_bits_len = av_log2(avctx->width * avctx->height) + 1;

    mp->vpt = av_mallocz_array(avctx->height, sizeof(YuvPixel));

    mp->hpt = av_mallocz_array(h4 / 4, w4 / 4 * sizeof(YuvPixel));

    if (!mp->changes_map || !mp->vpt || !mp->hpt) {

        av_freep(&mp->changes_map);

        av_freep(&mp->vpt);

        av_freep(&mp->hpt);

        return AVERROR(ENOMEM);

    }

    avctx->pix_fmt = AV_PIX_FMT_RGB555;

    mp->frame = av_frame_alloc();

    if (!mp->frame) {

        mp_decode_end(avctx);

        return AVERROR(ENOMEM);

    }

    return 0;

}

static void mp_read_changes_map(MotionPixelsContext *mp, GetBitContext *gb, int count, int bits_len, int read_color)

{

    uint16_t *pixels;

    int offset, w, h, color = 0, x, y, i;

    while (count--) {

        offset = get_bits_long(gb, mp->offset_bits_len);

        w      = get_bits(gb, bits_len) + 1;

        h      = get_bits(gb, bits_len) + 1;

        if (read_color)

            color = get_bits(gb, 15);

        x = offset % mp->avctx->width;

        y = offset / mp->avctx->width;

        if (y >= mp->avctx->height)

            continue;

        w = FFMIN(w, mp->avctx->width  - x);

        h = FFMIN(h, mp->avctx->height - y);

        pixels = (uint16_t *)&mp->frame->data[0][y * mp->frame->linesize[0] + x * 2];

        while (h--) {

            mp->changes_map[offset] = w;

            if (read_color)

                for (i = 0; i < w; ++i)

                    pixels[i] = color;

            offset += mp->avctx->width;

            pixels += mp->frame->linesize[0] / 2;

        }

    }

}

static int mp_get_code(MotionPixelsContext *mp, GetBitContext *gb, int size, int code)

{

    while (get_bits1(gb)) {

        ++size;

        if (size > mp->max_codes_bits) {

            av_log(mp->avctx, AV_LOG_ERROR, "invalid code size %d/%d\n", size, mp->max_codes_bits);

            return AVERROR_INVALIDDATA;

        }

        code <<= 1;

        if (mp_get_code(mp, gb, size, code + 1) < 0)

            return AVERROR_INVALIDDATA;

    }

    if (mp->current_codes_count >= MAX_HUFF_CODES) {

        av_log(mp->avctx, AV_LOG_ERROR, "too many codes\n");

        return AVERROR_INVALIDDATA;

    }

    mp->codes[mp->current_codes_count  ].code = code;

    mp->codes[mp->current_codes_count++].size = size;

    return 0;

}

static int mp_read_codes_table(MotionPixelsContext *mp, GetBitContext *gb)

{

    if (mp->codes_count == 1) {

        mp->codes[0].delta = get_bits(gb, 4);

    } else {

        int i;

        int ret;

        mp->max_codes_bits = get_bits(gb, 4);

        for (i = 0; i < mp->codes_count; ++i)

            mp->codes[i].delta = get_bits(gb, 4);

        mp->current_codes_count = 0;

        if ((ret = mp_get_code(mp, gb, 0, 0)) < 0)

            return ret;

        if (mp->current_codes_count < mp->codes_count) {

            av_log(mp->avctx, AV_LOG_ERROR, "too few codes\n");

            return AVERROR_INVALIDDATA;

        }

   }

   return 0;

}

static int mp_gradient(MotionPixelsContext *mp, int component, int v)

{

    int delta;

    delta = (v - 7) * mp->gradient_scale[component];

    mp->gradient_scale[component] = (v == 0 || v == 14) ? 2 : 1;

    return delta;

}

static YuvPixel mp_get_yuv_from_rgb(MotionPixelsContext *mp, int x, int y)

{

    int color;

    color = *(uint16_t *)&mp->frame->data[0][y * mp->frame->linesize[0] + x * 2];

    return mp_rgb_yuv_table[color];

}

static void mp_set_rgb_from_yuv(MotionPixelsContext *mp, int x, int y, const YuvPixel *p)

{

    int color;

    color = mp_yuv_to_rgb(p->y, p->v, p->u, 1);

    *(uint16_t *)&mp->frame->data[0][y * mp->frame->linesize[0] + x * 2] = color;

}

static int mp_get_vlc(MotionPixelsContext *mp, GetBitContext *gb)

{

    int i;

    i = (mp->codes_count == 1) ? 0 : get_vlc2(gb, mp->vlc.table, mp->max_codes_bits, 1);

    return mp->codes[i].delta;

}

static void mp_decode_line(MotionPixelsContext *mp, GetBitContext *gb, int y)

{

    YuvPixel p;

    const int y0 = y * mp->avctx->width;

    int w, i, x = 0;

    p = mp->vpt[y];

    if (mp->changes_map[y0 + x] == 0) {

        memset(mp->gradient_scale, 1, sizeof(mp->gradient_scale));

        ++x;

    }

    while (x < mp->avctx->width) {

        w = mp->changes_map[y0 + x];

        if (w != 0) {

            if ((y & 3) == 0) {

                if (mp->changes_map[y0 + x + mp->avctx->width] < w ||

                    mp->changes_map[y0 + x + mp->avctx->width * 2] < w ||

                    mp->changes_map[y0 + x + mp->avctx->width * 3] < w) {

                    for (i = (x + 3) & ~3; i < x + w; i += 4) {

                        mp->hpt[((y / 4) * mp->avctx->width + i) / 4] = mp_get_yuv_from_rgb(mp, i, y);

                    }

                }

            }

            x += w;

            memset(mp->gradient_scale, 1, sizeof(mp->gradient_scale));

            p = mp_get_yuv_from_rgb(mp, x - 1, y);

        } else {

            p.y += mp_gradient(mp, 0, mp_get_vlc(mp, gb));

            p.y = av_clip_uintp2(p.y, 5);

            if ((x & 3) == 0) {

                if ((y & 3) == 0) {

                    p.v += mp_gradient(mp, 1, mp_get_vlc(mp, gb));

                    p.v = av_clip_intp2(p.v, 5);

                    p.u += mp_gradient(mp, 2, mp_get_vlc(mp, gb));

                    p.u = av_clip_intp2(p.u, 5);

                    mp->hpt[((y / 4) * mp->avctx->width + x) / 4] = p;

                } else {

                    p.v = mp->hpt[((y / 4) * mp->avctx->width + x) / 4].v;

                    p.u = mp->hpt[((y / 4) * mp->avctx->width + x) / 4].u;

                }

            }

            mp_set_rgb_from_yuv(mp, x, y, &p);

            ++x;

        }

    }

}

static void mp_decode_frame_helper(MotionPixelsContext *mp, GetBitContext *gb)

{

    YuvPixel p;

    int y, y0;

    av_assert1(mp->changes_map[0]);

    for (y = 0; y < mp->avctx->height; ++y) {

        if (mp->changes_map[y * mp->avctx->width] != 0) {

            memset(mp->gradient_scale, 1, sizeof(mp->gradient_scale));

            p = mp_get_yuv_from_rgb(mp, 0, y);

        } else {

            p.y += mp_gradient(mp, 0, mp_get_vlc(mp, gb));

            p.y = av_clip_uintp2(p.y, 5);

            if ((y & 3) == 0) {

                p.v += mp_gradient(mp, 1, mp_get_vlc(mp, gb));

                p.v = av_clip_intp2(p.v, 5);

                p.u += mp_gradient(mp, 2, mp_get_vlc(mp, gb));

                p.u = av_clip_intp2(p.u, 5);

            }

            mp->vpt[y] = p;

            mp_set_rgb_from_yuv(mp, 0, y, &p);

        }

    }

    for (y0 = 0; y0 < 2; ++y0)

        for (y = y0; y < mp->avctx->height; y += 2)

            mp_decode_line(mp, gb, y);

}

static int mp_decode_frame(AVCodecContext *avctx,

                                 void *data, int *got_frame,

                                 AVPacket *avpkt)

{

    const uint8_t *buf = avpkt->data;

    int buf_size = avpkt->size;

    MotionPixelsContext *mp = avctx->priv_data;

    GetBitContext gb;

    int i, count1, count2, sz, ret;

    if ((ret = ff_reget_buffer(avctx, mp->frame)) < 0)

        return ret;

    /* le32 bitstream msb first */

    av_fast_padded_malloc(&mp->bswapbuf, &mp->bswapbuf_size, buf_size);

    if (!mp->bswapbuf)

        return AVERROR(ENOMEM);

    mp->bdsp.bswap_buf((uint32_t *) mp->bswapbuf, (const uint32_t *) buf,

                       buf_size / 4);

    if (buf_size & 3)

        memcpy(mp->bswapbuf + (buf_size & ~3), buf + (buf_size & ~3), buf_size & 3);

    init_get_bits(&gb, mp->bswapbuf, buf_size * 8);

    memset(mp->changes_map, 0, avctx->width * avctx->height);

    for (i = !(avctx->extradata[1] & 2); i < 2; ++i) {

        count1 = get_bits(&gb, 12);

        count2 = get_bits(&gb, 12);

        mp_read_changes_map(mp, &gb, count1, 8, i);

        mp_read_changes_map(mp, &gb, count2, 4, i);

    }

    mp->codes_count = get_bits(&gb, 4);

    if (mp->codes_count == 0)

        goto end;

    if (mp->changes_map[0] == 0) {

        *(uint16_t *)mp->frame->data[0] = get_bits(&gb, 15);

        mp->changes_map[0] = 1;

    }

    if (mp_read_codes_table(mp, &gb) < 0)

        goto end;

    sz = get_bits(&gb, 18);

    if (avctx->extradata[0] != 5)

        sz += get_bits(&gb, 18);

    if (sz == 0)

        goto end;

    if (mp->max_codes_bits <= 0)

        goto end;

    if (init_vlc(&mp->vlc, mp->max_codes_bits, mp->codes_count, &mp->codes[0].size, sizeof(HuffCode), 1, &mp->codes[0].code, sizeof(HuffCode), 4, 0))

        goto end;

    mp_decode_frame_helper(mp, &gb);

    ff_free_vlc(&mp->vlc);

end:

    if ((ret = av_frame_ref(data, mp->frame)) < 0)

        return ret;

    *got_frame       = 1;

    return buf_size;

}

AVCodec ff_motionpixels_decoder = {

    .name           = "motionpixels",

    .long_name      = NULL_IF_CONFIG_SMALL("Motion Pixels video"),

    .type           = AVMEDIA_TYPE_VIDEO,

    .id             = AV_CODEC_ID_MOTIONPIXELS,

    .priv_data_size = sizeof(MotionPixelsContext),

    .init           = mp_decode_init,

    .close          = mp_decode_end,

    .decode         = mp_decode_frame,

    .capabilities   = AV_CODEC_CAP_DR1,

};