Initial commit
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. | ||||
							
								
								
									
										134
									
								
								Drivers/CMSIS/DSP/Examples/ARM/arm_fir_example/arm_fir_data.c
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										134
									
								
								Drivers/CMSIS/DSP/Examples/ARM/arm_fir_example/arm_fir_data.c
									
									
									
									
									
										Normal file
									
								
							| @@ -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 */ | ||||
							
								
								
									
										466
									
								
								Drivers/CMSIS/DSP/Examples/ARM/arm_fir_example/math_helper.c
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										466
									
								
								Drivers/CMSIS/DSP/Examples/ARM/arm_fir_example/math_helper.c
									
									
									
									
									
										Normal file
									
								
							| @@ -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; | ||||
| 	  } | ||||
|  | ||||
|     } | ||||
| } | ||||
|  | ||||
|  | ||||
|  | ||||
|  | ||||
							
								
								
									
										63
									
								
								Drivers/CMSIS/DSP/Examples/ARM/arm_fir_example/math_helper.h
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										63
									
								
								Drivers/CMSIS/DSP/Examples/ARM/arm_fir_example/math_helper.h
									
									
									
									
									
										Normal file
									
								
							| @@ -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