/* GStreamer

 * Copyright (C) 2010 Mark Nauwelaerts <mark.nauwelaerts@collabora.co.uk>

 * Copyright (C) 2010 Nokia Corporation. All rights reserved.

 *   Contact: Stefan Kost <stefan.kost@nokia.com>

 *

 * Tremor modifications <2006>:

 *   Chris Lord, OpenedHand Ltd. <chris@openedhand.com>, http://www.o-hand.com/

 *

 * This library is free software; you can redistribute it and/or

 * modify it under the terms of the GNU Library General Public

 * License as published by the Free Software Foundation; either

 * version 2 of the License, or (at your option) any later version.

 *

 * This library 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

 * Library General Public License for more details.

 *

 * You should have received a copy of the GNU Library General Public

 * License along with this library; if not, write to the

 * Free Software Foundation, Inc., 51 Franklin St, Fifth Floor,

 * Boston, MA 02110-1301, USA.

 */

#ifdef HAVE_CONFIG_H

#include "config.h"

#endif

#include <string.h>

#include "gstvorbisdeclib.h"

#include "gstvorbiscommon.h"

#ifndef TREMOR

/* These samples can be outside of the float -1.0 -- 1.0 range, this

 * is allowed, downstream elements are supposed to clip */

static void

copy_samples_m (vorbis_sample_t * out, vorbis_sample_t ** in, guint samples,

    gint channels)

{

  memcpy (out, in[0], samples * sizeof (float));

}

static void

copy_samples_s (vorbis_sample_t * out, vorbis_sample_t ** in, guint samples,

    gint channels)

{

#ifdef GST_VORBIS_DEC_SEQUENTIAL

  memcpy (out, in[0], samples * sizeof (float));

  out += samples;

  memcpy (out, in[1], samples * sizeof (float));

#else

  gint j;

  for (j = 0; j < samples; j++) {

    *out++ = in[0][j];

    *out++ = in[1][j];

  }

#endif

}

static void

copy_samples (vorbis_sample_t * out, vorbis_sample_t ** in, guint samples,

    gint channels)

{

#ifdef GST_VORBIS_DEC_SEQUENTIAL

  gint i;

  for (i = 0; i < channels; i++) {

    memcpy (out, in[gst_vorbis_reorder_map[channels - 1][i]],

        samples * sizeof (float));

    out += samples;

  }

#else

  gint i, j;

  for (j = 0; j < samples; j++) {

    for (i = 0; i < channels; i++) {

      *out++ = in[gst_vorbis_reorder_map[channels - 1][i]][j];

    }

  }

#endif

}

static void

copy_samples_no_reorder (vorbis_sample_t * out, vorbis_sample_t ** in,

    guint samples, gint channels)

{

#ifdef GST_VORBIS_DEC_SEQUENTIAL

  gint i;

  for (i = 0; i < channels; i++) {

    memcpy (out, in[i], samples * sizeof (float));

    out += samples;

  }

#else

  gint i, j;

  for (j = 0; j < samples; j++) {

    for (i = 0; i < channels; i++) {

      *out++ = in[i][j];

    }

  }

#endif

}

CopySampleFunc

gst_vorbis_get_copy_sample_func (gint channels)

{

  CopySampleFunc f = NULL;

  switch (channels) {

    case 1:

      f = copy_samples_m;

      break;

    case 2:

      f = copy_samples_s;

      break;

    case 3:

    case 4:

    case 5:

    case 6:

    case 7:

    case 8:

      f = copy_samples;

      break;

    default:

      f = copy_samples_no_reorder;

      break;

  }

  return f;

}

#else

/* Taken from Tremor, misc.h */

#ifdef _ARM_ASSEM_

static inline ogg_int32_t

CLIP_TO_15 (ogg_int32_t x)

{

  int tmp;

  asm volatile ("subs	%1, %0, #32768\n\t"

      "movpl	%0, #0x7f00\n\t"

      "orrpl	%0, %0, #0xff\n"

      "adds	%1, %0, #32768\n\t"

      "movmi	%0, #0x8000":"+r" (x), "=r" (tmp)

      ::"cc");

  return (x);

}

#else

static inline ogg_int32_t

CLIP_TO_15 (ogg_int32_t x)

{

  int ret = x;

  ret -= ((x <= 32767) - 1) & (x - 32767);

  ret -= ((x >= -32768) - 1) & (x + 32768);

  return (ret);

}

#endif

static void

copy_samples_16_m (vorbis_sample_t * _out, vorbis_sample_t ** _in,

    guint samples, gint channels)

{

  gint16 *out = (gint16 *) _out;

  ogg_int32_t **in = (ogg_int32_t **) _in;

  gint j;

  for (j = 0; j < samples; j++) {

    *out++ = CLIP_TO_15 (in[0][j] >> 9);

  }

}

static void

copy_samples_16_s (vorbis_sample_t * _out, vorbis_sample_t ** _in,

    guint samples, gint channels)

{

  gint16 *out = (gint16 *) _out;

  ogg_int32_t **in = (ogg_int32_t **) _in;

  gint j;

  for (j = 0; j < samples; j++) {

    *out++ = CLIP_TO_15 (in[0][j] >> 9);

    *out++ = CLIP_TO_15 (in[1][j] >> 9);

  }

}

static void

copy_samples_16 (vorbis_sample_t * _out, vorbis_sample_t ** _in, guint samples,

    gint channels)

{

  gint16 *out = (gint16 *) _out;

  ogg_int32_t **in = (ogg_int32_t **) _in;

  gint i, j;

  for (j = 0; j < samples; j++) {

    for (i = 0; i < channels; i++) {

      *out++ = CLIP_TO_15 (in[gst_vorbis_reorder_map[channels - 1][i]][j] >> 9);

    }

  }

}

CopySampleFunc

gst_vorbis_get_copy_sample_func (gint channels)

{

  CopySampleFunc f = NULL;

  switch (channels) {

    case 1:

      f = copy_samples_16_m;

      break;

    case 2:

      f = copy_samples_16_s;

      break;

    default:

      f = copy_samples_16;

      break;

  }

  return f;

}

#endif