git.sesse.net Git - ffmpeg/blob - libavcodec/atrac3plusdec.c

   1 /*
   2  * ATRAC3+ compatible decoder
   3  *
   4  * Copyright (c) 2010-2013 Maxim Poliakovski
   5  *
   6  * This file is part of FFmpeg.
   7  *
   8  * FFmpeg is free software; you can redistribute it and/or
   9  * modify it under the terms of the GNU Lesser General Public
  10  * License as published by the Free Software Foundation; either
  11  * version 2.1 of the License, or (at your option) any later version.
  12  *
  13  * FFmpeg is distributed in the hope that it will be useful,
  14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  16  * Lesser General Public License for more details.
  17  *
  18  * You should have received a copy of the GNU Lesser General Public
  19  * License along with FFmpeg; if not, write to the Free Software
  20  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
  21  */
  22
  23 /**
  24  * @file
  25  * Sony ATRAC3+ compatible decoder.
  26  *
  27  * Container formats used to store its data:
  28  * RIFF WAV (.at3) and Sony OpenMG (.oma, .aa3).
  29  *
  30  * Technical description of this codec can be found here:
  31  * http://wiki.multimedia.cx/index.php?title=ATRAC3plus
  32  *
  33  * Kudos to Benjamin Larsson and Michael Karcher
  34  * for their precious technical help!
  35  */
  36
  37 #include <stdint.h>
  38 #include <string.h>
  39
  40 #include "libavutil/channel_layout.h"
  41 #include "libavutil/float_dsp.h"
  42 #include "avcodec.h"
  43 #include "get_bits.h"
  44 #include "internal.h"
  45 #include "atrac.h"
  46 #include "atrac3plus.h"
  47
  48 typedef struct ATRAC3PContext {
  49     GetBitContext gb;
  50     AVFloatDSPContext fdsp;
  51
  52     DECLARE_ALIGNED(32, float, samples)[2][ATRAC3P_FRAME_SAMPLES];  ///< quantized MDCT spectrum
  53     DECLARE_ALIGNED(32, float, mdct_buf)[2][ATRAC3P_FRAME_SAMPLES]; ///< output of the IMDCT
  54     DECLARE_ALIGNED(32, float, time_buf)[2][ATRAC3P_FRAME_SAMPLES]; ///< output of the gain compensation
  55     DECLARE_ALIGNED(32, float, outp_buf)[2][ATRAC3P_FRAME_SAMPLES];
  56
  57     AtracGCContext gainc_ctx;   ///< gain compensation context
  58     FFTContext mdct_ctx;
  59     FFTContext ipqf_dct_ctx;    ///< IDCT context used by IPQF
  60
  61     Atrac3pChanUnitCtx *ch_units;   ///< global channel units
  62
  63     int num_channel_blocks;     ///< number of channel blocks
  64     uint8_t channel_blocks[5];  ///< channel configuration descriptor
  65     uint64_t my_channel_layout; ///< current channel layout
  66 } ATRAC3PContext;
  67
  68 static av_cold int atrac3p_decode_close(AVCodecContext *avctx)
  69 {
  70     av_free(((ATRAC3PContext *)(avctx->priv_data))->ch_units);
  71
  72     return 0;
  73 }
  74
  75 static av_cold int set_channel_params(ATRAC3PContext *ctx,
  76                                       AVCodecContext *avctx)
  77 {
  78     memset(ctx->channel_blocks, 0, sizeof(ctx->channel_blocks));
  79
  80     switch (avctx->channel_layout) {
  81     case AV_CH_FRONT_LEFT:
  82     case AV_CH_LAYOUT_MONO:
  83         ctx->num_channel_blocks = 1;
  84         ctx->channel_blocks[0]  = CH_UNIT_MONO;
  85         break;
  86     case AV_CH_LAYOUT_STEREO:
  87         ctx->num_channel_blocks = 1;
  88         ctx->channel_blocks[0]  = CH_UNIT_STEREO;
  89         break;
  90     case AV_CH_LAYOUT_SURROUND:
  91         ctx->num_channel_blocks = 2;
  92         ctx->channel_blocks[0]  = CH_UNIT_STEREO;
  93         ctx->channel_blocks[1]  = CH_UNIT_MONO;
  94         break;
  95     case AV_CH_LAYOUT_4POINT0:
  96         ctx->num_channel_blocks = 3;
  97         ctx->channel_blocks[0]  = CH_UNIT_STEREO;
  98         ctx->channel_blocks[1]  = CH_UNIT_MONO;
  99         ctx->channel_blocks[2]  = CH_UNIT_MONO;
 100         break;
 101     case AV_CH_LAYOUT_5POINT1_BACK:
 102         ctx->num_channel_blocks = 4;
 103         ctx->channel_blocks[0]  = CH_UNIT_STEREO;
 104         ctx->channel_blocks[1]  = CH_UNIT_MONO;
 105         ctx->channel_blocks[2]  = CH_UNIT_STEREO;
 106         ctx->channel_blocks[3]  = CH_UNIT_MONO;
 107         break;
 108     case AV_CH_LAYOUT_6POINT1_BACK:
 109         ctx->num_channel_blocks = 5;
 110         ctx->channel_blocks[0]  = CH_UNIT_STEREO;
 111         ctx->channel_blocks[1]  = CH_UNIT_MONO;
 112         ctx->channel_blocks[2]  = CH_UNIT_STEREO;
 113         ctx->channel_blocks[3]  = CH_UNIT_MONO;
 114         ctx->channel_blocks[4]  = CH_UNIT_MONO;
 115         break;
 116     case AV_CH_LAYOUT_7POINT1:
 117         ctx->num_channel_blocks = 5;
 118         ctx->channel_blocks[0]  = CH_UNIT_STEREO;
 119         ctx->channel_blocks[1]  = CH_UNIT_MONO;
 120         ctx->channel_blocks[2]  = CH_UNIT_STEREO;
 121         ctx->channel_blocks[3]  = CH_UNIT_STEREO;
 122         ctx->channel_blocks[4]  = CH_UNIT_MONO;
 123         break;
 124     default:
 125         av_log(avctx, AV_LOG_ERROR,
 126                "Unsupported channel layout: %"PRIx64"!\n", avctx->channel_layout);
 127         return AVERROR_INVALIDDATA;
 128     }
 129
 130     return 0;
 131 }
 132
 133 static av_cold int atrac3p_decode_init(AVCodecContext *avctx)
 134 {
 135     ATRAC3PContext *ctx = avctx->priv_data;
 136     int i, ch, ret;
 137
 138     if (!avctx->block_align) {
 139         av_log(avctx, AV_LOG_ERROR, "block_align is not set\n");
 140         return AVERROR(EINVAL);
 141     }
 142
 143     ff_atrac3p_init_vlcs();
 144
 145     avpriv_float_dsp_init(&ctx->fdsp, avctx->flags & CODEC_FLAG_BITEXACT);
 146
 147     /* initialize IPQF */
 148     ff_mdct_init(&ctx->ipqf_dct_ctx, 5, 1, 32.0 / 32768.0);
 149
 150     ff_atrac3p_init_imdct(avctx, &ctx->mdct_ctx);
 151
 152     ff_atrac_init_gain_compensation(&ctx->gainc_ctx, 6, 2);
 153
 154     ff_atrac3p_init_wave_synth();
 155
 156     if ((ret = set_channel_params(ctx, avctx)) < 0)
 157         return ret;
 158
 159     ctx->my_channel_layout = avctx->channel_layout;
 160
 161     ctx->ch_units = av_mallocz(sizeof(*ctx->ch_units) *
 162                                ctx->num_channel_blocks);
 163     if (!ctx->ch_units) {
 164         atrac3p_decode_close(avctx);
 165         return AVERROR(ENOMEM);
 166     }
 167
 168     for (i = 0; i < ctx->num_channel_blocks; i++) {
 169         for (ch = 0; ch < 2; ch++) {
 170             ctx->ch_units[i].channels[ch].ch_num          = ch;
 171             ctx->ch_units[i].channels[ch].wnd_shape       = &ctx->ch_units[i].channels[ch].wnd_shape_hist[0][0];
 172             ctx->ch_units[i].channels[ch].wnd_shape_prev  = &ctx->ch_units[i].channels[ch].wnd_shape_hist[1][0];
 173             ctx->ch_units[i].channels[ch].gain_data       = &ctx->ch_units[i].channels[ch].gain_data_hist[0][0];
 174             ctx->ch_units[i].channels[ch].gain_data_prev  = &ctx->ch_units[i].channels[ch].gain_data_hist[1][0];
 175             ctx->ch_units[i].channels[ch].tones_info      = &ctx->ch_units[i].channels[ch].tones_info_hist[0][0];
 176             ctx->ch_units[i].channels[ch].tones_info_prev = &ctx->ch_units[i].channels[ch].tones_info_hist[1][0];
 177         }
 178
 179         ctx->ch_units[i].waves_info      = &ctx->ch_units[i].wave_synth_hist[0];
 180         ctx->ch_units[i].waves_info_prev = &ctx->ch_units[i].wave_synth_hist[1];
 181     }
 182
 183     avctx->sample_fmt = AV_SAMPLE_FMT_FLTP;
 184
 185     return 0;
 186 }
 187
 188 static void decode_residual_spectrum(Atrac3pChanUnitCtx *ctx,
 189                                      float out[2][ATRAC3P_FRAME_SAMPLES],
 190                                      int num_channels,
 191                                      AVCodecContext *avctx)
 192 {
 193     int i, sb, ch, qu, nspeclines, RNG_index;
 194     float *dst, q;
 195     int16_t *src;
 196     /* calculate RNG table index for each subband */
 197     int sb_RNG_index[ATRAC3P_SUBBANDS] = { 0 };
 198
 199     if (ctx->mute_flag) {
 200         for (ch = 0; ch < num_channels; ch++)
 201             memset(out[ch], 0, ATRAC3P_FRAME_SAMPLES * sizeof(*out[ch]));
 202         return;
 203     }
 204
 205     for (qu = 0, RNG_index = 0; qu < ctx->used_quant_units; qu++)
 206         RNG_index += ctx->channels[0].qu_sf_idx[qu] +
 207                      ctx->channels[1].qu_sf_idx[qu];
 208
 209     for (sb = 0; sb < ctx->num_coded_subbands; sb++, RNG_index += 128)
 210         sb_RNG_index[sb] = RNG_index & 0x3FC;
 211
 212     /* inverse quant and power compensation */
 213     for (ch = 0; ch < num_channels; ch++) {
 214         /* clear channel's residual spectrum */
 215         memset(out[ch], 0, ATRAC3P_FRAME_SAMPLES * sizeof(*out[ch]));
 216
 217         for (qu = 0; qu < ctx->used_quant_units; qu++) {
 218             src        = &ctx->channels[ch].spectrum[ff_atrac3p_qu_to_spec_pos[qu]];
 219             dst        = &out[ch][ff_atrac3p_qu_to_spec_pos[qu]];
 220             nspeclines = ff_atrac3p_qu_to_spec_pos[qu + 1] -
 221                          ff_atrac3p_qu_to_spec_pos[qu];
 222
 223             if (ctx->channels[ch].qu_wordlen[qu] > 0) {
 224                 q = ff_atrac3p_sf_tab[ctx->channels[ch].qu_sf_idx[qu]] *
 225                     ff_atrac3p_mant_tab[ctx->channels[ch].qu_wordlen[qu]];
 226                 for (i = 0; i < nspeclines; i++)
 227                     dst[i] = src[i] * q;
 228             }
 229         }
 230
 231         for (sb = 0; sb < ctx->num_coded_subbands; sb++)
 232             ff_atrac3p_power_compensation(ctx, ch, &out[ch][0],
 233                                           sb_RNG_index[sb], sb);
 234     }
 235
 236     if (ctx->unit_type == CH_UNIT_STEREO) {
 237         for (sb = 0; sb < ctx->num_coded_subbands; sb++) {
 238             if (ctx->swap_channels[sb]) {
 239                 for (i = 0; i < ATRAC3P_SUBBAND_SAMPLES; i++)
 240                     FFSWAP(float, out[0][sb * ATRAC3P_SUBBAND_SAMPLES + i],
 241                                   out[1][sb * ATRAC3P_SUBBAND_SAMPLES + i]);
 242             }
 243
 244             /* flip coefficients' sign if requested */
 245             if (ctx->negate_coeffs[sb])
 246                 for (i = 0; i < ATRAC3P_SUBBAND_SAMPLES; i++)
 247                     out[1][sb * ATRAC3P_SUBBAND_SAMPLES + i] = -(out[1][sb * ATRAC3P_SUBBAND_SAMPLES + i]);
 248         }
 249     }
 250 }
 251
 252 static void reconstruct_frame(ATRAC3PContext *ctx, Atrac3pChanUnitCtx *ch_unit,
 253                               int num_channels, AVCodecContext *avctx)
 254 {
 255     int ch, sb;
 256
 257     for (ch = 0; ch < num_channels; ch++) {
 258         for (sb = 0; sb < ch_unit->num_subbands; sb++) {
 259             /* inverse transform and windowing */
 260             ff_atrac3p_imdct(&ctx->fdsp, &ctx->mdct_ctx,
 261                              &ctx->samples[ch][sb * ATRAC3P_SUBBAND_SAMPLES],
 262                              &ctx->mdct_buf[ch][sb * ATRAC3P_SUBBAND_SAMPLES],
 263                              (ch_unit->channels[ch].wnd_shape_prev[sb] << 1) +
 264                              ch_unit->channels[ch].wnd_shape[sb], sb);
 265
 266             /* gain compensation and overlapping */
 267             ff_atrac_gain_compensation(&ctx->gainc_ctx,
 268                                        &ctx->mdct_buf[ch][sb * ATRAC3P_SUBBAND_SAMPLES],
 269                                        &ch_unit->prev_buf[ch][sb * ATRAC3P_SUBBAND_SAMPLES],
 270                                        &ch_unit->channels[ch].gain_data_prev[sb],
 271                                        &ch_unit->channels[ch].gain_data[sb],
 272                                        ATRAC3P_SUBBAND_SAMPLES,
 273                                        &ctx->time_buf[ch][sb * ATRAC3P_SUBBAND_SAMPLES]);
 274         }
 275
 276         /* zero unused subbands in both output and overlapping buffers */
 277         memset(&ch_unit->prev_buf[ch][ch_unit->num_subbands * ATRAC3P_SUBBAND_SAMPLES],
 278                0,
 279                (ATRAC3P_SUBBANDS - ch_unit->num_subbands) *
 280                ATRAC3P_SUBBAND_SAMPLES *
 281                sizeof(ch_unit->prev_buf[ch][ch_unit->num_subbands * ATRAC3P_SUBBAND_SAMPLES]));
 282         memset(&ctx->time_buf[ch][ch_unit->num_subbands * ATRAC3P_SUBBAND_SAMPLES],
 283                0,
 284                (ATRAC3P_SUBBANDS - ch_unit->num_subbands) *
 285                ATRAC3P_SUBBAND_SAMPLES *
 286                sizeof(ctx->time_buf[ch][ch_unit->num_subbands * ATRAC3P_SUBBAND_SAMPLES]));
 287
 288         /* resynthesize and add tonal signal */
 289         if (ch_unit->waves_info->tones_present ||
 290             ch_unit->waves_info_prev->tones_present) {
 291             for (sb = 0; sb < ch_unit->num_subbands; sb++)
 292                 if (ch_unit->channels[ch].tones_info[sb].num_wavs ||
 293                     ch_unit->channels[ch].tones_info_prev[sb].num_wavs) {
 294                     ff_atrac3p_generate_tones(ch_unit, &ctx->fdsp, ch, sb,
 295                                               &ctx->time_buf[ch][sb * 128]);
 296                 }
 297         }
 298
 299         /* subband synthesis and acoustic signal output */
 300         ff_atrac3p_ipqf(&ctx->ipqf_dct_ctx, &ch_unit->ipqf_ctx[ch],
 301                         &ctx->time_buf[ch][0], &ctx->outp_buf[ch][0]);
 302     }
 303
 304     /* swap window shape and gain control buffers. */
 305     for (ch = 0; ch < num_channels; ch++) {
 306         FFSWAP(uint8_t *, ch_unit->channels[ch].wnd_shape,
 307                ch_unit->channels[ch].wnd_shape_prev);
 308         FFSWAP(AtracGainInfo *, ch_unit->channels[ch].gain_data,
 309                ch_unit->channels[ch].gain_data_prev);
 310         FFSWAP(Atrac3pWavesData *, ch_unit->channels[ch].tones_info,
 311                ch_unit->channels[ch].tones_info_prev);
 312     }
 313
 314     FFSWAP(Atrac3pWaveSynthParams *, ch_unit->waves_info, ch_unit->waves_info_prev);
 315 }
 316
 317 static int atrac3p_decode_frame(AVCodecContext *avctx, void *data,
 318                                 int *got_frame_ptr, AVPacket *avpkt)
 319 {
 320     ATRAC3PContext *ctx = avctx->priv_data;
 321     AVFrame *frame      = data;
 322     int i, ret, ch_unit_id, ch_block = 0, out_ch_index = 0, channels_to_process;
 323     float **samples_p = (float **)frame->extended_data;
 324
 325     frame->nb_samples = ATRAC3P_FRAME_SAMPLES;
 326     if ((ret = ff_get_buffer(avctx, frame, 0)) < 0) {
 327         av_log(avctx, AV_LOG_ERROR, "get_buffer() failed\n");
 328         return ret;
 329     }
 330
 331     if ((ret = init_get_bits8(&ctx->gb, avpkt->data, avpkt->size)) < 0)
 332         return ret;
 333
 334     if (get_bits1(&ctx->gb)) {
 335         av_log(avctx, AV_LOG_ERROR, "Invalid start bit!\n");
 336         return AVERROR_INVALIDDATA;
 337     }
 338
 339     while (get_bits_left(&ctx->gb) >= 2 &&
 340            (ch_unit_id = get_bits(&ctx->gb, 2)) != CH_UNIT_TERMINATOR) {
 341         if (ch_unit_id == CH_UNIT_EXTENSION) {
 342             avpriv_report_missing_feature(avctx, "Channel unit extension");
 343             return AVERROR_PATCHWELCOME;
 344         }
 345         if (ch_block >= ctx->num_channel_blocks ||
 346             ctx->channel_blocks[ch_block] != ch_unit_id) {
 347             av_log(avctx, AV_LOG_ERROR,
 348                    "Frame data doesn't match channel configuration!\n");
 349             return AVERROR_INVALIDDATA;
 350         }
 351
 352         ctx->ch_units[ch_block].unit_type = ch_unit_id;
 353         channels_to_process               = ch_unit_id + 1;
 354
 355         if ((ret = ff_atrac3p_decode_channel_unit(&ctx->gb,
 356                                                   &ctx->ch_units[ch_block],
 357                                                   channels_to_process,
 358                                                   avctx)) < 0)
 359             return ret;
 360
 361         decode_residual_spectrum(&ctx->ch_units[ch_block], ctx->samples,
 362                                  channels_to_process, avctx);
 363         reconstruct_frame(ctx, &ctx->ch_units[ch_block],
 364                           channels_to_process, avctx);
 365
 366         for (i = 0; i < channels_to_process; i++)
 367             memcpy(samples_p[out_ch_index + i], ctx->outp_buf[i],
 368                    ATRAC3P_FRAME_SAMPLES * sizeof(**samples_p));
 369
 370         ch_block++;
 371         out_ch_index += channels_to_process;
 372     }
 373
 374     *got_frame_ptr = 1;
 375
 376     return avctx->block_align;
 377 }
 378
 379 AVCodec ff_atrac3p_decoder = {
 380     .name           = "atrac3plus",
 381     .long_name      = NULL_IF_CONFIG_SMALL("ATRAC3+ (Adaptive TRansform Acoustic Coding 3+)"),
 382     .type           = AVMEDIA_TYPE_AUDIO,
 383     .id             = AV_CODEC_ID_ATRAC3P,
 384     .priv_data_size = sizeof(ATRAC3PContext),
 385     .init           = atrac3p_decode_init,
 386     .close          = atrac3p_decode_close,
 387     .decode         = atrac3p_decode_frame,
 388 };