Initial commit
This commit is contained in:
		| @@ -0,0 +1,4 @@ | ||||
| CMSIS DSP_Lib example arm_convolution_example for | ||||
|   Cortex-M0, Cortex-M3, Cortex-M4 with FPU and Cortex-M7 with single precision FPU. | ||||
|  | ||||
| The example is configured for uVision Simulator. | ||||
| @@ -0,0 +1,247 @@ | ||||
| /* ---------------------------------------------------------------------- | ||||
| * Copyright (C) 2010-2012 ARM Limited. All rights reserved. | ||||
| * | ||||
| * $Date:         17. January 2013 | ||||
| * $Revision:     V1.4.0 | ||||
| * | ||||
| * Project:       CMSIS DSP Library | ||||
| * Title:         arm_convolution_example_f32.c | ||||
| * | ||||
| * Description:   Example code demonstrating Convolution of two input signals using fft. | ||||
| * | ||||
| * Target Processor: Cortex-M4/Cortex-M3 | ||||
| * | ||||
| * Redistribution and use in source and binary forms, with or without | ||||
| * modification, are permitted provided that the following conditions | ||||
| * are met: | ||||
| *   - Redistributions of source code must retain the above copyright | ||||
| *     notice, this list of conditions and the following disclaimer. | ||||
| *   - 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. | ||||
| *   - Neither the name of ARM LIMITED nor the names of its contributors | ||||
| *     may be used to endorse or promote products derived from this | ||||
| *     software without specific prior written permission. | ||||
| * | ||||
| * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS | ||||
| * "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 | ||||
| * COPYRIGHT OWNER OR CONTRIBUTORS 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. | ||||
| * -------------------------------------------------------------------- */ | ||||
|  | ||||
| /** | ||||
|  * @ingroup groupExamples | ||||
|  */ | ||||
|  | ||||
| /** | ||||
|  * @defgroup ConvolutionExample Convolution Example | ||||
|  * | ||||
|  * \par Description: | ||||
|  * \par | ||||
|  * Demonstrates the convolution theorem with the use of the Complex FFT, Complex-by-Complex | ||||
|  * Multiplication, and Support Functions. | ||||
|  * | ||||
|  * \par Algorithm: | ||||
|  * \par | ||||
|  * The convolution theorem states that convolution in the time domain corresponds to | ||||
|  * multiplication in the frequency domain. Therefore, the Fourier transform of the convoution of | ||||
|  * two signals is equal to the product of their individual Fourier transforms. | ||||
|  * The Fourier transform of a signal can be evaluated efficiently using the Fast Fourier Transform (FFT). | ||||
|  * \par | ||||
|  * Two input signals, <code>a[n]</code> and <code>b[n]</code>, with lengths \c n1 and \c n2 respectively, | ||||
|  * are zero padded so that their lengths become \c N, which is greater than or equal to <code>(n1+n2-1)</code> | ||||
|  * and is a power of 4 as FFT implementation is radix-4. | ||||
|  * The convolution of <code>a[n]</code> and <code>b[n]</code> is obtained by taking the FFT of the input | ||||
|  * signals, multiplying the Fourier transforms of the two signals, and taking the inverse FFT of | ||||
|  * the multiplied result. | ||||
|  * \par | ||||
|  * This is denoted by the following equations: | ||||
|  * <pre> A[k] = FFT(a[n],N) | ||||
|  * B[k] = FFT(b[n],N) | ||||
|  * conv(a[n], b[n]) = IFFT(A[k] * B[k], N)</pre> | ||||
|  * where <code>A[k]</code> and <code>B[k]</code> are the N-point FFTs of the signals <code>a[n]</code> | ||||
|  * and <code>b[n]</code> respectively. | ||||
|  * The length of the convolved signal is <code>(n1+n2-1)</code>. | ||||
|  * | ||||
|  * \par Block Diagram: | ||||
|  * \par | ||||
|  * \image html Convolution.gif | ||||
|  * | ||||
|  * \par Variables Description: | ||||
|  * \par | ||||
|  * \li \c testInputA_f32 points to the first input sequence | ||||
|  * \li \c srcALen length of the first input sequence | ||||
|  * \li \c testInputB_f32 points to the second input sequence | ||||
|  * \li \c srcBLen length of the second input sequence | ||||
|  * \li \c outLen length of convolution output sequence, <code>(srcALen + srcBLen - 1)</code> | ||||
|  * \li \c AxB points to the output array where the product of individual FFTs of inputs is stored. | ||||
|  * | ||||
|  * \par CMSIS DSP Software Library Functions Used: | ||||
|  * \par | ||||
|  * - arm_fill_f32() | ||||
|  * - arm_copy_f32() | ||||
|  * - arm_cfft_radix4_init_f32() | ||||
|  * - arm_cfft_radix4_f32() | ||||
|  * - arm_cmplx_mult_cmplx_f32() | ||||
|  * | ||||
|  * <b> Refer  </b> | ||||
|  * \link arm_convolution_example_f32.c \endlink | ||||
|  * | ||||
|  */ | ||||
|  | ||||
|  | ||||
| /** \example arm_convolution_example_f32.c | ||||
|   */ | ||||
|  | ||||
| #include "arm_math.h" | ||||
| #include "math_helper.h" | ||||
|  | ||||
| /* ---------------------------------------------------------------------- | ||||
| * Defines each of the tests performed | ||||
| * ------------------------------------------------------------------- */ | ||||
| #define MAX_BLOCKSIZE   128 | ||||
| #define DELTA           (0.000001f) | ||||
| #define SNR_THRESHOLD   90 | ||||
|  | ||||
| /* ---------------------------------------------------------------------- | ||||
| * Declare I/O buffers | ||||
| * ------------------------------------------------------------------- */ | ||||
| float32_t Ak[MAX_BLOCKSIZE];        /* Input A */ | ||||
| float32_t Bk[MAX_BLOCKSIZE];        /* Input B */ | ||||
| float32_t AxB[MAX_BLOCKSIZE * 2];   /* Output */ | ||||
|  | ||||
| /* ---------------------------------------------------------------------- | ||||
| * Test input data for Floating point Convolution example for 32-blockSize | ||||
| * Generated by the MATLAB randn() function | ||||
| * ------------------------------------------------------------------- */ | ||||
| float32_t testInputA_f32[64] = | ||||
| { | ||||
|   -0.808920,   1.357369,   1.180861,  -0.504544,   1.762637,  -0.703285, | ||||
|    1.696966,   0.620571,  -0.151093,  -0.100235,  -0.872382,  -0.403579, | ||||
|   -0.860749,  -0.382648,  -1.052338,   0.128113,  -0.646269,   1.093377, | ||||
|   -2.209198,   0.471706,   0.408901,   1.266242,   0.598252,   1.176827, | ||||
|   -0.203421,   0.213596,  -0.851964,  -0.466958,   0.021841,  -0.698938, | ||||
|   -0.604107,   0.461778,  -0.318219,   0.942520,   0.577585,   0.417619, | ||||
|    0.614665,   0.563679,  -1.295073,  -0.764437,   0.952194,  -0.859222, | ||||
|   -0.618554,  -2.268542,  -1.210592,   1.655853,  -2.627219,  -0.994249, | ||||
|   -1.374704,   0.343799,   0.025619,   1.227481,  -0.708031,   0.069355, | ||||
|   -1.845228,  -1.570886,   1.010668,  -1.802084,   1.630088,   1.286090, | ||||
|   -0.161050,  -0.940794,   0.367961,   0.291907 | ||||
|  | ||||
| }; | ||||
|  | ||||
| float32_t testInputB_f32[64] = | ||||
| { | ||||
|    0.933724,   0.046881,   1.316470,   0.438345,   0.332682,   2.094885, | ||||
|    0.512081,   0.035546,   0.050894,  -2.320371,   0.168711,  -1.830493, | ||||
|   -0.444834,  -1.003242,  -0.531494,  -1.365600,  -0.155420,  -0.757692, | ||||
|   -0.431880,  -0.380021,   0.096243,  -0.695835,   0.558850,  -1.648962, | ||||
|    0.020369,  -0.363630,   0.887146,   0.845503,  -0.252864,  -0.330397, | ||||
|    1.269131,  -1.109295,  -1.027876,   0.135940,   0.116721,  -0.293399, | ||||
|   -1.349799,   0.166078,  -0.802201,   0.369367,  -0.964568,  -2.266011, | ||||
|    0.465178,   0.651222,  -0.325426,   0.320245,  -0.784178,  -0.579456, | ||||
|    0.093374,   0.604778,  -0.048225,   0.376297,  -0.394412,   0.578182, | ||||
|   -1.218141,  -1.387326,   0.692462,  -0.631297,   0.153137,  -0.638952, | ||||
|   0.635474,   -0.970468,   1.334057,  -0.111370 | ||||
| }; | ||||
|  | ||||
| const float testRefOutput_f32[127] = | ||||
| { | ||||
|    -0.818943,    1.229484,  -0.533664,    1.016604,   0.341875,  -1.963656, | ||||
|     5.171476,    3.478033,   7.616361,    6.648384,   0.479069,   1.792012, | ||||
|    -1.295591,   -7.447818,   0.315830,  -10.657445,  -2.483469,  -6.524236, | ||||
|    -7.380591,   -3.739005,  -8.388957,    0.184147,  -1.554888,   3.786508, | ||||
|    -1.684421,    5.400610,  -1.578126,    7.403361,   8.315999,   2.080267, | ||||
|    11.077776,    2.749673,   7.138962,    2.748762,   0.660363,   0.981552, | ||||
|     1.442275,    0.552721,  -2.576892,    4.703989,   0.989156,   8.759344, | ||||
|    -0.564825,   -3.994680,   0.954710,   -5.014144,   6.592329,   1.599488, | ||||
|   -13.979146,   -0.391891,  -4.453369,   -2.311242,  -2.948764,   1.761415, | ||||
|    -0.138322,   10.433007,  -2.309103,    4.297153,   8.535523,   3.209462, | ||||
|     8.695819,    5.569919,   2.514304,    5.582029,   2.060199,   0.642280, | ||||
|     7.024616,    1.686615,  -6.481756,    1.343084,  -3.526451,   1.099073, | ||||
|    -2.965764,   -0.173723,  -4.111484,    6.528384,  -6.965658,   1.726291, | ||||
|     1.535172,   11.023435,   2.338401,   -4.690188,   1.298210,   3.943885, | ||||
|     8.407885,    5.168365,   0.684131,    1.559181,   1.859998,   2.852417, | ||||
|     8.574070,   -6.369078,   6.023458,   11.837963,  -6.027632,   4.469678, | ||||
|    -6.799093,   -2.674048,   6.250367,   -6.809971,  -3.459360,   9.112410, | ||||
|    -2.711621,   -1.336678,   1.564249,   -1.564297,  -1.296760,   8.904013, | ||||
|    -3.230109,    6.878013,  -7.819823,    3.369909,  -1.657410,  -2.007358, | ||||
|    -4.112825,    1.370685,  -3.420525,   -6.276605,   3.244873,  -3.352638, | ||||
|     1.545372,    0.902211,   0.197489,   -1.408732,   0.523390,   0.348440, 0 | ||||
| }; | ||||
|  | ||||
|  | ||||
| /* ---------------------------------------------------------------------- | ||||
| * Declare Global variables | ||||
| * ------------------------------------------------------------------- */ | ||||
| uint32_t srcALen = 64;   /* Length of Input A */ | ||||
| uint32_t srcBLen = 64;   /* Length of Input B */ | ||||
| uint32_t outLen;         /* Length of convolution output */ | ||||
| float32_t snr;           /* output SNR */ | ||||
|  | ||||
| int32_t main(void) | ||||
| { | ||||
|   arm_status status;                           /* Status of the example */ | ||||
|   arm_cfft_radix4_instance_f32 cfft_instance;  /* CFFT Structure instance */ | ||||
|  | ||||
|   /* CFFT Structure instance pointer */ | ||||
|   arm_cfft_radix4_instance_f32 *cfft_instance_ptr = | ||||
|       (arm_cfft_radix4_instance_f32*) &cfft_instance; | ||||
|  | ||||
|   /* output length of convolution */ | ||||
|   outLen = srcALen + srcBLen - 1; | ||||
|  | ||||
|   /* Initialise the fft input buffers with all zeros */ | ||||
|   arm_fill_f32(0.0,  Ak, MAX_BLOCKSIZE); | ||||
|   arm_fill_f32(0.0,  Bk, MAX_BLOCKSIZE); | ||||
|  | ||||
|   /* Copy the input values to the fft input buffers */ | ||||
|   arm_copy_f32(testInputA_f32,  Ak, MAX_BLOCKSIZE/2); | ||||
|   arm_copy_f32(testInputB_f32,  Bk, MAX_BLOCKSIZE/2); | ||||
|  | ||||
|   /* Initialize the CFFT function to compute 64 point fft */ | ||||
|   status = arm_cfft_radix4_init_f32(cfft_instance_ptr, 64, 0, 1); | ||||
|  | ||||
|   /* Transform input a[n] from time domain to frequency domain A[k] */ | ||||
|   arm_cfft_radix4_f32(cfft_instance_ptr, Ak); | ||||
|   /* Transform input b[n] from time domain to frequency domain B[k] */ | ||||
|   arm_cfft_radix4_f32(cfft_instance_ptr, Bk); | ||||
|  | ||||
|   /* Complex Multiplication of the two input buffers in frequency domain */ | ||||
|   arm_cmplx_mult_cmplx_f32(Ak, Bk, AxB, MAX_BLOCKSIZE/2); | ||||
|  | ||||
|   /* Initialize the CIFFT function to compute 64 point ifft */ | ||||
|   status = arm_cfft_radix4_init_f32(cfft_instance_ptr, 64, 1, 1); | ||||
|  | ||||
|   /* Transform the multiplication output from frequency domain to time domain, | ||||
|      that gives the convolved output  */ | ||||
|   arm_cfft_radix4_f32(cfft_instance_ptr, AxB); | ||||
|  | ||||
|   /* SNR Calculation */ | ||||
|   snr = arm_snr_f32((float32_t *)testRefOutput_f32, AxB, srcALen + srcBLen - 1); | ||||
|  | ||||
|   /* Compare the SNR with threshold to test whether the | ||||
|      computed output is matched with the reference output values. */ | ||||
|   if ( snr > SNR_THRESHOLD) | ||||
|   { | ||||
|     status = ARM_MATH_SUCCESS; | ||||
|   } | ||||
|  | ||||
|   if ( status != ARM_MATH_SUCCESS) | ||||
|   { | ||||
|     while (1); | ||||
|   } | ||||
|  | ||||
|   while (1);                             /* main function does not return */ | ||||
| } | ||||
|  | ||||
|  /** \endlink */ | ||||
| @@ -0,0 +1,466 @@ | ||||
| /* ---------------------------------------------------------------------- | ||||
| * Copyright (C) 2010-2012 ARM Limited. All rights reserved. | ||||
| * | ||||
| * $Date:        17. January 2013 | ||||
| * $Revision: 	V1.4.0  b | ||||
| * | ||||
| * Project: 	    CMSIS DSP Library | ||||
| * | ||||
| * Title:	    math_helper.c | ||||
| * | ||||
| * Description:	Definition of all helper functions required. | ||||
| * | ||||
| * Target Processor: Cortex-M4/Cortex-M3 | ||||
| * | ||||
| * Redistribution and use in source and binary forms, with or without | ||||
| * modification, are permitted provided that the following conditions | ||||
| * are met: | ||||
| *   - Redistributions of source code must retain the above copyright | ||||
| *     notice, this list of conditions and the following disclaimer. | ||||
| *   - 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. | ||||
| *   - Neither the name of ARM LIMITED nor the names of its contributors | ||||
| *     may be used to endorse or promote products derived from this | ||||
| *     software without specific prior written permission. | ||||
| * | ||||
| * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS | ||||
| * "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 | ||||
| * COPYRIGHT OWNER OR CONTRIBUTORS 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. | ||||
| * -------------------------------------------------------------------- */ | ||||
|  | ||||
| /* ---------------------------------------------------------------------- | ||||
| *		Include standard header files | ||||
| * -------------------------------------------------------------------- */ | ||||
| #include<math.h> | ||||
|  | ||||
| /* ---------------------------------------------------------------------- | ||||
| *		Include project header files | ||||
| * -------------------------------------------------------------------- */ | ||||
| #include "math_helper.h" | ||||
|  | ||||
| /** | ||||
|  * @brief  Caluclation of SNR | ||||
|  * @param[in]  pRef 	Pointer to the reference buffer | ||||
|  * @param[in]  pTest	Pointer to the test buffer | ||||
|  * @param[in]  buffSize	total number of samples | ||||
|  * @return     SNR | ||||
|  * The function Caluclates signal to noise ratio for the reference output | ||||
|  * and test output | ||||
|  */ | ||||
|  | ||||
| float arm_snr_f32(float *pRef, float *pTest, uint32_t buffSize) | ||||
| { | ||||
|   float EnergySignal = 0.0, EnergyError = 0.0; | ||||
|   uint32_t i; | ||||
|   float SNR; | ||||
|   int temp; | ||||
|   int *test; | ||||
|  | ||||
|   for (i = 0; i < buffSize; i++) | ||||
|     { | ||||
|  	  /* Checking for a NAN value in pRef array */ | ||||
| 	  test =   (int *)(&pRef[i]); | ||||
|       temp =  *test; | ||||
|  | ||||
| 	  if (temp == 0x7FC00000) | ||||
| 	  { | ||||
| 	  		return(0); | ||||
| 	  } | ||||
|  | ||||
| 	  /* Checking for a NAN value in pTest array */ | ||||
| 	  test =   (int *)(&pTest[i]); | ||||
|       temp =  *test; | ||||
|  | ||||
| 	  if (temp == 0x7FC00000) | ||||
| 	  { | ||||
| 	  		return(0); | ||||
| 	  } | ||||
|       EnergySignal += pRef[i] * pRef[i]; | ||||
|       EnergyError += (pRef[i] - pTest[i]) * (pRef[i] - pTest[i]); | ||||
|     } | ||||
|  | ||||
| 	/* Checking for a NAN value in EnergyError */ | ||||
| 	test =   (int *)(&EnergyError); | ||||
|     temp =  *test; | ||||
|  | ||||
|     if (temp == 0x7FC00000) | ||||
|     { | ||||
|   		return(0); | ||||
|     } | ||||
|  | ||||
|  | ||||
|   SNR = 10 * log10 (EnergySignal / EnergyError); | ||||
|  | ||||
|   return (SNR); | ||||
|  | ||||
| } | ||||
|  | ||||
|  | ||||
| /** | ||||
|  * @brief  Provide guard bits for Input buffer | ||||
|  * @param[in,out]  input_buf   Pointer to input buffer | ||||
|  * @param[in]       blockSize  block Size | ||||
|  * @param[in]       guard_bits guard bits | ||||
|  * @return none | ||||
|  * The function Provides the guard bits for the buffer | ||||
|  * to avoid overflow | ||||
|  */ | ||||
|  | ||||
| void arm_provide_guard_bits_q15 (q15_t * input_buf, uint32_t blockSize, | ||||
|                             uint32_t guard_bits) | ||||
| { | ||||
|   uint32_t i; | ||||
|  | ||||
|   for (i = 0; i < blockSize; i++) | ||||
|     { | ||||
|       input_buf[i] = input_buf[i] >> guard_bits; | ||||
|     } | ||||
| } | ||||
|  | ||||
| /** | ||||
|  * @brief  Converts float to fixed in q12.20 format | ||||
|  * @param[in]  pIn         pointer to input buffer | ||||
|  * @param[out] pOut        pointer to outputbuffer | ||||
|  * @param[in]  numSamples  number of samples in the input buffer | ||||
|  * @return none | ||||
|  * The function converts floating point values to fixed point(q12.20) values | ||||
|  */ | ||||
|  | ||||
| void arm_float_to_q12_20(float *pIn, q31_t * pOut, uint32_t numSamples) | ||||
| { | ||||
|   uint32_t i; | ||||
|  | ||||
|   for (i = 0; i < numSamples; i++) | ||||
|     { | ||||
| 	  /* 1048576.0f corresponds to pow(2, 20) */ | ||||
|       pOut[i] = (q31_t) (pIn[i] * 1048576.0f); | ||||
|  | ||||
|       pOut[i] += pIn[i] > 0 ? 0.5 : -0.5; | ||||
|  | ||||
|       if (pIn[i] == (float) 1.0) | ||||
|         { | ||||
|           pOut[i] = 0x000FFFFF; | ||||
|         } | ||||
|     } | ||||
| } | ||||
|  | ||||
| /** | ||||
|  * @brief  Compare MATLAB Reference Output and ARM Test output | ||||
|  * @param[in]  pIn         Pointer to Ref buffer | ||||
|  * @param[in]  pOut        Pointer to Test buffer | ||||
|  * @param[in]  numSamples  number of samples in the buffer | ||||
|  * @return maximum difference | ||||
|  */ | ||||
|  | ||||
| uint32_t arm_compare_fixed_q15(q15_t *pIn, q15_t *pOut, uint32_t numSamples) | ||||
| { | ||||
|   uint32_t i; | ||||
|   int32_t diff, diffCrnt = 0; | ||||
|   uint32_t maxDiff = 0; | ||||
|  | ||||
|   for (i = 0; i < numSamples; i++) | ||||
|   { | ||||
|   	diff = pIn[i] - pOut[i]; | ||||
|   	diffCrnt = (diff > 0) ? diff : -diff; | ||||
|  | ||||
| 	if (diffCrnt > maxDiff) | ||||
| 	{ | ||||
| 		maxDiff = diffCrnt; | ||||
| 	} | ||||
|   } | ||||
|  | ||||
|   return(maxDiff); | ||||
| } | ||||
|  | ||||
| /** | ||||
|  * @brief  Compare MATLAB Reference Output and ARM Test output | ||||
|  * @param[in]  pIn         Pointer to Ref buffer | ||||
|  * @param[in]  pOut        Pointer to Test buffer | ||||
|  * @param[in]  numSamples number of samples in the buffer | ||||
|  * @return maximum difference | ||||
|  */ | ||||
|  | ||||
| uint32_t arm_compare_fixed_q31(q31_t *pIn, q31_t * pOut, uint32_t numSamples) | ||||
| { | ||||
|   uint32_t i; | ||||
|   int32_t diff, diffCrnt = 0; | ||||
|   uint32_t maxDiff = 0; | ||||
|  | ||||
|   for (i = 0; i < numSamples; i++) | ||||
|   { | ||||
|   	diff = pIn[i] - pOut[i]; | ||||
|   	diffCrnt = (diff > 0) ? diff : -diff; | ||||
|  | ||||
| 	if (diffCrnt > maxDiff) | ||||
| 	{ | ||||
| 		maxDiff = diffCrnt; | ||||
| 	} | ||||
|   } | ||||
|  | ||||
|   return(maxDiff); | ||||
| } | ||||
|  | ||||
| /** | ||||
|  * @brief  Provide guard bits for Input buffer | ||||
|  * @param[in,out]  input_buf   Pointer to input buffer | ||||
|  * @param[in]       blockSize  block Size | ||||
|  * @param[in]       guard_bits guard bits | ||||
|  * @return none | ||||
|  * The function Provides the guard bits for the buffer | ||||
|  * to avoid overflow | ||||
|  */ | ||||
|  | ||||
| void arm_provide_guard_bits_q31 (q31_t * input_buf, | ||||
| 								 uint32_t blockSize, | ||||
|                                  uint32_t guard_bits) | ||||
| { | ||||
|   uint32_t i; | ||||
|  | ||||
|   for (i = 0; i < blockSize; i++) | ||||
|     { | ||||
|       input_buf[i] = input_buf[i] >> guard_bits; | ||||
|     } | ||||
| } | ||||
|  | ||||
| /** | ||||
|  * @brief  Provide guard bits for Input buffer | ||||
|  * @param[in,out]  input_buf   Pointer to input buffer | ||||
|  * @param[in]       blockSize  block Size | ||||
|  * @param[in]       guard_bits guard bits | ||||
|  * @return none | ||||
|  * The function Provides the guard bits for the buffer | ||||
|  * to avoid overflow | ||||
|  */ | ||||
|  | ||||
| void arm_provide_guard_bits_q7 (q7_t * input_buf, | ||||
| 								uint32_t blockSize, | ||||
|                                 uint32_t guard_bits) | ||||
| { | ||||
|   uint32_t i; | ||||
|  | ||||
|   for (i = 0; i < blockSize; i++) | ||||
|     { | ||||
|       input_buf[i] = input_buf[i] >> guard_bits; | ||||
|     } | ||||
| } | ||||
|  | ||||
|  | ||||
|  | ||||
| /** | ||||
|  * @brief  Caluclates number of guard bits | ||||
|  * @param[in]  num_adds 	number of additions | ||||
|  * @return guard bits | ||||
|  * The function Caluclates the number of guard bits | ||||
|  * depending on the numtaps | ||||
|  */ | ||||
|  | ||||
| uint32_t arm_calc_guard_bits (uint32_t num_adds) | ||||
| { | ||||
|   uint32_t i = 1, j = 0; | ||||
|  | ||||
|   if (num_adds == 1) | ||||
|     { | ||||
|       return (0); | ||||
|     } | ||||
|  | ||||
|   while (i < num_adds) | ||||
|     { | ||||
|       i = i * 2; | ||||
|       j++; | ||||
|     } | ||||
|  | ||||
|   return (j); | ||||
| } | ||||
|  | ||||
| /** | ||||
|  * @brief  Apply guard bits to buffer | ||||
|  * @param[in,out]  pIn         pointer to input buffer | ||||
|  * @param[in]      numSamples  number of samples in the input buffer | ||||
|  * @param[in]      guard_bits  guard bits | ||||
|  * @return none | ||||
|  */ | ||||
|  | ||||
| void arm_apply_guard_bits (float32_t *pIn, | ||||
| 						   uint32_t numSamples, | ||||
| 						   uint32_t guard_bits) | ||||
| { | ||||
|   uint32_t i; | ||||
|  | ||||
|   for (i = 0; i < numSamples; i++) | ||||
|     { | ||||
|       pIn[i] = pIn[i] * arm_calc_2pow(guard_bits); | ||||
|     } | ||||
| } | ||||
|  | ||||
| /** | ||||
|  * @brief  Calculates pow(2, numShifts) | ||||
|  * @param[in]  numShifts 	number of shifts | ||||
|  * @return pow(2, numShifts) | ||||
|  */ | ||||
| uint32_t arm_calc_2pow(uint32_t numShifts) | ||||
| { | ||||
|  | ||||
|   uint32_t i, val = 1; | ||||
|  | ||||
|   for (i = 0; i < numShifts; i++) | ||||
|     { | ||||
|       val = val * 2; | ||||
|     } | ||||
|  | ||||
|   return(val); | ||||
| } | ||||
|  | ||||
|  | ||||
|  | ||||
| /** | ||||
|  * @brief  Converts float to fixed q14 | ||||
|  * @param[in]  pIn         pointer to input buffer | ||||
|  * @param[out] pOut        pointer to output buffer | ||||
|  * @param[in]  numSamples  number of samples in the buffer | ||||
|  * @return none | ||||
|  * The function converts floating point values to fixed point values | ||||
|  */ | ||||
|  | ||||
| void arm_float_to_q14 (float *pIn, q15_t *pOut, uint32_t numSamples) | ||||
| { | ||||
|   uint32_t i; | ||||
|  | ||||
|   for (i = 0; i < numSamples; i++) | ||||
|     { | ||||
| 	  /* 16384.0f corresponds to pow(2, 14) */ | ||||
|       pOut[i] = (q15_t) (pIn[i] * 16384.0f); | ||||
|  | ||||
|       pOut[i] += pIn[i] > 0 ? 0.5 : -0.5; | ||||
|  | ||||
|       if (pIn[i] == (float) 2.0) | ||||
|         { | ||||
|           pOut[i] = 0x7FFF; | ||||
|         } | ||||
|  | ||||
|     } | ||||
|  | ||||
| } | ||||
|  | ||||
|  | ||||
| /** | ||||
|  * @brief  Converts float to fixed q30 format | ||||
|  * @param[in]  pIn         pointer to input buffer | ||||
|  * @param[out] pOut        pointer to output buffer | ||||
|  * @param[in]  numSamples  number of samples in the buffer | ||||
|  * @return none | ||||
|  * The function converts floating point values to fixed point values | ||||
|  */ | ||||
|  | ||||
| void arm_float_to_q30 (float *pIn, q31_t * pOut, uint32_t numSamples) | ||||
| { | ||||
|   uint32_t i; | ||||
|  | ||||
|   for (i = 0; i < numSamples; i++) | ||||
|     { | ||||
| 	  /* 1073741824.0f corresponds to pow(2, 30) */ | ||||
|       pOut[i] = (q31_t) (pIn[i] * 1073741824.0f); | ||||
|  | ||||
|       pOut[i] += pIn[i] > 0 ? 0.5 : -0.5; | ||||
|  | ||||
|       if (pIn[i] == (float) 2.0) | ||||
|         { | ||||
|           pOut[i] = 0x7FFFFFFF; | ||||
|         } | ||||
|     } | ||||
| } | ||||
|  | ||||
| /** | ||||
|  * @brief  Converts float to fixed q30 format | ||||
|  * @param[in]  pIn         pointer to input buffer | ||||
|  * @param[out] pOut        pointer to output buffer | ||||
|  * @param[in]  numSamples  number of samples in the buffer | ||||
|  * @return none | ||||
|  * The function converts floating point values to fixed point values | ||||
|  */ | ||||
|  | ||||
| void arm_float_to_q29 (float *pIn, q31_t *pOut, uint32_t numSamples) | ||||
| { | ||||
|   uint32_t i; | ||||
|  | ||||
|   for (i = 0; i < numSamples; i++) | ||||
|     { | ||||
| 	  /* 1073741824.0f corresponds to pow(2, 30) */ | ||||
|       pOut[i] = (q31_t) (pIn[i] * 536870912.0f); | ||||
|  | ||||
|       pOut[i] += pIn[i] > 0 ? 0.5 : -0.5; | ||||
|  | ||||
|       if (pIn[i] == (float) 4.0) | ||||
|         { | ||||
|           pOut[i] = 0x7FFFFFFF; | ||||
|         } | ||||
|     } | ||||
| } | ||||
|  | ||||
|  | ||||
| /** | ||||
|  * @brief  Converts float to fixed q28 format | ||||
|  * @param[in]  pIn         pointer to input buffer | ||||
|  * @param[out] pOut        pointer to output buffer | ||||
|  * @param[in]  numSamples  number of samples in the buffer | ||||
|  * @return none | ||||
|  * The function converts floating point values to fixed point values | ||||
|  */ | ||||
|  | ||||
| void arm_float_to_q28 (float *pIn, q31_t *pOut, uint32_t numSamples) | ||||
| { | ||||
|   uint32_t i; | ||||
|  | ||||
|   for (i = 0; i < numSamples; i++) | ||||
|     { | ||||
| 	/* 268435456.0f corresponds to pow(2, 28) */ | ||||
|       pOut[i] = (q31_t) (pIn[i] * 268435456.0f); | ||||
|  | ||||
|       pOut[i] += pIn[i] > 0 ? 0.5 : -0.5; | ||||
|  | ||||
|       if (pIn[i] == (float) 8.0) | ||||
|         { | ||||
|           pOut[i] = 0x7FFFFFFF; | ||||
|         } | ||||
|     } | ||||
| } | ||||
|  | ||||
| /** | ||||
|  * @brief  Clip the float values to +/- 1 | ||||
|  * @param[in,out]  pIn           input buffer | ||||
|  * @param[in]      numSamples    number of samples in the buffer | ||||
|  * @return none | ||||
|  * The function converts floating point values to fixed point values | ||||
|  */ | ||||
|  | ||||
| void arm_clip_f32 (float *pIn, uint32_t numSamples) | ||||
| { | ||||
|   uint32_t i; | ||||
|  | ||||
|   for (i = 0; i < numSamples; i++) | ||||
|     { | ||||
|       if (pIn[i] > 1.0f) | ||||
| 	  { | ||||
| 	    pIn[i] = 1.0; | ||||
| 	  } | ||||
| 	  else if ( pIn[i] < -1.0f) | ||||
| 	  { | ||||
| 	    pIn[i] = -1.0; | ||||
| 	  } | ||||
|  | ||||
|     } | ||||
| } | ||||
|  | ||||
|  | ||||
|  | ||||
|  | ||||
| @@ -0,0 +1,63 @@ | ||||
| /* ----------------------------------------------------------------------    | ||||
| * Copyright (C) 2010-2013 ARM Limited. All rights reserved.    | ||||
| *    | ||||
| * $Date:        17. January 2013   | ||||
| * $Revision: 	V1.4.0    | ||||
| *   | ||||
| * Project: 	    CMSIS DSP Library  | ||||
| * | ||||
| * Title:	    math_helper.h | ||||
| *  | ||||
| * Description:	Prototypes of all helper functions required.   | ||||
| * | ||||
| * Target Processor: Cortex-M4/Cortex-M3 | ||||
| *   | ||||
| * Redistribution and use in source and binary forms, with or without  | ||||
| * modification, are permitted provided that the following conditions | ||||
| * are met: | ||||
| *   - Redistributions of source code must retain the above copyright | ||||
| *     notice, this list of conditions and the following disclaimer. | ||||
| *   - 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. | ||||
| *   - Neither the name of ARM LIMITED nor the names of its contributors | ||||
| *     may be used to endorse or promote products derived from this | ||||
| *     software without specific prior written permission. | ||||
| * | ||||
| * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS | ||||
| * "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  | ||||
| * COPYRIGHT OWNER OR CONTRIBUTORS 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.   | ||||
| * -------------------------------------------------------------------- */ | ||||
|  | ||||
|  | ||||
| #include "arm_math.h" | ||||
|  | ||||
| #ifndef MATH_HELPER_H | ||||
| #define MATH_HELPER_H | ||||
|  | ||||
| float arm_snr_f32(float *pRef, float *pTest,  uint32_t buffSize);   | ||||
| void arm_float_to_q12_20(float *pIn, q31_t * pOut, uint32_t numSamples); | ||||
| void arm_provide_guard_bits_q15(q15_t *input_buf, uint32_t blockSize, uint32_t guard_bits); | ||||
| void arm_provide_guard_bits_q31(q31_t *input_buf, uint32_t blockSize, uint32_t guard_bits); | ||||
| void arm_float_to_q14(float *pIn, q15_t *pOut, uint32_t numSamples); | ||||
| void arm_float_to_q29(float *pIn, q31_t *pOut, uint32_t numSamples); | ||||
| void arm_float_to_q28(float *pIn, q31_t *pOut, uint32_t numSamples); | ||||
| void arm_float_to_q30(float *pIn, q31_t *pOut, uint32_t numSamples); | ||||
| void arm_clip_f32(float *pIn, uint32_t numSamples); | ||||
| uint32_t arm_calc_guard_bits(uint32_t num_adds); | ||||
| void arm_apply_guard_bits (float32_t * pIn, uint32_t numSamples, uint32_t guard_bits); | ||||
| uint32_t arm_compare_fixed_q15(q15_t *pIn, q15_t * pOut, uint32_t numSamples); | ||||
| uint32_t arm_compare_fixed_q31(q31_t *pIn, q31_t *pOut, uint32_t numSamples); | ||||
| uint32_t arm_calc_2pow(uint32_t guard_bits); | ||||
| #endif | ||||
|  | ||||
		Reference in New Issue
	
	Block a user