998 lines
		
	
	
		
			26 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			998 lines
		
	
	
		
			26 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
/*
 | 
						|
 * RKA decoder
 | 
						|
 * Copyright (c) 2023 Paul B Mahol
 | 
						|
 *
 | 
						|
 * 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 "libavutil/channel_layout.h"
 | 
						|
#include "libavutil/intreadwrite.h"
 | 
						|
 | 
						|
#include "avcodec.h"
 | 
						|
#include "codec_internal.h"
 | 
						|
#include "bytestream.h"
 | 
						|
#include "decode.h"
 | 
						|
 | 
						|
typedef struct ACoder {
 | 
						|
    GetByteContext gb;
 | 
						|
    uint32_t low, high;
 | 
						|
    uint32_t value;
 | 
						|
} ACoder;
 | 
						|
 | 
						|
typedef struct FiltCoeffs {
 | 
						|
    int32_t coeffs[257];
 | 
						|
    unsigned size;
 | 
						|
} FiltCoeffs;
 | 
						|
 | 
						|
typedef struct Model64 {
 | 
						|
    uint32_t zero[2];
 | 
						|
    uint32_t sign[2];
 | 
						|
    unsigned size;
 | 
						|
    int bits;
 | 
						|
 | 
						|
    uint16_t val4[65];
 | 
						|
    uint16_t val1[65];
 | 
						|
} Model64;
 | 
						|
 | 
						|
typedef struct AdaptiveModel {
 | 
						|
    int last;
 | 
						|
    int total;
 | 
						|
    int buf_size;
 | 
						|
    int16_t sum;
 | 
						|
    uint16_t aprob0;
 | 
						|
    uint16_t aprob1;
 | 
						|
    uint16_t *prob[2];
 | 
						|
} AdaptiveModel;
 | 
						|
 | 
						|
typedef struct ChContext {
 | 
						|
    int qfactor;
 | 
						|
    int vrq;
 | 
						|
    int last_nb_decoded;
 | 
						|
    unsigned srate_pad;
 | 
						|
    unsigned pos_idx;
 | 
						|
 | 
						|
    AdaptiveModel *filt_size;
 | 
						|
    AdaptiveModel *filt_bits;
 | 
						|
 | 
						|
    uint32_t *bprob[2];
 | 
						|
 | 
						|
    AdaptiveModel position;
 | 
						|
    AdaptiveModel fshift;
 | 
						|
    AdaptiveModel nb_segments;
 | 
						|
    AdaptiveModel coeff_bits[11];
 | 
						|
 | 
						|
    Model64 mdl64[4][11];
 | 
						|
 | 
						|
    int32_t buf0[131072+2560];
 | 
						|
    int32_t buf1[131072+2560];
 | 
						|
} ChContext;
 | 
						|
 | 
						|
typedef struct RKAContext {
 | 
						|
    AVClass *class;
 | 
						|
 | 
						|
    ACoder ac;
 | 
						|
    ChContext ch[2];
 | 
						|
 | 
						|
    int bps;
 | 
						|
    int align;
 | 
						|
    int channels;
 | 
						|
    int correlated;
 | 
						|
    int frame_samples;
 | 
						|
    int last_nb_samples;
 | 
						|
    uint32_t total_nb_samples;
 | 
						|
    uint32_t samples_left;
 | 
						|
 | 
						|
    uint32_t bprob[2][257];
 | 
						|
 | 
						|
    AdaptiveModel filt_size;
 | 
						|
    AdaptiveModel filt_bits;
 | 
						|
} RKAContext;
 | 
						|
 | 
						|
static int adaptive_model_init(AdaptiveModel *am, int buf_size)
 | 
						|
{
 | 
						|
    am->buf_size = buf_size;
 | 
						|
    am->sum = 2000;
 | 
						|
    am->aprob0 = 0;
 | 
						|
    am->aprob1 = 0;
 | 
						|
    am->total = 0;
 | 
						|
 | 
						|
    if (!am->prob[0])
 | 
						|
        am->prob[0] = av_malloc_array(buf_size + 5, sizeof(*am->prob[0]));
 | 
						|
    if (!am->prob[1])
 | 
						|
        am->prob[1] = av_malloc_array(buf_size + 5, sizeof(*am->prob[1]));
 | 
						|
 | 
						|
    if (!am->prob[0] || !am->prob[1])
 | 
						|
        return AVERROR(ENOMEM);
 | 
						|
    memset(am->prob[0], 0, (buf_size + 5) * sizeof(*am->prob[0]));
 | 
						|
    memset(am->prob[1], 0, (buf_size + 5) * sizeof(*am->prob[1]));
 | 
						|
    return 0;
 | 
						|
}
 | 
						|
 | 
						|
static void adaptive_model_free(AdaptiveModel *am)
 | 
						|
{
 | 
						|
    av_freep(&am->prob[0]);
 | 
						|
    av_freep(&am->prob[1]);
 | 
						|
}
 | 
						|
 | 
						|
static av_cold int rka_decode_init(AVCodecContext *avctx)
 | 
						|
{
 | 
						|
    RKAContext *s = avctx->priv_data;
 | 
						|
    int qfactor;
 | 
						|
 | 
						|
    if (avctx->extradata_size < 16)
 | 
						|
        return AVERROR_INVALIDDATA;
 | 
						|
 | 
						|
    s->bps = avctx->bits_per_raw_sample = avctx->extradata[13];
 | 
						|
 | 
						|
    switch (s->bps) {
 | 
						|
    case 8:
 | 
						|
        avctx->sample_fmt = AV_SAMPLE_FMT_U8P;
 | 
						|
        break;
 | 
						|
    case 16:
 | 
						|
        avctx->sample_fmt = AV_SAMPLE_FMT_S16P;
 | 
						|
        break;
 | 
						|
    default:
 | 
						|
        return AVERROR_INVALIDDATA;
 | 
						|
    }
 | 
						|
 | 
						|
    av_channel_layout_uninit(&avctx->ch_layout);
 | 
						|
    s->channels = avctx->ch_layout.nb_channels = avctx->extradata[12];
 | 
						|
    if (s->channels < 1 || s->channels > 2)
 | 
						|
        return AVERROR_INVALIDDATA;
 | 
						|
 | 
						|
    s->align = (s->channels * (avctx->bits_per_raw_sample >> 3));
 | 
						|
    s->samples_left = s->total_nb_samples = (AV_RL32(avctx->extradata + 4)) / s->align;
 | 
						|
    s->frame_samples = 131072 / s->align;
 | 
						|
    s->last_nb_samples = s->total_nb_samples % s->frame_samples;
 | 
						|
    s->correlated = avctx->extradata[15] & 1;
 | 
						|
 | 
						|
    qfactor = avctx->extradata[14] & 0xf;
 | 
						|
    if ((avctx->extradata[15] & 4) != 0)
 | 
						|
        qfactor = -qfactor;
 | 
						|
 | 
						|
    s->ch[0].qfactor = s->ch[1].qfactor = qfactor < 0 ? 2 : qfactor;
 | 
						|
    s->ch[0].vrq = qfactor < 0 ? -qfactor : 0;
 | 
						|
    s->ch[1].vrq = qfactor < 0 ? -qfactor : 0;
 | 
						|
    if (qfactor < 0) {
 | 
						|
        s->ch[0].vrq = av_clip(s->ch[0].vrq, 1, 8);
 | 
						|
        s->ch[1].vrq = av_clip(s->ch[1].vrq, 1, 8);
 | 
						|
    }
 | 
						|
    av_log(avctx, AV_LOG_DEBUG, "qfactor: %d\n", qfactor);
 | 
						|
 | 
						|
    return 0;
 | 
						|
}
 | 
						|
 | 
						|
static void model64_init(Model64 *m, unsigned bits)
 | 
						|
{
 | 
						|
    unsigned x;
 | 
						|
 | 
						|
    m->bits = bits;
 | 
						|
    m->size = 64;
 | 
						|
    m->zero[0] = 1;
 | 
						|
 | 
						|
    x = (1 << (bits >> 1)) + 3;
 | 
						|
    x = FFMIN(x, 20);
 | 
						|
 | 
						|
    m->zero[1] = x;
 | 
						|
    m->sign[0] = 1;
 | 
						|
    m->sign[1] = 1;
 | 
						|
 | 
						|
    for (int i = 0; i < FF_ARRAY_ELEMS(m->val4); i++) {
 | 
						|
        m->val4[i] = 4;
 | 
						|
        m->val1[i] = 1;
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
static int chctx_init(RKAContext *s, ChContext *c,
 | 
						|
                      int sample_rate, int bps)
 | 
						|
{
 | 
						|
    int ret;
 | 
						|
 | 
						|
    memset(c->buf0, 0, sizeof(c->buf0));
 | 
						|
    memset(c->buf1, 0, sizeof(c->buf1));
 | 
						|
 | 
						|
    c->filt_size = &s->filt_size;
 | 
						|
    c->filt_bits = &s->filt_bits;
 | 
						|
 | 
						|
    c->bprob[0] = s->bprob[0];
 | 
						|
    c->bprob[1] = s->bprob[1];
 | 
						|
 | 
						|
    c->srate_pad = ((int64_t)sample_rate << 13) / 44100 & 0xFFFFFFFCU;
 | 
						|
    c->pos_idx = 1;
 | 
						|
 | 
						|
    for (int i = 0; i < FF_ARRAY_ELEMS(s->bprob[0]); i++)
 | 
						|
        c->bprob[0][i] = c->bprob[1][i] = 1;
 | 
						|
 | 
						|
    for (int i = 0; i < 11; i++) {
 | 
						|
        ret = adaptive_model_init(&c->coeff_bits[i], 32);
 | 
						|
        if (ret < 0)
 | 
						|
            return ret;
 | 
						|
 | 
						|
        model64_init(&c->mdl64[0][i], i);
 | 
						|
        model64_init(&c->mdl64[1][i], i);
 | 
						|
        model64_init(&c->mdl64[2][i], i+1);
 | 
						|
        model64_init(&c->mdl64[3][i], i+1);
 | 
						|
    }
 | 
						|
 | 
						|
    ret = adaptive_model_init(c->filt_size, 256);
 | 
						|
    if (ret < 0)
 | 
						|
        return ret;
 | 
						|
    ret = adaptive_model_init(c->filt_bits, 16);
 | 
						|
    if (ret < 0)
 | 
						|
        return ret;
 | 
						|
    ret = adaptive_model_init(&c->position, 16);
 | 
						|
    if (ret < 0)
 | 
						|
        return ret;
 | 
						|
    ret = adaptive_model_init(&c->nb_segments, 8);
 | 
						|
    if (ret < 0)
 | 
						|
        return ret;
 | 
						|
    return adaptive_model_init(&c->fshift, 32);
 | 
						|
}
 | 
						|
 | 
						|
static void init_acoder(ACoder *ac)
 | 
						|
{
 | 
						|
    ac->low = 0x0;
 | 
						|
    ac->high = 0xffffffff;
 | 
						|
    ac->value = bytestream2_get_be32(&ac->gb);
 | 
						|
}
 | 
						|
 | 
						|
static int ac_decode_bool(ACoder *ac, int freq1, int freq2)
 | 
						|
{
 | 
						|
    unsigned help, add, high, value;
 | 
						|
    int low;
 | 
						|
 | 
						|
    low = ac->low;
 | 
						|
    help = ac->high / (unsigned)(freq2 + freq1);
 | 
						|
    value = ac->value;
 | 
						|
    add = freq1 * help;
 | 
						|
    ac->high = help;
 | 
						|
 | 
						|
    if (value - low >= add) {
 | 
						|
        ac->low = low = add + low;
 | 
						|
        ac->high = high = freq2 * help;
 | 
						|
        while (1) {
 | 
						|
            if ((low ^ (high + low)) > 0xFFFFFF) {
 | 
						|
                if (high > 0xFFFF)
 | 
						|
                    return 1;
 | 
						|
                ac->high = (uint16_t)-(int16_t)low;
 | 
						|
            }
 | 
						|
 | 
						|
            if (bytestream2_get_bytes_left(&ac->gb) <= 0)
 | 
						|
                break;
 | 
						|
            ac->value = bytestream2_get_byteu(&ac->gb) | (ac->value << 8);
 | 
						|
            ac->high = high = ac->high << 8;
 | 
						|
            low = ac->low = ac->low << 8;
 | 
						|
        }
 | 
						|
        return -1;
 | 
						|
    }
 | 
						|
 | 
						|
    ac->high = add;
 | 
						|
    while (1) {
 | 
						|
        if ((low ^ (add + low)) > 0xFFFFFF) {
 | 
						|
            if (add > 0xFFFF)
 | 
						|
                return 0;
 | 
						|
            ac->high = (uint16_t)-(int16_t)low;
 | 
						|
        }
 | 
						|
 | 
						|
        if (bytestream2_get_bytes_left(&ac->gb) <= 0)
 | 
						|
            break;
 | 
						|
        ac->value = bytestream2_get_byteu(&ac->gb) | (ac->value << 8);
 | 
						|
        ac->high = add = ac->high << 8;
 | 
						|
        low = ac->low = ac->low << 8;
 | 
						|
    }
 | 
						|
    return -1;
 | 
						|
}
 | 
						|
 | 
						|
static int decode_bool(ACoder *ac, ChContext *c, int idx)
 | 
						|
{
 | 
						|
    uint32_t x;
 | 
						|
    int b;
 | 
						|
 | 
						|
    x = c->bprob[0][idx];
 | 
						|
    if (x + c->bprob[1][idx] > 4096) {
 | 
						|
        c->bprob[0][idx] = (x >> 1) + 1;
 | 
						|
        c->bprob[1][idx] = (c->bprob[1][idx] >> 1) + 1;
 | 
						|
    }
 | 
						|
 | 
						|
    b = ac_decode_bool(ac, c->bprob[0][idx], c->bprob[1][idx]);
 | 
						|
    if (b < 0)
 | 
						|
        return b;
 | 
						|
 | 
						|
    c->bprob[b][idx]++;
 | 
						|
 | 
						|
    return b;
 | 
						|
}
 | 
						|
 | 
						|
static int ac_get_freq(ACoder *ac, unsigned freq, int *result)
 | 
						|
{
 | 
						|
    uint32_t new_high;
 | 
						|
 | 
						|
    if (freq == 0)
 | 
						|
        return -1;
 | 
						|
 | 
						|
    new_high = ac->high / freq;
 | 
						|
    ac->high = new_high;
 | 
						|
 | 
						|
    if (new_high == 0)
 | 
						|
        return -1;
 | 
						|
 | 
						|
    *result = (ac->value - ac->low) / new_high;
 | 
						|
 | 
						|
    return 0;
 | 
						|
}
 | 
						|
 | 
						|
static int ac_update(ACoder *ac, int freq, int mul)
 | 
						|
{
 | 
						|
    uint32_t low, high;
 | 
						|
 | 
						|
    low = ac->low = ac->high * freq + ac->low;
 | 
						|
    high = ac->high = ac->high * mul;
 | 
						|
 | 
						|
    while (1) {
 | 
						|
        if (((high + low) ^ low) > 0xffffff) {
 | 
						|
            if (high > 0xffff)
 | 
						|
                return 0;
 | 
						|
            ac->high = (uint16_t)-(int16_t)low;
 | 
						|
        }
 | 
						|
 | 
						|
        if (bytestream2_get_bytes_left(&ac->gb) <= 0)
 | 
						|
            break;
 | 
						|
 | 
						|
        ac->value = (ac->value << 8) | bytestream2_get_byteu(&ac->gb);
 | 
						|
        low = ac->low = ac->low << 8;
 | 
						|
        high = ac->high = ac->high << 8;
 | 
						|
    }
 | 
						|
 | 
						|
    return -1;
 | 
						|
}
 | 
						|
 | 
						|
static void amdl_update_prob(AdaptiveModel *am, int val, int diff)
 | 
						|
{
 | 
						|
    am->aprob0 += diff;
 | 
						|
    if (val <= 0) {
 | 
						|
        am->prob[0][0] += diff;
 | 
						|
    } else {
 | 
						|
        do {
 | 
						|
            am->prob[0][val] += diff;
 | 
						|
            val += (val & -val);
 | 
						|
        } while (val < am->buf_size);
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
static void update_ch_subobj(AdaptiveModel *am)
 | 
						|
{
 | 
						|
    int idx2, idx = am->buf_size - 1;
 | 
						|
 | 
						|
    if (idx >= 0) {
 | 
						|
        do {
 | 
						|
            uint16_t *prob = am->prob[0];
 | 
						|
            int diff, prob_idx = prob[idx];
 | 
						|
 | 
						|
            idx2 = idx - 1;
 | 
						|
            if (idx > 0) {
 | 
						|
                int idx3 = idx - 1;
 | 
						|
 | 
						|
                if ((idx2 & idx) != idx2) {
 | 
						|
                    do {
 | 
						|
                        prob_idx -= prob[idx3];
 | 
						|
                        idx3 &= idx3 - 1;
 | 
						|
                    } while ((idx2 & idx) != idx3);
 | 
						|
                }
 | 
						|
            }
 | 
						|
 | 
						|
            diff = ((prob_idx > 0) - prob_idx) >> 1;
 | 
						|
            amdl_update_prob(am, idx, diff);
 | 
						|
            idx--;
 | 
						|
        } while (idx2 >= 0);
 | 
						|
    }
 | 
						|
 | 
						|
    if (am->sum < 8000)
 | 
						|
        am->sum += 200;
 | 
						|
 | 
						|
    am->aprob1 = (am->aprob1 + 1) >> 1;
 | 
						|
}
 | 
						|
 | 
						|
static int amdl_decode_int(AdaptiveModel *am, ACoder *ac, unsigned *dst, unsigned size)
 | 
						|
{
 | 
						|
    unsigned freq, size2, val, mul;
 | 
						|
    int j;
 | 
						|
 | 
						|
    size = FFMIN(size, am->buf_size - 1);
 | 
						|
 | 
						|
    if (am->aprob0 >= am->sum)
 | 
						|
        update_ch_subobj(am);
 | 
						|
 | 
						|
    if (am->aprob1 && (am->total == am->buf_size ||
 | 
						|
                       ac_decode_bool(ac, am->aprob0, am->aprob1) == 0)) {
 | 
						|
        if (am->total <= 1) {
 | 
						|
            dst[0] = am->last;
 | 
						|
            amdl_update_prob(am, dst[0], 1);
 | 
						|
            return 0;
 | 
						|
        }
 | 
						|
        if (size == am->buf_size - 1) {
 | 
						|
            freq = am->aprob0;
 | 
						|
        } else {
 | 
						|
            freq = am->prob[0][0];
 | 
						|
            for (int j = size; j > 0; j &= (j - 1) )
 | 
						|
                freq += am->prob[0][j];
 | 
						|
        }
 | 
						|
        ac_get_freq(ac, freq, &freq);
 | 
						|
        size2 = am->buf_size >> 1;
 | 
						|
        val = am->prob[0][0];
 | 
						|
        if (freq >= val) {
 | 
						|
            int sum = 0;
 | 
						|
            for (j = freq - val; size2; size2 >>= 1) {
 | 
						|
                unsigned v = am->prob[0][size2 + sum];
 | 
						|
                if (j >= v) {
 | 
						|
                    sum += size2;
 | 
						|
                    j -= v;
 | 
						|
                }
 | 
						|
            }
 | 
						|
            freq -= j;
 | 
						|
            val = sum + 1;
 | 
						|
        } else {
 | 
						|
            freq = 0;
 | 
						|
            val = 0;
 | 
						|
        }
 | 
						|
        dst[0] = val;
 | 
						|
        mul = am->prob[0][val];
 | 
						|
        if (val > 0) {
 | 
						|
            for (int k = val - 1; (val & (val - 1)) != k; k &= k - 1)
 | 
						|
                mul -= am->prob[0][k];
 | 
						|
        }
 | 
						|
        ac_update(ac, freq, mul);
 | 
						|
        amdl_update_prob(am, dst[0], 1);
 | 
						|
        return 0;
 | 
						|
    }
 | 
						|
    am->aprob1++;
 | 
						|
    if (size == am->buf_size - 1) {
 | 
						|
        ac_get_freq(ac, am->buf_size - am->total, &val);
 | 
						|
    } else {
 | 
						|
        freq = 1;
 | 
						|
        for (dst[0] = 0; dst[0] < size; dst[0]++) {
 | 
						|
            if (!am->prob[1][dst[0]])
 | 
						|
                freq++;
 | 
						|
        }
 | 
						|
        ac_get_freq(ac, freq, &val);
 | 
						|
    }
 | 
						|
    freq = 0;
 | 
						|
    dst[0] = 0;
 | 
						|
    if (val > 0 && am->buf_size > 0) {
 | 
						|
        for (dst[0] = 0; dst[0] < size & freq < val; dst[0]++) {
 | 
						|
            if (!am->prob[1][dst[0]])
 | 
						|
                freq++;
 | 
						|
        }
 | 
						|
    }
 | 
						|
    if (am->prob[1][dst[0]]) {
 | 
						|
        do {
 | 
						|
            val = dst[0]++;
 | 
						|
        } while (val + 1 < am->buf_size && am->prob[1][val + 1]);
 | 
						|
    }
 | 
						|
    ac_update(ac, freq, 1);
 | 
						|
    am->prob[1][dst[0]]++;
 | 
						|
    am->total++;
 | 
						|
    amdl_update_prob(am, dst[0], 1);
 | 
						|
    am->last = dst[0];
 | 
						|
 | 
						|
    return 0;
 | 
						|
}
 | 
						|
 | 
						|
static int decode_filt_coeffs(RKAContext *s, ChContext *ctx, ACoder *ac, FiltCoeffs *dst)
 | 
						|
{
 | 
						|
    unsigned val, bits;
 | 
						|
    int idx = 0;
 | 
						|
 | 
						|
    if (amdl_decode_int(ctx->filt_size, ac, &dst->size, 256) < 0)
 | 
						|
        return -1;
 | 
						|
 | 
						|
    if (dst->size == 0)
 | 
						|
        return 0;
 | 
						|
 | 
						|
    if (amdl_decode_int(ctx->filt_bits, ac, &bits, 10) < 0)
 | 
						|
        return -1;
 | 
						|
 | 
						|
    do {
 | 
						|
        if (((idx == 8) || (idx == 20)) && (0 < bits))
 | 
						|
            bits--;
 | 
						|
 | 
						|
        if (bits > 10)
 | 
						|
            return -1;
 | 
						|
 | 
						|
        if (amdl_decode_int(&ctx->coeff_bits[bits], ac, &val, 31) < 0)
 | 
						|
            return -1;
 | 
						|
 | 
						|
        if (val == 31) {
 | 
						|
            ac_get_freq(ac, 65536, &val);
 | 
						|
            ac_update(ac, val, 1);
 | 
						|
        }
 | 
						|
 | 
						|
        if (val == 0) {
 | 
						|
            dst->coeffs[idx++] = 0;
 | 
						|
        } else {
 | 
						|
            unsigned freq = 0;
 | 
						|
            int sign;
 | 
						|
 | 
						|
            if (bits > 0) {
 | 
						|
                ac_get_freq(ac, 1 << bits, &freq);
 | 
						|
                ac_update(ac, freq, 1);
 | 
						|
            }
 | 
						|
            dst->coeffs[idx] = freq + 1 + ((val - 1U) << bits);
 | 
						|
            sign = decode_bool(ac, ctx, idx);
 | 
						|
            if (sign < 0)
 | 
						|
                return -1;
 | 
						|
            if (sign == 1)
 | 
						|
                dst->coeffs[idx] = -dst->coeffs[idx];
 | 
						|
            idx++;
 | 
						|
        }
 | 
						|
    } while (idx < dst->size);
 | 
						|
 | 
						|
    return 0;
 | 
						|
}
 | 
						|
 | 
						|
static int ac_dec_bit(ACoder *ac)
 | 
						|
{
 | 
						|
    uint32_t high, low;
 | 
						|
 | 
						|
    low = ac->low;
 | 
						|
    ac->high = high = ac->high >> 1;
 | 
						|
    if (ac->value - low < high) {
 | 
						|
        do {
 | 
						|
            if (((high + low) ^ low) > 0xffffff) {
 | 
						|
                if (high > 0xffff)
 | 
						|
                    return 0;
 | 
						|
                ac->high = (uint16_t)-(int16_t)low;
 | 
						|
            }
 | 
						|
 | 
						|
            if (bytestream2_get_bytes_left(&ac->gb) <= 0)
 | 
						|
                break;
 | 
						|
 | 
						|
            ac->value = (ac->value << 8) | bytestream2_get_byteu(&ac->gb);
 | 
						|
            ac->high = high = ac->high << 8;
 | 
						|
            ac->low = low = ac->low << 8;
 | 
						|
        } while (1);
 | 
						|
 | 
						|
        return -1;
 | 
						|
    }
 | 
						|
    ac->low = low = low + high;
 | 
						|
    do {
 | 
						|
        if (((high + low) ^ low) > 0xffffff) {
 | 
						|
            if (high > 0xffff)
 | 
						|
                return 1;
 | 
						|
            ac->high = (uint16_t)-(int16_t)low;
 | 
						|
        }
 | 
						|
 | 
						|
        if (bytestream2_get_bytes_left(&ac->gb) <= 0)
 | 
						|
            break;
 | 
						|
 | 
						|
        ac->value = (ac->value << 8) | bytestream2_get_byteu(&ac->gb);
 | 
						|
        ac->high = high = ac->high << 8;
 | 
						|
        ac->low = low = ac->low << 8;
 | 
						|
    } while (1);
 | 
						|
 | 
						|
    return -1;
 | 
						|
}
 | 
						|
 | 
						|
static int mdl64_decode(ACoder *ac, Model64 *ctx, int *dst)
 | 
						|
{
 | 
						|
    int sign, idx, bits;
 | 
						|
    unsigned val = 0;
 | 
						|
 | 
						|
    if (ctx->zero[0] + ctx->zero[1] > 4000U) {
 | 
						|
        ctx->zero[0] = (ctx->zero[0] >> 1) + 1;
 | 
						|
        ctx->zero[1] = (ctx->zero[1] >> 1) + 1;
 | 
						|
    }
 | 
						|
    if (ctx->sign[0] + ctx->sign[1] > 4000U) {
 | 
						|
        ctx->sign[0] = (ctx->sign[0] >> 1) + 1;
 | 
						|
        ctx->sign[1] = (ctx->sign[1] >> 1) + 1;
 | 
						|
    }
 | 
						|
    sign = ac_decode_bool(ac, ctx->zero[0], ctx->zero[1]);
 | 
						|
    if (sign == 0) {
 | 
						|
        ctx->zero[0] += 2;
 | 
						|
        dst[0] = 0;
 | 
						|
        return 0;
 | 
						|
    } else if (sign < 0) {
 | 
						|
        return -1;
 | 
						|
    }
 | 
						|
 | 
						|
    ctx->zero[1] += 2;
 | 
						|
    sign = ac_decode_bool(ac, ctx->sign[0], ctx->sign[1]);
 | 
						|
    if (sign < 0)
 | 
						|
        return -1;
 | 
						|
    ctx->sign[sign]++;
 | 
						|
    bits = ctx->bits;
 | 
						|
    if (bits > 0) {
 | 
						|
        if (bits < 13) {
 | 
						|
            ac_get_freq(ac, 1 << bits, &val);
 | 
						|
            ac_update(ac, val, 1);
 | 
						|
        } else {
 | 
						|
            int hbits = bits / 2;
 | 
						|
            ac_get_freq(ac, 1 << hbits, &val);
 | 
						|
            ac_update(ac, val, 1);
 | 
						|
            ac_get_freq(ac, 1 << (ctx->bits - (hbits)), &bits);
 | 
						|
            ac_update(ac, val, 1);
 | 
						|
            val += (bits << hbits);
 | 
						|
        }
 | 
						|
    }
 | 
						|
    bits = ctx->size;
 | 
						|
    idx = 0;
 | 
						|
    if (bits >= 0) {
 | 
						|
        do {
 | 
						|
            uint16_t *val4 = ctx->val4;
 | 
						|
            int b;
 | 
						|
 | 
						|
            if (val4[idx] + ctx->val1[idx] > 2000U) {
 | 
						|
                val4[idx] = (val4[idx] >> 1) + 1;
 | 
						|
                ctx->val1[idx] = (ctx->val1[idx] >> 1) + 1;
 | 
						|
            }
 | 
						|
            b = ac_decode_bool(ac, ctx->val4[idx], ctx->val1[idx]);
 | 
						|
            if (b == 1) {
 | 
						|
                ctx->val1[idx] += 4;
 | 
						|
                break;
 | 
						|
            } else if (b < 0) {
 | 
						|
                return -1;
 | 
						|
            }
 | 
						|
            ctx->val4[idx] += 4;
 | 
						|
            idx++;
 | 
						|
        } while (idx <= ctx->size);
 | 
						|
        bits = ctx->size;
 | 
						|
        if (idx <= bits) {
 | 
						|
            dst[0] = val + 1 + (idx << ctx->bits);
 | 
						|
            if (sign)
 | 
						|
                dst[0] = -dst[0];
 | 
						|
            return 0;
 | 
						|
        }
 | 
						|
    }
 | 
						|
    bits++;
 | 
						|
    while (ac_dec_bit(ac) == 0)
 | 
						|
        bits += 64;
 | 
						|
    ac_get_freq(ac, 64, &idx);
 | 
						|
    ac_update(ac, idx, 1);
 | 
						|
    idx += bits;
 | 
						|
    dst[0] = val + 1 + (idx << ctx->bits);
 | 
						|
    if (sign)
 | 
						|
        dst[0] = -dst[0];
 | 
						|
 | 
						|
    return 0;
 | 
						|
}
 | 
						|
 | 
						|
static const uint8_t vrq_qfactors[8] = { 3, 3, 2, 2, 1, 1, 1, 1 };
 | 
						|
 | 
						|
static int decode_filter(RKAContext *s, ChContext *ctx, ACoder *ac, int off, unsigned size)
 | 
						|
{
 | 
						|
    FiltCoeffs filt;
 | 
						|
    Model64 *mdl64;
 | 
						|
    int split, val, last_val = 0, ret;
 | 
						|
    unsigned rsize, idx = 3, bits = 0, m = 0;
 | 
						|
 | 
						|
    if (ctx->qfactor == 0) {
 | 
						|
        if (amdl_decode_int(&ctx->fshift, ac, &bits, 15) < 0)
 | 
						|
            return -1;
 | 
						|
        bits &= 31U;
 | 
						|
    }
 | 
						|
 | 
						|
    ret = decode_filt_coeffs(s, ctx, ac, &filt);
 | 
						|
    if (ret < 0)
 | 
						|
        return ret;
 | 
						|
 | 
						|
    if (size < 512)
 | 
						|
        split = size / 2;
 | 
						|
    else
 | 
						|
        split = size >> 4;
 | 
						|
 | 
						|
    if (size <= 1)
 | 
						|
        return 0;
 | 
						|
 | 
						|
    for (int x = 0; x < size;) {
 | 
						|
        if (amdl_decode_int(&ctx->position, ac, &idx, 10) < 0)
 | 
						|
            return -1;
 | 
						|
 | 
						|
        m = 0;
 | 
						|
        idx = (ctx->pos_idx + idx) % 11;
 | 
						|
        ctx->pos_idx = idx;
 | 
						|
 | 
						|
        rsize = FFMIN(split, size - x);
 | 
						|
        for (int y = 0; y < rsize; y++, off++) {
 | 
						|
            int midx, shift = idx, *src, sum = 16;
 | 
						|
 | 
						|
            if (off >= FF_ARRAY_ELEMS(ctx->buf0))
 | 
						|
                return -1;
 | 
						|
 | 
						|
            midx = FFABS(last_val) >> shift;
 | 
						|
            if (midx >= 15) {
 | 
						|
                mdl64 = &ctx->mdl64[3][idx];
 | 
						|
            } else if (midx >= 7) {
 | 
						|
                mdl64 = &ctx->mdl64[2][idx];
 | 
						|
            } else if (midx >= 4) {
 | 
						|
                mdl64 = &ctx->mdl64[1][idx];
 | 
						|
            } else {
 | 
						|
                mdl64 = &ctx->mdl64[0][idx];
 | 
						|
            }
 | 
						|
            ret = mdl64_decode(ac, mdl64, &val);
 | 
						|
            if (ret < 0)
 | 
						|
                return -1;
 | 
						|
            last_val = val;
 | 
						|
            src = &ctx->buf1[off + -1];
 | 
						|
            for (int i = 0; i < filt.size && i < 15; i++)
 | 
						|
                sum += filt.coeffs[i] * (unsigned)src[-i];
 | 
						|
            sum = sum * 2U;
 | 
						|
            for (int i = 15; i < filt.size; i++)
 | 
						|
                sum += filt.coeffs[i] * (unsigned)src[-i];
 | 
						|
            sum = sum >> 6;
 | 
						|
            if (ctx->qfactor == 0) {
 | 
						|
                if (bits == 0) {
 | 
						|
                    ctx->buf1[off] = sum + val;
 | 
						|
                } else {
 | 
						|
                    ctx->buf1[off] = (val + (sum >> bits)) * (1U << bits) +
 | 
						|
                        (((1U << bits) - 1U) & ctx->buf1[off + -1]);
 | 
						|
                }
 | 
						|
                ctx->buf0[off] = ctx->buf1[off] + (unsigned)ctx->buf0[off + -1];
 | 
						|
            } else {
 | 
						|
                val *= 1U << ctx->qfactor;
 | 
						|
                sum += ctx->buf0[off + -1] + (unsigned)val;
 | 
						|
                switch (s->bps) {
 | 
						|
                case 16: sum = av_clip_int16(sum); break;
 | 
						|
                case  8: sum = av_clip_int8(sum);  break;
 | 
						|
                }
 | 
						|
                ctx->buf1[off] = sum - ctx->buf0[off + -1];
 | 
						|
                ctx->buf0[off] = sum;
 | 
						|
                m += (unsigned)FFABS(ctx->buf1[off]);
 | 
						|
            }
 | 
						|
        }
 | 
						|
        if (ctx->vrq != 0) {
 | 
						|
            int sum = 0;
 | 
						|
            for (unsigned i = (m << 6) / rsize; i > 0; i = i >> 1)
 | 
						|
                sum++;
 | 
						|
            sum -= (ctx->vrq + 7);
 | 
						|
            ctx->qfactor = FFMAX(sum, vrq_qfactors[ctx->vrq - 1]);
 | 
						|
        }
 | 
						|
 | 
						|
        x += split;
 | 
						|
    }
 | 
						|
 | 
						|
    return 0;
 | 
						|
}
 | 
						|
 | 
						|
static int decode_samples(AVCodecContext *avctx, ACoder *ac, ChContext *ctx, int offset)
 | 
						|
{
 | 
						|
    RKAContext *s = avctx->priv_data;
 | 
						|
    int segment_size, offset2, mode, ret;
 | 
						|
 | 
						|
    ret = amdl_decode_int(&ctx->nb_segments, ac, &mode, 5);
 | 
						|
    if (ret < 0)
 | 
						|
        return ret;
 | 
						|
 | 
						|
    if (mode == 5) {
 | 
						|
        ret = ac_get_freq(ac, ctx->srate_pad >> 2, &segment_size);
 | 
						|
        if (ret < 0)
 | 
						|
            return ret;
 | 
						|
        ac_update(ac, segment_size, 1);
 | 
						|
        segment_size *= 4;
 | 
						|
        ret = decode_filter(s, ctx, ac, offset, segment_size);
 | 
						|
        if (ret < 0)
 | 
						|
            return ret;
 | 
						|
    } else {
 | 
						|
        segment_size = ctx->srate_pad;
 | 
						|
 | 
						|
        if (mode) {
 | 
						|
            if (mode > 2) {
 | 
						|
                ret = decode_filter(s, ctx, ac, offset, segment_size / 4);
 | 
						|
                if (ret < 0)
 | 
						|
                    return ret;
 | 
						|
                offset2 = segment_size / 4 + offset;
 | 
						|
                ret = decode_filter(s, ctx, ac, offset2, segment_size / 4);
 | 
						|
                if (ret < 0)
 | 
						|
                    return ret;
 | 
						|
                offset2 = segment_size / 4 + offset2;
 | 
						|
            } else {
 | 
						|
                ret = decode_filter(s, ctx, ac, offset, segment_size / 2);
 | 
						|
                if (ret < 0)
 | 
						|
                    return ret;
 | 
						|
                offset2 = segment_size / 2 + offset;
 | 
						|
            }
 | 
						|
            if (mode & 1) {
 | 
						|
                ret = decode_filter(s, ctx, ac, offset2, segment_size / 2);
 | 
						|
                if (ret < 0)
 | 
						|
                    return ret;
 | 
						|
            } else {
 | 
						|
                ret = decode_filter(s, ctx, ac, offset2, segment_size / 4);
 | 
						|
                if (ret < 0)
 | 
						|
                    return ret;
 | 
						|
                ret = decode_filter(s, ctx, ac, segment_size / 4 + offset2, segment_size / 4);
 | 
						|
                if (ret < 0)
 | 
						|
                    return ret;
 | 
						|
            }
 | 
						|
        } else {
 | 
						|
            ret = decode_filter(s, ctx, ac, offset, ctx->srate_pad);
 | 
						|
            if (ret < 0)
 | 
						|
                return ret;
 | 
						|
        }
 | 
						|
    }
 | 
						|
 | 
						|
    return segment_size;
 | 
						|
}
 | 
						|
 | 
						|
static int decode_ch_samples(AVCodecContext *avctx, ChContext *c)
 | 
						|
{
 | 
						|
    RKAContext *s = avctx->priv_data;
 | 
						|
    ACoder *ac = &s->ac;
 | 
						|
    int nb_decoded = 0;
 | 
						|
 | 
						|
    if (bytestream2_get_bytes_left(&ac->gb) <= 0)
 | 
						|
        return 0;
 | 
						|
 | 
						|
    memmove(c->buf0, &c->buf0[c->last_nb_decoded], 2560 * sizeof(*c->buf0));
 | 
						|
    memmove(c->buf1, &c->buf1[c->last_nb_decoded], 2560 * sizeof(*c->buf1));
 | 
						|
 | 
						|
    nb_decoded = decode_samples(avctx, ac, c, 2560);
 | 
						|
    if (nb_decoded < 0)
 | 
						|
        return nb_decoded;
 | 
						|
    c->last_nb_decoded = nb_decoded;
 | 
						|
 | 
						|
    return nb_decoded;
 | 
						|
}
 | 
						|
 | 
						|
static int rka_decode_frame(AVCodecContext *avctx, AVFrame *frame,
 | 
						|
                            int *got_frame_ptr, AVPacket *avpkt)
 | 
						|
{
 | 
						|
    RKAContext *s = avctx->priv_data;
 | 
						|
    ACoder *ac = &s->ac;
 | 
						|
    int ret;
 | 
						|
 | 
						|
    bytestream2_init(&ac->gb, avpkt->data, avpkt->size);
 | 
						|
    init_acoder(ac);
 | 
						|
 | 
						|
    for (int ch = 0; ch < s->channels; ch++) {
 | 
						|
        ret = chctx_init(s, &s->ch[ch], avctx->sample_rate,
 | 
						|
                         avctx->bits_per_raw_sample);
 | 
						|
        if (ret < 0)
 | 
						|
            return ret;
 | 
						|
    }
 | 
						|
 | 
						|
    frame->nb_samples = s->frame_samples;
 | 
						|
    if ((ret = ff_get_buffer(avctx, frame, 0)) < 0)
 | 
						|
        return ret;
 | 
						|
 | 
						|
    if (s->channels == 2 && s->correlated) {
 | 
						|
        int16_t *l16 = (int16_t *)frame->extended_data[0];
 | 
						|
        int16_t *r16 = (int16_t *)frame->extended_data[1];
 | 
						|
        uint8_t *l8 = frame->extended_data[0];
 | 
						|
        uint8_t *r8 = frame->extended_data[1];
 | 
						|
 | 
						|
        for (int n = 0; n < frame->nb_samples;) {
 | 
						|
            ret = decode_ch_samples(avctx, &s->ch[0]);
 | 
						|
            if (ret == 0) {
 | 
						|
                frame->nb_samples = n;
 | 
						|
                break;
 | 
						|
            }
 | 
						|
            if (ret < 0 || n + ret > frame->nb_samples)
 | 
						|
                return AVERROR_INVALIDDATA;
 | 
						|
 | 
						|
            ret = decode_ch_samples(avctx, &s->ch[1]);
 | 
						|
            if (ret == 0) {
 | 
						|
                frame->nb_samples = n;
 | 
						|
                break;
 | 
						|
            }
 | 
						|
            if (ret < 0 || n + ret > frame->nb_samples)
 | 
						|
                return AVERROR_INVALIDDATA;
 | 
						|
 | 
						|
            switch (avctx->sample_fmt) {
 | 
						|
            case AV_SAMPLE_FMT_S16P:
 | 
						|
                for (int i = 0; i < ret; i++) {
 | 
						|
                    int l = s->ch[0].buf0[2560 + i];
 | 
						|
                    int r = s->ch[1].buf0[2560 + i];
 | 
						|
 | 
						|
                    l16[n + i] = (l * 2 + r + 1) >> 1;
 | 
						|
                    r16[n + i] = (l * 2 - r + 1) >> 1;
 | 
						|
                }
 | 
						|
                break;
 | 
						|
            case AV_SAMPLE_FMT_U8P:
 | 
						|
                for (int i = 0; i < ret; i++) {
 | 
						|
                    int l = s->ch[0].buf0[2560 + i];
 | 
						|
                    int r = s->ch[1].buf0[2560 + i];
 | 
						|
 | 
						|
                    l8[n + i] = ((l * 2 + r + 1) >> 1) + 0x7f;
 | 
						|
                    r8[n + i] = ((l * 2 - r + 1) >> 1) + 0x7f;
 | 
						|
                }
 | 
						|
                break;
 | 
						|
            default:
 | 
						|
                return AVERROR_INVALIDDATA;
 | 
						|
            }
 | 
						|
 | 
						|
            n += ret;
 | 
						|
        }
 | 
						|
    } else {
 | 
						|
        for (int n = 0; n < frame->nb_samples;) {
 | 
						|
            for (int ch = 0; ch < s->channels; ch++) {
 | 
						|
                int16_t *m16 = (int16_t *)frame->data[ch];
 | 
						|
                uint8_t *m8 = frame->data[ch];
 | 
						|
 | 
						|
                ret = decode_ch_samples(avctx, &s->ch[ch]);
 | 
						|
                if (ret == 0) {
 | 
						|
                    frame->nb_samples = n;
 | 
						|
                    break;
 | 
						|
                }
 | 
						|
 | 
						|
                if (ret < 0 || n + ret > frame->nb_samples)
 | 
						|
                    return AVERROR_INVALIDDATA;
 | 
						|
 | 
						|
                switch (avctx->sample_fmt) {
 | 
						|
                case AV_SAMPLE_FMT_S16P:
 | 
						|
                    for (int i = 0; i < ret; i++) {
 | 
						|
                        int m = s->ch[ch].buf0[2560 + i];
 | 
						|
 | 
						|
                        m16[n + i] = m;
 | 
						|
                    }
 | 
						|
                    break;
 | 
						|
                case AV_SAMPLE_FMT_U8P:
 | 
						|
                    for (int i = 0; i < ret; i++) {
 | 
						|
                        int m = s->ch[ch].buf0[2560 + i];
 | 
						|
 | 
						|
                        m8[n + i] = m + 0x7f;
 | 
						|
                    }
 | 
						|
                    break;
 | 
						|
                default:
 | 
						|
                    return AVERROR_INVALIDDATA;
 | 
						|
                }
 | 
						|
            }
 | 
						|
 | 
						|
            n += ret;
 | 
						|
        }
 | 
						|
    }
 | 
						|
 | 
						|
    if (frame->nb_samples < s->frame_samples &&
 | 
						|
        frame->nb_samples > s->last_nb_samples)
 | 
						|
        frame->nb_samples = s->last_nb_samples;
 | 
						|
 | 
						|
    *got_frame_ptr = 1;
 | 
						|
 | 
						|
    return avpkt->size;
 | 
						|
}
 | 
						|
 | 
						|
static av_cold int rka_decode_close(AVCodecContext *avctx)
 | 
						|
{
 | 
						|
    RKAContext *s = avctx->priv_data;
 | 
						|
 | 
						|
    for (int ch = 0; ch < 2; ch++) {
 | 
						|
        ChContext *c = &s->ch[ch];
 | 
						|
 | 
						|
        for (int i = 0; i < 11; i++)
 | 
						|
            adaptive_model_free(&c->coeff_bits[i]);
 | 
						|
 | 
						|
        adaptive_model_free(&c->position);
 | 
						|
        adaptive_model_free(&c->nb_segments);
 | 
						|
        adaptive_model_free(&c->fshift);
 | 
						|
    }
 | 
						|
 | 
						|
    adaptive_model_free(&s->filt_size);
 | 
						|
    adaptive_model_free(&s->filt_bits);
 | 
						|
 | 
						|
    return 0;
 | 
						|
}
 | 
						|
 | 
						|
const FFCodec ff_rka_decoder = {
 | 
						|
    .p.name         = "rka",
 | 
						|
    CODEC_LONG_NAME("RKA (RK Audio)"),
 | 
						|
    .p.type         = AVMEDIA_TYPE_AUDIO,
 | 
						|
    .p.id           = AV_CODEC_ID_RKA,
 | 
						|
    .priv_data_size = sizeof(RKAContext),
 | 
						|
    .init           = rka_decode_init,
 | 
						|
    .close          = rka_decode_close,
 | 
						|
    FF_CODEC_DECODE_CB(rka_decode_frame),
 | 
						|
    .p.capabilities = AV_CODEC_CAP_DR1 | AV_CODEC_CAP_CHANNEL_CONF,
 | 
						|
    .caps_internal  = FF_CODEC_CAP_INIT_CLEANUP,
 | 
						|
};
 |