2 files changed, 215 insertions, 0 deletions

diff --git a/apps/plugins/SOURCES b/apps/plugins/SOURCES
index 35a7d39cbf..7131f8329e 100644
--- a/apps/plugins/SOURCES
+++ b/apps/plugins/SOURCES
@@ -77,6 +77,7 @@ codecmpa.c
 codecflac.c
 codecwav.c
 codeca52.c
+codecmpc.c
 #endif
 wv2wav.c
 mpc2wav.c
diff --git a/apps/plugins/codecmpc.c b/apps/plugins/codecmpc.c
new file mode 100644
index 0000000000..3fe35705eb
--- /dev/null
+++ b/apps/plugins/codecmpc.c
@@ -0,0 +1,214 @@
+/***************************************************************************
+ *             __________               __   ___.
+ *   Open      \______   \ ____   ____ |  | _\_ |__   _______  ___
+ *   Source     |       _//  _ \_/ ___\|  |/ /| __ \ /  _ \  \/  /
+ *   Jukebox    |    |   (  <_> )  \___|    < | \_\ (  <_> > <  <
+ *   Firmware   |____|_  /\____/ \___  >__|_ \|___  /\____/__/\_ \
+ *                     \/            \/     \/    \/            \/
+ * $Id$
+ *
+ * Copyright (C) 2005 Thom Johansen
+ *
+ * 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 "plugin.h"
+#include "playback.h"
+#include "lib/codeclib.h"
+#include <codecs/libmusepack/musepack.h>
+
+static struct plugin_api* rb;
+mpc_decoder decoder;
+
+/*
+  Our implementations of the mpc_reader callback functions.
+*/
+mpc_int32_t
+read_impl(void *data, void *ptr, mpc_int32_t size)
+{
+  struct codec_api* ci = (struct codec_api*)data;
+
+  return((mpc_int32_t)(ci->read_filebuf(ptr,size)));
+}
+
+bool
+seek_impl(void *data, mpc_int32_t offset)
+{  
+  struct codec_api* ci = (struct codec_api*)data;
+
+  /* We don't support seeking yet. */
+  (void)ci;
+  (void)offset;
+  return 0;
+}
+
+mpc_int32_t
+tell_impl(void *data)
+{
+  struct codec_api* ci = (struct codec_api*)data;
+
+  return ci->curpos;
+}
+
+mpc_int32_t
+get_size_impl(void *data)
+{
+  struct codec_api* ci = (struct codec_api*)data;
+  return ci->filesize;
+}
+
+bool
+canseek_impl(void *data)
+{
+    (void)data;
+    return false;
+}
+
+static int
+shift_signed(MPC_SAMPLE_FORMAT val, int shift)
+{
+  if (shift > 0)
+    val <<= shift;
+  else if (shift < 0)
+    val >>= -shift;
+  return (int)val;
+}
+
+#define OUTPUT_BUFFER_SIZE 65536 /* Must be an integer multiple of 4. */
+
+unsigned char OutputBuffer[OUTPUT_BUFFER_SIZE];
+MPC_SAMPLE_FORMAT sample_buffer[MPC_DECODER_BUFFER_LENGTH];
+unsigned char *OutputPtr=OutputBuffer;
+const unsigned char *OutputBufferEnd=OutputBuffer+OUTPUT_BUFFER_SIZE;
+
+#ifdef USE_IRAM
+extern char iramcopy[];
+extern char iramstart[];
+extern char iramend[];
+#endif
+
+/* this is the plugin entry point */
+enum plugin_status plugin_start(struct plugin_api* api, void* parm)
+{
+  struct codec_api* ci = (struct codec_api*)parm;
+  unsigned short Sample;
+  unsigned long samplesdone;
+  unsigned long frequency;
+  unsigned status = 1;
+  unsigned int i;
+  mpc_reader reader;
+
+  /* Generic plugin inititialisation */
+
+  TEST_PLUGIN_API(api);
+  rb = api;
+
+#ifndef SIMULATOR
+  rb->memcpy(iramstart, iramcopy, iramend-iramstart);
+#endif
+
+  ci->configure(CODEC_SET_FILEBUF_LIMIT, (int *)(1024*1024*2));
+  ci->configure(CODEC_SET_FILEBUF_CHUNKSIZE, (int *)(1024*16));
+
+  next_track:
+
+  if (codec_init(api, ci)) {
+    return PLUGIN_ERROR;
+  }
+
+  /* Create a decoder instance */
+
+  reader.read = read_impl;
+  reader.seek = seek_impl;
+  reader.tell = tell_impl;
+  reader.get_size = get_size_impl;
+  reader.canseek = canseek_impl;
+  reader.data = ci;
+
+  /* read file's streaminfo data */
+  mpc_streaminfo info;
+  mpc_streaminfo_init(&info);
+  if (mpc_streaminfo_read(&info, &reader) != ERROR_CODE_OK) {
+    return PLUGIN_ERROR;  
+  }
+  frequency=info.sample_freq;
+
+  /* instantiate a decoder with our file reader */
+  mpc_decoder_setup(&decoder, &reader);
+  if (!mpc_decoder_initialize(&decoder, &info)) {
+    return PLUGIN_ERROR;
+  }
+
+  /* Initialise the output buffer. */
+  OutputPtr=OutputBuffer;
+  OutputBufferEnd=OutputBuffer+OUTPUT_BUFFER_SIZE;
+
+  /* This is the decoding loop. */
+  samplesdone=0;
+  while (status != 0) {
+    if (ci->stop_codec || ci->reload_codec) {
+      break;
+    }
+
+    status = mpc_decoder_decode(&decoder, sample_buffer, 0, 0);
+    if (status == (unsigned)(-1)) {
+      //decode error
+      return PLUGIN_ERROR;
+    }
+    else                    //status>0
+    {
+    //      file_info.current_sample += status;
+    //      file_info.frames_decoded++;
+      /* Convert musepack's numbers to an array of 16-bit BE signed integers */
+      for(i = 0; i < status*info.channels; i += info.channels)
+      {
+        /* Left channel */
+        Sample=shift_signed(sample_buffer[i], 16 - MPC_FIXED_POINT_SCALE_SHIFT);
+        *(OutputPtr++)=Sample>>8;
+        *(OutputPtr++)=Sample&0xff;
+
+        /* Right channel. If the decoded stream is monophonic then
+         * the right output channel is the same as the left one.
+         */
+        if(info.channels==2) {
+          Sample=shift_signed(sample_buffer[i + 1], 16 - MPC_FIXED_POINT_SCALE_SHIFT);
+        }
+        *(OutputPtr++)=Sample>>8;
+        *(OutputPtr++)=Sample&0xff;
+
+        samplesdone++;
+
+        /* Flush the buffer if it is full. */
+        if(OutputPtr==OutputBufferEnd)
+        {
+          rb->yield();
+          while (!ci->audiobuffer_insert(OutputBuffer, OUTPUT_BUFFER_SIZE)) {
+            rb->yield();
+          }
+
+          ci->set_elapsed(samplesdone/(frequency/1000));
+          OutputPtr=OutputBuffer;
+        }
+      }
+    }
+  }
+
+  /* Flush the remaining data in the output buffer */
+  if (OutputPtr > OutputBuffer) {
+    rb->yield();
+    while (!ci->audiobuffer_insert(OutputBuffer, OutputPtr-OutputBuffer)) {
+      rb->yield();
+    }
+  }
+
+  if (ci->request_next_track())
+    goto next_track;
+
+  return PLUGIN_OK;
+}
+