]> git.gag.com Git - fw/stlink/blob - exampleF4/CMSIS/DSP_Lib/Source/BasicMathFunctions/arm_abs_q7.c
Added all the F4 libraries to the project
[fw/stlink] / exampleF4 / CMSIS / DSP_Lib / Source / BasicMathFunctions / arm_abs_q7.c
1 /* ----------------------------------------------------------------------   
2 * Copyright (C) 2010 ARM Limited. All rights reserved.   
3 *   
4 * $Date:        15. July 2011  
5 * $Revision:    V1.0.10  
6 *   
7 * Project:          CMSIS DSP Library   
8 * Title:                arm_abs_q7.c   
9 *   
10 * Description:  Q7 vector absolute value.   
11 *   
12 * Target Processor: Cortex-M4/Cortex-M3/Cortex-M0
13 *  
14 * Version 1.0.10 2011/7/15 
15 *    Big Endian support added and Merged M0 and M3/M4 Source code.  
16 *   
17 * Version 1.0.3 2010/11/29  
18 *    Re-organized the CMSIS folders and updated documentation.   
19 *    
20 * Version 1.0.2 2010/11/11   
21 *    Documentation updated.    
22 *   
23 * Version 1.0.1 2010/10/05    
24 *    Production release and review comments incorporated.   
25 *   
26 * Version 1.0.0 2010/09/20    
27 *    Production release and review comments incorporated.   
28 *   
29 * Version 0.0.7  2010/06/10    
30 *    Misra-C changes done   
31 * -------------------------------------------------------------------- */
32
33 #include "arm_math.h"
34
35 /**   
36  * @ingroup groupMath   
37  */
38
39 /**   
40  * @addtogroup BasicAbs   
41  * @{   
42  */
43
44 /**   
45  * @brief Q7 vector absolute value.   
46  * @param[in]       *pSrc points to the input buffer   
47  * @param[out]      *pDst points to the output buffer   
48  * @param[in]       blockSize number of samples in each vector   
49  * @return none.   
50  *   
51  * <b>Scaling and Overflow Behavior:</b>   
52  * \par   
53  * The function uses saturating arithmetic.   
54  * The Q7 value -1 (0x80) will be saturated to the maximum allowable positive value 0x7F.   
55  */
56
57 void arm_abs_q7(
58   q7_t * pSrc,
59   q7_t * pDst,
60   uint32_t blockSize)
61 {
62   uint32_t blkCnt;                               /* loop counter */
63
64 #ifndef ARM_MATH_CM0
65
66   /* Run the below code for Cortex-M4 and Cortex-M3 */
67   q7_t in1;                                      /* Input value1 */
68   q7_t in2;                                      /* Input value2 */
69   q7_t in3;                                      /* Input value3 */
70   q7_t in4;                                      /* Input value4 */
71
72
73   /*loop Unrolling */
74   blkCnt = blockSize >> 2u;
75
76   /* First part of the processing with loop unrolling.  Compute 4 outputs at a time.   
77    ** a second loop below computes the remaining 1 to 3 samples. */
78   while(blkCnt > 0u)
79   {
80     /* C = |A| */
81     /* Read 4 inputs */
82     in1 = *pSrc++;
83     in2 = *pSrc++;
84     in3 = *pSrc++;
85     in4 = *pSrc++;
86
87     /* Store the Absolute result in the destination buffer by packing the 4 values in single cycle */
88     *__SIMD32(pDst)++ =
89       __PACKq7(((in1 > 0) ? in1 : __SSAT(-in1, 8)),
90                ((in2 > 0) ? in2 : __SSAT(-in2, 8)),
91                ((in3 > 0) ? in3 : __SSAT(-in3, 8)),
92                ((in4 > 0) ? in4 : __SSAT(-in4, 8)));
93
94     /* Decrement the loop counter */
95     blkCnt--;
96   }
97
98   /* If the blockSize is not a multiple of 4, compute any remaining output samples here.   
99    ** No loop unrolling is used. */
100   blkCnt = blockSize % 0x4u;
101
102   while(blkCnt > 0u)
103   {
104     /* C = |A| */
105     /* Read the input */
106     in1 = *pSrc++;
107
108     /* Store the Absolute result in the destination buffer */
109     *pDst++ = (in1 > 0) ? in1 : __SSAT(-in1, 8);
110
111     /* Decrement the loop counter */
112     blkCnt--;
113   }
114
115 #else
116
117   /* Run the below code for Cortex-M0 */
118
119   q7_t in;                                       /* Temporary input varible */
120
121   /* Initialize blkCnt with number of samples */
122   blkCnt = blockSize;
123
124   while(blkCnt > 0u)
125   {
126     /* C = |A| */
127     /* Read the input */
128     in = *pSrc++;
129
130     /* Store the Absolute result in the destination buffer */
131     *pDst++ = (in > 0) ? in : __SSAT(-in, 8);
132
133     /* Decrement the loop counter */
134     blkCnt--;
135   }
136
137 #endif /*   #ifndef ARM_MATH_CM0   */
138
139 }
140
141 /**   
142  * @} end of BasicAbs group   
143  */