/*

  * LIBOIL - Library of Optimized Inner Loops

  * Copyright (c) 2003,2004 David A. Schleef <ds@schleef.org>

  * All rights reserved.

  *

  * Redistribution and use in source and binary forms, with or without

  * modification, are permitted provided that the following conditions

  * are met:

  * 1. Redistributions of source code must retain the above copyright

  *    notice, this list of conditions and the following disclaimer.

  * 2. Redistributions in binary form must reproduce the above copyright

  *    notice, this list of conditions and the following disclaimer in the

  *    documentation and/or other materials provided with the distribution.

  * 

  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR

  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED

  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE

  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,

  * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES

  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR

  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)

  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,

  * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING

  * IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE

  * POSSIBILITY OF SUCH DAMAGE.

  */

 //Portions Copyright (c)  2008-2009 Nokia Corporation and/or its subsidiary(-ies). All rights reserved. 

 #ifdef HAVE_CONFIG_H

 #include "config.h"

 #endif

 #include <liboil/liboilfunction.h>

 #include "conv.h"

 #ifdef HAVE_IEEE754_H

 #include <ieee754.h>   

 static void conv_f32_u8_bitstuff(float *dst, int dest_stride, const uint8_t *src,

 	int src_stride, int n)

 {

 	const float offset = -65536;

 	union ieee754_float id;

 	int i;

 	id.f = 0x1ffff;

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

 		id.ieee.mantissa = (*src<<7);

 		*dst = id.f + offset;

 		OIL_INCREMENT(dst, dest_stride);

 		OIL_INCREMENT(src, src_stride);

 	}

 }

 OIL_DEFINE_IMPL(conv_f32_u8_bitstuff, conv_f32_u8);

 static void conv_f32_s8_bitstuff(float *dst, int dest_stride, const int8_t *src,

 	int src_stride, int n)

 {

 	const float offset = -384;

 	union ieee754_float id;

 	int i;

 	id.f = 0x1ff;

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

 		id.ieee.mantissa = ((*src^0x80)<<15);

 		*dst = id.f + offset;

 		OIL_INCREMENT(dst, dest_stride);

 		OIL_INCREMENT(src, src_stride);

 	}

 }

 OIL_DEFINE_IMPL(conv_f32_s8_bitstuff, conv_f32_s8);

 static void conv_f32_u16_bitstuff(float *dst, int dest_stride, const uint16_t *src,

 	int src_stride, int n)

 {

 	const float offset = -65536;

 	union ieee754_float id;

 	int i;

 	id.f = 0x1ffff;

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

 		id.ieee.mantissa = (*src<<7);

 		*dst = id.f + offset;

 		OIL_INCREMENT(dst, dest_stride);

 		OIL_INCREMENT(src, src_stride);

 	}

 }

 OIL_DEFINE_IMPL(conv_f32_u16_bitstuff, conv_f32_u16);

 #ifdef ENABLE_BROKEN_IMPLS

 /* This is intermittently broken on powerpc for unknown reasons */

 static void conv_f32_s16_bitstuff(float *dst, int dest_stride, const int16_t *src,

 	int src_stride, int n)

 {

 	const float offset = -98304;

 	union ieee754_float id;

 	int i;

 	id.f = 0x1ffff;

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

 		id.ieee.mantissa = ((*src^0x8000)<<7);

 		*dst = id.f + offset;

 		OIL_INCREMENT(dst, dest_stride);

 		OIL_INCREMENT(src, src_stride);

 	}

 }

 OIL_DEFINE_IMPL(conv_f32_s16_bitstuff, conv_f32_s16);

 #endif

 #define signbit_S32(x) (((uint32_t)(x))>>31)

 #if 0

 /* broken */

 /* This implementation is slightly inaccurate */

 static void conv_s16_f32_bitstuff(int16_t *dst, int dest_stride, const float *src,

 	int src_stride, int n)

 {

 	const float offset = 98304.5;

 	union ieee754_double id;

 	int i;

 	int16_t d;

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

 		id.d = offset + *src;

 		d = 0x8000 | (id.ieee.mantissa0 >> 4);

 		d += (-32768-d)*signbit_S32(id.ieee.exponent-1039);

 		d += (32767-d)*signbit_S32(1039-id.ieee.exponent);

 		*dst = d;

 		OIL_INCREMENT(dst, dest_stride);

 		OIL_INCREMENT(src, src_stride);

 	}

 }

 OIL_DEFINE_IMPL(conv_s16_f32_bitstuff, conv_s16_f32);

 #endif

 #if 0

 static void conv_f64_u8_bitstuff(float *dst, int dest_stride, const uint8_t *src,

 	int src_stride, int n)

 {

 	const float offset = -65536;

 	union ieee754_float id;

 	int i;

 	id.f = 0x1ffff;

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

 		id.ieee.mantissa = (*src<<7);

 		*dst = id.f + offset;

 		OIL_INCREMENT(dst, dest_stride);

 		OIL_INCREMENT(src, src_stride);

 	}

 }

 OIL_DEFINE_IMPL(conv_f64_u8_bitstuff, conv_f64_u8);

 static void conv_f64_s8_bitstuff(float *dst, int dest_stride, const int8_t *src,

 	int src_stride, int n)

 {

 	const float offset = -384;

 	union ieee754_float id;

 	int i;

 	id.f = 0x1ff;

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

 		id.ieee.mantissa = ((*src^0x80)<<15);

 		*dst = id.f + offset;

 		OIL_INCREMENT(dst, dest_stride);

 		OIL_INCREMENT(src, src_stride);

 	}

 }

 OIL_DEFINE_IMPL(conv_f64_s8_bitstuff, conv_f64_s8);

 static void conv_f64_u16_bitstuff(float *dst, int dest_stride, const uint16_t *src,

 	int src_stride, int n)

 {

 	const float offset = -65536;

 	union ieee754_float id;

 	int i;

 	id.f = 0x1ffff;

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

 		id.ieee.mantissa = (*src<<7);

 		*dst = id.f + offset;

 		OIL_INCREMENT(dst, dest_stride);

 		OIL_INCREMENT(src, src_stride);

 	}

 }

 OIL_DEFINE_IMPL(conv_f64_u16_bitstuff, conv_f64_u16);

 static void conv_f64_s16_bitstuff(float *dst, int dest_stride, const int16_t *src,

 	int src_stride, int n)

 {

 	const float offset = -98304;

 	union ieee754_float id;

 	int i;

 	id.f = 0x1ffff;

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

 		id.ieee.mantissa = ((*src^0x8000)<<7);

 		*dst = id.f + offset;

 		OIL_INCREMENT(dst, dest_stride);

 		OIL_INCREMENT(src, src_stride);

 	}

 }

 OIL_DEFINE_IMPL(conv_f64_s16_bitstuff, conv_f64_s16);

 #endif

 #if 0

 /* broken */

 /* This implementation is slightly inaccurate */

 static void conv_s16_f64_bitstuff(int16_t *dst, int dest_stride, const float *src,

 	int src_stride, int n)

 {

 	const float offset = 98304.5;

 	union ieee754_double id;

 	int i;

 	int16_t d;

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

 		id.d = offset + *src;

 		d = 0x8000 ^ (id.ieee.mantissa0 >> 4);

 		d += (-32768-d)*signbit_S32(id.ieee.exponent-1039);

 		d += (32767-d)*signbit_S32(1039-id.ieee.exponent);

 #if 0

 /* for clipping */

 		if (id.ieee.exponent < 1039) {

 		  d = -32768;

 		}

 		if (id.ieee.exponent > 1039) {

 		  d = 32767;

 		}

 #endif

 		*dst = d;

 		OIL_INCREMENT (dst, dest_stride);

 		OIL_INCREMENT (src, src_stride);

 	}

 }

 OIL_DEFINE_IMPL(conv_s16_f64_bitstuff, conv_s16_f64);

 #endif

 #ifdef	__SYMBIAN32__

 OilFunctionImpl* __oil_function_impl_conv_f32_u8_bitstuff() {

 		return &_oil_function_impl_conv_f32_u8_bitstuff;

 }

 #endif

 #ifdef	__SYMBIAN32__

 OilFunctionImpl* __oil_function_impl_conv_f32_s8_bitstuff() {

 		return &_oil_function_impl_conv_f32_s8_bitstuff;

 }

 #endif

 #ifdef	__SYMBIAN32__

 OilFunctionImpl* __oil_function_impl_conv_f32_u16_bitstuff() {

 		return &_oil_function_impl_conv_f32_u16_bitstuff;

 }

 #endif

 #ifdef	__SYMBIAN32__

 OilFunctionImpl* __oil_function_impl_conv_f32_s16_bitstuff() {

 		return &_oil_function_impl_conv_f32_s16_bitstuff;

 }

 #endif

 #ifdef	__SYMBIAN32__

 OilFunctionImpl* __oil_function_impl_conv_s16_f32_bitstuff() {

 		return &_oil_function_impl_conv_s16_f32_bitstuff;

 }

 #endif

 #ifdef	__SYMBIAN32__

 OilFunctionImpl* __oil_function_impl_conv_f64_u8_bitstuff() {

 		return &_oil_function_impl_conv_f64_u8_bitstuff;

 }

 #endif

 #ifdef	__SYMBIAN32__

 OilFunctionImpl* __oil_function_impl_conv_f64_s8_bitstuff() {

 		return &_oil_function_impl_conv_f64_s8_bitstuff;

 }

 #endif

 #ifdef	__SYMBIAN32__

 OilFunctionImpl* __oil_function_impl_conv_f64_u16_bitstuff() {

 		return &_oil_function_impl_conv_f64_u16_bitstuff;

 }

 #endif

 #ifdef	__SYMBIAN32__

 OilFunctionImpl* __oil_function_impl_conv_f64_s16_bitstuff() {

 		return &_oil_function_impl_conv_f64_s16_bitstuff;

 }

 #endif

 #ifdef	__SYMBIAN32__

 OilFunctionImpl* __oil_function_impl_conv_s16_f64_bitstuff() {

 		return &_oil_function_impl_conv_s16_f64_bitstuff;

 }

 #endif

 #endif