1 files changed, 385 insertions, 0 deletions

diff --git a/apps/codecs/wma.c b/apps/codecs/wma.c
new file mode 100644
index 0000000000..5303eb4287
--- /dev/null
+++ b/apps/codecs/wma.c
@@ -0,0 +1,385 @@
+/***************************************************************************
+ *             __________               __   ___.
+ *   Open      \______   \ ____   ____ |  | _\_ |__   _______  ___
+ *   Source     |       _//  _ \_/ ___\|  |/ /| __ \ /  _ \  \/  /
+ *   Jukebox    |    |   (  <_> )  \___|    < | \_\ (  <_> > <  <
+ *   Firmware   |____|_  /\____/ \___  >__|_ \|___  /\____/__/\_ \
+ *                     \/            \/     \/    \/            \/
+ * $Id: flac.c 12830 2007-03-18 09:50:53Z learman $
+ *
+ * Copyright (C) 2005 Dave Chapman
+ *
+ * All files in this archive are subject to the GNU General Public License.
+ * See the file COPYING in the source tree root for full license agreement.
+ *
+ * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
+ * KIND, either express or implied.
+ *
+ ****************************************************************************/
+
+#include "codeclib.h"
+#include "libwma/asf.h"
+#include "libwma/wmadec.h"
+
+CODEC_HEADER
+
+#define MAX_BLOCKSIZE 2048
+
+/* The output buffers containing the decoded samples (channels 0 and 1) */
+
+/* NOTE: WMADecodeContext is 142688 bytes (on x86) */
+static WMADecodeContext wmadec;
+
+/* TODO: Check the size of this */
+#define OUTBUF_SIZE 256*1024
+
+enum asf_error_e {
+    ASF_ERROR_INTERNAL       = -1,  /* incorrect input to API calls */
+    ASF_ERROR_OUTOFMEM       = -2,  /* some malloc inside program failed */
+    ASF_ERROR_EOF            = -3,  /* unexpected end of file */
+    ASF_ERROR_IO             = -4,  /* error reading or writing to file */
+    ASF_ERROR_INVALID_LENGTH = -5,  /* length value conflict in input data */
+    ASF_ERROR_INVALID_VALUE  = -6,  /* other value conflict in input data */
+    ASF_ERROR_INVALID_OBJECT = -7,  /* ASF object missing or in wrong place */
+    ASF_ERROR_OBJECT_SIZE    = -8,  /* invalid ASF object size (too small) */
+    ASF_ERROR_SEEKABLE       = -9,  /* file not seekable */
+    ASF_ERROR_SEEK           = -10  /* file is seekable but seeking failed */
+};
+
+/* Read an unaligned 32-bit little endian long from buffer. */
+static unsigned long get_long_le(void* buf)
+{
+    unsigned char* p = (unsigned char*) buf;
+
+    return p[0] | (p[1] << 8) | (p[2] << 16) | (p[3] << 24);
+}
+
+/* Read an unaligned 16-bit little endian short from buffer. */
+static unsigned short get_short_le(void* buf)
+{
+    unsigned char* p = (unsigned char*) buf;
+
+    return p[0] | (p[1] << 8);
+}
+
+#define GETLEN2b(bits) (((bits) == 0x03) ? 4 : bits)
+
+#define GETVALUE2b(bits, data) \
+        (((bits) != 0x03) ? ((bits) != 0x02) ? ((bits) != 0x01) ? \
+         0 : *(data) : get_short_le(data) : get_long_le(data))
+
+static int asf_read_packet(int* padding, asf_waveformatex_t* wfx)
+{
+    uint8_t tmp8, packet_flags, packet_property;
+    int ec_length, opaque_data, ec_length_type;
+    int datalen;
+    uint8_t data[18];
+    uint8_t* datap;
+    uint32_t length;
+    uint32_t padding_length;
+    uint32_t send_time;
+    uint16_t duration;
+    uint16_t payload_count;
+    int payload_length_type;
+    uint32_t payload_hdrlen;
+    int payload_datalen;
+    int multiple;
+    uint32_t replicated_length;
+    uint32_t media_object_number;
+    uint32_t media_object_offset;
+    uint32_t bytesread = 0;
+
+    if (ci->read_filebuf(&tmp8, 1) == 0) {
+        return ASF_ERROR_EOF;
+    }
+    bytesread++;
+
+    /* TODO: We need a better way to detect endofstream */
+    if (tmp8 != 0x82) { return -1; }
+
+    //DEBUGF("tmp8=0x%02x\n",tmp8);
+
+    if (tmp8 & 0x80) {
+       ec_length = tmp8 & 0x0f;
+       opaque_data = (tmp8 >> 4) & 0x01;
+       ec_length_type = (tmp8 >> 5) & 0x03;
+
+       if (ec_length_type != 0x00 || opaque_data != 0 || ec_length != 0x02) {
+            DEBUGF("incorrect error correction flags\n");
+            return ASF_ERROR_INVALID_VALUE;
+       }
+
+       /* Skip ec_data */
+       ci->advance_buffer(ec_length);
+       bytesread += ec_length;
+    } else {
+        ec_length = 0;
+    }
+
+    if (ci->read_filebuf(&packet_flags, 1) == 0) { return ASF_ERROR_EOF; }
+    if (ci->read_filebuf(&packet_property, 1) == 0) { return ASF_ERROR_EOF; }
+    bytesread += 2;
+
+    datalen = GETLEN2b((packet_flags >> 1) & 0x03) +
+              GETLEN2b((packet_flags >> 3) & 0x03) +
+              GETLEN2b((packet_flags >> 5) & 0x03) + 6;
+
+#if 0
+    if (datalen > sizeof(data)) {
+        DEBUGF("Unexpectedly long datalen in data - %d\n",datalen);
+        return ASF_ERROR_OUTOFMEM;
+    }
+#endif
+
+    if (ci->read_filebuf(data, datalen) == 0) {
+        return ASF_ERROR_EOF;
+    }
+
+    bytesread += datalen;
+
+    datap = data;
+    length = GETVALUE2b((packet_flags >> 5) & 0x03, datap);
+    datap += GETLEN2b((packet_flags >> 5) & 0x03);
+    /* sequence value is not used */
+    GETVALUE2b((packet_flags >> 1) & 0x03, datap);
+    datap += GETLEN2b((packet_flags >> 1) & 0x03);
+    padding_length = GETVALUE2b((packet_flags >> 3) & 0x03, datap);
+    datap += GETLEN2b((packet_flags >> 3) & 0x03);
+    send_time = get_long_le(datap);
+    datap += 4;
+    duration = get_short_le(datap);
+    datap += 2;
+
+    /* this is really idiotic, packet length can (and often will) be
+     * undefined and we just have to use the header packet size as the size
+     * value */
+    if (!((packet_flags >> 5) & 0x03)) {
+         length = wfx->packet_size;
+    }
+
+    /* this is also really idiotic, if packet length is smaller than packet
+     * size, we need to manually add the additional bytes into padding length
+     */
+    if (length < wfx->packet_size) {
+        padding_length += wfx->packet_size - length;
+        length = wfx->packet_size;
+    }
+
+    if (length > wfx->packet_size) {
+        DEBUGF("packet with too big length value\n");
+        return ASF_ERROR_INVALID_LENGTH;
+    }
+
+    /* check if we have multiple payloads */
+    if (packet_flags & 0x01) {
+        if (ci->read_filebuf(&tmp8, 1) == 0) {
+            return ASF_ERROR_EOF;
+        }
+        payload_count = tmp8 & 0x3f;
+        payload_length_type = (tmp8 >> 6) & 0x03;
+        bytesread++;
+    } else {
+        payload_count = 1;
+        payload_length_type = 0x02; /* not used */
+    }
+
+    if (length < bytesread) {
+        DEBUGF("header exceeded packet size, invalid file - length=%d, bytesread=%d\n",(int)length,(int)bytesread);
+        /* FIXME: should this be checked earlier? */
+        return ASF_ERROR_INVALID_LENGTH;
+    }
+
+    if (ci->read_filebuf(&tmp8, 1) == 0) {
+        return ASF_ERROR_EOF;
+    }
+    //DEBUGF("stream = %u\n",tmp8&0x7f);
+    bytesread++;
+
+    if ((tmp8 & 0x7f) != wfx->audiostream) {
+        /* Not interested in this packet, just skip it */
+        ci->advance_buffer(length - bytesread);
+        return 0;
+    } else {
+        /* We are now at the data */
+        //DEBUGF("Read packet - length=%u, padding_length=%u, send_time=%u, duration=%u, payload_count=%d, bytesread=%d\n",length,padding_length,(int)send_time,duration,payload_count,bytesread);
+
+        /* TODO: Loop through all payloads in this packet - or do we
+           assume that audio streams only have one payload per packet? */
+
+        payload_hdrlen = GETLEN2b(packet_property & 0x03) +
+                         GETLEN2b((packet_property >> 2) & 0x03) +
+                         GETLEN2b((packet_property >> 4) & 0x03);
+
+        //DEBUGF("payload_hdrlen = %d\n",payload_hdrlen);
+#if 0
+        /* TODO */
+        if (payload_hdrlen > size) {
+            return ASF_ERROR_INVALID_LENGTH;
+        }
+#endif
+        if (payload_hdrlen > sizeof(data)) {
+            DEBUGF("Unexpectedly long datalen in data - %d\n",datalen);
+            return ASF_ERROR_OUTOFMEM;
+        }
+
+        if (ci->read_filebuf(data, payload_hdrlen) == 0) {
+            return ASF_ERROR_EOF;
+        }
+        bytesread += payload_hdrlen;
+
+        datap = data;
+        media_object_number = GETVALUE2b((packet_property >> 4) & 0x03, datap);
+        datap += GETLEN2b((packet_property >> 4) & 0x03);
+        media_object_offset = GETVALUE2b((packet_property >> 2) & 0x03, datap);
+        datap += GETLEN2b((packet_property >> 2) & 0x03);
+        replicated_length = GETVALUE2b(packet_property & 0x03, datap);
+        datap += GETLEN2b(packet_property & 0x03);
+
+        /* TODO: Validate replicated_length */
+        /* TODO: Is the content of this important for us? */
+        ci->advance_buffer(replicated_length);
+        bytesread += replicated_length;
+
+
+        multiple = packet_flags & 0x01;
+
+        if (multiple) {
+            int x;
+
+            x = GETLEN2b(payload_length_type);
+
+            if (x != 2) {
+                /* in multiple payloads datalen should be a word */
+                return ASF_ERROR_INVALID_VALUE;
+            }
+
+#if 0
+            if (skip + tmp > datalen) {
+                /* not enough data */
+                return ASF_ERROR_INVALID_LENGTH;
+            }
+#endif
+            if (ci->read_filebuf(&data, x) == 0) {
+                return ASF_ERROR_EOF;
+            }
+            bytesread += x;
+            payload_datalen = GETVALUE2b(payload_length_type, data);
+        } else {
+            payload_datalen = length - bytesread;
+        }
+
+        //DEBUGF("WE HAVE DATA - %d bytes\n", payload_datalen);
+//        lseek(fd, payload_datalen, SEEK_CUR);
+        *padding = padding_length;
+        return payload_datalen;
+    }
+}
+
+/* this is the codec entry point */
+enum codec_status codec_main(void)
+{
+    uint32_t samplesdone;
+    uint32_t elapsedtime;
+    int retval;
+    asf_waveformatex_t wfx;
+    uint32_t currentframe;
+    unsigned char* inbuffer;
+    size_t resume_offset;
+    size_t n;
+    int wmares, res, padding, outbufsize;
+    uint8_t* outbuf;
+
+    /* Generic codec initialisation */
+    ci->configure(CODEC_SET_FILEBUF_WATERMARK, 1024*512);
+    ci->configure(CODEC_SET_FILEBUF_CHUNKSIZE, 1024*128);
+
+    ci->configure(DSP_SET_SAMPLE_DEPTH, 15);
+
+    next_track:
+
+    /* Wait for the metadata to be read */
+    while (!*ci->taginfo_ready && !ci->stop_codec)
+        ci->sleep(1);
+
+    retval = CODEC_OK;
+
+    /* Remember the resume position - when the codec is opened, the
+       playback engine will reset it. */
+    resume_offset = ci->id3->offset;
+        
+    if (codec_init()) {
+        LOGF("WMA: Error initialising codec\n");
+        retval = CODEC_ERROR;
+        goto exit;
+    }
+
+    outbuf = codec_malloc(OUTBUF_SIZE);
+
+    /* Copy the format metadata we've stored in the id3 TOC field.  This 
+       saves us from parsing it again here. */
+    memcpy(&wfx, ci->id3->toc, sizeof(wfx));
+
+    wma_decode_init(&wmadec,&wfx);
+
+    /* Now advance the file position to the first frame */
+    ci->seek_buffer(ci->id3->first_frame_offset);
+
+    ci->configure(DSP_SWITCH_FREQUENCY, wfx.rate);
+    ci->configure(DSP_SET_STEREO_MODE, wfx.channels == 1 ?
+                  STEREO_MONO : STEREO_INTERLEAVED);
+    codec_set_replaygain(ci->id3);
+
+    /* The main decoding loop */
+
+    currentframe = 0;
+    samplesdone = 0;
+
+    DEBUGF("**************** IN WMA.C ******************\n");
+    wma_decode_init(&wmadec,&wfx);
+
+    res = 1;
+    while (res >= 0)
+    {
+        ci->yield();
+        if (ci->stop_codec || ci->new_track) {
+            goto done;
+        }
+
+        /* Deal with any pending seek requests - ignore them */
+        if (ci->seek_time) 
+        {
+            ci->seek_complete();
+        }
+
+        res = asf_read_packet(&padding, &wfx);
+        if (res > 0) {
+            inbuffer = ci->request_buffer(&n, res - padding);
+
+            wmares = wma_decode_superframe(&wmadec,
+                                        outbuf,&outbufsize,
+                                        inbuffer,res - padding);
+
+            ci->advance_buffer(res);
+
+            if (wmares > 0) {
+                ci->pcmbuf_insert(outbuf, NULL, outbufsize / (wfx.channels * 2));
+                samplesdone += (outbufsize / (wfx.channels * 2));
+                DEBUGF("Decoded %d samples\n",(outbufsize / (wfx.channels * 2)));
+                elapsedtime = (samplesdone*10)/(wfx.rate/100);
+                ci->set_elapsed(elapsedtime);
+            }
+
+            ci->yield ();
+        }
+    }
+    retval = CODEC_OK;
+
+done:
+    LOGF("WMA: Decoded %ld samples\n",samplesdone);
+
+    if (ci->request_next_track())
+        goto next_track;
+
+exit:
+    return retval;
+}