/*
 * QEMU Mixing engine
 *
 * Copyright (c) 2004-2005 Vassili Karpov (malc)
 *
 * Permission is hereby granted, free of charge, to any person obtaining a copy
 * of this software and associated documentation files (the "Software"), to deal
 * in the Software without restriction, including without limitation the rights
 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
 * copies of the Software, and to permit persons to whom the Software is
 * furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice shall be included in
 * all copies or substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
 * THE SOFTWARE.
 */

/*
 * Tusen tack till Mike Nordell
 * dec++'ified by Dscho
 */

#ifndef SIGNED
#define HALF (IN_MAX >> 1)
#endif

#ifdef NOVOL
#define VOL(a, b) a
#else
#ifdef VBOX
#define VOL(a, b) ((ASMMult2xS32RetS64(a, b) >> 31))
#else /* !VBOX */
#ifdef FLOAT_MIXENG
#define VOL(a, b) ((a) * (b))
#else
#define VOL(a, b) ((a) * (b)) >> 32
#endif
#endif
#endif /* !VBOX */

#define ET glue (ENDIAN_CONVERSION, glue (_, IN_T))

#ifdef FLOAT_MIXENG
static real_t inline glue (conv_, ET) (IN_T v)
{
    IN_T nv = ENDIAN_CONVERT (v);

#ifdef RECIPROCAL
#ifdef SIGNED
    return nv * (1.f / (real_t) (IN_MAX - IN_MIN));
#else
    return (nv - HALF) * (1.f / (real_t) IN_MAX);
#endif
#else  /* !RECIPROCAL */
#ifdef SIGNED
    return nv / (real_t) (IN_MAX - IN_MIN);
#else
    return (nv - HALF) / (real_t) IN_MAX;
#endif
#endif
}

static IN_T inline glue (clip_, ET) (real_t v)
{
    if (v >= 0.5) {
        return IN_MAX;
    }
    else if (v < -0.5) {
        return IN_MIN;
    }

#ifdef SIGNED
    return ENDIAN_CONVERT ((IN_T) (v * (IN_MAX - IN_MIN)));
#else
    return ENDIAN_CONVERT ((IN_T) ((v * IN_MAX) + HALF));
#endif
}

#else  /* !FLOAT_MIXENG */

static inline int64_t glue (conv_, ET) (IN_T v)
{
    IN_T nv = ENDIAN_CONVERT (v);
#ifdef SIGNED
    return ((int64_t) nv) << (32 - SHIFT);
#else
    return ((int64_t) nv - HALF) << (32 - SHIFT);
#endif
}

static inline IN_T glue (clip_, ET) (int64_t v)
{
    if (v >= 0x7f000000) {
        return IN_MAX;
    }
    else if (v < -2147483648LL) {
        return IN_MIN;
    }

#ifdef SIGNED
    return ENDIAN_CONVERT ((IN_T) (v >> (32 - SHIFT)));
#else
    return ENDIAN_CONVERT ((IN_T) ((v >> (32 - SHIFT)) + HALF));
#endif
}
#endif

static void glue (glue (conv_, ET), _to_stereo)
#ifdef VBOX_WITH_PDM_AUDIO_DRIVER
    (PPDMHOSTSTEREOSAMPLE dst, const void *src, int samples, volume_t *vol)
#else
    (st_sample_t *dst, const void *src, int samples, volume_t *vol)
#endif
{
#ifdef VBOX_WITH_PDM_AUDIO_DRIVER
    PPDMHOSTSTEREOSAMPLE out = dst;
#else
    st_sample_t *out = dst;
#endif
    IN_T *in = (IN_T *) src;
#ifndef NOVOL
    if (vol->mute) {
        mixeng_clear (dst, samples);
        return;
    }
#else
    (void) vol;
#endif
    while (samples--) {
#ifdef VBOX_WITH_PDM_AUDIO_DRIVER
        out->u64LSample = VOL (glue (conv_, ET) (*in++), vol->l);
        out->u64RSample = VOL (glue (conv_, ET) (*in++), vol->r);
#else
        out->l = VOL (glue (conv_, ET) (*in++), vol->l);
        out->r = VOL (glue (conv_, ET) (*in++), vol->r);
#endif
        out += 1;
    }
}

static void glue (glue (conv_, ET), _to_mono)
#ifdef VBOX_WITH_PDM_AUDIO_DRIVER
    (PPDMHOSTSTEREOSAMPLE dst, const void *src, int samples, volume_t *vol)
#else
    (st_sample_t *dst, const void *src, int samples, volume_t *vol)
#endif
{
#ifdef VBOX_WITH_PDM_AUDIO_DRIVER
    PPDMHOSTSTEREOSAMPLE out = dst;
#else
    st_sample_t *out = dst;
#endif
    IN_T *in = (IN_T *) src;
#ifndef NOVOL
    if (vol->mute) {
        mixeng_clear (dst, samples);
        return;
    }
#else
    (void) vol;
#endif
    while (samples--) {
#ifdef VBOX_WITH_PDM_AUDIO_DRIVER
        out->u64LSample = VOL (glue (conv_, ET) (in[0]), vol->l);
        out->u64RSample = out->u64LSample;
#else
        out->l = VOL (glue (conv_, ET) (in[0]), vol->l);
        out->r = out->l;

#endif
        out += 1;
        in += 1;
    }
}

static void glue (glue (clip_, ET), _from_stereo)
    (void *dst, const st_sample_t *src, int samples)
{
    const st_sample_t *in = src;
    IN_T *out = (IN_T *) dst;
    while (samples--) {
        *out++ = glue (clip_, ET) (in->l);
        *out++ = glue (clip_, ET) (in->r);
        in += 1;
    }
}

static void glue (glue (clip_, ET), _from_mono)
    (void *dst, const st_sample_t *src, int samples)
{
    const st_sample_t *in = src;
    IN_T *out = (IN_T *) dst;
    while (samples--) {
        *out++ = glue (clip_, ET) (in->l + in->r);
        in += 1;
    }
}

#undef ET
#undef HALF
#undef VOL