avfilter/vf_pad: add aspect option
[ffmpeg.git] / libavcodec / adx.c
index d6d6fdd..cd88b16 100644 (file)
 /*
- * ADX ADPCM codecs
- * Copyright (c) 2001,2003 BERO
+ * Copyright (c) 2011  Justin Ruggles
  *
- * This library is free software; you can redistribute it and/or
+ * 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 of the License, or (at your option) any later version.
+ * version 2.1 of the License, or (at your option) any later version.
  *
- * This library is distributed in the hope that it will be useful,
+ * 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 this library; if not, write to the Free Software
- * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
- */
-#include "avcodec.h"
-
-/**
- * @file adx.c
- * SEGA CRI adx codecs.
- *
- * Reference documents:
- * http://ku-www.ss.titech.ac.jp/~yatsushi/adx.html
- * adx2wav & wav2adx http://www.geocities.co.jp/Playtown/2004/
+ * License along with FFmpeg; if not, write to the Free Software
+ * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
  */
 
-typedef struct {
-       int s1,s2;
-} PREV;
-
-typedef struct {
-       PREV prev[2];
-       int header_parsed;
-       unsigned char dec_temp[18*2];
-       unsigned short enc_temp[32*2];
-       int in_temp;
-} ADXContext;
-
-//#define      BASEVOL 0x11e0
-#define        BASEVOL 0x4000
-#define SCALE1 0x7298
-#define        SCALE2  0x3350
+#include "libavutil/common.h"
+#include "libavutil/intreadwrite.h"
+#include "libavutil/mathematics.h"
+#include "adx.h"
 
-#define        CLIP(s) if (s>32767) s=32767; else if (s<-32768) s=-32768
-
-/* 18byte <-> 32 samples */
-
-#ifdef CONFIG_ENCODERS
-static void adx_encode(unsigned char *adx,const short *wav,PREV *prev)
+void ff_adx_calculate_coeffs(int cutoff, int sample_rate, int bits, int *coeff)
 {
-       int scale;
-       int i;
-       int s0,s1,s2,d;
-       int max=0;
-       int min=0;
-       int data[32];
-
-       s1 = prev->s1;
-       s2 = prev->s2;
-       for(i=0;i<32;i++) {
-               s0 = wav[i];
-               d = ((s0<<14) - SCALE1*s1 + SCALE2*s2)/BASEVOL;
-               data[i]=d;
-               if (max<d) max=d;
-               if (min>d) min=d;
-               s2 = s1;
-               s1 = s0;
-       }
-       prev->s1 = s1;
-       prev->s2 = s2;
-
-       /* -8..+7 */
-
-       if (max==0 && min==0) {
-               memset(adx,0,18);
-               return;
-       }
+    double a, b, c;
 
-       if (max/7>-min/8) scale = max/7;
-       else scale = -min/8;
-
-       if (scale==0) scale=1;
-
-       adx[0] = scale>>8;
-       adx[1] = scale;
-
-       for(i=0;i<16;i++) {
-               adx[i+2] = ((data[i*2]/scale)<<4) | ((data[i*2+1]/scale)&0xf);
-       }
-}
-#endif //CONFIG_ENCODERS
-
-static void adx_decode(short *out,const unsigned char *in,PREV *prev)
-{
-       int scale = ((in[0]<<8)|(in[1]));
-       int i;
-       int s0,s1,s2,d;
-
-//     printf("%x ",scale);
-
-       in+=2;
-       s1 = prev->s1;
-       s2 = prev->s2;
-       for(i=0;i<16;i++) {
-               d = in[i];
-               // d>>=4; if (d&8) d-=16;
-               d = ((signed char)d >> 4);
-               s0 = (BASEVOL*d*scale + SCALE1*s1 - SCALE2*s2)>>14;
-               CLIP(s0);
-               *out++=s0;
-               s2 = s1;
-               s1 = s0;
-
-               d = in[i];
-               //d&=15; if (d&8) d-=16;
-               d = ((signed char)(d<<4) >> 4);
-               s0 = (BASEVOL*d*scale + SCALE1*s1 - SCALE2*s2)>>14;
-               CLIP(s0);
-               *out++=s0;
-               s2 = s1;
-               s1 = s0;
-       }
-       prev->s1 = s1;
-       prev->s2 = s2;
+    a = M_SQRT2 - cos(2.0 * M_PI * cutoff / sample_rate);
+    b = M_SQRT2 - 1.0;
+    c = (a - sqrt((a + b) * (a - b))) / b;
 
+    coeff[0] = lrintf(c * 2.0  * (1 << bits));
+    coeff[1] = lrintf(-(c * c) * (1 << bits));
 }
 
-static void adx_decode_stereo(short *out,const unsigned char *in,PREV *prev)
+int ff_adx_decode_header(AVCodecContext *avctx, const uint8_t *buf,
+                         int bufsize, int *header_size, int *coeff)
 {
-       short tmp[32*2];
-       int i;
-
-       adx_decode(tmp   ,in   ,prev);
-       adx_decode(tmp+32,in+18,prev+1);
-       for(i=0;i<32;i++) {
-               out[i*2]   = tmp[i];
-               out[i*2+1] = tmp[i+32];
-       }
-}
-
-#ifdef CONFIG_ENCODERS
-
-static void write_long(unsigned char *p,uint32_t v)
-{
-       p[0] = v>>24;
-       p[1] = v>>16;
-       p[2] = v>>8;
-       p[3] = v;
-}
-
-static int adx_encode_header(AVCodecContext *avctx,unsigned char *buf,size_t bufsize)
-{
-#if 0
-       struct {
-               uint32_t offset; /* 0x80000000 + sample start - 4 */
-               unsigned char unknown1[3]; /* 03 12 04 */
-               unsigned char channel; /* 1 or 2 */
-               uint32_t freq;
-               uint32_t size;
-               uint32_t unknown2; /* 01 f4 03 00 */
-               uint32_t unknown3; /* 00 00 00 00 */
-               uint32_t unknown4; /* 00 00 00 00 */
-
-       /* if loop
-               unknown3 00 15 00 01
-               unknown4 00 00 00 01
-               long loop_start_sample;
-               long loop_start_byte;
-               long loop_end_sample;
-               long loop_end_byte;
-               long 
-       */
-       } adxhdr; /* big endian */
-       /* offset-6 "(c)CRI" */
-#endif
-       write_long(buf+0x00,0x80000000|0x20);
-       write_long(buf+0x04,0x03120400|avctx->channels);
-       write_long(buf+0x08,avctx->sample_rate);
-       write_long(buf+0x0c,0); /* FIXME: set after */
-       write_long(buf+0x10,0x01040300);
-       write_long(buf+0x14,0x00000000);
-       write_long(buf+0x18,0x00000000);
-       memcpy(buf+0x1c,"\0\0(c)CRI",8);
-       return 0x20+4;
-}
-
-static int adx_decode_init(AVCodecContext *avctx);
-static int adx_encode_init(AVCodecContext *avctx)
-{
-    if (avctx->channels > 2)
-        return -1; /* only stereo or mono =) */
-    avctx->frame_size = 32;
-
-    avctx->coded_frame= avcodec_alloc_frame();
-    avctx->coded_frame->key_frame= 1;
-
-//    avctx->bit_rate = avctx->sample_rate*avctx->channels*18*8/32;
-
-    printf("adx encode init\n"); fflush(stdout);
-    adx_decode_init(avctx);
-
-    return 0;
-}
-
-static int adx_encode_close(AVCodecContext *avctx)
-{
-    av_freep(&avctx->coded_frame);
-
+    int offset, cutoff;
+
+    if (bufsize < 24)
+        return AVERROR_INVALIDDATA;
+
+    if (AV_RB16(buf) != 0x8000)
+        return AVERROR_INVALIDDATA;
+    offset = AV_RB16(buf + 2) + 4;
+
+    /* if copyright string is within the provided data, validate it */
+    if (bufsize >= offset && offset >= 6 && memcmp(buf + offset - 6, "(c)CRI", 6))
+        return AVERROR_INVALIDDATA;
+
+    /* check for encoding=3 block_size=18, sample_size=4 */
+    if (buf[4] != 3 || buf[5] != 18 || buf[6] != 4) {
+        avpriv_request_sample(avctx, "Support for this ADX format");
+        return AVERROR_PATCHWELCOME;
+    }
+
+    /* channels */
+    avctx->channels = buf[7];
+    if (avctx->channels <= 0 || avctx->channels > 2)
+        return AVERROR_INVALIDDATA;
+
+    /* sample rate */
+    avctx->sample_rate = AV_RB32(buf + 8);
+    if (avctx->sample_rate < 1 ||
+        avctx->sample_rate > INT_MAX / (avctx->channels * BLOCK_SIZE * 8))
+        return AVERROR_INVALIDDATA;
+
+    /* bit rate */
+    avctx->bit_rate = avctx->sample_rate * avctx->channels * BLOCK_SIZE * 8 / BLOCK_SAMPLES;
+
+    /* LPC coefficients */
+    if (coeff) {
+        cutoff = AV_RB16(buf + 16);
+        ff_adx_calculate_coeffs(cutoff, avctx->sample_rate, COEFF_BITS, coeff);
+    }
+
+    *header_size = offset;
     return 0;
 }
-
-static int adx_encode_frame(AVCodecContext *avctx,
-                           unsigned char *frame, int buf_size, const void *data)
-{
-       ADXContext *c = avctx->priv_data;
-       const short *samples = data;
-       unsigned char *dst = frame;
-       int rest = avctx->frame_size;
-
-/*
-       input data size =
-       ffmpeg.c: do_audio_out()
-       frame_bytes = enc->frame_size * 2 * enc->channels;
-*/
-
-//     printf("sz=%d ",buf_size); fflush(stdout);
-       if (!c->header_parsed) {
-               int hdrsize = adx_encode_header(avctx,dst,buf_size);
-               dst+=hdrsize;
-               c->header_parsed = 1;
-       }
-
-       if (avctx->channels==1) {
-               while(rest>=32) {
-                       adx_encode(dst,samples,c->prev);
-                       dst+=18;
-                       samples+=32;
-                       rest-=32;
-               }
-       } else {
-               while(rest>=32*2) {
-                       short tmpbuf[32*2];
-                       int i;
-
-                       for(i=0;i<32;i++) {
-                               tmpbuf[i] = samples[i*2];
-                               tmpbuf[i+32] = samples[i*2+1];
-                       }
-
-                       adx_encode(dst,tmpbuf,c->prev);
-                       adx_encode(dst+18,tmpbuf+32,c->prev+1);
-                       dst+=18*2;
-                       samples+=32*2;
-                       rest-=32*2;
-               }
-       }
-       return dst-frame;
-}
-
-#endif //CONFIG_ENCODERS
-
-static uint32_t read_long(const unsigned char *p)
-{
-       return (p[0]<<24)|(p[1]<<16)|(p[2]<<8)|p[3];
-}
-
-int is_adx(const unsigned char *buf,size_t bufsize)
-{
-       int     offset;
-
-       if (buf[0]!=0x80) return 0;
-       offset = (read_long(buf)^0x80000000)+4;
-       if (bufsize<offset || memcmp(buf+offset-6,"(c)CRI",6)) return 0;
-       return offset;
-}
-
-/* return data offset or 6 */
-static int adx_decode_header(AVCodecContext *avctx,const unsigned char *buf,size_t bufsize)
-{
-       int offset;
-       int channels,freq,size;
-
-       offset = is_adx(buf,bufsize);
-       if (offset==0) return 0;
-
-       channels = buf[7];
-       freq = read_long(buf+8);
-       size = read_long(buf+12);
-
-//     printf("freq=%d ch=%d\n",freq,channels);
-
-       avctx->sample_rate = freq;
-       avctx->channels = channels;
-       avctx->bit_rate = freq*channels*18*8/32;
-//     avctx->frame_size = 18*channels;
-
-       return offset;
-}
-
-static int adx_decode_init(AVCodecContext * avctx)
-{
-       ADXContext *c = avctx->priv_data;
-
-//     printf("adx_decode_init\n"); fflush(stdout);
-       c->prev[0].s1 = 0;
-       c->prev[0].s2 = 0;
-       c->prev[1].s1 = 0;
-       c->prev[1].s2 = 0;
-       c->header_parsed = 0;
-       c->in_temp = 0;
-       return 0;
-}
-
-static void dump(unsigned char *buf,size_t len)
-{
-       int i;
-       for(i=0;i<len;i++) {
-               if ((i&15)==0) printf("%04x  ",i);
-               printf("%02x ",buf[i]);
-               if ((i&15)==15) printf("\n");
-       }
-       printf("\n");
-}
-static int adx_decode_frame(AVCodecContext *avctx,
-                           void *data, int *data_size,
-                           const uint8_t *buf0, int buf_size)
-{
-       ADXContext *c = avctx->priv_data;
-       short *samples = data;
-       const uint8_t *buf = buf0;
-       int rest = buf_size;
-
-       if (!c->header_parsed) {
-               int hdrsize = adx_decode_header(avctx,buf,rest);
-               if (hdrsize==0) return -1;
-               c->header_parsed = 1;
-               buf  += hdrsize;
-               rest -= hdrsize;
-       }
-
-       if (c->in_temp) {
-               int copysize = 18*avctx->channels - c->in_temp;
-               memcpy(c->dec_temp+c->in_temp,buf,copysize);
-               rest -= copysize;
-               buf  += copysize;
-               if (avctx->channels==1) {
-                       adx_decode(samples,c->dec_temp,c->prev);
-                       samples += 32;
-               } else {
-                       adx_decode_stereo(samples,c->dec_temp,c->prev);
-                       samples += 32*2;
-               }
-       }
-       //
-       if (avctx->channels==1) {
-               while(rest>=18) {
-                       adx_decode(samples,buf,c->prev);
-                       rest-=18;
-                       buf+=18;
-                       samples+=32;
-               }
-       } else {
-               while(rest>=18*2) {
-                       adx_decode_stereo(samples,buf,c->prev);
-                       rest-=18*2;
-                       buf+=18*2;
-                       samples+=32*2;
-               }
-       }
-       //
-       c->in_temp = rest;
-       if (rest) {
-               memcpy(c->dec_temp,buf,rest);
-               buf+=rest;
-       }
-       *data_size = (uint8_t*)samples - (uint8_t*)data;
-//     printf("%d:%d ",buf-buf0,*data_size); fflush(stdout);
-       return buf-buf0;
-}
-
-#define DEFINE_ENCODER(id, name, context)                \
-AVCodec name ## _encoder = {                    \
-    #name,                                      \
-    CODEC_TYPE_AUDIO,                           \
-    id,                                         \
-    sizeof(context),                       \
-    name ## _encode_init,                       \
-    name ## _encode_frame,                      \
-    name ## _encode_close,                      \
-    NULL,                                       \
-};
-
-#define DEFINE_DECODER(id, name, context)                \
-AVCodec name ## _decoder = {                    \
-    #name,                                      \
-    CODEC_TYPE_AUDIO,                           \
-    id,                                         \
-    sizeof(context),                       \
-    name ## _decode_init,                       \
-    NULL,                                       \
-    NULL,                                       \
-    name ## _decode_frame,                      \
-};
-
-#ifdef CONFIG_ENCODERS
-DEFINE_ENCODER(CODEC_ID_ADPCM_ADX,adx,ADXContext)
-#endif //CONFIG_ENCODERS
-
-DEFINE_DECODER(CODEC_ID_ADPCM_ADX,adx,ADXContext)