00001 /*This file is prepared for Doxygen automatic documentation generation.*/ 00015 /* Copyright (c) 2009 Atmel Corporation. All rights reserved. 00016 * 00017 * Redistribution and use in source and binary forms, with or without 00018 * modification, are permitted provided that the following conditions are met: 00019 * 00020 * 1. Redistributions of source code must retain the above copyright notice, this 00021 * list of conditions and the following disclaimer. 00022 * 00023 * 2. Redistributions in binary form must reproduce the above copyright notice, 00024 * this list of conditions and the following disclaimer in the documentation 00025 * and/or other materials provided with the distribution. 00026 * 00027 * 3. The name of Atmel may not be used to endorse or promote products derived 00028 * from this software without specific prior written permission. 00029 * 00030 * 4. This software may only be redistributed and used in connection with an Atmel 00031 * AVR product. 00032 * 00033 * THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR IMPLIED 00034 * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF 00035 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE 00036 * EXPRESSLY AND SPECIFICALLY DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR 00037 * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES 00038 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; 00039 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND 00040 * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 00041 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS 00042 * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE 00043 * 00044 */ 00045 #include "dsp.h" 00046 #include "preprocessor.h" 00047 00048 #if defined(FORCE_ALL_GENERICS) || \ 00049 defined(FORCE_GENERIC_VECT32_ADD_AND_SAT) || \ 00050 !defined(TARGET_SPECIFIC_VECT32_ADD_AND_SAT) 00051 00052 #define DSP32_ADDITION(x_num, data) \ 00053 { \ 00054 S64 temp = vect2[x_num] + vect3[x_num]; \ 00055 if (temp > (S64) DSP_Q_MAX(DSP32_QA, DSP32_QB)) \ 00056 vect1[x_num] = DSP_Q_MAX(DSP32_QA, DSP32_QB); \ 00057 else if (temp < (S64) DSP_Q_MIN(DSP32_QA, DSP32_QB)) \ 00058 vect1[x_num] = DSP_Q_MIN(DSP32_QA, DSP32_QB); \ 00059 else \ 00060 vect1[x_num] = (dsp32_t) temp; \ 00061 } 00062 00063 /********************************************************************************************* 00064 * This function is the ending function of the addition. It is used to add the last items of a vector. 00065 *********************************************************************************************/ 00066 #define DSP32_ADD_KERNEL_X_FCT(x_num, data) \ 00067 static void TPASTE2(dsp32_vect_add_kernel_x, x_num)(dsp32_t *vect1, dsp32_t *vect2, dsp32_t *vect3) \ 00068 { \ 00069 MREPEAT(x_num, DSP32_ADDITION, ""); \ 00070 } 00071 /*********************************************************************************************/ 00072 00073 DSP32_ADD_KERNEL_X_FCT(0, "") 00074 DSP32_ADD_KERNEL_X_FCT(1, "") 00075 DSP32_ADD_KERNEL_X_FCT(2, "") 00076 DSP32_ADD_KERNEL_X_FCT(3, "") 00077 00078 void dsp32_vect_add_and_sat(dsp32_t *vect1, dsp32_t *vect2, dsp32_t *vect3, int size) 00079 { 00080 typedef void (*add_kernel_opti_t)(dsp32_t *, dsp32_t *, dsp32_t *); 00081 static const add_kernel_opti_t add_end_kernel_opti[4] = { 00082 dsp32_vect_add_kernel_x0, 00083 dsp32_vect_add_kernel_x1, 00084 dsp32_vect_add_kernel_x2, 00085 dsp32_vect_add_kernel_x3 00086 }; 00087 int n; 00088 00089 for(n=0; n<size-3; n+=4) 00090 { 00091 DSP32_ADDITION(n, ""); 00092 DSP32_ADDITION(n+1, ""); 00093 DSP32_ADDITION(n+2, ""); 00094 DSP32_ADDITION(n+3, ""); 00095 } 00096 00097 // Jump on different functions depending on the length of the vectors to compute 00098 add_end_kernel_opti[size&0x3](&vect1[n], &vect2[n], &vect3[n]); 00099 } 00100 00101 #endif