sl@0: /*
sl@0:  * LIBOIL - Library of Optimized Inner Loops
sl@0:  * Copyright (c) 2003,2004 David A. Schleef <ds@schleef.org>
sl@0:  * All rights reserved.
sl@0:  *
sl@0:  * Redistribution and use in source and binary forms, with or without
sl@0:  * modification, are permitted provided that the following conditions
sl@0:  * are met:
sl@0:  * 1. Redistributions of source code must retain the above copyright
sl@0:  *    notice, this list of conditions and the following disclaimer.
sl@0:  * 2. Redistributions in binary form must reproduce the above copyright
sl@0:  *    notice, this list of conditions and the following disclaimer in the
sl@0:  *    documentation and/or other materials provided with the distribution.
sl@0:  * 
sl@0:  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
sl@0:  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
sl@0:  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
sl@0:  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
sl@0:  * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
sl@0:  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
sl@0:  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
sl@0:  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
sl@0:  * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING
sl@0:  * IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
sl@0:  * POSSIBILITY OF SUCH DAMAGE.
sl@0:  */
sl@0: //Portions Copyright (c)  2008-2009 Nokia Corporation and/or its subsidiary(-ies). All rights reserved. 
sl@0: 
sl@0: #ifdef HAVE_CONFIG_H
sl@0: #include "config.h"
sl@0: #endif
sl@0: 
sl@0: #include <liboil/liboilfunction.h>
sl@0: #include "liboil/simdpack/simdpack.h"
sl@0: 
sl@0: /* This is a suprisingly fast implementation of clipping
sl@0:  * in straight C.  It would be difficult to do it faster in asm
sl@0:  * without specialized opcodes. */
sl@0: 
sl@0: static void
sl@0: clip_s16_fast (int16_t *dest, int dstr, int16_t *src, int sstr, int n,
sl@0:     int16_t *low, int16_t *hi)
sl@0: {
sl@0: 	int i;
sl@0: 	int32_t x;
sl@0: 
sl@0: 	for(i=0;i<n;i++){
sl@0: 		x = OIL_GET(src,i*sstr, int16_t);
sl@0: 		x = x - (((x-*low)>>31)&(x-*low)) + (((*hi-x)>>31)&(*hi-x));
sl@0: 		OIL_GET(dest,i*dstr, int16_t) = x;
sl@0: 	}
sl@0: }
sl@0: 
sl@0: OIL_DEFINE_IMPL (clip_s16_fast, clip_s16);
sl@0: 
sl@0: static void
sl@0: clip_s16_fast2 (int16_t *dest, int dstr, int16_t *src, int sstr, int n,
sl@0:     int16_t *low, int16_t *hi)
sl@0: {
sl@0: 	int32_t x1, x2;
sl@0: 
sl@0:         if (n&1) {
sl@0: 		x1 = *src;
sl@0: 		OIL_INCREMENT(src,sstr);
sl@0: 		x1 -= (((x1-*low)>>31)&(x1-*low));
sl@0: 		*dest = x1 + (((*hi-x1)>>31)&(*hi-x1));
sl@0: 		OIL_INCREMENT(dest,dstr);
sl@0: 		n--;
sl@0:         }
sl@0: 	while(n>0){
sl@0: 		x1 = *src;
sl@0: 		OIL_INCREMENT(src,sstr);
sl@0: 		 x2 = *src;
sl@0: 		 OIL_INCREMENT(src,sstr);
sl@0: 		x1 -= (((x1-*low)>>31)&(x1-*low));
sl@0: 		 x2 -= (((x2-*low)>>31)&(x2-*low));
sl@0: 		*dest = x1 + (((*hi-x1)>>31)&(*hi-x1));
sl@0: 		OIL_INCREMENT(dest,dstr);
sl@0: 		 *dest = x2 + (((*hi-x2)>>31)&(*hi-x2));
sl@0: 		 OIL_INCREMENT(dest,dstr);
sl@0: 		n-=2;
sl@0: 	}
sl@0: }
sl@0: OIL_DEFINE_IMPL (clip_s16_fast2, clip_s16);
sl@0: 
sl@0: 
sl@0: 
sl@0: 
sl@0: #if 0
sl@0: /* broken */
sl@0: 
sl@0: /* This trick clips
sl@0:  * the range min^(1<<31) to max^(1<<31) incorrectly with int32_t.
sl@0:  * Thus the use of int64_t. */
sl@0: 
sl@0: static void
sl@0: clip_s32_fast (int32_t *dest, int dstr, int32_t *src, int sstr, int n,
sl@0:     int32_t *low, int32_t *hi)
sl@0: {
sl@0: 	int i;
sl@0: 	int64_t x;
sl@0: 
sl@0: 	for(i=0;i<n;i++){
sl@0: 		x = OIL_GET(src,i*sstr,int32_t);
sl@0: 		x = x - (((x-*low)>>63)&(x-*low)) + (((*hi-x)>>63)&(*hi-x));
sl@0: 		OIL_GET(dest,i*dstr,int32_t) = x;
sl@0: 	}
sl@0: }
sl@0: 
sl@0: OIL_DEFINE_IMPL (clip_s32_fast, clip_s32);
sl@0: #endif
sl@0: 
sl@0: 
sl@0: 
sl@0: 
sl@0: #ifdef	__SYMBIAN32__
sl@0:  
sl@0: OilFunctionImpl* __oil_function_impl_clip_s16_fast() {
sl@0: 		return &_oil_function_impl_clip_s16_fast;
sl@0: }
sl@0: #endif
sl@0: 
sl@0: #ifdef	__SYMBIAN32__
sl@0:  
sl@0: OilFunctionImpl* __oil_function_impl_clip_s16_fast2() {
sl@0: 		return &_oil_function_impl_clip_s16_fast2;
sl@0: }
sl@0: #endif
sl@0: #if 0
sl@0: #ifdef	__SYMBIAN32__
sl@0:  
sl@0: OilFunctionImpl* __oil_function_impl_clip_s32_fast() {
sl@0: 		return &_oil_function_impl_clip_s32_fast;
sl@0: }
sl@0: #endif
sl@0: #endif