init
This commit is contained in:
		@@ -0,0 +1,4 @@
 | 
			
		||||
CMSIS DSP_Lib example arm_fir_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,134 @@
 | 
			
		||||
/* ----------------------------------------------------------------------   
 | 
			
		||||
* Copyright (C) 2010-2012 ARM Limited. All rights reserved.   
 | 
			
		||||
*   
 | 
			
		||||
* $Date:        17. January 2013  
 | 
			
		||||
* $Revision: 	V1.4.0   
 | 
			
		||||
*   
 | 
			
		||||
* Project: 	    CMSIS DSP Library   
 | 
			
		||||
* Title:	     	arm_fir_data.c
 | 
			
		||||
*   
 | 
			
		||||
* Description:	 Data file used for example code
 | 
			
		||||
*   
 | 
			
		||||
* Target Processor: Cortex-M4/Cortex-M3/Cortex-M0
 | 
			
		||||
*  
 | 
			
		||||
* 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"
 | 
			
		||||
 | 
			
		||||
/* ----------------------------------------------------------------------
 | 
			
		||||
** Test input signal contains 1000Hz + 15000 Hz
 | 
			
		||||
** ------------------------------------------------------------------- */
 | 
			
		||||
 | 
			
		||||
float32_t testInput_f32_1kHz_15kHz[320] =
 | 
			
		||||
{
 | 
			
		||||
+0.0000000000f, +0.5924659585f, -0.0947343455f, +0.1913417162f, +1.0000000000f, +0.4174197128f, +0.3535533906f, +1.2552931065f, 
 | 
			
		||||
+0.8660254038f, +0.4619397663f, +1.3194792169f, +1.1827865776f, +0.5000000000f, +1.1827865776f, +1.3194792169f, +0.4619397663f, 
 | 
			
		||||
+0.8660254038f, +1.2552931065f, +0.3535533906f, +0.4174197128f, +1.0000000000f, +0.1913417162f, -0.0947343455f, +0.5924659585f, 
 | 
			
		||||
-0.0000000000f, -0.5924659585f, +0.0947343455f, -0.1913417162f, -1.0000000000f, -0.4174197128f, -0.3535533906f, -1.2552931065f, 
 | 
			
		||||
-0.8660254038f, -0.4619397663f, -1.3194792169f, -1.1827865776f, -0.5000000000f, -1.1827865776f, -1.3194792169f, -0.4619397663f, 
 | 
			
		||||
-0.8660254038f, -1.2552931065f, -0.3535533906f, -0.4174197128f, -1.0000000000f, -0.1913417162f, +0.0947343455f, -0.5924659585f, 
 | 
			
		||||
+0.0000000000f, +0.5924659585f, -0.0947343455f, +0.1913417162f, +1.0000000000f, +0.4174197128f, +0.3535533906f, +1.2552931065f, 
 | 
			
		||||
+0.8660254038f, +0.4619397663f, +1.3194792169f, +1.1827865776f, +0.5000000000f, +1.1827865776f, +1.3194792169f, +0.4619397663f, 
 | 
			
		||||
+0.8660254038f, +1.2552931065f, +0.3535533906f, +0.4174197128f, +1.0000000000f, +0.1913417162f, -0.0947343455f, +0.5924659585f, 
 | 
			
		||||
+0.0000000000f, -0.5924659585f, +0.0947343455f, -0.1913417162f, -1.0000000000f, -0.4174197128f, -0.3535533906f, -1.2552931065f, 
 | 
			
		||||
-0.8660254038f, -0.4619397663f, -1.3194792169f, -1.1827865776f, -0.5000000000f, -1.1827865776f, -1.3194792169f, -0.4619397663f, 
 | 
			
		||||
-0.8660254038f, -1.2552931065f, -0.3535533906f, -0.4174197128f, -1.0000000000f, -0.1913417162f, +0.0947343455f, -0.5924659585f, 
 | 
			
		||||
+0.0000000000f, +0.5924659585f, -0.0947343455f, +0.1913417162f, +1.0000000000f, +0.4174197128f, +0.3535533906f, +1.2552931065f, 
 | 
			
		||||
+0.8660254038f, +0.4619397663f, +1.3194792169f, +1.1827865776f, +0.5000000000f, +1.1827865776f, +1.3194792169f, +0.4619397663f, 
 | 
			
		||||
+0.8660254038f, +1.2552931065f, +0.3535533906f, +0.4174197128f, +1.0000000000f, +0.1913417162f, -0.0947343455f, +0.5924659585f, 
 | 
			
		||||
+0.0000000000f, -0.5924659585f, +0.0947343455f, -0.1913417162f, -1.0000000000f, -0.4174197128f, -0.3535533906f, -1.2552931065f, 
 | 
			
		||||
-0.8660254038f, -0.4619397663f, -1.3194792169f, -1.1827865776f, -0.5000000000f, -1.1827865776f, -1.3194792169f, -0.4619397663f, 
 | 
			
		||||
-0.8660254038f, -1.2552931065f, -0.3535533906f, -0.4174197128f, -1.0000000000f, -0.1913417162f, +0.0947343455f, -0.5924659585f, 
 | 
			
		||||
-0.0000000000f, +0.5924659585f, -0.0947343455f, +0.1913417162f, +1.0000000000f, +0.4174197128f, +0.3535533906f, +1.2552931065f, 
 | 
			
		||||
+0.8660254038f, +0.4619397663f, +1.3194792169f, +1.1827865776f, +0.5000000000f, +1.1827865776f, +1.3194792169f, +0.4619397663f, 
 | 
			
		||||
+0.8660254038f, +1.2552931065f, +0.3535533906f, +0.4174197128f, +1.0000000000f, +0.1913417162f, -0.0947343455f, +0.5924659585f, 
 | 
			
		||||
-0.0000000000f, -0.5924659585f, +0.0947343455f, -0.1913417162f, -1.0000000000f, -0.4174197128f, -0.3535533906f, -1.2552931065f, 
 | 
			
		||||
-0.8660254038f, -0.4619397663f, -1.3194792169f, -1.1827865776f, -0.5000000000f, -1.1827865776f, -1.3194792169f, -0.4619397663f, 
 | 
			
		||||
-0.8660254038f, -1.2552931065f, -0.3535533906f, -0.4174197128f, -1.0000000000f, -0.1913417162f, +0.0947343455f, -0.5924659585f, 
 | 
			
		||||
+0.0000000000f, +0.5924659585f, -0.0947343455f, +0.1913417162f, +1.0000000000f, +0.4174197128f, +0.3535533906f, +1.2552931065f, 
 | 
			
		||||
+0.8660254038f, +0.4619397663f, +1.3194792169f, +1.1827865776f, +0.5000000000f, +1.1827865776f, +1.3194792169f, +0.4619397663f, 
 | 
			
		||||
+0.8660254038f, +1.2552931065f, +0.3535533906f, +0.4174197128f, +1.0000000000f, +0.1913417162f, -0.0947343455f, +0.5924659585f, 
 | 
			
		||||
+0.0000000000f, -0.5924659585f, +0.0947343455f, -0.1913417162f, -1.0000000000f, -0.4174197128f, -0.3535533906f, -1.2552931065f, 
 | 
			
		||||
-0.8660254038f, -0.4619397663f, -1.3194792169f, -1.1827865776f, -0.5000000000f, -1.1827865776f, -1.3194792169f, -0.4619397663f, 
 | 
			
		||||
-0.8660254038f, -1.2552931065f, -0.3535533906f, -0.4174197128f, -1.0000000000f, -0.1913417162f, +0.0947343455f, -0.5924659585f, 
 | 
			
		||||
-0.0000000000f, +0.5924659585f, -0.0947343455f, +0.1913417162f, +1.0000000000f, +0.4174197128f, +0.3535533906f, +1.2552931065f, 
 | 
			
		||||
+0.8660254038f, +0.4619397663f, +1.3194792169f, +1.1827865776f, +0.5000000000f, +1.1827865776f, +1.3194792169f, +0.4619397663f, 
 | 
			
		||||
+0.8660254038f, +1.2552931065f, +0.3535533906f, +0.4174197128f, +1.0000000000f, +0.1913417162f, -0.0947343455f, +0.5924659585f, 
 | 
			
		||||
+0.0000000000f, -0.5924659585f, +0.0947343455f, -0.1913417162f, -1.0000000000f, -0.4174197128f, -0.3535533906f, -1.2552931065f, 
 | 
			
		||||
-0.8660254038f, -0.4619397663f, -1.3194792169f, -1.1827865776f, -0.5000000000f, -1.1827865776f, -1.3194792169f, -0.4619397663f, 
 | 
			
		||||
-0.8660254038f, -1.2552931065f, -0.3535533906f, -0.4174197128f, -1.0000000000f, -0.1913417162f, +0.0947343455f, -0.5924659585f, 
 | 
			
		||||
-0.0000000000f, +0.5924659585f, -0.0947343455f, +0.1913417162f, +1.0000000000f, +0.4174197128f, +0.3535533906f, +1.2552931065f, 
 | 
			
		||||
+0.8660254038f, +0.4619397663f, +1.3194792169f, +1.1827865776f, +0.5000000000f, +1.1827865776f, +1.3194792169f, +0.4619397663f, 
 | 
			
		||||
+0.8660254038f, +1.2552931065f, +0.3535533906f, +0.4174197128f, +1.0000000000f, +0.1913417162f, -0.0947343455f, +0.5924659585f, 
 | 
			
		||||
+0.0000000000f, -0.5924659585f, +0.0947343455f, -0.1913417162f, -1.0000000000f, -0.4174197128f, -0.3535533906f, -1.2552931065f, 
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
float32_t refOutput[320] = 
 | 
			
		||||
{
 | 
			
		||||
+0.0000000000f, -0.0010797829f, -0.0007681386f, -0.0001982932f, +0.0000644313f, +0.0020854271f, +0.0036891871f, +0.0015855941f, 
 | 
			
		||||
-0.0026280805f, -0.0075907658f, -0.0119390538f, -0.0086665968f, +0.0088981202f, +0.0430539279f, +0.0974468742f, +0.1740405600f, 
 | 
			
		||||
+0.2681416601f, +0.3747720089f, +0.4893362230f, +0.6024154672f, +0.7058740791f, +0.7968348987f, +0.8715901940f, +0.9277881093f, 
 | 
			
		||||
+0.9682182661f, +0.9934674267f, +1.0012052245f, +0.9925859371f, +0.9681538347f, +0.9257026822f, +0.8679010068f, +0.7952493046f, 
 | 
			
		||||
+0.7085021596f, +0.6100062330f, +0.5012752767f, +0.3834386057f, +0.2592435399f, +0.1309866321f, -0.0000000000f, -0.1309866321f, 
 | 
			
		||||
-0.2592435399f, -0.3834386057f, -0.5012752767f, -0.6100062330f, -0.7085021596f, -0.7952493046f, -0.8679010068f, -0.9257026822f, 
 | 
			
		||||
-0.9681538347f, -0.9936657199f, -1.0019733630f, -0.9936657199f, -0.9681538347f, -0.9257026822f, -0.8679010068f, -0.7952493046f, 
 | 
			
		||||
-0.7085021596f, -0.6100062330f, -0.5012752767f, -0.3834386057f, -0.2592435399f, -0.1309866321f, +0.0000000000f, +0.1309866321f, 
 | 
			
		||||
+0.2592435399f, +0.3834386057f, +0.5012752767f, +0.6100062330f, +0.7085021596f, +0.7952493046f, +0.8679010068f, +0.9257026822f, 
 | 
			
		||||
+0.9681538347f, +0.9936657199f, +1.0019733630f, +0.9936657199f, +0.9681538347f, +0.9257026822f, +0.8679010068f, +0.7952493046f, 
 | 
			
		||||
+0.7085021596f, +0.6100062330f, +0.5012752767f, +0.3834386057f, +0.2592435399f, +0.1309866321f, -0.0000000000f, -0.1309866321f, 
 | 
			
		||||
-0.2592435399f, -0.3834386057f, -0.5012752767f, -0.6100062330f, -0.7085021596f, -0.7952493046f, -0.8679010068f, -0.9257026822f, 
 | 
			
		||||
-0.9681538347f, -0.9936657199f, -1.0019733630f, -0.9936657199f, -0.9681538347f, -0.9257026822f, -0.8679010068f, -0.7952493046f, 
 | 
			
		||||
-0.7085021596f, -0.6100062330f, -0.5012752767f, -0.3834386057f, -0.2592435399f, -0.1309866321f, +0.0000000000f, +0.1309866321f, 
 | 
			
		||||
+0.2592435399f, +0.3834386057f, +0.5012752767f, +0.6100062330f, +0.7085021596f, +0.7952493046f, +0.8679010068f, +0.9257026822f, 
 | 
			
		||||
+0.9681538347f, +0.9936657199f, +1.0019733630f, +0.9936657199f, +0.9681538347f, +0.9257026822f, +0.8679010068f, +0.7952493046f, 
 | 
			
		||||
+0.7085021596f, +0.6100062330f, +0.5012752767f, +0.3834386057f, +0.2592435399f, +0.1309866321f, -0.0000000000f, -0.1309866321f, 
 | 
			
		||||
-0.2592435399f, -0.3834386057f, -0.5012752767f, -0.6100062330f, -0.7085021596f, -0.7952493046f, -0.8679010068f, -0.9257026822f, 
 | 
			
		||||
-0.9681538347f, -0.9936657199f, -1.0019733630f, -0.9936657199f, -0.9681538347f, -0.9257026822f, -0.8679010068f, -0.7952493046f, 
 | 
			
		||||
-0.7085021596f, -0.6100062330f, -0.5012752767f, -0.3834386057f, -0.2592435399f, -0.1309866321f, +0.0000000000f, +0.1309866321f, 
 | 
			
		||||
+0.2592435399f, +0.3834386057f, +0.5012752767f, +0.6100062330f, +0.7085021596f, +0.7952493046f, +0.8679010068f, +0.9257026822f, 
 | 
			
		||||
+0.9681538347f, +0.9936657199f, +1.0019733630f, +0.9936657199f, +0.9681538347f, +0.9257026822f, +0.8679010068f, +0.7952493046f, 
 | 
			
		||||
+0.7085021596f, +0.6100062330f, +0.5012752767f, +0.3834386057f, +0.2592435399f, +0.1309866321f, +0.0000000000f, -0.1309866321f, 
 | 
			
		||||
-0.2592435399f, -0.3834386057f, -0.5012752767f, -0.6100062330f, -0.7085021596f, -0.7952493046f, -0.8679010068f, -0.9257026822f, 
 | 
			
		||||
-0.9681538347f, -0.9936657199f, -1.0019733630f, -0.9936657199f, -0.9681538347f, -0.9257026822f, -0.8679010068f, -0.7952493046f, 
 | 
			
		||||
-0.7085021596f, -0.6100062330f, -0.5012752767f, -0.3834386057f, -0.2592435399f, -0.1309866321f, +0.0000000000f, +0.1309866321f, 
 | 
			
		||||
+0.2592435399f, +0.3834386057f, +0.5012752767f, +0.6100062330f, +0.7085021596f, +0.7952493046f, +0.8679010068f, +0.9257026822f, 
 | 
			
		||||
+0.9681538347f, +0.9936657199f, +1.0019733630f, +0.9936657199f, +0.9681538347f, +0.9257026822f, +0.8679010068f, +0.7952493046f, 
 | 
			
		||||
+0.7085021596f, +0.6100062330f, +0.5012752767f, +0.3834386057f, +0.2592435399f, +0.1309866321f, +0.0000000000f, -0.1309866321f, 
 | 
			
		||||
-0.2592435399f, -0.3834386057f, -0.5012752767f, -0.6100062330f, -0.7085021596f, -0.7952493046f, -0.8679010068f, -0.9257026822f, 
 | 
			
		||||
-0.9681538347f, -0.9936657199f, -1.0019733630f, -0.9936657199f, -0.9681538347f, -0.9257026822f, -0.8679010068f, -0.7952493046f, 
 | 
			
		||||
-0.7085021596f, -0.6100062330f, -0.5012752767f, -0.3834386057f, -0.2592435399f, -0.1309866321f, -0.0000000000f, +0.1309866321f, 
 | 
			
		||||
+0.2592435399f, +0.3834386057f, +0.5012752767f, +0.6100062330f, +0.7085021596f, +0.7952493046f, +0.8679010068f, +0.9257026822f, 
 | 
			
		||||
+0.9681538347f, +0.9936657199f, +1.0019733630f, +0.9936657199f, +0.9681538347f, +0.9257026822f, +0.8679010068f, +0.7952493046f, 
 | 
			
		||||
+0.7085021596f, +0.6100062330f, +0.5012752767f, +0.3834386057f, +0.2592435399f, +0.1309866321f, +0.0000000000f, -0.1309866321f, 
 | 
			
		||||
-0.2592435399f, -0.3834386057f, -0.5012752767f, -0.6100062330f, -0.7085021596f, -0.7952493046f, -0.8679010068f, -0.9257026822f, 
 | 
			
		||||
-0.9681538347f, -0.9936657199f, -1.0019733630f, -0.9936657199f, -0.9681538347f, -0.9257026822f, -0.8679010068f, -0.7952493046f, 
 | 
			
		||||
-0.7085021596f, -0.6100062330f, -0.5012752767f, -0.3834386057f, -0.2592435399f, -0.1309866321f, +0.0000000000f, +0.1309866321f, 
 | 
			
		||||
+0.2592435399f, +0.3834386057f, +0.5012752767f, +0.6100062330f, +0.7085021596f, +0.7952493046f, +0.8679010068f, +0.9257026822f, 
 | 
			
		||||
+0.9681538347f, +0.9936657199f, +1.0019733630f, +0.9936657199f, +0.9681538347f, +0.9257026822f, +0.8679010068f, +0.7952493046f 
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
@@ -0,0 +1,233 @@
 | 
			
		||||
/* ----------------------------------------------------------------------
 | 
			
		||||
 * Copyright (C) 2010-2012 ARM Limited. All rights reserved.
 | 
			
		||||
 *
 | 
			
		||||
* $Date:         17. January 2013
 | 
			
		||||
* $Revision:     V1.4.0
 | 
			
		||||
*
 | 
			
		||||
* Project:       CMSIS DSP Library
 | 
			
		||||
 * Title:        arm_fir_example_f32.c
 | 
			
		||||
 *
 | 
			
		||||
 * Description:  Example code demonstrating how an FIR filter can be used
 | 
			
		||||
 *               as a low pass filter.
 | 
			
		||||
 *
 | 
			
		||||
 * 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 FIRLPF FIR Lowpass Filter Example
 | 
			
		||||
 *
 | 
			
		||||
 * \par Description:
 | 
			
		||||
 * \par
 | 
			
		||||
 * Removes high frequency signal components from the input using an FIR lowpass filter.
 | 
			
		||||
 * The example demonstrates how to configure an FIR filter and then pass data through
 | 
			
		||||
 * it in a block-by-block fashion.
 | 
			
		||||
 * \image html FIRLPF_signalflow.gif
 | 
			
		||||
 *
 | 
			
		||||
 * \par Algorithm:
 | 
			
		||||
 * \par
 | 
			
		||||
 * The input signal is a sum of two sine waves:  1 kHz and 15 kHz.
 | 
			
		||||
 * This is processed by an FIR lowpass filter with cutoff frequency 6 kHz.
 | 
			
		||||
 * The lowpass filter eliminates the 15 kHz signal leaving only the 1 kHz sine wave at the output.
 | 
			
		||||
 * \par
 | 
			
		||||
 * The lowpass filter was designed using MATLAB with a sample rate of 48 kHz and
 | 
			
		||||
 * a length of 29 points.
 | 
			
		||||
 * The MATLAB code to generate the filter coefficients is shown below:
 | 
			
		||||
 * <pre>
 | 
			
		||||
 *     h = fir1(28, 6/24);
 | 
			
		||||
 * </pre>
 | 
			
		||||
 * The first argument is the "order" of the filter and is always one less than the desired length.
 | 
			
		||||
 * The second argument is the normalized cutoff frequency.  This is in the range 0 (DC) to 1.0 (Nyquist).
 | 
			
		||||
 * A 6 kHz cutoff with a Nyquist frequency of 24 kHz lies at a normalized frequency of 6/24 = 0.25.
 | 
			
		||||
 * The CMSIS FIR filter function requires the coefficients to be in time reversed order.
 | 
			
		||||
 * <pre>
 | 
			
		||||
 *     fliplr(h)
 | 
			
		||||
 * </pre>
 | 
			
		||||
 * The resulting filter coefficients and are shown below.
 | 
			
		||||
 * Note that the filter is symmetric (a property of linear phase FIR filters)
 | 
			
		||||
 * and the point of symmetry is sample 14.  Thus the filter will have a delay of
 | 
			
		||||
 * 14 samples for all frequencies.
 | 
			
		||||
 * \par
 | 
			
		||||
 * \image html FIRLPF_coeffs.gif
 | 
			
		||||
 * \par
 | 
			
		||||
 * The frequency response of the filter is shown next.
 | 
			
		||||
 * The passband gain of the filter is 1.0 and it reaches 0.5 at the cutoff frequency 6 kHz.
 | 
			
		||||
 * \par
 | 
			
		||||
 * \image html FIRLPF_response.gif
 | 
			
		||||
 * \par
 | 
			
		||||
 * The input signal is shown below.
 | 
			
		||||
 * The left hand side shows the signal in the time domain while the right hand side is a frequency domain representation.
 | 
			
		||||
 * The two sine wave components can be clearly seen.
 | 
			
		||||
 * \par
 | 
			
		||||
 * \image html FIRLPF_input.gif
 | 
			
		||||
 * \par
 | 
			
		||||
 * The output of the filter is shown below.  The 15 kHz component has been eliminated.
 | 
			
		||||
 * \par
 | 
			
		||||
 * \image html FIRLPF_output.gif
 | 
			
		||||
 *
 | 
			
		||||
 * \par Variables Description:
 | 
			
		||||
 * \par
 | 
			
		||||
 * \li \c testInput_f32_1kHz_15kHz points to the input data
 | 
			
		||||
 * \li \c refOutput points to the reference output data
 | 
			
		||||
 * \li \c testOutput points to the test output data
 | 
			
		||||
 * \li \c firStateF32 points to state buffer
 | 
			
		||||
 * \li \c firCoeffs32 points to coefficient buffer
 | 
			
		||||
 * \li \c blockSize number of samples processed at a time
 | 
			
		||||
 * \li \c numBlocks number of frames
 | 
			
		||||
 *
 | 
			
		||||
 * \par CMSIS DSP Software Library Functions Used:
 | 
			
		||||
 * \par
 | 
			
		||||
 * - arm_fir_init_f32()
 | 
			
		||||
 * - arm_fir_f32()
 | 
			
		||||
 *
 | 
			
		||||
 * <b> Refer  </b>
 | 
			
		||||
 * \link arm_fir_example_f32.c \endlink
 | 
			
		||||
 *
 | 
			
		||||
 */
 | 
			
		||||
 | 
			
		||||
 | 
			
		||||
/** \example arm_fir_example_f32.c
 | 
			
		||||
 */
 | 
			
		||||
 | 
			
		||||
/* ----------------------------------------------------------------------
 | 
			
		||||
** Include Files
 | 
			
		||||
** ------------------------------------------------------------------- */
 | 
			
		||||
 | 
			
		||||
#include "arm_math.h"
 | 
			
		||||
#include "math_helper.h"
 | 
			
		||||
 | 
			
		||||
/* ----------------------------------------------------------------------
 | 
			
		||||
** Macro Defines
 | 
			
		||||
** ------------------------------------------------------------------- */
 | 
			
		||||
 | 
			
		||||
#define TEST_LENGTH_SAMPLES  320
 | 
			
		||||
#define SNR_THRESHOLD_F32    140.0f
 | 
			
		||||
#define BLOCK_SIZE            32
 | 
			
		||||
#define NUM_TAPS              29
 | 
			
		||||
 | 
			
		||||
/* -------------------------------------------------------------------
 | 
			
		||||
 * The input signal and reference output (computed with MATLAB)
 | 
			
		||||
 * are defined externally in arm_fir_lpf_data.c.
 | 
			
		||||
 * ------------------------------------------------------------------- */
 | 
			
		||||
 | 
			
		||||
extern float32_t testInput_f32_1kHz_15kHz[TEST_LENGTH_SAMPLES];
 | 
			
		||||
extern float32_t refOutput[TEST_LENGTH_SAMPLES];
 | 
			
		||||
 | 
			
		||||
/* -------------------------------------------------------------------
 | 
			
		||||
 * Declare Test output buffer
 | 
			
		||||
 * ------------------------------------------------------------------- */
 | 
			
		||||
 | 
			
		||||
static float32_t testOutput[TEST_LENGTH_SAMPLES];
 | 
			
		||||
 | 
			
		||||
/* -------------------------------------------------------------------
 | 
			
		||||
 * Declare State buffer of size (numTaps + blockSize - 1)
 | 
			
		||||
 * ------------------------------------------------------------------- */
 | 
			
		||||
 | 
			
		||||
static float32_t firStateF32[BLOCK_SIZE + NUM_TAPS - 1];
 | 
			
		||||
 | 
			
		||||
/* ----------------------------------------------------------------------
 | 
			
		||||
** FIR Coefficients buffer generated using fir1() MATLAB function.
 | 
			
		||||
** fir1(28, 6/24)
 | 
			
		||||
** ------------------------------------------------------------------- */
 | 
			
		||||
 | 
			
		||||
const float32_t firCoeffs32[NUM_TAPS] = {
 | 
			
		||||
  -0.0018225230f, -0.0015879294f, +0.0000000000f, +0.0036977508f, +0.0080754303f, +0.0085302217f, -0.0000000000f, -0.0173976984f,
 | 
			
		||||
  -0.0341458607f, -0.0333591565f, +0.0000000000f, +0.0676308395f, +0.1522061835f, +0.2229246956f, +0.2504960933f, +0.2229246956f,
 | 
			
		||||
  +0.1522061835f, +0.0676308395f, +0.0000000000f, -0.0333591565f, -0.0341458607f, -0.0173976984f, -0.0000000000f, +0.0085302217f,
 | 
			
		||||
  +0.0080754303f, +0.0036977508f, +0.0000000000f, -0.0015879294f, -0.0018225230f
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
/* ------------------------------------------------------------------
 | 
			
		||||
 * Global variables for FIR LPF Example
 | 
			
		||||
 * ------------------------------------------------------------------- */
 | 
			
		||||
 | 
			
		||||
uint32_t blockSize = BLOCK_SIZE;
 | 
			
		||||
uint32_t numBlocks = TEST_LENGTH_SAMPLES/BLOCK_SIZE;
 | 
			
		||||
 | 
			
		||||
float32_t  snr;
 | 
			
		||||
 | 
			
		||||
/* ----------------------------------------------------------------------
 | 
			
		||||
 * FIR LPF Example
 | 
			
		||||
 * ------------------------------------------------------------------- */
 | 
			
		||||
 | 
			
		||||
int32_t main(void)
 | 
			
		||||
{
 | 
			
		||||
  uint32_t i;
 | 
			
		||||
  arm_fir_instance_f32 S;
 | 
			
		||||
  arm_status status;
 | 
			
		||||
  float32_t  *inputF32, *outputF32;
 | 
			
		||||
 | 
			
		||||
  /* Initialize input and output buffer pointers */
 | 
			
		||||
  inputF32 = &testInput_f32_1kHz_15kHz[0];
 | 
			
		||||
  outputF32 = &testOutput[0];
 | 
			
		||||
 | 
			
		||||
  /* Call FIR init function to initialize the instance structure. */
 | 
			
		||||
  arm_fir_init_f32(&S, NUM_TAPS, (float32_t *)&firCoeffs32[0], &firStateF32[0], blockSize);
 | 
			
		||||
 | 
			
		||||
  /* ----------------------------------------------------------------------
 | 
			
		||||
  ** Call the FIR process function for every blockSize samples
 | 
			
		||||
  ** ------------------------------------------------------------------- */
 | 
			
		||||
 | 
			
		||||
  for(i=0; i < numBlocks; i++)
 | 
			
		||||
  {
 | 
			
		||||
    arm_fir_f32(&S, inputF32 + (i * blockSize), outputF32 + (i * blockSize), blockSize);
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  /* ----------------------------------------------------------------------
 | 
			
		||||
  ** Compare the generated output against the reference output computed
 | 
			
		||||
  ** in MATLAB.
 | 
			
		||||
  ** ------------------------------------------------------------------- */
 | 
			
		||||
 | 
			
		||||
  snr = arm_snr_f32(&refOutput[0], &testOutput[0], TEST_LENGTH_SAMPLES);
 | 
			
		||||
 | 
			
		||||
  if (snr < SNR_THRESHOLD_F32)
 | 
			
		||||
  {
 | 
			
		||||
    status = ARM_MATH_TEST_FAILURE;
 | 
			
		||||
  }
 | 
			
		||||
  else
 | 
			
		||||
  {
 | 
			
		||||
    status = ARM_MATH_SUCCESS;
 | 
			
		||||
  }
 | 
			
		||||
 | 
			
		||||
  /* ----------------------------------------------------------------------
 | 
			
		||||
  ** Loop here if the signal does not match the reference output.
 | 
			
		||||
  ** ------------------------------------------------------------------- */
 | 
			
		||||
 | 
			
		||||
  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