flacdsp.c 3.79 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23
/*
 * Copyright (c) 2012 Mans Rullgard <mans@mansr.com>
 *
 * This file is part of Libav.
 *
 * Libav 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.
 *
 * Libav 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 Libav; if not, write to the Free Software
 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
 */

#include "libavutil/attributes.h"
#include "libavutil/samplefmt.h"
#include "flacdsp.h"
24
#include "config.h"
25 26

#define SAMPLE_SIZE 16
27 28
#define PLANAR 0
#include "flacdsp_template.c"
29
#include "flacdsp_lpc_template.c"
30 31 32

#undef  PLANAR
#define PLANAR 1
33 34 35
#include "flacdsp_template.c"

#undef  SAMPLE_SIZE
36
#undef  PLANAR
37
#define SAMPLE_SIZE 32
38 39
#define PLANAR 0
#include "flacdsp_template.c"
40
#include "flacdsp_lpc_template.c"
41 42 43

#undef  PLANAR
#define PLANAR 1
44 45
#include "flacdsp_template.c"

46 47 48 49 50
static void flac_lpc_16_c(int32_t *decoded, const int coeffs[32],
                          int pred_order, int qlevel, int len)
{
    int i, j;

51 52 53
    for (i = pred_order; i < len - 1; i += 2, decoded += 2) {
        int c = coeffs[0];
        int d = decoded[0];
54
        int s0 = 0, s1 = 0;
55
        for (j = 1; j < pred_order; j++) {
56
            s0 += c*d;
57
            d = decoded[j];
58
            s1 += c*d;
59
            c = coeffs[j];
60 61
        }
        s0 += c*d;
62
        d = decoded[j] += s0 >> qlevel;
63
        s1 += c*d;
64
        decoded[j + 1] += s1 >> qlevel;
65 66 67 68
    }
    if (i < len) {
        int sum = 0;
        for (j = 0; j < pred_order; j++)
69 70
            sum += coeffs[j] * decoded[j];
        decoded[j] += sum >> qlevel;
71 72 73 74 75 76 77 78
    }
}

static void flac_lpc_32_c(int32_t *decoded, const int coeffs[32],
                          int pred_order, int qlevel, int len)
{
    int i, j;

79
    for (i = pred_order; i < len; i++, decoded++) {
80 81
        int64_t sum = 0;
        for (j = 0; j < pred_order; j++)
82 83
            sum += (int64_t)coeffs[j] * decoded[j];
        decoded[j] += sum >> qlevel;
84 85 86 87
    }

}

88 89
av_cold void ff_flacdsp_init(FLACDSPContext *c, enum AVSampleFormat fmt,
                             int bps)
90
{
91
    if (bps > 16) {
92
        c->lpc            = flac_lpc_32_c;
93 94
        c->lpc_encode     = flac_lpc_encode_c_32;
    } else {
95
        c->lpc            = flac_lpc_16_c;
96 97
        c->lpc_encode     = flac_lpc_encode_c_16;
    }
98

99 100 101 102 103 104
    switch (fmt) {
    case AV_SAMPLE_FMT_S32:
        c->decorrelate[0] = flac_decorrelate_indep_c_32;
        c->decorrelate[1] = flac_decorrelate_ls_c_32;
        c->decorrelate[2] = flac_decorrelate_rs_c_32;
        c->decorrelate[3] = flac_decorrelate_ms_c_32;
105 106 107 108 109 110 111
        break;

    case AV_SAMPLE_FMT_S32P:
        c->decorrelate[0] = flac_decorrelate_indep_c_32p;
        c->decorrelate[1] = flac_decorrelate_ls_c_32p;
        c->decorrelate[2] = flac_decorrelate_rs_c_32p;
        c->decorrelate[3] = flac_decorrelate_ms_c_32p;
112 113 114 115 116 117 118
        break;

    case AV_SAMPLE_FMT_S16:
        c->decorrelate[0] = flac_decorrelate_indep_c_16;
        c->decorrelate[1] = flac_decorrelate_ls_c_16;
        c->decorrelate[2] = flac_decorrelate_rs_c_16;
        c->decorrelate[3] = flac_decorrelate_ms_c_16;
119 120 121 122 123 124 125
        break;

    case AV_SAMPLE_FMT_S16P:
        c->decorrelate[0] = flac_decorrelate_indep_c_16p;
        c->decorrelate[1] = flac_decorrelate_ls_c_16p;
        c->decorrelate[2] = flac_decorrelate_rs_c_16p;
        c->decorrelate[3] = flac_decorrelate_ms_c_16p;
126 127
        break;
    }
128 129 130

    if (ARCH_ARM)
        ff_flacdsp_init_arm(c, fmt, bps);
131
}