genericopenlibs/liboil/src/conv/conv_bitstuff.c
changeset 18 47c74d1534e1
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/genericopenlibs/liboil/src/conv/conv_bitstuff.c	Fri Apr 16 16:46:38 2010 +0300
@@ -0,0 +1,315 @@
+/*
+ * 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