ads1115 only

Fork of mbed by mbed official

Committer:
kaoshen
Date:
Tue Jan 17 23:27:32 2017 +0000
Revision:
135:fce8a9387ed1
Parent:
128:9bcdf88f62b0
333 ADS1115 ADC1

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Kojto 123:b0220dba8be7 1 /* ----------------------------------------------------------------------
Kojto 123:b0220dba8be7 2 * Copyright (C) 2010-2015 ARM Limited. All rights reserved.
Kojto 123:b0220dba8be7 3 *
Kojto 123:b0220dba8be7 4 * $Date: 19. March 2015
Kojto 123:b0220dba8be7 5 * $Revision: V.1.4.5
Kojto 123:b0220dba8be7 6 *
Kojto 123:b0220dba8be7 7 * Project: CMSIS DSP Library
Kojto 123:b0220dba8be7 8 * Title: arm_math.h
Kojto 123:b0220dba8be7 9 *
Kojto 123:b0220dba8be7 10 * Description: Public header file for CMSIS DSP Library
Kojto 123:b0220dba8be7 11 *
Kojto 123:b0220dba8be7 12 * Target Processor: Cortex-M7/Cortex-M4/Cortex-M3/Cortex-M0
Kojto 123:b0220dba8be7 13 *
Kojto 123:b0220dba8be7 14 * Redistribution and use in source and binary forms, with or without
Kojto 123:b0220dba8be7 15 * modification, are permitted provided that the following conditions
Kojto 123:b0220dba8be7 16 * are met:
Kojto 123:b0220dba8be7 17 * - Redistributions of source code must retain the above copyright
Kojto 123:b0220dba8be7 18 * notice, this list of conditions and the following disclaimer.
Kojto 123:b0220dba8be7 19 * - Redistributions in binary form must reproduce the above copyright
Kojto 123:b0220dba8be7 20 * notice, this list of conditions and the following disclaimer in
Kojto 123:b0220dba8be7 21 * the documentation and/or other materials provided with the
Kojto 123:b0220dba8be7 22 * distribution.
Kojto 123:b0220dba8be7 23 * - Neither the name of ARM LIMITED nor the names of its contributors
Kojto 123:b0220dba8be7 24 * may be used to endorse or promote products derived from this
Kojto 123:b0220dba8be7 25 * software without specific prior written permission.
Kojto 123:b0220dba8be7 26 *
Kojto 123:b0220dba8be7 27 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
Kojto 123:b0220dba8be7 28 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
Kojto 123:b0220dba8be7 29 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
Kojto 123:b0220dba8be7 30 * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
Kojto 123:b0220dba8be7 31 * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
Kojto 123:b0220dba8be7 32 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
Kojto 123:b0220dba8be7 33 * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
Kojto 123:b0220dba8be7 34 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
Kojto 123:b0220dba8be7 35 * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
Kojto 123:b0220dba8be7 36 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
Kojto 123:b0220dba8be7 37 * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
Kojto 123:b0220dba8be7 38 * POSSIBILITY OF SUCH DAMAGE.
Kojto 123:b0220dba8be7 39 * -------------------------------------------------------------------- */
Kojto 123:b0220dba8be7 40
Kojto 123:b0220dba8be7 41 /**
Kojto 123:b0220dba8be7 42 \mainpage CMSIS DSP Software Library
Kojto 123:b0220dba8be7 43 *
Kojto 123:b0220dba8be7 44 * Introduction
Kojto 123:b0220dba8be7 45 * ------------
Kojto 123:b0220dba8be7 46 *
Kojto 123:b0220dba8be7 47 * This user manual describes the CMSIS DSP software library,
Kojto 123:b0220dba8be7 48 * a suite of common signal processing functions for use on Cortex-M processor based devices.
Kojto 123:b0220dba8be7 49 *
Kojto 123:b0220dba8be7 50 * The library is divided into a number of functions each covering a specific category:
Kojto 123:b0220dba8be7 51 * - Basic math functions
Kojto 123:b0220dba8be7 52 * - Fast math functions
Kojto 123:b0220dba8be7 53 * - Complex math functions
Kojto 123:b0220dba8be7 54 * - Filters
Kojto 123:b0220dba8be7 55 * - Matrix functions
Kojto 123:b0220dba8be7 56 * - Transforms
Kojto 123:b0220dba8be7 57 * - Motor control functions
Kojto 123:b0220dba8be7 58 * - Statistical functions
Kojto 123:b0220dba8be7 59 * - Support functions
Kojto 123:b0220dba8be7 60 * - Interpolation functions
Kojto 123:b0220dba8be7 61 *
Kojto 123:b0220dba8be7 62 * The library has separate functions for operating on 8-bit integers, 16-bit integers,
Kojto 123:b0220dba8be7 63 * 32-bit integer and 32-bit floating-point values.
Kojto 123:b0220dba8be7 64 *
Kojto 123:b0220dba8be7 65 * Using the Library
Kojto 123:b0220dba8be7 66 * ------------
Kojto 123:b0220dba8be7 67 *
Kojto 123:b0220dba8be7 68 * The library installer contains prebuilt versions of the libraries in the <code>Lib</code> folder.
Kojto 123:b0220dba8be7 69 * - arm_cortexM7lfdp_math.lib (Little endian and Double Precision Floating Point Unit on Cortex-M7)
Kojto 123:b0220dba8be7 70 * - arm_cortexM7bfdp_math.lib (Big endian and Double Precision Floating Point Unit on Cortex-M7)
Kojto 123:b0220dba8be7 71 * - arm_cortexM7lfsp_math.lib (Little endian and Single Precision Floating Point Unit on Cortex-M7)
Kojto 123:b0220dba8be7 72 * - arm_cortexM7bfsp_math.lib (Big endian and Single Precision Floating Point Unit on Cortex-M7)
Kojto 123:b0220dba8be7 73 * - arm_cortexM7l_math.lib (Little endian on Cortex-M7)
Kojto 123:b0220dba8be7 74 * - arm_cortexM7b_math.lib (Big endian on Cortex-M7)
Kojto 123:b0220dba8be7 75 * - arm_cortexM4lf_math.lib (Little endian and Floating Point Unit on Cortex-M4)
Kojto 123:b0220dba8be7 76 * - arm_cortexM4bf_math.lib (Big endian and Floating Point Unit on Cortex-M4)
Kojto 123:b0220dba8be7 77 * - arm_cortexM4l_math.lib (Little endian on Cortex-M4)
Kojto 123:b0220dba8be7 78 * - arm_cortexM4b_math.lib (Big endian on Cortex-M4)
Kojto 123:b0220dba8be7 79 * - arm_cortexM3l_math.lib (Little endian on Cortex-M3)
Kojto 123:b0220dba8be7 80 * - arm_cortexM3b_math.lib (Big endian on Cortex-M3)
Kojto 123:b0220dba8be7 81 * - arm_cortexM0l_math.lib (Little endian on Cortex-M0 / CortexM0+)
Kojto 123:b0220dba8be7 82 * - arm_cortexM0b_math.lib (Big endian on Cortex-M0 / CortexM0+)
Kojto 123:b0220dba8be7 83 *
Kojto 123:b0220dba8be7 84 * The library functions are declared in the public file <code>arm_math.h</code> which is placed in the <code>Include</code> folder.
Kojto 123:b0220dba8be7 85 * Simply include this file and link the appropriate library in the application and begin calling the library functions. The Library supports single
Kojto 123:b0220dba8be7 86 * public header file <code> arm_math.h</code> for Cortex-M7/M4/M3/M0/M0+ with little endian and big endian. Same header file will be used for floating point unit(FPU) variants.
Kojto 123:b0220dba8be7 87 * Define the appropriate pre processor MACRO ARM_MATH_CM7 or ARM_MATH_CM4 or ARM_MATH_CM3 or
Kojto 123:b0220dba8be7 88 * ARM_MATH_CM0 or ARM_MATH_CM0PLUS depending on the target processor in the application.
Kojto 123:b0220dba8be7 89 *
Kojto 123:b0220dba8be7 90 * Examples
Kojto 123:b0220dba8be7 91 * --------
Kojto 123:b0220dba8be7 92 *
Kojto 123:b0220dba8be7 93 * The library ships with a number of examples which demonstrate how to use the library functions.
Kojto 123:b0220dba8be7 94 *
Kojto 123:b0220dba8be7 95 * Toolchain Support
Kojto 123:b0220dba8be7 96 * ------------
Kojto 123:b0220dba8be7 97 *
Kojto 123:b0220dba8be7 98 * The library has been developed and tested with MDK-ARM version 5.14.0.0
Kojto 123:b0220dba8be7 99 * The library is being tested in GCC and IAR toolchains and updates on this activity will be made available shortly.
Kojto 123:b0220dba8be7 100 *
Kojto 123:b0220dba8be7 101 * Building the Library
Kojto 123:b0220dba8be7 102 * ------------
Kojto 123:b0220dba8be7 103 *
Kojto 123:b0220dba8be7 104 * The library installer contains a project file to re build libraries on MDK-ARM Tool chain in the <code>CMSIS\\DSP_Lib\\Source\\ARM</code> folder.
Kojto 123:b0220dba8be7 105 * - arm_cortexM_math.uvprojx
Kojto 123:b0220dba8be7 106 *
Kojto 123:b0220dba8be7 107 *
Kojto 123:b0220dba8be7 108 * The libraries can be built by opening the arm_cortexM_math.uvprojx project in MDK-ARM, selecting a specific target, and defining the optional pre processor MACROs detailed above.
Kojto 123:b0220dba8be7 109 *
Kojto 123:b0220dba8be7 110 * Pre-processor Macros
Kojto 123:b0220dba8be7 111 * ------------
Kojto 123:b0220dba8be7 112 *
Kojto 123:b0220dba8be7 113 * Each library project have differant pre-processor macros.
Kojto 123:b0220dba8be7 114 *
Kojto 123:b0220dba8be7 115 * - UNALIGNED_SUPPORT_DISABLE:
Kojto 123:b0220dba8be7 116 *
Kojto 123:b0220dba8be7 117 * Define macro UNALIGNED_SUPPORT_DISABLE, If the silicon does not support unaligned memory access
Kojto 123:b0220dba8be7 118 *
Kojto 123:b0220dba8be7 119 * - ARM_MATH_BIG_ENDIAN:
Kojto 123:b0220dba8be7 120 *
Kojto 123:b0220dba8be7 121 * Define macro ARM_MATH_BIG_ENDIAN to build the library for big endian targets. By default library builds for little endian targets.
Kojto 123:b0220dba8be7 122 *
Kojto 123:b0220dba8be7 123 * - ARM_MATH_MATRIX_CHECK:
Kojto 123:b0220dba8be7 124 *
Kojto 123:b0220dba8be7 125 * Define macro ARM_MATH_MATRIX_CHECK for checking on the input and output sizes of matrices
Kojto 123:b0220dba8be7 126 *
Kojto 123:b0220dba8be7 127 * - ARM_MATH_ROUNDING:
Kojto 123:b0220dba8be7 128 *
Kojto 123:b0220dba8be7 129 * Define macro ARM_MATH_ROUNDING for rounding on support functions
Kojto 123:b0220dba8be7 130 *
Kojto 123:b0220dba8be7 131 * - ARM_MATH_CMx:
Kojto 123:b0220dba8be7 132 *
Kojto 123:b0220dba8be7 133 * Define macro ARM_MATH_CM4 for building the library on Cortex-M4 target, ARM_MATH_CM3 for building library on Cortex-M3 target
Kojto 123:b0220dba8be7 134 * and ARM_MATH_CM0 for building library on Cortex-M0 target, ARM_MATH_CM0PLUS for building library on Cortex-M0+ target, and
Kojto 123:b0220dba8be7 135 * ARM_MATH_CM7 for building the library on cortex-M7.
Kojto 123:b0220dba8be7 136 *
Kojto 123:b0220dba8be7 137 * - __FPU_PRESENT:
Kojto 123:b0220dba8be7 138 *
Kojto 123:b0220dba8be7 139 * Initialize macro __FPU_PRESENT = 1 when building on FPU supported Targets. Enable this macro for M4bf and M4lf libraries
Kojto 123:b0220dba8be7 140 *
Kojto 123:b0220dba8be7 141 * <hr>
Kojto 123:b0220dba8be7 142 * CMSIS-DSP in ARM::CMSIS Pack
Kojto 123:b0220dba8be7 143 * -----------------------------
Kojto 123:b0220dba8be7 144 *
Kojto 123:b0220dba8be7 145 * The following files relevant to CMSIS-DSP are present in the <b>ARM::CMSIS</b> Pack directories:
Kojto 123:b0220dba8be7 146 * |File/Folder |Content |
Kojto 123:b0220dba8be7 147 * |------------------------------|------------------------------------------------------------------------|
Kojto 123:b0220dba8be7 148 * |\b CMSIS\\Documentation\\DSP | This documentation |
Kojto 123:b0220dba8be7 149 * |\b CMSIS\\DSP_Lib | Software license agreement (license.txt) |
Kojto 123:b0220dba8be7 150 * |\b CMSIS\\DSP_Lib\\Examples | Example projects demonstrating the usage of the library functions |
Kojto 123:b0220dba8be7 151 * |\b CMSIS\\DSP_Lib\\Source | Source files for rebuilding the library |
Kojto 123:b0220dba8be7 152 *
Kojto 123:b0220dba8be7 153 * <hr>
Kojto 123:b0220dba8be7 154 * Revision History of CMSIS-DSP
Kojto 123:b0220dba8be7 155 * ------------
Kojto 123:b0220dba8be7 156 * Please refer to \ref ChangeLog_pg.
Kojto 123:b0220dba8be7 157 *
Kojto 123:b0220dba8be7 158 * Copyright Notice
Kojto 123:b0220dba8be7 159 * ------------
Kojto 123:b0220dba8be7 160 *
Kojto 123:b0220dba8be7 161 * Copyright (C) 2010-2015 ARM Limited. All rights reserved.
Kojto 123:b0220dba8be7 162 */
Kojto 123:b0220dba8be7 163
Kojto 123:b0220dba8be7 164
Kojto 123:b0220dba8be7 165 /**
Kojto 123:b0220dba8be7 166 * @defgroup groupMath Basic Math Functions
Kojto 123:b0220dba8be7 167 */
Kojto 123:b0220dba8be7 168
Kojto 123:b0220dba8be7 169 /**
Kojto 123:b0220dba8be7 170 * @defgroup groupFastMath Fast Math Functions
Kojto 123:b0220dba8be7 171 * This set of functions provides a fast approximation to sine, cosine, and square root.
Kojto 123:b0220dba8be7 172 * As compared to most of the other functions in the CMSIS math library, the fast math functions
Kojto 123:b0220dba8be7 173 * operate on individual values and not arrays.
Kojto 123:b0220dba8be7 174 * There are separate functions for Q15, Q31, and floating-point data.
Kojto 123:b0220dba8be7 175 *
Kojto 123:b0220dba8be7 176 */
Kojto 123:b0220dba8be7 177
Kojto 123:b0220dba8be7 178 /**
Kojto 123:b0220dba8be7 179 * @defgroup groupCmplxMath Complex Math Functions
Kojto 123:b0220dba8be7 180 * This set of functions operates on complex data vectors.
Kojto 123:b0220dba8be7 181 * The data in the complex arrays is stored in an interleaved fashion
Kojto 123:b0220dba8be7 182 * (real, imag, real, imag, ...).
Kojto 123:b0220dba8be7 183 * In the API functions, the number of samples in a complex array refers
Kojto 123:b0220dba8be7 184 * to the number of complex values; the array contains twice this number of
Kojto 123:b0220dba8be7 185 * real values.
Kojto 123:b0220dba8be7 186 */
Kojto 123:b0220dba8be7 187
Kojto 123:b0220dba8be7 188 /**
Kojto 123:b0220dba8be7 189 * @defgroup groupFilters Filtering Functions
Kojto 123:b0220dba8be7 190 */
Kojto 123:b0220dba8be7 191
Kojto 123:b0220dba8be7 192 /**
Kojto 123:b0220dba8be7 193 * @defgroup groupMatrix Matrix Functions
Kojto 123:b0220dba8be7 194 *
Kojto 123:b0220dba8be7 195 * This set of functions provides basic matrix math operations.
Kojto 123:b0220dba8be7 196 * The functions operate on matrix data structures. For example,
Kojto 123:b0220dba8be7 197 * the type
Kojto 123:b0220dba8be7 198 * definition for the floating-point matrix structure is shown
Kojto 123:b0220dba8be7 199 * below:
Kojto 123:b0220dba8be7 200 * <pre>
Kojto 123:b0220dba8be7 201 * typedef struct
Kojto 123:b0220dba8be7 202 * {
Kojto 123:b0220dba8be7 203 * uint16_t numRows; // number of rows of the matrix.
Kojto 123:b0220dba8be7 204 * uint16_t numCols; // number of columns of the matrix.
Kojto 123:b0220dba8be7 205 * float32_t *pData; // points to the data of the matrix.
Kojto 123:b0220dba8be7 206 * } arm_matrix_instance_f32;
Kojto 123:b0220dba8be7 207 * </pre>
Kojto 123:b0220dba8be7 208 * There are similar definitions for Q15 and Q31 data types.
Kojto 123:b0220dba8be7 209 *
Kojto 123:b0220dba8be7 210 * The structure specifies the size of the matrix and then points to
Kojto 123:b0220dba8be7 211 * an array of data. The array is of size <code>numRows X numCols</code>
Kojto 123:b0220dba8be7 212 * and the values are arranged in row order. That is, the
Kojto 123:b0220dba8be7 213 * matrix element (i, j) is stored at:
Kojto 123:b0220dba8be7 214 * <pre>
Kojto 123:b0220dba8be7 215 * pData[i*numCols + j]
Kojto 123:b0220dba8be7 216 * </pre>
Kojto 123:b0220dba8be7 217 *
Kojto 123:b0220dba8be7 218 * \par Init Functions
Kojto 123:b0220dba8be7 219 * There is an associated initialization function for each type of matrix
Kojto 123:b0220dba8be7 220 * data structure.
Kojto 123:b0220dba8be7 221 * The initialization function sets the values of the internal structure fields.
Kojto 123:b0220dba8be7 222 * Refer to the function <code>arm_mat_init_f32()</code>, <code>arm_mat_init_q31()</code>
Kojto 123:b0220dba8be7 223 * and <code>arm_mat_init_q15()</code> for floating-point, Q31 and Q15 types, respectively.
Kojto 123:b0220dba8be7 224 *
Kojto 123:b0220dba8be7 225 * \par
Kojto 123:b0220dba8be7 226 * Use of the initialization function is optional. However, if initialization function is used
Kojto 123:b0220dba8be7 227 * then the instance structure cannot be placed into a const data section.
Kojto 123:b0220dba8be7 228 * To place the instance structure in a const data
Kojto 123:b0220dba8be7 229 * section, manually initialize the data structure. For example:
Kojto 123:b0220dba8be7 230 * <pre>
Kojto 123:b0220dba8be7 231 * <code>arm_matrix_instance_f32 S = {nRows, nColumns, pData};</code>
Kojto 123:b0220dba8be7 232 * <code>arm_matrix_instance_q31 S = {nRows, nColumns, pData};</code>
Kojto 123:b0220dba8be7 233 * <code>arm_matrix_instance_q15 S = {nRows, nColumns, pData};</code>
Kojto 123:b0220dba8be7 234 * </pre>
Kojto 123:b0220dba8be7 235 * where <code>nRows</code> specifies the number of rows, <code>nColumns</code>
Kojto 123:b0220dba8be7 236 * specifies the number of columns, and <code>pData</code> points to the
Kojto 123:b0220dba8be7 237 * data array.
Kojto 123:b0220dba8be7 238 *
Kojto 123:b0220dba8be7 239 * \par Size Checking
Kojto 123:b0220dba8be7 240 * By default all of the matrix functions perform size checking on the input and
Kojto 123:b0220dba8be7 241 * output matrices. For example, the matrix addition function verifies that the
Kojto 123:b0220dba8be7 242 * two input matrices and the output matrix all have the same number of rows and
Kojto 123:b0220dba8be7 243 * columns. If the size check fails the functions return:
Kojto 123:b0220dba8be7 244 * <pre>
Kojto 123:b0220dba8be7 245 * ARM_MATH_SIZE_MISMATCH
Kojto 123:b0220dba8be7 246 * </pre>
Kojto 123:b0220dba8be7 247 * Otherwise the functions return
Kojto 123:b0220dba8be7 248 * <pre>
Kojto 123:b0220dba8be7 249 * ARM_MATH_SUCCESS
Kojto 123:b0220dba8be7 250 * </pre>
Kojto 123:b0220dba8be7 251 * There is some overhead associated with this matrix size checking.
Kojto 123:b0220dba8be7 252 * The matrix size checking is enabled via the \#define
Kojto 123:b0220dba8be7 253 * <pre>
Kojto 123:b0220dba8be7 254 * ARM_MATH_MATRIX_CHECK
Kojto 123:b0220dba8be7 255 * </pre>
Kojto 123:b0220dba8be7 256 * within the library project settings. By default this macro is defined
Kojto 123:b0220dba8be7 257 * and size checking is enabled. By changing the project settings and
Kojto 123:b0220dba8be7 258 * undefining this macro size checking is eliminated and the functions
Kojto 123:b0220dba8be7 259 * run a bit faster. With size checking disabled the functions always
Kojto 123:b0220dba8be7 260 * return <code>ARM_MATH_SUCCESS</code>.
Kojto 123:b0220dba8be7 261 */
Kojto 123:b0220dba8be7 262
Kojto 123:b0220dba8be7 263 /**
Kojto 123:b0220dba8be7 264 * @defgroup groupTransforms Transform Functions
Kojto 123:b0220dba8be7 265 */
Kojto 123:b0220dba8be7 266
Kojto 123:b0220dba8be7 267 /**
Kojto 123:b0220dba8be7 268 * @defgroup groupController Controller Functions
Kojto 123:b0220dba8be7 269 */
Kojto 123:b0220dba8be7 270
Kojto 123:b0220dba8be7 271 /**
Kojto 123:b0220dba8be7 272 * @defgroup groupStats Statistics Functions
Kojto 123:b0220dba8be7 273 */
Kojto 123:b0220dba8be7 274 /**
Kojto 123:b0220dba8be7 275 * @defgroup groupSupport Support Functions
Kojto 123:b0220dba8be7 276 */
Kojto 123:b0220dba8be7 277
Kojto 123:b0220dba8be7 278 /**
Kojto 123:b0220dba8be7 279 * @defgroup groupInterpolation Interpolation Functions
Kojto 123:b0220dba8be7 280 * These functions perform 1- and 2-dimensional interpolation of data.
Kojto 123:b0220dba8be7 281 * Linear interpolation is used for 1-dimensional data and
Kojto 123:b0220dba8be7 282 * bilinear interpolation is used for 2-dimensional data.
Kojto 123:b0220dba8be7 283 */
Kojto 123:b0220dba8be7 284
Kojto 123:b0220dba8be7 285 /**
Kojto 123:b0220dba8be7 286 * @defgroup groupExamples Examples
Kojto 123:b0220dba8be7 287 */
Kojto 123:b0220dba8be7 288 #ifndef _ARM_MATH_H
Kojto 123:b0220dba8be7 289 #define _ARM_MATH_H
Kojto 123:b0220dba8be7 290
Kojto 123:b0220dba8be7 291 #define __CMSIS_GENERIC /* disable NVIC and Systick functions */
Kojto 123:b0220dba8be7 292
Kojto 123:b0220dba8be7 293 #if defined(ARM_MATH_CM7)
Kojto 123:b0220dba8be7 294 #include "core_cm7.h"
Kojto 123:b0220dba8be7 295 #elif defined (ARM_MATH_CM4)
Kojto 123:b0220dba8be7 296 #include "core_cm4.h"
Kojto 123:b0220dba8be7 297 #elif defined (ARM_MATH_CM3)
Kojto 123:b0220dba8be7 298 #include "core_cm3.h"
Kojto 123:b0220dba8be7 299 #elif defined (ARM_MATH_CM0)
Kojto 123:b0220dba8be7 300 #include "core_cm0.h"
Kojto 123:b0220dba8be7 301 #define ARM_MATH_CM0_FAMILY
Kojto 123:b0220dba8be7 302 #elif defined (ARM_MATH_CM0PLUS)
Kojto 123:b0220dba8be7 303 #include "core_cm0plus.h"
Kojto 123:b0220dba8be7 304 #define ARM_MATH_CM0_FAMILY
Kojto 123:b0220dba8be7 305 #else
Kojto 123:b0220dba8be7 306 #error "Define according the used Cortex core ARM_MATH_CM7, ARM_MATH_CM4, ARM_MATH_CM3, ARM_MATH_CM0PLUS or ARM_MATH_CM0"
Kojto 123:b0220dba8be7 307 #endif
Kojto 123:b0220dba8be7 308
Kojto 123:b0220dba8be7 309 #undef __CMSIS_GENERIC /* enable NVIC and Systick functions */
Kojto 123:b0220dba8be7 310 #include "string.h"
Kojto 123:b0220dba8be7 311 #include "math.h"
Kojto 123:b0220dba8be7 312 #ifdef __cplusplus
Kojto 123:b0220dba8be7 313 extern "C"
Kojto 123:b0220dba8be7 314 {
Kojto 123:b0220dba8be7 315 #endif
Kojto 123:b0220dba8be7 316
Kojto 123:b0220dba8be7 317
Kojto 123:b0220dba8be7 318 /**
Kojto 123:b0220dba8be7 319 * @brief Macros required for reciprocal calculation in Normalized LMS
Kojto 123:b0220dba8be7 320 */
Kojto 123:b0220dba8be7 321
Kojto 123:b0220dba8be7 322 #define DELTA_Q31 (0x100)
Kojto 123:b0220dba8be7 323 #define DELTA_Q15 0x5
Kojto 123:b0220dba8be7 324 #define INDEX_MASK 0x0000003F
Kojto 123:b0220dba8be7 325 #ifndef PI
Kojto 123:b0220dba8be7 326 #define PI 3.14159265358979f
Kojto 123:b0220dba8be7 327 #endif
Kojto 123:b0220dba8be7 328
Kojto 123:b0220dba8be7 329 /**
Kojto 123:b0220dba8be7 330 * @brief Macros required for SINE and COSINE Fast math approximations
Kojto 123:b0220dba8be7 331 */
Kojto 123:b0220dba8be7 332
Kojto 123:b0220dba8be7 333 #define FAST_MATH_TABLE_SIZE 512
Kojto 123:b0220dba8be7 334 #define FAST_MATH_Q31_SHIFT (32 - 10)
Kojto 123:b0220dba8be7 335 #define FAST_MATH_Q15_SHIFT (16 - 10)
Kojto 123:b0220dba8be7 336 #define CONTROLLER_Q31_SHIFT (32 - 9)
Kojto 123:b0220dba8be7 337 #define TABLE_SIZE 256
Kojto 123:b0220dba8be7 338 #define TABLE_SPACING_Q31 0x400000
Kojto 123:b0220dba8be7 339 #define TABLE_SPACING_Q15 0x80
Kojto 123:b0220dba8be7 340
Kojto 123:b0220dba8be7 341 /**
Kojto 123:b0220dba8be7 342 * @brief Macros required for SINE and COSINE Controller functions
Kojto 123:b0220dba8be7 343 */
Kojto 123:b0220dba8be7 344 /* 1.31(q31) Fixed value of 2/360 */
Kojto 123:b0220dba8be7 345 /* -1 to +1 is divided into 360 values so total spacing is (2/360) */
Kojto 123:b0220dba8be7 346 #define INPUT_SPACING 0xB60B61
Kojto 123:b0220dba8be7 347
Kojto 123:b0220dba8be7 348 /**
Kojto 123:b0220dba8be7 349 * @brief Macro for Unaligned Support
Kojto 123:b0220dba8be7 350 */
Kojto 123:b0220dba8be7 351 #ifndef UNALIGNED_SUPPORT_DISABLE
Kojto 123:b0220dba8be7 352 #define ALIGN4
Kojto 123:b0220dba8be7 353 #else
Kojto 123:b0220dba8be7 354 #if defined (__GNUC__)
Kojto 123:b0220dba8be7 355 #define ALIGN4 __attribute__((aligned(4)))
Kojto 123:b0220dba8be7 356 #else
Kojto 123:b0220dba8be7 357 #define ALIGN4 __align(4)
Kojto 123:b0220dba8be7 358 #endif
Kojto 123:b0220dba8be7 359 #endif /* #ifndef UNALIGNED_SUPPORT_DISABLE */
Kojto 123:b0220dba8be7 360
Kojto 123:b0220dba8be7 361 /**
Kojto 123:b0220dba8be7 362 * @brief Error status returned by some functions in the library.
Kojto 123:b0220dba8be7 363 */
Kojto 123:b0220dba8be7 364
Kojto 123:b0220dba8be7 365 typedef enum
Kojto 123:b0220dba8be7 366 {
Kojto 123:b0220dba8be7 367 ARM_MATH_SUCCESS = 0, /**< No error */
Kojto 123:b0220dba8be7 368 ARM_MATH_ARGUMENT_ERROR = -1, /**< One or more arguments are incorrect */
Kojto 123:b0220dba8be7 369 ARM_MATH_LENGTH_ERROR = -2, /**< Length of data buffer is incorrect */
Kojto 123:b0220dba8be7 370 ARM_MATH_SIZE_MISMATCH = -3, /**< Size of matrices is not compatible with the operation. */
Kojto 123:b0220dba8be7 371 ARM_MATH_NANINF = -4, /**< Not-a-number (NaN) or infinity is generated */
Kojto 123:b0220dba8be7 372 ARM_MATH_SINGULAR = -5, /**< Generated by matrix inversion if the input matrix is singular and cannot be inverted. */
Kojto 123:b0220dba8be7 373 ARM_MATH_TEST_FAILURE = -6 /**< Test Failed */
Kojto 123:b0220dba8be7 374 } arm_status;
Kojto 123:b0220dba8be7 375
Kojto 123:b0220dba8be7 376 /**
Kojto 123:b0220dba8be7 377 * @brief 8-bit fractional data type in 1.7 format.
Kojto 123:b0220dba8be7 378 */
Kojto 123:b0220dba8be7 379 typedef int8_t q7_t;
Kojto 123:b0220dba8be7 380
Kojto 123:b0220dba8be7 381 /**
Kojto 123:b0220dba8be7 382 * @brief 16-bit fractional data type in 1.15 format.
Kojto 123:b0220dba8be7 383 */
Kojto 123:b0220dba8be7 384 typedef int16_t q15_t;
Kojto 123:b0220dba8be7 385
Kojto 123:b0220dba8be7 386 /**
Kojto 123:b0220dba8be7 387 * @brief 32-bit fractional data type in 1.31 format.
Kojto 123:b0220dba8be7 388 */
Kojto 123:b0220dba8be7 389 typedef int32_t q31_t;
Kojto 123:b0220dba8be7 390
Kojto 123:b0220dba8be7 391 /**
Kojto 123:b0220dba8be7 392 * @brief 64-bit fractional data type in 1.63 format.
Kojto 123:b0220dba8be7 393 */
Kojto 123:b0220dba8be7 394 typedef int64_t q63_t;
Kojto 123:b0220dba8be7 395
Kojto 123:b0220dba8be7 396 /**
Kojto 123:b0220dba8be7 397 * @brief 32-bit floating-point type definition.
Kojto 123:b0220dba8be7 398 */
Kojto 123:b0220dba8be7 399 typedef float float32_t;
Kojto 123:b0220dba8be7 400
Kojto 123:b0220dba8be7 401 /**
Kojto 123:b0220dba8be7 402 * @brief 64-bit floating-point type definition.
Kojto 123:b0220dba8be7 403 */
Kojto 123:b0220dba8be7 404 typedef double float64_t;
Kojto 123:b0220dba8be7 405
Kojto 123:b0220dba8be7 406 /**
Kojto 123:b0220dba8be7 407 * @brief definition to read/write two 16 bit values.
Kojto 123:b0220dba8be7 408 */
Kojto 123:b0220dba8be7 409 #if defined __CC_ARM
Kojto 123:b0220dba8be7 410 #define __SIMD32_TYPE int32_t __packed
Kojto 123:b0220dba8be7 411 #define CMSIS_UNUSED __attribute__((unused))
Kojto 123:b0220dba8be7 412 #elif defined __ICCARM__
Kojto 123:b0220dba8be7 413 #define __SIMD32_TYPE int32_t __packed
Kojto 123:b0220dba8be7 414 #define CMSIS_UNUSED
Kojto 123:b0220dba8be7 415 #elif defined __GNUC__
Kojto 123:b0220dba8be7 416 #define __SIMD32_TYPE int32_t
Kojto 123:b0220dba8be7 417 #define CMSIS_UNUSED __attribute__((unused))
Kojto 123:b0220dba8be7 418 #elif defined __CSMC__ /* Cosmic */
Kojto 123:b0220dba8be7 419 #define __SIMD32_TYPE int32_t
Kojto 123:b0220dba8be7 420 #define CMSIS_UNUSED
Kojto 123:b0220dba8be7 421 #elif defined __TASKING__
Kojto 123:b0220dba8be7 422 #define __SIMD32_TYPE __unaligned int32_t
Kojto 123:b0220dba8be7 423 #define CMSIS_UNUSED
Kojto 123:b0220dba8be7 424 #else
Kojto 123:b0220dba8be7 425 #error Unknown compiler
Kojto 123:b0220dba8be7 426 #endif
Kojto 123:b0220dba8be7 427
Kojto 123:b0220dba8be7 428 #define __SIMD32(addr) (*(__SIMD32_TYPE **) & (addr))
Kojto 123:b0220dba8be7 429 #define __SIMD32_CONST(addr) ((__SIMD32_TYPE *)(addr))
Kojto 123:b0220dba8be7 430
Kojto 123:b0220dba8be7 431 #define _SIMD32_OFFSET(addr) (*(__SIMD32_TYPE *) (addr))
Kojto 123:b0220dba8be7 432
Kojto 123:b0220dba8be7 433 #define __SIMD64(addr) (*(int64_t **) & (addr))
Kojto 123:b0220dba8be7 434
Kojto 123:b0220dba8be7 435 #if defined (ARM_MATH_CM3) || defined (ARM_MATH_CM0_FAMILY)
Kojto 123:b0220dba8be7 436 /**
Kojto 123:b0220dba8be7 437 * @brief definition to pack two 16 bit values.
Kojto 123:b0220dba8be7 438 */
Kojto 123:b0220dba8be7 439 #define __PKHBT(ARG1, ARG2, ARG3) ( (((int32_t)(ARG1) << 0) & (int32_t)0x0000FFFF) | \
Kojto 123:b0220dba8be7 440 (((int32_t)(ARG2) << ARG3) & (int32_t)0xFFFF0000) )
Kojto 123:b0220dba8be7 441 #define __PKHTB(ARG1, ARG2, ARG3) ( (((int32_t)(ARG1) << 0) & (int32_t)0xFFFF0000) | \
Kojto 123:b0220dba8be7 442 (((int32_t)(ARG2) >> ARG3) & (int32_t)0x0000FFFF) )
Kojto 123:b0220dba8be7 443
Kojto 123:b0220dba8be7 444 #endif
Kojto 123:b0220dba8be7 445
Kojto 123:b0220dba8be7 446
Kojto 123:b0220dba8be7 447 /**
Kojto 123:b0220dba8be7 448 * @brief definition to pack four 8 bit values.
Kojto 123:b0220dba8be7 449 */
Kojto 123:b0220dba8be7 450 #ifndef ARM_MATH_BIG_ENDIAN
Kojto 123:b0220dba8be7 451
Kojto 123:b0220dba8be7 452 #define __PACKq7(v0,v1,v2,v3) ( (((int32_t)(v0) << 0) & (int32_t)0x000000FF) | \
Kojto 123:b0220dba8be7 453 (((int32_t)(v1) << 8) & (int32_t)0x0000FF00) | \
Kojto 123:b0220dba8be7 454 (((int32_t)(v2) << 16) & (int32_t)0x00FF0000) | \
Kojto 123:b0220dba8be7 455 (((int32_t)(v3) << 24) & (int32_t)0xFF000000) )
Kojto 123:b0220dba8be7 456 #else
Kojto 123:b0220dba8be7 457
Kojto 123:b0220dba8be7 458 #define __PACKq7(v0,v1,v2,v3) ( (((int32_t)(v3) << 0) & (int32_t)0x000000FF) | \
Kojto 123:b0220dba8be7 459 (((int32_t)(v2) << 8) & (int32_t)0x0000FF00) | \
Kojto 123:b0220dba8be7 460 (((int32_t)(v1) << 16) & (int32_t)0x00FF0000) | \
Kojto 123:b0220dba8be7 461 (((int32_t)(v0) << 24) & (int32_t)0xFF000000) )
Kojto 123:b0220dba8be7 462
Kojto 123:b0220dba8be7 463 #endif
Kojto 123:b0220dba8be7 464
Kojto 123:b0220dba8be7 465
Kojto 123:b0220dba8be7 466 /**
Kojto 123:b0220dba8be7 467 * @brief Clips Q63 to Q31 values.
Kojto 123:b0220dba8be7 468 */
Kojto 123:b0220dba8be7 469 static __INLINE q31_t clip_q63_to_q31(
Kojto 123:b0220dba8be7 470 q63_t x)
Kojto 123:b0220dba8be7 471 {
Kojto 123:b0220dba8be7 472 return ((q31_t) (x >> 32) != ((q31_t) x >> 31)) ?
Kojto 123:b0220dba8be7 473 ((0x7FFFFFFF ^ ((q31_t) (x >> 63)))) : (q31_t) x;
Kojto 123:b0220dba8be7 474 }
Kojto 123:b0220dba8be7 475
Kojto 123:b0220dba8be7 476 /**
Kojto 123:b0220dba8be7 477 * @brief Clips Q63 to Q15 values.
Kojto 123:b0220dba8be7 478 */
Kojto 123:b0220dba8be7 479 static __INLINE q15_t clip_q63_to_q15(
Kojto 123:b0220dba8be7 480 q63_t x)
Kojto 123:b0220dba8be7 481 {
Kojto 123:b0220dba8be7 482 return ((q31_t) (x >> 32) != ((q31_t) x >> 31)) ?
Kojto 123:b0220dba8be7 483 ((0x7FFF ^ ((q15_t) (x >> 63)))) : (q15_t) (x >> 15);
Kojto 123:b0220dba8be7 484 }
Kojto 123:b0220dba8be7 485
Kojto 123:b0220dba8be7 486 /**
Kojto 123:b0220dba8be7 487 * @brief Clips Q31 to Q7 values.
Kojto 123:b0220dba8be7 488 */
Kojto 123:b0220dba8be7 489 static __INLINE q7_t clip_q31_to_q7(
Kojto 123:b0220dba8be7 490 q31_t x)
Kojto 123:b0220dba8be7 491 {
Kojto 123:b0220dba8be7 492 return ((q31_t) (x >> 24) != ((q31_t) x >> 23)) ?
Kojto 123:b0220dba8be7 493 ((0x7F ^ ((q7_t) (x >> 31)))) : (q7_t) x;
Kojto 123:b0220dba8be7 494 }
Kojto 123:b0220dba8be7 495
Kojto 123:b0220dba8be7 496 /**
Kojto 123:b0220dba8be7 497 * @brief Clips Q31 to Q15 values.
Kojto 123:b0220dba8be7 498 */
Kojto 123:b0220dba8be7 499 static __INLINE q15_t clip_q31_to_q15(
Kojto 123:b0220dba8be7 500 q31_t x)
Kojto 123:b0220dba8be7 501 {
Kojto 123:b0220dba8be7 502 return ((q31_t) (x >> 16) != ((q31_t) x >> 15)) ?
Kojto 123:b0220dba8be7 503 ((0x7FFF ^ ((q15_t) (x >> 31)))) : (q15_t) x;
Kojto 123:b0220dba8be7 504 }
Kojto 123:b0220dba8be7 505
Kojto 123:b0220dba8be7 506 /**
Kojto 123:b0220dba8be7 507 * @brief Multiplies 32 X 64 and returns 32 bit result in 2.30 format.
Kojto 123:b0220dba8be7 508 */
Kojto 123:b0220dba8be7 509
Kojto 123:b0220dba8be7 510 static __INLINE q63_t mult32x64(
Kojto 123:b0220dba8be7 511 q63_t x,
Kojto 123:b0220dba8be7 512 q31_t y)
Kojto 123:b0220dba8be7 513 {
Kojto 123:b0220dba8be7 514 return ((((q63_t) (x & 0x00000000FFFFFFFF) * y) >> 32) +
Kojto 123:b0220dba8be7 515 (((q63_t) (x >> 32) * y)));
Kojto 123:b0220dba8be7 516 }
Kojto 123:b0220dba8be7 517
Kojto 123:b0220dba8be7 518
Kojto 123:b0220dba8be7 519 //#if defined (ARM_MATH_CM0_FAMILY) && defined ( __CC_ARM )
Kojto 123:b0220dba8be7 520 //#define __CLZ __clz
Kojto 123:b0220dba8be7 521 //#endif
Kojto 123:b0220dba8be7 522
Kojto 123:b0220dba8be7 523 //note: function can be removed when all toolchain support __CLZ for Cortex-M0
Kojto 123:b0220dba8be7 524 #if defined (ARM_MATH_CM0_FAMILY) && ((defined (__ICCARM__)) )
Kojto 123:b0220dba8be7 525
Kojto 123:b0220dba8be7 526 static __INLINE uint32_t __CLZ(
Kojto 123:b0220dba8be7 527 q31_t data);
Kojto 123:b0220dba8be7 528
Kojto 123:b0220dba8be7 529
Kojto 123:b0220dba8be7 530 static __INLINE uint32_t __CLZ(
Kojto 123:b0220dba8be7 531 q31_t data)
Kojto 123:b0220dba8be7 532 {
Kojto 123:b0220dba8be7 533 uint32_t count = 0;
Kojto 123:b0220dba8be7 534 uint32_t mask = 0x80000000;
Kojto 123:b0220dba8be7 535
Kojto 123:b0220dba8be7 536 while((data & mask) == 0)
Kojto 123:b0220dba8be7 537 {
Kojto 123:b0220dba8be7 538 count += 1u;
Kojto 123:b0220dba8be7 539 mask = mask >> 1u;
Kojto 123:b0220dba8be7 540 }
Kojto 123:b0220dba8be7 541
Kojto 123:b0220dba8be7 542 return (count);
Kojto 123:b0220dba8be7 543
Kojto 123:b0220dba8be7 544 }
Kojto 123:b0220dba8be7 545
Kojto 123:b0220dba8be7 546 #endif
Kojto 123:b0220dba8be7 547
Kojto 123:b0220dba8be7 548 /**
Kojto 123:b0220dba8be7 549 * @brief Function to Calculates 1/in (reciprocal) value of Q31 Data type.
Kojto 123:b0220dba8be7 550 */
Kojto 123:b0220dba8be7 551
Kojto 123:b0220dba8be7 552 static __INLINE uint32_t arm_recip_q31(
Kojto 123:b0220dba8be7 553 q31_t in,
Kojto 123:b0220dba8be7 554 q31_t * dst,
Kojto 123:b0220dba8be7 555 q31_t * pRecipTable)
Kojto 123:b0220dba8be7 556 {
Kojto 123:b0220dba8be7 557
Kojto 123:b0220dba8be7 558 uint32_t out, tempVal;
Kojto 123:b0220dba8be7 559 uint32_t index, i;
Kojto 123:b0220dba8be7 560 uint32_t signBits;
Kojto 123:b0220dba8be7 561
Kojto 123:b0220dba8be7 562 if(in > 0)
Kojto 123:b0220dba8be7 563 {
Kojto 123:b0220dba8be7 564 signBits = __CLZ(in) - 1;
Kojto 123:b0220dba8be7 565 }
Kojto 123:b0220dba8be7 566 else
Kojto 123:b0220dba8be7 567 {
Kojto 123:b0220dba8be7 568 signBits = __CLZ(-in) - 1;
Kojto 123:b0220dba8be7 569 }
Kojto 123:b0220dba8be7 570
Kojto 123:b0220dba8be7 571 /* Convert input sample to 1.31 format */
Kojto 123:b0220dba8be7 572 in = in << signBits;
Kojto 123:b0220dba8be7 573
Kojto 123:b0220dba8be7 574 /* calculation of index for initial approximated Val */
Kojto 123:b0220dba8be7 575 index = (uint32_t) (in >> 24u);
Kojto 123:b0220dba8be7 576 index = (index & INDEX_MASK);
Kojto 123:b0220dba8be7 577
Kojto 123:b0220dba8be7 578 /* 1.31 with exp 1 */
Kojto 123:b0220dba8be7 579 out = pRecipTable[index];
Kojto 123:b0220dba8be7 580
Kojto 123:b0220dba8be7 581 /* calculation of reciprocal value */
Kojto 123:b0220dba8be7 582 /* running approximation for two iterations */
Kojto 123:b0220dba8be7 583 for (i = 0u; i < 2u; i++)
Kojto 123:b0220dba8be7 584 {
Kojto 123:b0220dba8be7 585 tempVal = (q31_t) (((q63_t) in * out) >> 31u);
Kojto 123:b0220dba8be7 586 tempVal = 0x7FFFFFFF - tempVal;
Kojto 123:b0220dba8be7 587 /* 1.31 with exp 1 */
Kojto 123:b0220dba8be7 588 //out = (q31_t) (((q63_t) out * tempVal) >> 30u);
Kojto 123:b0220dba8be7 589 out = (q31_t) clip_q63_to_q31(((q63_t) out * tempVal) >> 30u);
Kojto 123:b0220dba8be7 590 }
Kojto 123:b0220dba8be7 591
Kojto 123:b0220dba8be7 592 /* write output */
Kojto 123:b0220dba8be7 593 *dst = out;
Kojto 123:b0220dba8be7 594
Kojto 123:b0220dba8be7 595 /* return num of signbits of out = 1/in value */
Kojto 123:b0220dba8be7 596 return (signBits + 1u);
Kojto 123:b0220dba8be7 597
Kojto 123:b0220dba8be7 598 }
Kojto 123:b0220dba8be7 599
Kojto 123:b0220dba8be7 600 /**
Kojto 123:b0220dba8be7 601 * @brief Function to Calculates 1/in (reciprocal) value of Q15 Data type.
Kojto 123:b0220dba8be7 602 */
Kojto 123:b0220dba8be7 603 static __INLINE uint32_t arm_recip_q15(
Kojto 123:b0220dba8be7 604 q15_t in,
Kojto 123:b0220dba8be7 605 q15_t * dst,
Kojto 123:b0220dba8be7 606 q15_t * pRecipTable)
Kojto 123:b0220dba8be7 607 {
Kojto 123:b0220dba8be7 608
Kojto 123:b0220dba8be7 609 uint32_t out = 0, tempVal = 0;
Kojto 123:b0220dba8be7 610 uint32_t index = 0, i = 0;
Kojto 123:b0220dba8be7 611 uint32_t signBits = 0;
Kojto 123:b0220dba8be7 612
Kojto 123:b0220dba8be7 613 if(in > 0)
Kojto 123:b0220dba8be7 614 {
Kojto 123:b0220dba8be7 615 signBits = __CLZ(in) - 17;
Kojto 123:b0220dba8be7 616 }
Kojto 123:b0220dba8be7 617 else
Kojto 123:b0220dba8be7 618 {
Kojto 123:b0220dba8be7 619 signBits = __CLZ(-in) - 17;
Kojto 123:b0220dba8be7 620 }
Kojto 123:b0220dba8be7 621
Kojto 123:b0220dba8be7 622 /* Convert input sample to 1.15 format */
Kojto 123:b0220dba8be7 623 in = in << signBits;
Kojto 123:b0220dba8be7 624
Kojto 123:b0220dba8be7 625 /* calculation of index for initial approximated Val */
Kojto 123:b0220dba8be7 626 index = in >> 8;
Kojto 123:b0220dba8be7 627 index = (index & INDEX_MASK);
Kojto 123:b0220dba8be7 628
Kojto 123:b0220dba8be7 629 /* 1.15 with exp 1 */
Kojto 123:b0220dba8be7 630 out = pRecipTable[index];
Kojto 123:b0220dba8be7 631
Kojto 123:b0220dba8be7 632 /* calculation of reciprocal value */
Kojto 123:b0220dba8be7 633 /* running approximation for two iterations */
Kojto 123:b0220dba8be7 634 for (i = 0; i < 2; i++)
Kojto 123:b0220dba8be7 635 {
Kojto 123:b0220dba8be7 636 tempVal = (q15_t) (((q31_t) in * out) >> 15);
Kojto 123:b0220dba8be7 637 tempVal = 0x7FFF - tempVal;
Kojto 123:b0220dba8be7 638 /* 1.15 with exp 1 */
Kojto 123:b0220dba8be7 639 out = (q15_t) (((q31_t) out * tempVal) >> 14);
Kojto 123:b0220dba8be7 640 }
Kojto 123:b0220dba8be7 641
Kojto 123:b0220dba8be7 642 /* write output */
Kojto 123:b0220dba8be7 643 *dst = out;
Kojto 123:b0220dba8be7 644
Kojto 123:b0220dba8be7 645 /* return num of signbits of out = 1/in value */
Kojto 123:b0220dba8be7 646 return (signBits + 1);
Kojto 123:b0220dba8be7 647
Kojto 123:b0220dba8be7 648 }
Kojto 123:b0220dba8be7 649
Kojto 123:b0220dba8be7 650
Kojto 123:b0220dba8be7 651 /*
Kojto 123:b0220dba8be7 652 * @brief C custom defined intrinisic function for only M0 processors
Kojto 123:b0220dba8be7 653 */
Kojto 123:b0220dba8be7 654 #if defined(ARM_MATH_CM0_FAMILY)
Kojto 123:b0220dba8be7 655
Kojto 123:b0220dba8be7 656 static __INLINE q31_t __SSAT(
Kojto 123:b0220dba8be7 657 q31_t x,
Kojto 123:b0220dba8be7 658 uint32_t y)
Kojto 123:b0220dba8be7 659 {
Kojto 123:b0220dba8be7 660 int32_t posMax, negMin;
Kojto 123:b0220dba8be7 661 uint32_t i;
Kojto 123:b0220dba8be7 662
Kojto 123:b0220dba8be7 663 posMax = 1;
Kojto 123:b0220dba8be7 664 for (i = 0; i < (y - 1); i++)
Kojto 123:b0220dba8be7 665 {
Kojto 123:b0220dba8be7 666 posMax = posMax * 2;
Kojto 123:b0220dba8be7 667 }
Kojto 123:b0220dba8be7 668
Kojto 123:b0220dba8be7 669 if(x > 0)
Kojto 123:b0220dba8be7 670 {
Kojto 123:b0220dba8be7 671 posMax = (posMax - 1);
Kojto 123:b0220dba8be7 672
Kojto 123:b0220dba8be7 673 if(x > posMax)
Kojto 123:b0220dba8be7 674 {
Kojto 123:b0220dba8be7 675 x = posMax;
Kojto 123:b0220dba8be7 676 }
Kojto 123:b0220dba8be7 677 }
Kojto 123:b0220dba8be7 678 else
Kojto 123:b0220dba8be7 679 {
Kojto 123:b0220dba8be7 680 negMin = -posMax;
Kojto 123:b0220dba8be7 681
Kojto 123:b0220dba8be7 682 if(x < negMin)
Kojto 123:b0220dba8be7 683 {
Kojto 123:b0220dba8be7 684 x = negMin;
Kojto 123:b0220dba8be7 685 }
Kojto 123:b0220dba8be7 686 }
Kojto 123:b0220dba8be7 687 return (x);
Kojto 123:b0220dba8be7 688
Kojto 123:b0220dba8be7 689
Kojto 123:b0220dba8be7 690 }
Kojto 123:b0220dba8be7 691
Kojto 123:b0220dba8be7 692 #endif /* end of ARM_MATH_CM0_FAMILY */
Kojto 123:b0220dba8be7 693
Kojto 123:b0220dba8be7 694
Kojto 123:b0220dba8be7 695
Kojto 123:b0220dba8be7 696 /*
Kojto 123:b0220dba8be7 697 * @brief C custom defined intrinsic function for M3 and M0 processors
Kojto 123:b0220dba8be7 698 */
Kojto 123:b0220dba8be7 699 #if defined (ARM_MATH_CM3) || defined (ARM_MATH_CM0_FAMILY)
Kojto 123:b0220dba8be7 700
Kojto 123:b0220dba8be7 701 /*
Kojto 123:b0220dba8be7 702 * @brief C custom defined QADD8 for M3 and M0 processors
Kojto 123:b0220dba8be7 703 */
Kojto 123:b0220dba8be7 704 static __INLINE q31_t __QADD8(
Kojto 123:b0220dba8be7 705 q31_t x,
Kojto 123:b0220dba8be7 706 q31_t y)
Kojto 123:b0220dba8be7 707 {
Kojto 123:b0220dba8be7 708
Kojto 123:b0220dba8be7 709 q31_t sum;
Kojto 123:b0220dba8be7 710 q7_t r, s, t, u;
Kojto 123:b0220dba8be7 711
Kojto 123:b0220dba8be7 712 r = (q7_t) x;
Kojto 123:b0220dba8be7 713 s = (q7_t) y;
Kojto 123:b0220dba8be7 714
Kojto 123:b0220dba8be7 715 r = __SSAT((q31_t) (r + s), 8);
Kojto 123:b0220dba8be7 716 s = __SSAT(((q31_t) (((x << 16) >> 24) + ((y << 16) >> 24))), 8);
Kojto 123:b0220dba8be7 717 t = __SSAT(((q31_t) (((x << 8) >> 24) + ((y << 8) >> 24))), 8);
Kojto 123:b0220dba8be7 718 u = __SSAT(((q31_t) ((x >> 24) + (y >> 24))), 8);
Kojto 123:b0220dba8be7 719
Kojto 123:b0220dba8be7 720 sum =
Kojto 123:b0220dba8be7 721 (((q31_t) u << 24) & 0xFF000000) | (((q31_t) t << 16) & 0x00FF0000) |
Kojto 123:b0220dba8be7 722 (((q31_t) s << 8) & 0x0000FF00) | (r & 0x000000FF);
Kojto 123:b0220dba8be7 723
Kojto 123:b0220dba8be7 724 return sum;
Kojto 123:b0220dba8be7 725
Kojto 123:b0220dba8be7 726 }
Kojto 123:b0220dba8be7 727
Kojto 123:b0220dba8be7 728 /*
Kojto 123:b0220dba8be7 729 * @brief C custom defined QSUB8 for M3 and M0 processors
Kojto 123:b0220dba8be7 730 */
Kojto 123:b0220dba8be7 731 static __INLINE q31_t __QSUB8(
Kojto 123:b0220dba8be7 732 q31_t x,
Kojto 123:b0220dba8be7 733 q31_t y)
Kojto 123:b0220dba8be7 734 {
Kojto 123:b0220dba8be7 735
Kojto 123:b0220dba8be7 736 q31_t sum;
Kojto 123:b0220dba8be7 737 q31_t r, s, t, u;
Kojto 123:b0220dba8be7 738
Kojto 123:b0220dba8be7 739 r = (q7_t) x;
Kojto 123:b0220dba8be7 740 s = (q7_t) y;
Kojto 123:b0220dba8be7 741
Kojto 123:b0220dba8be7 742 r = __SSAT((r - s), 8);
Kojto 123:b0220dba8be7 743 s = __SSAT(((q31_t) (((x << 16) >> 24) - ((y << 16) >> 24))), 8) << 8;
Kojto 123:b0220dba8be7 744 t = __SSAT(((q31_t) (((x << 8) >> 24) - ((y << 8) >> 24))), 8) << 16;
Kojto 123:b0220dba8be7 745 u = __SSAT(((q31_t) ((x >> 24) - (y >> 24))), 8) << 24;
Kojto 123:b0220dba8be7 746
Kojto 123:b0220dba8be7 747 sum =
Kojto 123:b0220dba8be7 748 (u & 0xFF000000) | (t & 0x00FF0000) | (s & 0x0000FF00) | (r &
Kojto 123:b0220dba8be7 749 0x000000FF);
Kojto 123:b0220dba8be7 750
Kojto 123:b0220dba8be7 751 return sum;
Kojto 123:b0220dba8be7 752 }
Kojto 123:b0220dba8be7 753
Kojto 123:b0220dba8be7 754 /*
Kojto 123:b0220dba8be7 755 * @brief C custom defined QADD16 for M3 and M0 processors
Kojto 123:b0220dba8be7 756 */
Kojto 123:b0220dba8be7 757
Kojto 123:b0220dba8be7 758 /*
Kojto 123:b0220dba8be7 759 * @brief C custom defined QADD16 for M3 and M0 processors
Kojto 123:b0220dba8be7 760 */
Kojto 123:b0220dba8be7 761 static __INLINE q31_t __QADD16(
Kojto 123:b0220dba8be7 762 q31_t x,
Kojto 123:b0220dba8be7 763 q31_t y)
Kojto 123:b0220dba8be7 764 {
Kojto 123:b0220dba8be7 765
Kojto 123:b0220dba8be7 766 q31_t sum;
Kojto 123:b0220dba8be7 767 q31_t r, s;
Kojto 123:b0220dba8be7 768
Kojto 123:b0220dba8be7 769 r = (q15_t) x;
Kojto 123:b0220dba8be7 770 s = (q15_t) y;
Kojto 123:b0220dba8be7 771
Kojto 123:b0220dba8be7 772 r = __SSAT(r + s, 16);
Kojto 123:b0220dba8be7 773 s = __SSAT(((q31_t) ((x >> 16) + (y >> 16))), 16) << 16;
Kojto 123:b0220dba8be7 774
Kojto 123:b0220dba8be7 775 sum = (s & 0xFFFF0000) | (r & 0x0000FFFF);
Kojto 123:b0220dba8be7 776
Kojto 123:b0220dba8be7 777 return sum;
Kojto 123:b0220dba8be7 778
Kojto 123:b0220dba8be7 779 }
Kojto 123:b0220dba8be7 780
Kojto 123:b0220dba8be7 781 /*
Kojto 123:b0220dba8be7 782 * @brief C custom defined SHADD16 for M3 and M0 processors
Kojto 123:b0220dba8be7 783 */
Kojto 123:b0220dba8be7 784 static __INLINE q31_t __SHADD16(
Kojto 123:b0220dba8be7 785 q31_t x,
Kojto 123:b0220dba8be7 786 q31_t y)
Kojto 123:b0220dba8be7 787 {
Kojto 123:b0220dba8be7 788
Kojto 123:b0220dba8be7 789 q31_t sum;
Kojto 123:b0220dba8be7 790 q31_t r, s;
Kojto 123:b0220dba8be7 791
Kojto 123:b0220dba8be7 792 r = (q15_t) x;
Kojto 123:b0220dba8be7 793 s = (q15_t) y;
Kojto 123:b0220dba8be7 794
Kojto 123:b0220dba8be7 795 r = ((r >> 1) + (s >> 1));
Kojto 123:b0220dba8be7 796 s = ((q31_t) ((x >> 17) + (y >> 17))) << 16;
Kojto 123:b0220dba8be7 797
Kojto 123:b0220dba8be7 798 sum = (s & 0xFFFF0000) | (r & 0x0000FFFF);
Kojto 123:b0220dba8be7 799
Kojto 123:b0220dba8be7 800 return sum;
Kojto 123:b0220dba8be7 801
Kojto 123:b0220dba8be7 802 }
Kojto 123:b0220dba8be7 803
Kojto 123:b0220dba8be7 804 /*
Kojto 123:b0220dba8be7 805 * @brief C custom defined QSUB16 for M3 and M0 processors
Kojto 123:b0220dba8be7 806 */
Kojto 123:b0220dba8be7 807 static __INLINE q31_t __QSUB16(
Kojto 123:b0220dba8be7 808 q31_t x,
Kojto 123:b0220dba8be7 809 q31_t y)
Kojto 123:b0220dba8be7 810 {
Kojto 123:b0220dba8be7 811
Kojto 123:b0220dba8be7 812 q31_t sum;
Kojto 123:b0220dba8be7 813 q31_t r, s;
Kojto 123:b0220dba8be7 814
Kojto 123:b0220dba8be7 815 r = (q15_t) x;
Kojto 123:b0220dba8be7 816 s = (q15_t) y;
Kojto 123:b0220dba8be7 817
Kojto 123:b0220dba8be7 818 r = __SSAT(r - s, 16);
Kojto 123:b0220dba8be7 819 s = __SSAT(((q31_t) ((x >> 16) - (y >> 16))), 16) << 16;
Kojto 123:b0220dba8be7 820
Kojto 123:b0220dba8be7 821 sum = (s & 0xFFFF0000) | (r & 0x0000FFFF);
Kojto 123:b0220dba8be7 822
Kojto 123:b0220dba8be7 823 return sum;
Kojto 123:b0220dba8be7 824 }
Kojto 123:b0220dba8be7 825
Kojto 123:b0220dba8be7 826 /*
Kojto 123:b0220dba8be7 827 * @brief C custom defined SHSUB16 for M3 and M0 processors
Kojto 123:b0220dba8be7 828 */
Kojto 123:b0220dba8be7 829 static __INLINE q31_t __SHSUB16(
Kojto 123:b0220dba8be7 830 q31_t x,
Kojto 123:b0220dba8be7 831 q31_t y)
Kojto 123:b0220dba8be7 832 {
Kojto 123:b0220dba8be7 833
Kojto 123:b0220dba8be7 834 q31_t diff;
Kojto 123:b0220dba8be7 835 q31_t r, s;
Kojto 123:b0220dba8be7 836
Kojto 123:b0220dba8be7 837 r = (q15_t) x;
Kojto 123:b0220dba8be7 838 s = (q15_t) y;
Kojto 123:b0220dba8be7 839
Kojto 123:b0220dba8be7 840 r = ((r >> 1) - (s >> 1));
Kojto 123:b0220dba8be7 841 s = (((x >> 17) - (y >> 17)) << 16);
Kojto 123:b0220dba8be7 842
Kojto 123:b0220dba8be7 843 diff = (s & 0xFFFF0000) | (r & 0x0000FFFF);
Kojto 123:b0220dba8be7 844
Kojto 123:b0220dba8be7 845 return diff;
Kojto 123:b0220dba8be7 846 }
Kojto 123:b0220dba8be7 847
Kojto 123:b0220dba8be7 848 /*
Kojto 123:b0220dba8be7 849 * @brief C custom defined QASX for M3 and M0 processors
Kojto 123:b0220dba8be7 850 */
Kojto 123:b0220dba8be7 851 static __INLINE q31_t __QASX(
Kojto 123:b0220dba8be7 852 q31_t x,
Kojto 123:b0220dba8be7 853 q31_t y)
Kojto 123:b0220dba8be7 854 {
Kojto 123:b0220dba8be7 855
Kojto 123:b0220dba8be7 856 q31_t sum = 0;
Kojto 123:b0220dba8be7 857
Kojto 123:b0220dba8be7 858 sum =
Kojto 123:b0220dba8be7 859 ((sum +
Kojto 123:b0220dba8be7 860 clip_q31_to_q15((q31_t) ((q15_t) (x >> 16) + (q15_t) y))) << 16) +
Kojto 123:b0220dba8be7 861 clip_q31_to_q15((q31_t) ((q15_t) x - (q15_t) (y >> 16)));
Kojto 123:b0220dba8be7 862
Kojto 123:b0220dba8be7 863 return sum;
Kojto 123:b0220dba8be7 864 }
Kojto 123:b0220dba8be7 865
Kojto 123:b0220dba8be7 866 /*
Kojto 123:b0220dba8be7 867 * @brief C custom defined SHASX for M3 and M0 processors
Kojto 123:b0220dba8be7 868 */
Kojto 123:b0220dba8be7 869 static __INLINE q31_t __SHASX(
Kojto 123:b0220dba8be7 870 q31_t x,
Kojto 123:b0220dba8be7 871 q31_t y)
Kojto 123:b0220dba8be7 872 {
Kojto 123:b0220dba8be7 873
Kojto 123:b0220dba8be7 874 q31_t sum;
Kojto 123:b0220dba8be7 875 q31_t r, s;
Kojto 123:b0220dba8be7 876
Kojto 123:b0220dba8be7 877 r = (q15_t) x;
Kojto 123:b0220dba8be7 878 s = (q15_t) y;
Kojto 123:b0220dba8be7 879
Kojto 123:b0220dba8be7 880 r = ((r >> 1) - (y >> 17));
Kojto 123:b0220dba8be7 881 s = (((x >> 17) + (s >> 1)) << 16);
Kojto 123:b0220dba8be7 882
Kojto 123:b0220dba8be7 883 sum = (s & 0xFFFF0000) | (r & 0x0000FFFF);
Kojto 123:b0220dba8be7 884
Kojto 123:b0220dba8be7 885 return sum;
Kojto 123:b0220dba8be7 886 }
Kojto 123:b0220dba8be7 887
Kojto 123:b0220dba8be7 888
Kojto 123:b0220dba8be7 889 /*
Kojto 123:b0220dba8be7 890 * @brief C custom defined QSAX for M3 and M0 processors
Kojto 123:b0220dba8be7 891 */
Kojto 123:b0220dba8be7 892 static __INLINE q31_t __QSAX(
Kojto 123:b0220dba8be7 893 q31_t x,
Kojto 123:b0220dba8be7 894 q31_t y)
Kojto 123:b0220dba8be7 895 {
Kojto 123:b0220dba8be7 896
Kojto 123:b0220dba8be7 897 q31_t sum = 0;
Kojto 123:b0220dba8be7 898
Kojto 123:b0220dba8be7 899 sum =
Kojto 123:b0220dba8be7 900 ((sum +
Kojto 123:b0220dba8be7 901 clip_q31_to_q15((q31_t) ((q15_t) (x >> 16) - (q15_t) y))) << 16) +
Kojto 123:b0220dba8be7 902 clip_q31_to_q15((q31_t) ((q15_t) x + (q15_t) (y >> 16)));
Kojto 123:b0220dba8be7 903
Kojto 123:b0220dba8be7 904 return sum;
Kojto 123:b0220dba8be7 905 }
Kojto 123:b0220dba8be7 906
Kojto 123:b0220dba8be7 907 /*
Kojto 123:b0220dba8be7 908 * @brief C custom defined SHSAX for M3 and M0 processors
Kojto 123:b0220dba8be7 909 */
Kojto 123:b0220dba8be7 910 static __INLINE q31_t __SHSAX(
Kojto 123:b0220dba8be7 911 q31_t x,
Kojto 123:b0220dba8be7 912 q31_t y)
Kojto 123:b0220dba8be7 913 {
Kojto 123:b0220dba8be7 914
Kojto 123:b0220dba8be7 915 q31_t sum;
Kojto 123:b0220dba8be7 916 q31_t r, s;
Kojto 123:b0220dba8be7 917
Kojto 123:b0220dba8be7 918 r = (q15_t) x;
Kojto 123:b0220dba8be7 919 s = (q15_t) y;
Kojto 123:b0220dba8be7 920
Kojto 123:b0220dba8be7 921 r = ((r >> 1) + (y >> 17));
Kojto 123:b0220dba8be7 922 s = (((x >> 17) - (s >> 1)) << 16);
Kojto 123:b0220dba8be7 923
Kojto 123:b0220dba8be7 924 sum = (s & 0xFFFF0000) | (r & 0x0000FFFF);
Kojto 123:b0220dba8be7 925
Kojto 123:b0220dba8be7 926 return sum;
Kojto 123:b0220dba8be7 927 }
Kojto 123:b0220dba8be7 928
Kojto 123:b0220dba8be7 929 /*
Kojto 123:b0220dba8be7 930 * @brief C custom defined SMUSDX for M3 and M0 processors
Kojto 123:b0220dba8be7 931 */
Kojto 123:b0220dba8be7 932 static __INLINE q31_t __SMUSDX(
Kojto 123:b0220dba8be7 933 q31_t x,
Kojto 123:b0220dba8be7 934 q31_t y)
Kojto 123:b0220dba8be7 935 {
Kojto 123:b0220dba8be7 936
Kojto 123:b0220dba8be7 937 return ((q31_t) (((q15_t) x * (q15_t) (y >> 16)) -
Kojto 123:b0220dba8be7 938 ((q15_t) (x >> 16) * (q15_t) y)));
Kojto 123:b0220dba8be7 939 }
Kojto 123:b0220dba8be7 940
Kojto 123:b0220dba8be7 941 /*
Kojto 123:b0220dba8be7 942 * @brief C custom defined SMUADX for M3 and M0 processors
Kojto 123:b0220dba8be7 943 */
Kojto 123:b0220dba8be7 944 static __INLINE q31_t __SMUADX(
Kojto 123:b0220dba8be7 945 q31_t x,
Kojto 123:b0220dba8be7 946 q31_t y)
Kojto 123:b0220dba8be7 947 {
Kojto 123:b0220dba8be7 948
Kojto 123:b0220dba8be7 949 return ((q31_t) (((q15_t) x * (q15_t) (y >> 16)) +
Kojto 123:b0220dba8be7 950 ((q15_t) (x >> 16) * (q15_t) y)));
Kojto 123:b0220dba8be7 951 }
Kojto 123:b0220dba8be7 952
Kojto 123:b0220dba8be7 953 /*
Kojto 123:b0220dba8be7 954 * @brief C custom defined QADD for M3 and M0 processors
Kojto 123:b0220dba8be7 955 */
Kojto 123:b0220dba8be7 956 static __INLINE q31_t __QADD(
Kojto 123:b0220dba8be7 957 q31_t x,
Kojto 123:b0220dba8be7 958 q31_t y)
Kojto 123:b0220dba8be7 959 {
Kojto 123:b0220dba8be7 960 return clip_q63_to_q31((q63_t) x + y);
Kojto 123:b0220dba8be7 961 }
Kojto 123:b0220dba8be7 962
Kojto 123:b0220dba8be7 963 /*
Kojto 123:b0220dba8be7 964 * @brief C custom defined QSUB for M3 and M0 processors
Kojto 123:b0220dba8be7 965 */
Kojto 123:b0220dba8be7 966 static __INLINE q31_t __QSUB(
Kojto 123:b0220dba8be7 967 q31_t x,
Kojto 123:b0220dba8be7 968 q31_t y)
Kojto 123:b0220dba8be7 969 {
Kojto 123:b0220dba8be7 970 return clip_q63_to_q31((q63_t) x - y);
Kojto 123:b0220dba8be7 971 }
Kojto 123:b0220dba8be7 972
Kojto 123:b0220dba8be7 973 /*
Kojto 123:b0220dba8be7 974 * @brief C custom defined SMLAD for M3 and M0 processors
Kojto 123:b0220dba8be7 975 */
Kojto 123:b0220dba8be7 976 static __INLINE q31_t __SMLAD(
Kojto 123:b0220dba8be7 977 q31_t x,
Kojto 123:b0220dba8be7 978 q31_t y,
Kojto 123:b0220dba8be7 979 q31_t sum)
Kojto 123:b0220dba8be7 980 {
Kojto 123:b0220dba8be7 981
Kojto 123:b0220dba8be7 982 return (sum + ((q15_t) (x >> 16) * (q15_t) (y >> 16)) +
Kojto 123:b0220dba8be7 983 ((q15_t) x * (q15_t) y));
Kojto 123:b0220dba8be7 984 }
Kojto 123:b0220dba8be7 985
Kojto 123:b0220dba8be7 986 /*
Kojto 123:b0220dba8be7 987 * @brief C custom defined SMLADX for M3 and M0 processors
Kojto 123:b0220dba8be7 988 */
Kojto 123:b0220dba8be7 989 static __INLINE q31_t __SMLADX(
Kojto 123:b0220dba8be7 990 q31_t x,
Kojto 123:b0220dba8be7 991 q31_t y,
Kojto 123:b0220dba8be7 992 q31_t sum)
Kojto 123:b0220dba8be7 993 {
Kojto 123:b0220dba8be7 994
Kojto 123:b0220dba8be7 995 return (sum + ((q15_t) (x >> 16) * (q15_t) (y)) +
Kojto 123:b0220dba8be7 996 ((q15_t) x * (q15_t) (y >> 16)));
Kojto 123:b0220dba8be7 997 }
Kojto 123:b0220dba8be7 998
Kojto 123:b0220dba8be7 999 /*
Kojto 123:b0220dba8be7 1000 * @brief C custom defined SMLSDX for M3 and M0 processors
Kojto 123:b0220dba8be7 1001 */
Kojto 123:b0220dba8be7 1002 static __INLINE q31_t __SMLSDX(
Kojto 123:b0220dba8be7 1003 q31_t x,
Kojto 123:b0220dba8be7 1004 q31_t y,
Kojto 123:b0220dba8be7 1005 q31_t sum)
Kojto 123:b0220dba8be7 1006 {
Kojto 123:b0220dba8be7 1007
Kojto 123:b0220dba8be7 1008 return (sum - ((q15_t) (x >> 16) * (q15_t) (y)) +
Kojto 123:b0220dba8be7 1009 ((q15_t) x * (q15_t) (y >> 16)));
Kojto 123:b0220dba8be7 1010 }
Kojto 123:b0220dba8be7 1011
Kojto 123:b0220dba8be7 1012 /*
Kojto 123:b0220dba8be7 1013 * @brief C custom defined SMLALD for M3 and M0 processors
Kojto 123:b0220dba8be7 1014 */
Kojto 123:b0220dba8be7 1015 static __INLINE q63_t __SMLALD(
Kojto 123:b0220dba8be7 1016 q31_t x,
Kojto 123:b0220dba8be7 1017 q31_t y,
Kojto 123:b0220dba8be7 1018 q63_t sum)
Kojto 123:b0220dba8be7 1019 {
Kojto 123:b0220dba8be7 1020
Kojto 123:b0220dba8be7 1021 return (sum + ((q15_t) (x >> 16) * (q15_t) (y >> 16)) +
Kojto 123:b0220dba8be7 1022 ((q15_t) x * (q15_t) y));
Kojto 123:b0220dba8be7 1023 }
Kojto 123:b0220dba8be7 1024
Kojto 123:b0220dba8be7 1025 /*
Kojto 123:b0220dba8be7 1026 * @brief C custom defined SMLALDX for M3 and M0 processors
Kojto 123:b0220dba8be7 1027 */
Kojto 123:b0220dba8be7 1028 static __INLINE q63_t __SMLALDX(
Kojto 123:b0220dba8be7 1029 q31_t x,
Kojto 123:b0220dba8be7 1030 q31_t y,
Kojto 123:b0220dba8be7 1031 q63_t sum)
Kojto 123:b0220dba8be7 1032 {
Kojto 123:b0220dba8be7 1033
Kojto 123:b0220dba8be7 1034 return (sum + ((q15_t) (x >> 16) * (q15_t) y)) +
Kojto 123:b0220dba8be7 1035 ((q15_t) x * (q15_t) (y >> 16));
Kojto 123:b0220dba8be7 1036 }
Kojto 123:b0220dba8be7 1037
Kojto 123:b0220dba8be7 1038 /*
Kojto 123:b0220dba8be7 1039 * @brief C custom defined SMUAD for M3 and M0 processors
Kojto 123:b0220dba8be7 1040 */
Kojto 123:b0220dba8be7 1041 static __INLINE q31_t __SMUAD(
Kojto 123:b0220dba8be7 1042 q31_t x,
Kojto 123:b0220dba8be7 1043 q31_t y)
Kojto 123:b0220dba8be7 1044 {
Kojto 123:b0220dba8be7 1045
Kojto 123:b0220dba8be7 1046 return (((x >> 16) * (y >> 16)) +
Kojto 123:b0220dba8be7 1047 (((x << 16) >> 16) * ((y << 16) >> 16)));
Kojto 123:b0220dba8be7 1048 }
Kojto 123:b0220dba8be7 1049
Kojto 123:b0220dba8be7 1050 /*
Kojto 123:b0220dba8be7 1051 * @brief C custom defined SMUSD for M3 and M0 processors
Kojto 123:b0220dba8be7 1052 */
Kojto 123:b0220dba8be7 1053 static __INLINE q31_t __SMUSD(
Kojto 123:b0220dba8be7 1054 q31_t x,
Kojto 123:b0220dba8be7 1055 q31_t y)
Kojto 123:b0220dba8be7 1056 {
Kojto 123:b0220dba8be7 1057
Kojto 123:b0220dba8be7 1058 return (-((x >> 16) * (y >> 16)) +
Kojto 123:b0220dba8be7 1059 (((x << 16) >> 16) * ((y << 16) >> 16)));
Kojto 123:b0220dba8be7 1060 }
Kojto 123:b0220dba8be7 1061
Kojto 123:b0220dba8be7 1062
Kojto 123:b0220dba8be7 1063 /*
Kojto 123:b0220dba8be7 1064 * @brief C custom defined SXTB16 for M3 and M0 processors
Kojto 123:b0220dba8be7 1065 */
Kojto 123:b0220dba8be7 1066 static __INLINE q31_t __SXTB16(
Kojto 123:b0220dba8be7 1067 q31_t x)
Kojto 123:b0220dba8be7 1068 {
Kojto 123:b0220dba8be7 1069
Kojto 123:b0220dba8be7 1070 return ((((x << 24) >> 24) & 0x0000FFFF) |
Kojto 123:b0220dba8be7 1071 (((x << 8) >> 8) & 0xFFFF0000));
Kojto 123:b0220dba8be7 1072 }
Kojto 123:b0220dba8be7 1073
Kojto 123:b0220dba8be7 1074
Kojto 123:b0220dba8be7 1075 #endif /* defined (ARM_MATH_CM3) || defined (ARM_MATH_CM0_FAMILY) */
Kojto 123:b0220dba8be7 1076
Kojto 123:b0220dba8be7 1077
Kojto 123:b0220dba8be7 1078 /**
Kojto 123:b0220dba8be7 1079 * @brief Instance structure for the Q7 FIR filter.
Kojto 123:b0220dba8be7 1080 */
Kojto 123:b0220dba8be7 1081 typedef struct
Kojto 123:b0220dba8be7 1082 {
Kojto 123:b0220dba8be7 1083 uint16_t numTaps; /**< number of filter coefficients in the filter. */
Kojto 123:b0220dba8be7 1084 q7_t *pState; /**< points to the state variable array. The array is of length numTaps+blockSize-1. */
Kojto 123:b0220dba8be7 1085 q7_t *pCoeffs; /**< points to the coefficient array. The array is of length numTaps.*/
Kojto 123:b0220dba8be7 1086 } arm_fir_instance_q7;
Kojto 123:b0220dba8be7 1087
Kojto 123:b0220dba8be7 1088 /**
Kojto 123:b0220dba8be7 1089 * @brief Instance structure for the Q15 FIR filter.
Kojto 123:b0220dba8be7 1090 */
Kojto 123:b0220dba8be7 1091 typedef struct
Kojto 123:b0220dba8be7 1092 {
Kojto 123:b0220dba8be7 1093 uint16_t numTaps; /**< number of filter coefficients in the filter. */
Kojto 123:b0220dba8be7 1094 q15_t *pState; /**< points to the state variable array. The array is of length numTaps+blockSize-1. */
Kojto 123:b0220dba8be7 1095 q15_t *pCoeffs; /**< points to the coefficient array. The array is of length numTaps.*/
Kojto 123:b0220dba8be7 1096 } arm_fir_instance_q15;
Kojto 123:b0220dba8be7 1097
Kojto 123:b0220dba8be7 1098 /**
Kojto 123:b0220dba8be7 1099 * @brief Instance structure for the Q31 FIR filter.
Kojto 123:b0220dba8be7 1100 */
Kojto 123:b0220dba8be7 1101 typedef struct
Kojto 123:b0220dba8be7 1102 {
Kojto 123:b0220dba8be7 1103 uint16_t numTaps; /**< number of filter coefficients in the filter. */
Kojto 123:b0220dba8be7 1104 q31_t *pState; /**< points to the state variable array. The array is of length numTaps+blockSize-1. */
Kojto 123:b0220dba8be7 1105 q31_t *pCoeffs; /**< points to the coefficient array. The array is of length numTaps. */
Kojto 123:b0220dba8be7 1106 } arm_fir_instance_q31;
Kojto 123:b0220dba8be7 1107
Kojto 123:b0220dba8be7 1108 /**
Kojto 123:b0220dba8be7 1109 * @brief Instance structure for the floating-point FIR filter.
Kojto 123:b0220dba8be7 1110 */
Kojto 123:b0220dba8be7 1111 typedef struct
Kojto 123:b0220dba8be7 1112 {
Kojto 123:b0220dba8be7 1113 uint16_t numTaps; /**< number of filter coefficients in the filter. */
Kojto 123:b0220dba8be7 1114 float32_t *pState; /**< points to the state variable array. The array is of length numTaps+blockSize-1. */
Kojto 123:b0220dba8be7 1115 float32_t *pCoeffs; /**< points to the coefficient array. The array is of length numTaps. */
Kojto 123:b0220dba8be7 1116 } arm_fir_instance_f32;
Kojto 123:b0220dba8be7 1117
Kojto 123:b0220dba8be7 1118
Kojto 123:b0220dba8be7 1119 /**
Kojto 123:b0220dba8be7 1120 * @brief Processing function for the Q7 FIR filter.
Kojto 123:b0220dba8be7 1121 * @param[in] *S points to an instance of the Q7 FIR filter structure.
Kojto 123:b0220dba8be7 1122 * @param[in] *pSrc points to the block of input data.
Kojto 123:b0220dba8be7 1123 * @param[out] *pDst points to the block of output data.
Kojto 123:b0220dba8be7 1124 * @param[in] blockSize number of samples to process.
Kojto 123:b0220dba8be7 1125 * @return none.
Kojto 123:b0220dba8be7 1126 */
Kojto 123:b0220dba8be7 1127 void arm_fir_q7(
Kojto 123:b0220dba8be7 1128 const arm_fir_instance_q7 * S,
Kojto 123:b0220dba8be7 1129 q7_t * pSrc,
Kojto 123:b0220dba8be7 1130 q7_t * pDst,
Kojto 123:b0220dba8be7 1131 uint32_t blockSize);
Kojto 123:b0220dba8be7 1132
Kojto 123:b0220dba8be7 1133
Kojto 123:b0220dba8be7 1134 /**
Kojto 123:b0220dba8be7 1135 * @brief Initialization function for the Q7 FIR filter.
Kojto 123:b0220dba8be7 1136 * @param[in,out] *S points to an instance of the Q7 FIR structure.
Kojto 123:b0220dba8be7 1137 * @param[in] numTaps Number of filter coefficients in the filter.
Kojto 123:b0220dba8be7 1138 * @param[in] *pCoeffs points to the filter coefficients.
Kojto 123:b0220dba8be7 1139 * @param[in] *pState points to the state buffer.
Kojto 123:b0220dba8be7 1140 * @param[in] blockSize number of samples that are processed.
Kojto 123:b0220dba8be7 1141 * @return none
Kojto 123:b0220dba8be7 1142 */
Kojto 123:b0220dba8be7 1143 void arm_fir_init_q7(
Kojto 123:b0220dba8be7 1144 arm_fir_instance_q7 * S,
Kojto 123:b0220dba8be7 1145 uint16_t numTaps,
Kojto 123:b0220dba8be7 1146 q7_t * pCoeffs,
Kojto 123:b0220dba8be7 1147 q7_t * pState,
Kojto 123:b0220dba8be7 1148 uint32_t blockSize);
Kojto 123:b0220dba8be7 1149
Kojto 123:b0220dba8be7 1150
Kojto 123:b0220dba8be7 1151 /**
Kojto 123:b0220dba8be7 1152 * @brief Processing function for the Q15 FIR filter.
Kojto 123:b0220dba8be7 1153 * @param[in] *S points to an instance of the Q15 FIR structure.
Kojto 123:b0220dba8be7 1154 * @param[in] *pSrc points to the block of input data.
Kojto 123:b0220dba8be7 1155 * @param[out] *pDst points to the block of output data.
Kojto 123:b0220dba8be7 1156 * @param[in] blockSize number of samples to process.
Kojto 123:b0220dba8be7 1157 * @return none.
Kojto 123:b0220dba8be7 1158 */
Kojto 123:b0220dba8be7 1159 void arm_fir_q15(
Kojto 123:b0220dba8be7 1160 const arm_fir_instance_q15 * S,
Kojto 123:b0220dba8be7 1161 q15_t * pSrc,
Kojto 123:b0220dba8be7 1162 q15_t * pDst,
Kojto 123:b0220dba8be7 1163 uint32_t blockSize);
Kojto 123:b0220dba8be7 1164
Kojto 123:b0220dba8be7 1165 /**
Kojto 123:b0220dba8be7 1166 * @brief Processing function for the fast Q15 FIR filter for Cortex-M3 and Cortex-M4.
Kojto 123:b0220dba8be7 1167 * @param[in] *S points to an instance of the Q15 FIR filter structure.
Kojto 123:b0220dba8be7 1168 * @param[in] *pSrc points to the block of input data.
Kojto 123:b0220dba8be7 1169 * @param[out] *pDst points to the block of output data.
Kojto 123:b0220dba8be7 1170 * @param[in] blockSize number of samples to process.
Kojto 123:b0220dba8be7 1171 * @return none.
Kojto 123:b0220dba8be7 1172 */
Kojto 123:b0220dba8be7 1173 void arm_fir_fast_q15(
Kojto 123:b0220dba8be7 1174 const arm_fir_instance_q15 * S,
Kojto 123:b0220dba8be7 1175 q15_t * pSrc,
Kojto 123:b0220dba8be7 1176 q15_t * pDst,
Kojto 123:b0220dba8be7 1177 uint32_t blockSize);
Kojto 123:b0220dba8be7 1178
Kojto 123:b0220dba8be7 1179 /**
Kojto 123:b0220dba8be7 1180 * @brief Initialization function for the Q15 FIR filter.
Kojto 123:b0220dba8be7 1181 * @param[in,out] *S points to an instance of the Q15 FIR filter structure.
Kojto 123:b0220dba8be7 1182 * @param[in] numTaps Number of filter coefficients in the filter. Must be even and greater than or equal to 4.
Kojto 123:b0220dba8be7 1183 * @param[in] *pCoeffs points to the filter coefficients.
Kojto 123:b0220dba8be7 1184 * @param[in] *pState points to the state buffer.
Kojto 123:b0220dba8be7 1185 * @param[in] blockSize number of samples that are processed at a time.
Kojto 123:b0220dba8be7 1186 * @return The function returns ARM_MATH_SUCCESS if initialization was successful or ARM_MATH_ARGUMENT_ERROR if
Kojto 123:b0220dba8be7 1187 * <code>numTaps</code> is not a supported value.
Kojto 123:b0220dba8be7 1188 */
Kojto 123:b0220dba8be7 1189
Kojto 123:b0220dba8be7 1190 arm_status arm_fir_init_q15(
Kojto 123:b0220dba8be7 1191 arm_fir_instance_q15 * S,
Kojto 123:b0220dba8be7 1192 uint16_t numTaps,
Kojto 123:b0220dba8be7 1193 q15_t * pCoeffs,
Kojto 123:b0220dba8be7 1194 q15_t * pState,
Kojto 123:b0220dba8be7 1195 uint32_t blockSize);
Kojto 123:b0220dba8be7 1196
Kojto 123:b0220dba8be7 1197 /**
Kojto 123:b0220dba8be7 1198 * @brief Processing function for the Q31 FIR filter.
Kojto 123:b0220dba8be7 1199 * @param[in] *S points to an instance of the Q31 FIR filter structure.
Kojto 123:b0220dba8be7 1200 * @param[in] *pSrc points to the block of input data.
Kojto 123:b0220dba8be7 1201 * @param[out] *pDst points to the block of output data.
Kojto 123:b0220dba8be7 1202 * @param[in] blockSize number of samples to process.
Kojto 123:b0220dba8be7 1203 * @return none.
Kojto 123:b0220dba8be7 1204 */
Kojto 123:b0220dba8be7 1205 void arm_fir_q31(
Kojto 123:b0220dba8be7 1206 const arm_fir_instance_q31 * S,
Kojto 123:b0220dba8be7 1207 q31_t * pSrc,
Kojto 123:b0220dba8be7 1208 q31_t * pDst,
Kojto 123:b0220dba8be7 1209 uint32_t blockSize);
Kojto 123:b0220dba8be7 1210
Kojto 123:b0220dba8be7 1211 /**
Kojto 123:b0220dba8be7 1212 * @brief Processing function for the fast Q31 FIR filter for Cortex-M3 and Cortex-M4.
Kojto 123:b0220dba8be7 1213 * @param[in] *S points to an instance of the Q31 FIR structure.
Kojto 123:b0220dba8be7 1214 * @param[in] *pSrc points to the block of input data.
Kojto 123:b0220dba8be7 1215 * @param[out] *pDst points to the block of output data.
Kojto 123:b0220dba8be7 1216 * @param[in] blockSize number of samples to process.
Kojto 123:b0220dba8be7 1217 * @return none.
Kojto 123:b0220dba8be7 1218 */
Kojto 123:b0220dba8be7 1219 void arm_fir_fast_q31(
Kojto 123:b0220dba8be7 1220 const arm_fir_instance_q31 * S,
Kojto 123:b0220dba8be7 1221 q31_t * pSrc,
Kojto 123:b0220dba8be7 1222 q31_t * pDst,
Kojto 123:b0220dba8be7 1223 uint32_t blockSize);
Kojto 123:b0220dba8be7 1224
Kojto 123:b0220dba8be7 1225 /**
Kojto 123:b0220dba8be7 1226 * @brief Initialization function for the Q31 FIR filter.
Kojto 123:b0220dba8be7 1227 * @param[in,out] *S points to an instance of the Q31 FIR structure.
Kojto 123:b0220dba8be7 1228 * @param[in] numTaps Number of filter coefficients in the filter.
Kojto 123:b0220dba8be7 1229 * @param[in] *pCoeffs points to the filter coefficients.
Kojto 123:b0220dba8be7 1230 * @param[in] *pState points to the state buffer.
Kojto 123:b0220dba8be7 1231 * @param[in] blockSize number of samples that are processed at a time.
Kojto 123:b0220dba8be7 1232 * @return none.
Kojto 123:b0220dba8be7 1233 */
Kojto 123:b0220dba8be7 1234 void arm_fir_init_q31(
Kojto 123:b0220dba8be7 1235 arm_fir_instance_q31 * S,
Kojto 123:b0220dba8be7 1236 uint16_t numTaps,
Kojto 123:b0220dba8be7 1237 q31_t * pCoeffs,
Kojto 123:b0220dba8be7 1238 q31_t * pState,
Kojto 123:b0220dba8be7 1239 uint32_t blockSize);
Kojto 123:b0220dba8be7 1240
Kojto 123:b0220dba8be7 1241 /**
Kojto 123:b0220dba8be7 1242 * @brief Processing function for the floating-point FIR filter.
Kojto 123:b0220dba8be7 1243 * @param[in] *S points to an instance of the floating-point FIR structure.
Kojto 123:b0220dba8be7 1244 * @param[in] *pSrc points to the block of input data.
Kojto 123:b0220dba8be7 1245 * @param[out] *pDst points to the block of output data.
Kojto 123:b0220dba8be7 1246 * @param[in] blockSize number of samples to process.
Kojto 123:b0220dba8be7 1247 * @return none.
Kojto 123:b0220dba8be7 1248 */
Kojto 123:b0220dba8be7 1249 void arm_fir_f32(
Kojto 123:b0220dba8be7 1250 const arm_fir_instance_f32 * S,
Kojto 123:b0220dba8be7 1251 float32_t * pSrc,
Kojto 123:b0220dba8be7 1252 float32_t * pDst,
Kojto 123:b0220dba8be7 1253 uint32_t blockSize);
Kojto 123:b0220dba8be7 1254
Kojto 123:b0220dba8be7 1255 /**
Kojto 123:b0220dba8be7 1256 * @brief Initialization function for the floating-point FIR filter.
Kojto 123:b0220dba8be7 1257 * @param[in,out] *S points to an instance of the floating-point FIR filter structure.
Kojto 123:b0220dba8be7 1258 * @param[in] numTaps Number of filter coefficients in the filter.
Kojto 123:b0220dba8be7 1259 * @param[in] *pCoeffs points to the filter coefficients.
Kojto 123:b0220dba8be7 1260 * @param[in] *pState points to the state buffer.
Kojto 123:b0220dba8be7 1261 * @param[in] blockSize number of samples that are processed at a time.
Kojto 123:b0220dba8be7 1262 * @return none.
Kojto 123:b0220dba8be7 1263 */
Kojto 123:b0220dba8be7 1264 void arm_fir_init_f32(
Kojto 123:b0220dba8be7 1265 arm_fir_instance_f32 * S,
Kojto 123:b0220dba8be7 1266 uint16_t numTaps,
Kojto 123:b0220dba8be7 1267 float32_t * pCoeffs,
Kojto 123:b0220dba8be7 1268 float32_t * pState,
Kojto 123:b0220dba8be7 1269 uint32_t blockSize);
Kojto 123:b0220dba8be7 1270
Kojto 123:b0220dba8be7 1271
Kojto 123:b0220dba8be7 1272 /**
Kojto 123:b0220dba8be7 1273 * @brief Instance structure for the Q15 Biquad cascade filter.
Kojto 123:b0220dba8be7 1274 */
Kojto 123:b0220dba8be7 1275 typedef struct
Kojto 123:b0220dba8be7 1276 {
Kojto 123:b0220dba8be7 1277 int8_t numStages; /**< number of 2nd order stages in the filter. Overall order is 2*numStages. */
Kojto 123:b0220dba8be7 1278 q15_t *pState; /**< Points to the array of state coefficients. The array is of length 4*numStages. */
Kojto 123:b0220dba8be7 1279 q15_t *pCoeffs; /**< Points to the array of coefficients. The array is of length 5*numStages. */
Kojto 123:b0220dba8be7 1280 int8_t postShift; /**< Additional shift, in bits, applied to each output sample. */
Kojto 123:b0220dba8be7 1281
Kojto 123:b0220dba8be7 1282 } arm_biquad_casd_df1_inst_q15;
Kojto 123:b0220dba8be7 1283
Kojto 123:b0220dba8be7 1284
Kojto 123:b0220dba8be7 1285 /**
Kojto 123:b0220dba8be7 1286 * @brief Instance structure for the Q31 Biquad cascade filter.
Kojto 123:b0220dba8be7 1287 */
Kojto 123:b0220dba8be7 1288 typedef struct
Kojto 123:b0220dba8be7 1289 {
Kojto 123:b0220dba8be7 1290 uint32_t numStages; /**< number of 2nd order stages in the filter. Overall order is 2*numStages. */
Kojto 123:b0220dba8be7 1291 q31_t *pState; /**< Points to the array of state coefficients. The array is of length 4*numStages. */
Kojto 123:b0220dba8be7 1292 q31_t *pCoeffs; /**< Points to the array of coefficients. The array is of length 5*numStages. */
Kojto 123:b0220dba8be7 1293 uint8_t postShift; /**< Additional shift, in bits, applied to each output sample. */
Kojto 123:b0220dba8be7 1294
Kojto 123:b0220dba8be7 1295 } arm_biquad_casd_df1_inst_q31;
Kojto 123:b0220dba8be7 1296
Kojto 123:b0220dba8be7 1297 /**
Kojto 123:b0220dba8be7 1298 * @brief Instance structure for the floating-point Biquad cascade filter.
Kojto 123:b0220dba8be7 1299 */
Kojto 123:b0220dba8be7 1300 typedef struct
Kojto 123:b0220dba8be7 1301 {
Kojto 123:b0220dba8be7 1302 uint32_t numStages; /**< number of 2nd order stages in the filter. Overall order is 2*numStages. */
Kojto 123:b0220dba8be7 1303 float32_t *pState; /**< Points to the array of state coefficients. The array is of length 4*numStages. */
Kojto 123:b0220dba8be7 1304 float32_t *pCoeffs; /**< Points to the array of coefficients. The array is of length 5*numStages. */
Kojto 123:b0220dba8be7 1305
Kojto 123:b0220dba8be7 1306
Kojto 123:b0220dba8be7 1307 } arm_biquad_casd_df1_inst_f32;
Kojto 123:b0220dba8be7 1308
Kojto 123:b0220dba8be7 1309
Kojto 123:b0220dba8be7 1310
Kojto 123:b0220dba8be7 1311 /**
Kojto 123:b0220dba8be7 1312 * @brief Processing function for the Q15 Biquad cascade filter.
Kojto 123:b0220dba8be7 1313 * @param[in] *S points to an instance of the Q15 Biquad cascade structure.
Kojto 123:b0220dba8be7 1314 * @param[in] *pSrc points to the block of input data.
Kojto 123:b0220dba8be7 1315 * @param[out] *pDst points to the block of output data.
Kojto 123:b0220dba8be7 1316 * @param[in] blockSize number of samples to process.
Kojto 123:b0220dba8be7 1317 * @return none.
Kojto 123:b0220dba8be7 1318 */
Kojto 123:b0220dba8be7 1319
Kojto 123:b0220dba8be7 1320 void arm_biquad_cascade_df1_q15(
Kojto 123:b0220dba8be7 1321 const arm_biquad_casd_df1_inst_q15 * S,
Kojto 123:b0220dba8be7 1322 q15_t * pSrc,
Kojto 123:b0220dba8be7 1323 q15_t * pDst,
Kojto 123:b0220dba8be7 1324 uint32_t blockSize);
Kojto 123:b0220dba8be7 1325
Kojto 123:b0220dba8be7 1326 /**
Kojto 123:b0220dba8be7 1327 * @brief Initialization function for the Q15 Biquad cascade filter.
Kojto 123:b0220dba8be7 1328 * @param[in,out] *S points to an instance of the Q15 Biquad cascade structure.
Kojto 123:b0220dba8be7 1329 * @param[in] numStages number of 2nd order stages in the filter.
Kojto 123:b0220dba8be7 1330 * @param[in] *pCoeffs points to the filter coefficients.
Kojto 123:b0220dba8be7 1331 * @param[in] *pState points to the state buffer.
Kojto 123:b0220dba8be7 1332 * @param[in] postShift Shift to be applied to the output. Varies according to the coefficients format
Kojto 123:b0220dba8be7 1333 * @return none
Kojto 123:b0220dba8be7 1334 */
Kojto 123:b0220dba8be7 1335
Kojto 123:b0220dba8be7 1336 void arm_biquad_cascade_df1_init_q15(
Kojto 123:b0220dba8be7 1337 arm_biquad_casd_df1_inst_q15 * S,
Kojto 123:b0220dba8be7 1338 uint8_t numStages,
Kojto 123:b0220dba8be7 1339 q15_t * pCoeffs,
Kojto 123:b0220dba8be7 1340 q15_t * pState,
Kojto 123:b0220dba8be7 1341 int8_t postShift);
Kojto 123:b0220dba8be7 1342
Kojto 123:b0220dba8be7 1343
Kojto 123:b0220dba8be7 1344 /**
Kojto 123:b0220dba8be7 1345 * @brief Fast but less precise processing function for the Q15 Biquad cascade filter for Cortex-M3 and Cortex-M4.
Kojto 123:b0220dba8be7 1346 * @param[in] *S points to an instance of the Q15 Biquad cascade structure.
Kojto 123:b0220dba8be7 1347 * @param[in] *pSrc points to the block of input data.
Kojto 123:b0220dba8be7 1348 * @param[out] *pDst points to the block of output data.
Kojto 123:b0220dba8be7 1349 * @param[in] blockSize number of samples to process.
Kojto 123:b0220dba8be7 1350 * @return none.
Kojto 123:b0220dba8be7 1351 */
Kojto 123:b0220dba8be7 1352
Kojto 123:b0220dba8be7 1353 void arm_biquad_cascade_df1_fast_q15(
Kojto 123:b0220dba8be7 1354 const arm_biquad_casd_df1_inst_q15 * S,
Kojto 123:b0220dba8be7 1355 q15_t * pSrc,
Kojto 123:b0220dba8be7 1356 q15_t * pDst,
Kojto 123:b0220dba8be7 1357 uint32_t blockSize);
Kojto 123:b0220dba8be7 1358
Kojto 123:b0220dba8be7 1359
Kojto 123:b0220dba8be7 1360 /**
Kojto 123:b0220dba8be7 1361 * @brief Processing function for the Q31 Biquad cascade filter
Kojto 123:b0220dba8be7 1362 * @param[in] *S points to an instance of the Q31 Biquad cascade structure.
Kojto 123:b0220dba8be7 1363 * @param[in] *pSrc points to the block of input data.
Kojto 123:b0220dba8be7 1364 * @param[out] *pDst points to the block of output data.
Kojto 123:b0220dba8be7 1365 * @param[in] blockSize number of samples to process.
Kojto 123:b0220dba8be7 1366 * @return none.
Kojto 123:b0220dba8be7 1367 */
Kojto 123:b0220dba8be7 1368
Kojto 123:b0220dba8be7 1369 void arm_biquad_cascade_df1_q31(
Kojto 123:b0220dba8be7 1370 const arm_biquad_casd_df1_inst_q31 * S,
Kojto 123:b0220dba8be7 1371 q31_t * pSrc,
Kojto 123:b0220dba8be7 1372 q31_t * pDst,
Kojto 123:b0220dba8be7 1373 uint32_t blockSize);
Kojto 123:b0220dba8be7 1374
Kojto 123:b0220dba8be7 1375 /**
Kojto 123:b0220dba8be7 1376 * @brief Fast but less precise processing function for the Q31 Biquad cascade filter for Cortex-M3 and Cortex-M4.
Kojto 123:b0220dba8be7 1377 * @param[in] *S points to an instance of the Q31 Biquad cascade structure.
Kojto 123:b0220dba8be7 1378 * @param[in] *pSrc points to the block of input data.
Kojto 123:b0220dba8be7 1379 * @param[out] *pDst points to the block of output data.
Kojto 123:b0220dba8be7 1380 * @param[in] blockSize number of samples to process.
Kojto 123:b0220dba8be7 1381 * @return none.
Kojto 123:b0220dba8be7 1382 */
Kojto 123:b0220dba8be7 1383
Kojto 123:b0220dba8be7 1384 void arm_biquad_cascade_df1_fast_q31(
Kojto 123:b0220dba8be7 1385 const arm_biquad_casd_df1_inst_q31 * S,
Kojto 123:b0220dba8be7 1386 q31_t * pSrc,
Kojto 123:b0220dba8be7 1387 q31_t * pDst,
Kojto 123:b0220dba8be7 1388 uint32_t blockSize);
Kojto 123:b0220dba8be7 1389
Kojto 123:b0220dba8be7 1390 /**
Kojto 123:b0220dba8be7 1391 * @brief Initialization function for the Q31 Biquad cascade filter.
Kojto 123:b0220dba8be7 1392 * @param[in,out] *S points to an instance of the Q31 Biquad cascade structure.
Kojto 123:b0220dba8be7 1393 * @param[in] numStages number of 2nd order stages in the filter.
Kojto 123:b0220dba8be7 1394 * @param[in] *pCoeffs points to the filter coefficients.
Kojto 123:b0220dba8be7 1395 * @param[in] *pState points to the state buffer.
Kojto 123:b0220dba8be7 1396 * @param[in] postShift Shift to be applied to the output. Varies according to the coefficients format
Kojto 123:b0220dba8be7 1397 * @return none
Kojto 123:b0220dba8be7 1398 */
Kojto 123:b0220dba8be7 1399
Kojto 123:b0220dba8be7 1400 void arm_biquad_cascade_df1_init_q31(
Kojto 123:b0220dba8be7 1401 arm_biquad_casd_df1_inst_q31 * S,
Kojto 123:b0220dba8be7 1402 uint8_t numStages,
Kojto 123:b0220dba8be7 1403 q31_t * pCoeffs,
Kojto 123:b0220dba8be7 1404 q31_t * pState,
Kojto 123:b0220dba8be7 1405 int8_t postShift);
Kojto 123:b0220dba8be7 1406
Kojto 123:b0220dba8be7 1407 /**
Kojto 123:b0220dba8be7 1408 * @brief Processing function for the floating-point Biquad cascade filter.
Kojto 123:b0220dba8be7 1409 * @param[in] *S points to an instance of the floating-point Biquad cascade structure.
Kojto 123:b0220dba8be7 1410 * @param[in] *pSrc points to the block of input data.
Kojto 123:b0220dba8be7 1411 * @param[out] *pDst points to the block of output data.
Kojto 123:b0220dba8be7 1412 * @param[in] blockSize number of samples to process.
Kojto 123:b0220dba8be7 1413 * @return none.
Kojto 123:b0220dba8be7 1414 */
Kojto 123:b0220dba8be7 1415
Kojto 123:b0220dba8be7 1416 void arm_biquad_cascade_df1_f32(
Kojto 123:b0220dba8be7 1417 const arm_biquad_casd_df1_inst_f32 * S,
Kojto 123:b0220dba8be7 1418 float32_t * pSrc,
Kojto 123:b0220dba8be7 1419 float32_t * pDst,
Kojto 123:b0220dba8be7 1420 uint32_t blockSize);
Kojto 123:b0220dba8be7 1421
Kojto 123:b0220dba8be7 1422 /**
Kojto 123:b0220dba8be7 1423 * @brief Initialization function for the floating-point Biquad cascade filter.
Kojto 123:b0220dba8be7 1424 * @param[in,out] *S points to an instance of the floating-point Biquad cascade structure.
Kojto 123:b0220dba8be7 1425 * @param[in] numStages number of 2nd order stages in the filter.
Kojto 123:b0220dba8be7 1426 * @param[in] *pCoeffs points to the filter coefficients.
Kojto 123:b0220dba8be7 1427 * @param[in] *pState points to the state buffer.
Kojto 123:b0220dba8be7 1428 * @return none
Kojto 123:b0220dba8be7 1429 */
Kojto 123:b0220dba8be7 1430
Kojto 123:b0220dba8be7 1431 void arm_biquad_cascade_df1_init_f32(
Kojto 123:b0220dba8be7 1432 arm_biquad_casd_df1_inst_f32 * S,
Kojto 123:b0220dba8be7 1433 uint8_t numStages,
Kojto 123:b0220dba8be7 1434 float32_t * pCoeffs,
Kojto 123:b0220dba8be7 1435 float32_t * pState);
Kojto 123:b0220dba8be7 1436
Kojto 123:b0220dba8be7 1437
Kojto 123:b0220dba8be7 1438 /**
Kojto 123:b0220dba8be7 1439 * @brief Instance structure for the floating-point matrix structure.
Kojto 123:b0220dba8be7 1440 */
Kojto 123:b0220dba8be7 1441
Kojto 123:b0220dba8be7 1442 typedef struct
Kojto 123:b0220dba8be7 1443 {
Kojto 123:b0220dba8be7 1444 uint16_t numRows; /**< number of rows of the matrix. */
Kojto 123:b0220dba8be7 1445 uint16_t numCols; /**< number of columns of the matrix. */
Kojto 123:b0220dba8be7 1446 float32_t *pData; /**< points to the data of the matrix. */
Kojto 123:b0220dba8be7 1447 } arm_matrix_instance_f32;
Kojto 123:b0220dba8be7 1448
Kojto 123:b0220dba8be7 1449
Kojto 123:b0220dba8be7 1450 /**
Kojto 123:b0220dba8be7 1451 * @brief Instance structure for the floating-point matrix structure.
Kojto 123:b0220dba8be7 1452 */
Kojto 123:b0220dba8be7 1453
Kojto 123:b0220dba8be7 1454 typedef struct
Kojto 123:b0220dba8be7 1455 {
Kojto 123:b0220dba8be7 1456 uint16_t numRows; /**< number of rows of the matrix. */
Kojto 123:b0220dba8be7 1457 uint16_t numCols; /**< number of columns of the matrix. */
Kojto 123:b0220dba8be7 1458 float64_t *pData; /**< points to the data of the matrix. */
Kojto 123:b0220dba8be7 1459 } arm_matrix_instance_f64;
Kojto 123:b0220dba8be7 1460
Kojto 123:b0220dba8be7 1461 /**
Kojto 123:b0220dba8be7 1462 * @brief Instance structure for the Q15 matrix structure.
Kojto 123:b0220dba8be7 1463 */
Kojto 123:b0220dba8be7 1464
Kojto 123:b0220dba8be7 1465 typedef struct
Kojto 123:b0220dba8be7 1466 {
Kojto 123:b0220dba8be7 1467 uint16_t numRows; /**< number of rows of the matrix. */
Kojto 123:b0220dba8be7 1468 uint16_t numCols; /**< number of columns of the matrix. */
Kojto 123:b0220dba8be7 1469 q15_t *pData; /**< points to the data of the matrix. */
Kojto 123:b0220dba8be7 1470
Kojto 123:b0220dba8be7 1471 } arm_matrix_instance_q15;
Kojto 123:b0220dba8be7 1472
Kojto 123:b0220dba8be7 1473 /**
Kojto 123:b0220dba8be7 1474 * @brief Instance structure for the Q31 matrix structure.
Kojto 123:b0220dba8be7 1475 */
Kojto 123:b0220dba8be7 1476
Kojto 123:b0220dba8be7 1477 typedef struct
Kojto 123:b0220dba8be7 1478 {
Kojto 123:b0220dba8be7 1479 uint16_t numRows; /**< number of rows of the matrix. */
Kojto 123:b0220dba8be7 1480 uint16_t numCols; /**< number of columns of the matrix. */
Kojto 123:b0220dba8be7 1481 q31_t *pData; /**< points to the data of the matrix. */
Kojto 123:b0220dba8be7 1482
Kojto 123:b0220dba8be7 1483 } arm_matrix_instance_q31;
Kojto 123:b0220dba8be7 1484
Kojto 123:b0220dba8be7 1485
Kojto 123:b0220dba8be7 1486
Kojto 123:b0220dba8be7 1487 /**
Kojto 123:b0220dba8be7 1488 * @brief Floating-point matrix addition.
Kojto 123:b0220dba8be7 1489 * @param[in] *pSrcA points to the first input matrix structure
Kojto 123:b0220dba8be7 1490 * @param[in] *pSrcB points to the second input matrix structure
Kojto 123:b0220dba8be7 1491 * @param[out] *pDst points to output matrix structure
Kojto 123:b0220dba8be7 1492 * @return The function returns either
Kojto 123:b0220dba8be7 1493 * <code>ARM_MATH_SIZE_MISMATCH</code> or <code>ARM_MATH_SUCCESS</code> based on the outcome of size checking.
Kojto 123:b0220dba8be7 1494 */
Kojto 123:b0220dba8be7 1495
Kojto 123:b0220dba8be7 1496 arm_status arm_mat_add_f32(
Kojto 123:b0220dba8be7 1497 const arm_matrix_instance_f32 * pSrcA,
Kojto 123:b0220dba8be7 1498 const arm_matrix_instance_f32 * pSrcB,
Kojto 123:b0220dba8be7 1499 arm_matrix_instance_f32 * pDst);
Kojto 123:b0220dba8be7 1500
Kojto 123:b0220dba8be7 1501 /**
Kojto 123:b0220dba8be7 1502 * @brief Q15 matrix addition.
Kojto 123:b0220dba8be7 1503 * @param[in] *pSrcA points to the first input matrix structure
Kojto 123:b0220dba8be7 1504 * @param[in] *pSrcB points to the second input matrix structure
Kojto 123:b0220dba8be7 1505 * @param[out] *pDst points to output matrix structure
Kojto 123:b0220dba8be7 1506 * @return The function returns either
Kojto 123:b0220dba8be7 1507 * <code>ARM_MATH_SIZE_MISMATCH</code> or <code>ARM_MATH_SUCCESS</code> based on the outcome of size checking.
Kojto 123:b0220dba8be7 1508 */
Kojto 123:b0220dba8be7 1509
Kojto 123:b0220dba8be7 1510 arm_status arm_mat_add_q15(
Kojto 123:b0220dba8be7 1511 const arm_matrix_instance_q15 * pSrcA,
Kojto 123:b0220dba8be7 1512 const arm_matrix_instance_q15 * pSrcB,
Kojto 123:b0220dba8be7 1513 arm_matrix_instance_q15 * pDst);
Kojto 123:b0220dba8be7 1514
Kojto 123:b0220dba8be7 1515 /**
Kojto 123:b0220dba8be7 1516 * @brief Q31 matrix addition.
Kojto 123:b0220dba8be7 1517 * @param[in] *pSrcA points to the first input matrix structure
Kojto 123:b0220dba8be7 1518 * @param[in] *pSrcB points to the second input matrix structure
Kojto 123:b0220dba8be7 1519 * @param[out] *pDst points to output matrix structure
Kojto 123:b0220dba8be7 1520 * @return The function returns either
Kojto 123:b0220dba8be7 1521 * <code>ARM_MATH_SIZE_MISMATCH</code> or <code>ARM_MATH_SUCCESS</code> based on the outcome of size checking.
Kojto 123:b0220dba8be7 1522 */
Kojto 123:b0220dba8be7 1523
Kojto 123:b0220dba8be7 1524 arm_status arm_mat_add_q31(
Kojto 123:b0220dba8be7 1525 const arm_matrix_instance_q31 * pSrcA,
Kojto 123:b0220dba8be7 1526 const arm_matrix_instance_q31 * pSrcB,
Kojto 123:b0220dba8be7 1527 arm_matrix_instance_q31 * pDst);
Kojto 123:b0220dba8be7 1528
Kojto 123:b0220dba8be7 1529 /**
Kojto 123:b0220dba8be7 1530 * @brief Floating-point, complex, matrix multiplication.
Kojto 123:b0220dba8be7 1531 * @param[in] *pSrcA points to the first input matrix structure
Kojto 123:b0220dba8be7 1532 * @param[in] *pSrcB points to the second input matrix structure
Kojto 123:b0220dba8be7 1533 * @param[out] *pDst points to output matrix structure
Kojto 123:b0220dba8be7 1534 * @return The function returns either
Kojto 123:b0220dba8be7 1535 * <code>ARM_MATH_SIZE_MISMATCH</code> or <code>ARM_MATH_SUCCESS</code> based on the outcome of size checking.
Kojto 123:b0220dba8be7 1536 */
Kojto 123:b0220dba8be7 1537
Kojto 123:b0220dba8be7 1538 arm_status arm_mat_cmplx_mult_f32(
Kojto 123:b0220dba8be7 1539 const arm_matrix_instance_f32 * pSrcA,
Kojto 123:b0220dba8be7 1540 const arm_matrix_instance_f32 * pSrcB,
Kojto 123:b0220dba8be7 1541 arm_matrix_instance_f32 * pDst);
Kojto 123:b0220dba8be7 1542
Kojto 123:b0220dba8be7 1543 /**
Kojto 123:b0220dba8be7 1544 * @brief Q15, complex, matrix multiplication.
Kojto 123:b0220dba8be7 1545 * @param[in] *pSrcA points to the first input matrix structure
Kojto 123:b0220dba8be7 1546 * @param[in] *pSrcB points to the second input matrix structure
Kojto 123:b0220dba8be7 1547 * @param[out] *pDst points to output matrix structure
Kojto 123:b0220dba8be7 1548 * @return The function returns either
Kojto 123:b0220dba8be7 1549 * <code>ARM_MATH_SIZE_MISMATCH</code> or <code>ARM_MATH_SUCCESS</code> based on the outcome of size checking.
Kojto 123:b0220dba8be7 1550 */
Kojto 123:b0220dba8be7 1551
Kojto 123:b0220dba8be7 1552 arm_status arm_mat_cmplx_mult_q15(
Kojto 123:b0220dba8be7 1553 const arm_matrix_instance_q15 * pSrcA,
Kojto 123:b0220dba8be7 1554 const arm_matrix_instance_q15 * pSrcB,
Kojto 123:b0220dba8be7 1555 arm_matrix_instance_q15 * pDst,
Kojto 123:b0220dba8be7 1556 q15_t * pScratch);
Kojto 123:b0220dba8be7 1557
Kojto 123:b0220dba8be7 1558 /**
Kojto 123:b0220dba8be7 1559 * @brief Q31, complex, matrix multiplication.
Kojto 123:b0220dba8be7 1560 * @param[in] *pSrcA points to the first input matrix structure
Kojto 123:b0220dba8be7 1561 * @param[in] *pSrcB points to the second input matrix structure
Kojto 123:b0220dba8be7 1562 * @param[out] *pDst points to output matrix structure
Kojto 123:b0220dba8be7 1563 * @return The function returns either
Kojto 123:b0220dba8be7 1564 * <code>ARM_MATH_SIZE_MISMATCH</code> or <code>ARM_MATH_SUCCESS</code> based on the outcome of size checking.
Kojto 123:b0220dba8be7 1565 */
Kojto 123:b0220dba8be7 1566
Kojto 123:b0220dba8be7 1567 arm_status arm_mat_cmplx_mult_q31(
Kojto 123:b0220dba8be7 1568 const arm_matrix_instance_q31 * pSrcA,
Kojto 123:b0220dba8be7 1569 const arm_matrix_instance_q31 * pSrcB,
Kojto 123:b0220dba8be7 1570 arm_matrix_instance_q31 * pDst);
Kojto 123:b0220dba8be7 1571
Kojto 123:b0220dba8be7 1572
Kojto 123:b0220dba8be7 1573 /**
Kojto 123:b0220dba8be7 1574 * @brief Floating-point matrix transpose.
Kojto 123:b0220dba8be7 1575 * @param[in] *pSrc points to the input matrix
Kojto 123:b0220dba8be7 1576 * @param[out] *pDst points to the output matrix
Kojto 123:b0220dba8be7 1577 * @return The function returns either <code>ARM_MATH_SIZE_MISMATCH</code>
Kojto 123:b0220dba8be7 1578 * or <code>ARM_MATH_SUCCESS</code> based on the outcome of size checking.
Kojto 123:b0220dba8be7 1579 */
Kojto 123:b0220dba8be7 1580
Kojto 123:b0220dba8be7 1581 arm_status arm_mat_trans_f32(
Kojto 123:b0220dba8be7 1582 const arm_matrix_instance_f32 * pSrc,
Kojto 123:b0220dba8be7 1583 arm_matrix_instance_f32 * pDst);
Kojto 123:b0220dba8be7 1584
Kojto 123:b0220dba8be7 1585
Kojto 123:b0220dba8be7 1586 /**
Kojto 123:b0220dba8be7 1587 * @brief Q15 matrix transpose.
Kojto 123:b0220dba8be7 1588 * @param[in] *pSrc points to the input matrix
Kojto 123:b0220dba8be7 1589 * @param[out] *pDst points to the output matrix
Kojto 123:b0220dba8be7 1590 * @return The function returns either <code>ARM_MATH_SIZE_MISMATCH</code>
Kojto 123:b0220dba8be7 1591 * or <code>ARM_MATH_SUCCESS</code> based on the outcome of size checking.
Kojto 123:b0220dba8be7 1592 */
Kojto 123:b0220dba8be7 1593
Kojto 123:b0220dba8be7 1594 arm_status arm_mat_trans_q15(
Kojto 123:b0220dba8be7 1595 const arm_matrix_instance_q15 * pSrc,
Kojto 123:b0220dba8be7 1596 arm_matrix_instance_q15 * pDst);
Kojto 123:b0220dba8be7 1597
Kojto 123:b0220dba8be7 1598 /**
Kojto 123:b0220dba8be7 1599 * @brief Q31 matrix transpose.
Kojto 123:b0220dba8be7 1600 * @param[in] *pSrc points to the input matrix
Kojto 123:b0220dba8be7 1601 * @param[out] *pDst points to the output matrix
Kojto 123:b0220dba8be7 1602 * @return The function returns either <code>ARM_MATH_SIZE_MISMATCH</code>
Kojto 123:b0220dba8be7 1603 * or <code>ARM_MATH_SUCCESS</code> based on the outcome of size checking.
Kojto 123:b0220dba8be7 1604 */
Kojto 123:b0220dba8be7 1605
Kojto 123:b0220dba8be7 1606 arm_status arm_mat_trans_q31(
Kojto 123:b0220dba8be7 1607 const arm_matrix_instance_q31 * pSrc,
Kojto 123:b0220dba8be7 1608 arm_matrix_instance_q31 * pDst);
Kojto 123:b0220dba8be7 1609
Kojto 123:b0220dba8be7 1610
Kojto 123:b0220dba8be7 1611 /**
Kojto 123:b0220dba8be7 1612 * @brief Floating-point matrix multiplication
Kojto 123:b0220dba8be7 1613 * @param[in] *pSrcA points to the first input matrix structure
Kojto 123:b0220dba8be7 1614 * @param[in] *pSrcB points to the second input matrix structure
Kojto 123:b0220dba8be7 1615 * @param[out] *pDst points to output matrix structure
Kojto 123:b0220dba8be7 1616 * @return The function returns either
Kojto 123:b0220dba8be7 1617 * <code>ARM_MATH_SIZE_MISMATCH</code> or <code>ARM_MATH_SUCCESS</code> based on the outcome of size checking.
Kojto 123:b0220dba8be7 1618 */
Kojto 123:b0220dba8be7 1619
Kojto 123:b0220dba8be7 1620 arm_status arm_mat_mult_f32(
Kojto 123:b0220dba8be7 1621 const arm_matrix_instance_f32 * pSrcA,
Kojto 123:b0220dba8be7 1622 const arm_matrix_instance_f32 * pSrcB,
Kojto 123:b0220dba8be7 1623 arm_matrix_instance_f32 * pDst);
Kojto 123:b0220dba8be7 1624
Kojto 123:b0220dba8be7 1625 /**
Kojto 123:b0220dba8be7 1626 * @brief Q15 matrix multiplication
Kojto 123:b0220dba8be7 1627 * @param[in] *pSrcA points to the first input matrix structure
Kojto 123:b0220dba8be7 1628 * @param[in] *pSrcB points to the second input matrix structure
Kojto 123:b0220dba8be7 1629 * @param[out] *pDst points to output matrix structure
Kojto 123:b0220dba8be7 1630 * @param[in] *pState points to the array for storing intermediate results
Kojto 123:b0220dba8be7 1631 * @return The function returns either
Kojto 123:b0220dba8be7 1632 * <code>ARM_MATH_SIZE_MISMATCH</code> or <code>ARM_MATH_SUCCESS</code> based on the outcome of size checking.
Kojto 123:b0220dba8be7 1633 */
Kojto 123:b0220dba8be7 1634
Kojto 123:b0220dba8be7 1635 arm_status arm_mat_mult_q15(
Kojto 123:b0220dba8be7 1636 const arm_matrix_instance_q15 * pSrcA,
Kojto 123:b0220dba8be7 1637 const arm_matrix_instance_q15 * pSrcB,
Kojto 123:b0220dba8be7 1638 arm_matrix_instance_q15 * pDst,
Kojto 123:b0220dba8be7 1639 q15_t * pState);
Kojto 123:b0220dba8be7 1640
Kojto 123:b0220dba8be7 1641 /**
Kojto 123:b0220dba8be7 1642 * @brief Q15 matrix multiplication (fast variant) for Cortex-M3 and Cortex-M4
Kojto 123:b0220dba8be7 1643 * @param[in] *pSrcA points to the first input matrix structure
Kojto 123:b0220dba8be7 1644 * @param[in] *pSrcB points to the second input matrix structure
Kojto 123:b0220dba8be7 1645 * @param[out] *pDst points to output matrix structure
Kojto 123:b0220dba8be7 1646 * @param[in] *pState points to the array for storing intermediate results
Kojto 123:b0220dba8be7 1647 * @return The function returns either
Kojto 123:b0220dba8be7 1648 * <code>ARM_MATH_SIZE_MISMATCH</code> or <code>ARM_MATH_SUCCESS</code> based on the outcome of size checking.
Kojto 123:b0220dba8be7 1649 */
Kojto 123:b0220dba8be7 1650
Kojto 123:b0220dba8be7 1651 arm_status arm_mat_mult_fast_q15(
Kojto 123:b0220dba8be7 1652 const arm_matrix_instance_q15 * pSrcA,
Kojto 123:b0220dba8be7 1653 const arm_matrix_instance_q15 * pSrcB,
Kojto 123:b0220dba8be7 1654 arm_matrix_instance_q15 * pDst,
Kojto 123:b0220dba8be7 1655 q15_t * pState);
Kojto 123:b0220dba8be7 1656
Kojto 123:b0220dba8be7 1657 /**
Kojto 123:b0220dba8be7 1658 * @brief Q31 matrix multiplication
Kojto 123:b0220dba8be7 1659 * @param[in] *pSrcA points to the first input matrix structure
Kojto 123:b0220dba8be7 1660 * @param[in] *pSrcB points to the second input matrix structure
Kojto 123:b0220dba8be7 1661 * @param[out] *pDst points to output matrix structure
Kojto 123:b0220dba8be7 1662 * @return The function returns either
Kojto 123:b0220dba8be7 1663 * <code>ARM_MATH_SIZE_MISMATCH</code> or <code>ARM_MATH_SUCCESS</code> based on the outcome of size checking.
Kojto 123:b0220dba8be7 1664 */
Kojto 123:b0220dba8be7 1665
Kojto 123:b0220dba8be7 1666 arm_status arm_mat_mult_q31(
Kojto 123:b0220dba8be7 1667 const arm_matrix_instance_q31 * pSrcA,
Kojto 123:b0220dba8be7 1668 const arm_matrix_instance_q31 * pSrcB,
Kojto 123:b0220dba8be7 1669 arm_matrix_instance_q31 * pDst);
Kojto 123:b0220dba8be7 1670
Kojto 123:b0220dba8be7 1671 /**
Kojto 123:b0220dba8be7 1672 * @brief Q31 matrix multiplication (fast variant) for Cortex-M3 and Cortex-M4
Kojto 123:b0220dba8be7 1673 * @param[in] *pSrcA points to the first input matrix structure
Kojto 123:b0220dba8be7 1674 * @param[in] *pSrcB points to the second input matrix structure
Kojto 123:b0220dba8be7 1675 * @param[out] *pDst points to output matrix structure
Kojto 123:b0220dba8be7 1676 * @return The function returns either
Kojto 123:b0220dba8be7 1677 * <code>ARM_MATH_SIZE_MISMATCH</code> or <code>ARM_MATH_SUCCESS</code> based on the outcome of size checking.
Kojto 123:b0220dba8be7 1678 */
Kojto 123:b0220dba8be7 1679
Kojto 123:b0220dba8be7 1680 arm_status arm_mat_mult_fast_q31(
Kojto 123:b0220dba8be7 1681 const arm_matrix_instance_q31 * pSrcA,
Kojto 123:b0220dba8be7 1682 const arm_matrix_instance_q31 * pSrcB,
Kojto 123:b0220dba8be7 1683 arm_matrix_instance_q31 * pDst);
Kojto 123:b0220dba8be7 1684
Kojto 123:b0220dba8be7 1685
Kojto 123:b0220dba8be7 1686 /**
Kojto 123:b0220dba8be7 1687 * @brief Floating-point matrix subtraction
Kojto 123:b0220dba8be7 1688 * @param[in] *pSrcA points to the first input matrix structure
Kojto 123:b0220dba8be7 1689 * @param[in] *pSrcB points to the second input matrix structure
Kojto 123:b0220dba8be7 1690 * @param[out] *pDst points to output matrix structure
Kojto 123:b0220dba8be7 1691 * @return The function returns either
Kojto 123:b0220dba8be7 1692 * <code>ARM_MATH_SIZE_MISMATCH</code> or <code>ARM_MATH_SUCCESS</code> based on the outcome of size checking.
Kojto 123:b0220dba8be7 1693 */
Kojto 123:b0220dba8be7 1694
Kojto 123:b0220dba8be7 1695 arm_status arm_mat_sub_f32(
Kojto 123:b0220dba8be7 1696 const arm_matrix_instance_f32 * pSrcA,
Kojto 123:b0220dba8be7 1697 const arm_matrix_instance_f32 * pSrcB,
Kojto 123:b0220dba8be7 1698 arm_matrix_instance_f32 * pDst);
Kojto 123:b0220dba8be7 1699
Kojto 123:b0220dba8be7 1700 /**
Kojto 123:b0220dba8be7 1701 * @brief Q15 matrix subtraction
Kojto 123:b0220dba8be7 1702 * @param[in] *pSrcA points to the first input matrix structure
Kojto 123:b0220dba8be7 1703 * @param[in] *pSrcB points to the second input matrix structure
Kojto 123:b0220dba8be7 1704 * @param[out] *pDst points to output matrix structure
Kojto 123:b0220dba8be7 1705 * @return The function returns either
Kojto 123:b0220dba8be7 1706 * <code>ARM_MATH_SIZE_MISMATCH</code> or <code>ARM_MATH_SUCCESS</code> based on the outcome of size checking.
Kojto 123:b0220dba8be7 1707 */
Kojto 123:b0220dba8be7 1708
Kojto 123:b0220dba8be7 1709 arm_status arm_mat_sub_q15(
Kojto 123:b0220dba8be7 1710 const arm_matrix_instance_q15 * pSrcA,
Kojto 123:b0220dba8be7 1711 const arm_matrix_instance_q15 * pSrcB,
Kojto 123:b0220dba8be7 1712 arm_matrix_instance_q15 * pDst);
Kojto 123:b0220dba8be7 1713
Kojto 123:b0220dba8be7 1714 /**
Kojto 123:b0220dba8be7 1715 * @brief Q31 matrix subtraction
Kojto 123:b0220dba8be7 1716 * @param[in] *pSrcA points to the first input matrix structure
Kojto 123:b0220dba8be7 1717 * @param[in] *pSrcB points to the second input matrix structure
Kojto 123:b0220dba8be7 1718 * @param[out] *pDst points to output matrix structure
Kojto 123:b0220dba8be7 1719 * @return The function returns either
Kojto 123:b0220dba8be7 1720 * <code>ARM_MATH_SIZE_MISMATCH</code> or <code>ARM_MATH_SUCCESS</code> based on the outcome of size checking.
Kojto 123:b0220dba8be7 1721 */
Kojto 123:b0220dba8be7 1722
Kojto 123:b0220dba8be7 1723 arm_status arm_mat_sub_q31(
Kojto 123:b0220dba8be7 1724 const arm_matrix_instance_q31 * pSrcA,
Kojto 123:b0220dba8be7 1725 const arm_matrix_instance_q31 * pSrcB,
Kojto 123:b0220dba8be7 1726 arm_matrix_instance_q31 * pDst);
Kojto 123:b0220dba8be7 1727
Kojto 123:b0220dba8be7 1728 /**
Kojto 123:b0220dba8be7 1729 * @brief Floating-point matrix scaling.
Kojto 123:b0220dba8be7 1730 * @param[in] *pSrc points to the input matrix
Kojto 123:b0220dba8be7 1731 * @param[in] scale scale factor
Kojto 123:b0220dba8be7 1732 * @param[out] *pDst points to the output matrix
Kojto 123:b0220dba8be7 1733 * @return The function returns either
Kojto 123:b0220dba8be7 1734 * <code>ARM_MATH_SIZE_MISMATCH</code> or <code>ARM_MATH_SUCCESS</code> based on the outcome of size checking.
Kojto 123:b0220dba8be7 1735 */
Kojto 123:b0220dba8be7 1736
Kojto 123:b0220dba8be7 1737 arm_status arm_mat_scale_f32(
Kojto 123:b0220dba8be7 1738 const arm_matrix_instance_f32 * pSrc,
Kojto 123:b0220dba8be7 1739 float32_t scale,
Kojto 123:b0220dba8be7 1740 arm_matrix_instance_f32 * pDst);
Kojto 123:b0220dba8be7 1741
Kojto 123:b0220dba8be7 1742 /**
Kojto 123:b0220dba8be7 1743 * @brief Q15 matrix scaling.
Kojto 123:b0220dba8be7 1744 * @param[in] *pSrc points to input matrix
Kojto 123:b0220dba8be7 1745 * @param[in] scaleFract fractional portion of the scale factor
Kojto 123:b0220dba8be7 1746 * @param[in] shift number of bits to shift the result by
Kojto 123:b0220dba8be7 1747 * @param[out] *pDst points to output matrix
Kojto 123:b0220dba8be7 1748 * @return The function returns either
Kojto 123:b0220dba8be7 1749 * <code>ARM_MATH_SIZE_MISMATCH</code> or <code>ARM_MATH_SUCCESS</code> based on the outcome of size checking.
Kojto 123:b0220dba8be7 1750 */
Kojto 123:b0220dba8be7 1751
Kojto 123:b0220dba8be7 1752 arm_status arm_mat_scale_q15(
Kojto 123:b0220dba8be7 1753 const arm_matrix_instance_q15 * pSrc,
Kojto 123:b0220dba8be7 1754 q15_t scaleFract,
Kojto 123:b0220dba8be7 1755 int32_t shift,
Kojto 123:b0220dba8be7 1756 arm_matrix_instance_q15 * pDst);
Kojto 123:b0220dba8be7 1757
Kojto 123:b0220dba8be7 1758 /**
Kojto 123:b0220dba8be7 1759 * @brief Q31 matrix scaling.
Kojto 123:b0220dba8be7 1760 * @param[in] *pSrc points to input matrix
Kojto 123:b0220dba8be7 1761 * @param[in] scaleFract fractional portion of the scale factor
Kojto 123:b0220dba8be7 1762 * @param[in] shift number of bits to shift the result by
Kojto 123:b0220dba8be7 1763 * @param[out] *pDst points to output matrix structure
Kojto 123:b0220dba8be7 1764 * @return The function returns either
Kojto 123:b0220dba8be7 1765 * <code>ARM_MATH_SIZE_MISMATCH</code> or <code>ARM_MATH_SUCCESS</code> based on the outcome of size checking.
Kojto 123:b0220dba8be7 1766 */
Kojto 123:b0220dba8be7 1767
Kojto 123:b0220dba8be7 1768 arm_status arm_mat_scale_q31(
Kojto 123:b0220dba8be7 1769 const arm_matrix_instance_q31 * pSrc,
Kojto 123:b0220dba8be7 1770 q31_t scaleFract,
Kojto 123:b0220dba8be7 1771 int32_t shift,
Kojto 123:b0220dba8be7 1772 arm_matrix_instance_q31 * pDst);
Kojto 123:b0220dba8be7 1773
Kojto 123:b0220dba8be7 1774
Kojto 123:b0220dba8be7 1775 /**
Kojto 123:b0220dba8be7 1776 * @brief Q31 matrix initialization.
Kojto 123:b0220dba8be7 1777 * @param[in,out] *S points to an instance of the floating-point matrix structure.
Kojto 123:b0220dba8be7 1778 * @param[in] nRows number of rows in the matrix.
Kojto 123:b0220dba8be7 1779 * @param[in] nColumns number of columns in the matrix.
Kojto 123:b0220dba8be7 1780 * @param[in] *pData points to the matrix data array.
Kojto 123:b0220dba8be7 1781 * @return none
Kojto 123:b0220dba8be7 1782 */
Kojto 123:b0220dba8be7 1783
Kojto 123:b0220dba8be7 1784 void arm_mat_init_q31(
Kojto 123:b0220dba8be7 1785 arm_matrix_instance_q31 * S,
Kojto 123:b0220dba8be7 1786 uint16_t nRows,
Kojto 123:b0220dba8be7 1787 uint16_t nColumns,
Kojto 123:b0220dba8be7 1788 q31_t * pData);
Kojto 123:b0220dba8be7 1789
Kojto 123:b0220dba8be7 1790 /**
Kojto 123:b0220dba8be7 1791 * @brief Q15 matrix initialization.
Kojto 123:b0220dba8be7 1792 * @param[in,out] *S points to an instance of the floating-point matrix structure.
Kojto 123:b0220dba8be7 1793 * @param[in] nRows number of rows in the matrix.
Kojto 123:b0220dba8be7 1794 * @param[in] nColumns number of columns in the matrix.
Kojto 123:b0220dba8be7 1795 * @param[in] *pData points to the matrix data array.
Kojto 123:b0220dba8be7 1796 * @return none
Kojto 123:b0220dba8be7 1797 */
Kojto 123:b0220dba8be7 1798
Kojto 123:b0220dba8be7 1799 void arm_mat_init_q15(
Kojto 123:b0220dba8be7 1800 arm_matrix_instance_q15 * S,
Kojto 123:b0220dba8be7 1801 uint16_t nRows,
Kojto 123:b0220dba8be7 1802 uint16_t nColumns,
Kojto 123:b0220dba8be7 1803 q15_t * pData);
Kojto 123:b0220dba8be7 1804
Kojto 123:b0220dba8be7 1805 /**
Kojto 123:b0220dba8be7 1806 * @brief Floating-point matrix initialization.
Kojto 123:b0220dba8be7 1807 * @param[in,out] *S points to an instance of the floating-point matrix structure.
Kojto 123:b0220dba8be7 1808 * @param[in] nRows number of rows in the matrix.
Kojto 123:b0220dba8be7 1809 * @param[in] nColumns number of columns in the matrix.
Kojto 123:b0220dba8be7 1810 * @param[in] *pData points to the matrix data array.
Kojto 123:b0220dba8be7 1811 * @return none
Kojto 123:b0220dba8be7 1812 */
Kojto 123:b0220dba8be7 1813
Kojto 123:b0220dba8be7 1814 void arm_mat_init_f32(
Kojto 123:b0220dba8be7 1815 arm_matrix_instance_f32 * S,
Kojto 123:b0220dba8be7 1816 uint16_t nRows,
Kojto 123:b0220dba8be7 1817 uint16_t nColumns,
Kojto 123:b0220dba8be7 1818 float32_t * pData);
Kojto 123:b0220dba8be7 1819
Kojto 123:b0220dba8be7 1820
Kojto 123:b0220dba8be7 1821
Kojto 123:b0220dba8be7 1822 /**
Kojto 123:b0220dba8be7 1823 * @brief Instance structure for the Q15 PID Control.
Kojto 123:b0220dba8be7 1824 */
Kojto 123:b0220dba8be7 1825 typedef struct
Kojto 123:b0220dba8be7 1826 {
Kojto 123:b0220dba8be7 1827 q15_t A0; /**< The derived gain, A0 = Kp + Ki + Kd . */
Kojto 123:b0220dba8be7 1828 #ifdef ARM_MATH_CM0_FAMILY
Kojto 123:b0220dba8be7 1829 q15_t A1;
Kojto 123:b0220dba8be7 1830 q15_t A2;
Kojto 123:b0220dba8be7 1831 #else
Kojto 123:b0220dba8be7 1832 q31_t A1; /**< The derived gain A1 = -Kp - 2Kd | Kd.*/
Kojto 123:b0220dba8be7 1833 #endif
Kojto 123:b0220dba8be7 1834 q15_t state[3]; /**< The state array of length 3. */
Kojto 123:b0220dba8be7 1835 q15_t Kp; /**< The proportional gain. */
Kojto 123:b0220dba8be7 1836 q15_t Ki; /**< The integral gain. */
Kojto 123:b0220dba8be7 1837 q15_t Kd; /**< The derivative gain. */
Kojto 123:b0220dba8be7 1838 } arm_pid_instance_q15;
Kojto 123:b0220dba8be7 1839
Kojto 123:b0220dba8be7 1840 /**
Kojto 123:b0220dba8be7 1841 * @brief Instance structure for the Q31 PID Control.
Kojto 123:b0220dba8be7 1842 */
Kojto 123:b0220dba8be7 1843 typedef struct
Kojto 123:b0220dba8be7 1844 {
Kojto 123:b0220dba8be7 1845 q31_t A0; /**< The derived gain, A0 = Kp + Ki + Kd . */
Kojto 123:b0220dba8be7 1846 q31_t A1; /**< The derived gain, A1 = -Kp - 2Kd. */
Kojto 123:b0220dba8be7 1847 q31_t A2; /**< The derived gain, A2 = Kd . */
Kojto 123:b0220dba8be7 1848 q31_t state[3]; /**< The state array of length 3. */
Kojto 123:b0220dba8be7 1849 q31_t Kp; /**< The proportional gain. */
Kojto 123:b0220dba8be7 1850 q31_t Ki; /**< The integral gain. */
Kojto 123:b0220dba8be7 1851 q31_t Kd; /**< The derivative gain. */
Kojto 123:b0220dba8be7 1852
Kojto 123:b0220dba8be7 1853 } arm_pid_instance_q31;
Kojto 123:b0220dba8be7 1854
Kojto 123:b0220dba8be7 1855 /**
Kojto 123:b0220dba8be7 1856 * @brief Instance structure for the floating-point PID Control.
Kojto 123:b0220dba8be7 1857 */
Kojto 123:b0220dba8be7 1858 typedef struct
Kojto 123:b0220dba8be7 1859 {
Kojto 123:b0220dba8be7 1860 float32_t A0; /**< The derived gain, A0 = Kp + Ki + Kd . */
Kojto 123:b0220dba8be7 1861 float32_t A1; /**< The derived gain, A1 = -Kp - 2Kd. */
Kojto 123:b0220dba8be7 1862 float32_t A2; /**< The derived gain, A2 = Kd . */
Kojto 123:b0220dba8be7 1863 float32_t state[3]; /**< The state array of length 3. */
Kojto 123:b0220dba8be7 1864 float32_t Kp; /**< The proportional gain. */
Kojto 123:b0220dba8be7 1865 float32_t Ki; /**< The integral gain. */
Kojto 123:b0220dba8be7 1866 float32_t Kd; /**< The derivative gain. */
Kojto 123:b0220dba8be7 1867 } arm_pid_instance_f32;
Kojto 123:b0220dba8be7 1868
Kojto 123:b0220dba8be7 1869
Kojto 123:b0220dba8be7 1870
Kojto 123:b0220dba8be7 1871 /**
Kojto 123:b0220dba8be7 1872 * @brief Initialization function for the floating-point PID Control.
Kojto 123:b0220dba8be7 1873 * @param[in,out] *S points to an instance of the PID structure.
Kojto 123:b0220dba8be7 1874 * @param[in] resetStateFlag flag to reset the state. 0 = no change in state 1 = reset the state.
Kojto 123:b0220dba8be7 1875 * @return none.
Kojto 123:b0220dba8be7 1876 */
Kojto 123:b0220dba8be7 1877 void arm_pid_init_f32(
Kojto 123:b0220dba8be7 1878 arm_pid_instance_f32 * S,
Kojto 123:b0220dba8be7 1879 int32_t resetStateFlag);
Kojto 123:b0220dba8be7 1880
Kojto 123:b0220dba8be7 1881 /**
Kojto 123:b0220dba8be7 1882 * @brief Reset function for the floating-point PID Control.
Kojto 123:b0220dba8be7 1883 * @param[in,out] *S is an instance of the floating-point PID Control structure
Kojto 123:b0220dba8be7 1884 * @return none
Kojto 123:b0220dba8be7 1885 */
Kojto 123:b0220dba8be7 1886 void arm_pid_reset_f32(
Kojto 123:b0220dba8be7 1887 arm_pid_instance_f32 * S);
Kojto 123:b0220dba8be7 1888
Kojto 123:b0220dba8be7 1889
Kojto 123:b0220dba8be7 1890 /**
Kojto 123:b0220dba8be7 1891 * @brief Initialization function for the Q31 PID Control.
Kojto 123:b0220dba8be7 1892 * @param[in,out] *S points to an instance of the Q15 PID structure.
Kojto 123:b0220dba8be7 1893 * @param[in] resetStateFlag flag to reset the state. 0 = no change in state 1 = reset the state.
Kojto 123:b0220dba8be7 1894 * @return none.
Kojto 123:b0220dba8be7 1895 */
Kojto 123:b0220dba8be7 1896 void arm_pid_init_q31(
Kojto 123:b0220dba8be7 1897 arm_pid_instance_q31 * S,
Kojto 123:b0220dba8be7 1898 int32_t resetStateFlag);
Kojto 123:b0220dba8be7 1899
Kojto 123:b0220dba8be7 1900
Kojto 123:b0220dba8be7 1901 /**
Kojto 123:b0220dba8be7 1902 * @brief Reset function for the Q31 PID Control.
Kojto 123:b0220dba8be7 1903 * @param[in,out] *S points to an instance of the Q31 PID Control structure
Kojto 123:b0220dba8be7 1904 * @return none
Kojto 123:b0220dba8be7 1905 */
Kojto 123:b0220dba8be7 1906
Kojto 123:b0220dba8be7 1907 void arm_pid_reset_q31(
Kojto 123:b0220dba8be7 1908 arm_pid_instance_q31 * S);
Kojto 123:b0220dba8be7 1909
Kojto 123:b0220dba8be7 1910 /**
Kojto 123:b0220dba8be7 1911 * @brief Initialization function for the Q15 PID Control.
Kojto 123:b0220dba8be7 1912 * @param[in,out] *S points to an instance of the Q15 PID structure.
Kojto 123:b0220dba8be7 1913 * @param[in] resetStateFlag flag to reset the state. 0 = no change in state 1 = reset the state.
Kojto 123:b0220dba8be7 1914 * @return none.
Kojto 123:b0220dba8be7 1915 */
Kojto 123:b0220dba8be7 1916 void arm_pid_init_q15(
Kojto 123:b0220dba8be7 1917 arm_pid_instance_q15 * S,
Kojto 123:b0220dba8be7 1918 int32_t resetStateFlag);
Kojto 123:b0220dba8be7 1919
Kojto 123:b0220dba8be7 1920 /**
Kojto 123:b0220dba8be7 1921 * @brief Reset function for the Q15 PID Control.
Kojto 123:b0220dba8be7 1922 * @param[in,out] *S points to an instance of the q15 PID Control structure
Kojto 123:b0220dba8be7 1923 * @return none
Kojto 123:b0220dba8be7 1924 */
Kojto 123:b0220dba8be7 1925 void arm_pid_reset_q15(
Kojto 123:b0220dba8be7 1926 arm_pid_instance_q15 * S);
Kojto 123:b0220dba8be7 1927
Kojto 123:b0220dba8be7 1928
Kojto 123:b0220dba8be7 1929 /**
Kojto 123:b0220dba8be7 1930 * @brief Instance structure for the floating-point Linear Interpolate function.
Kojto 123:b0220dba8be7 1931 */
Kojto 123:b0220dba8be7 1932 typedef struct
Kojto 123:b0220dba8be7 1933 {
Kojto 123:b0220dba8be7 1934 uint32_t nValues; /**< nValues */
Kojto 123:b0220dba8be7 1935 float32_t x1; /**< x1 */
Kojto 123:b0220dba8be7 1936 float32_t xSpacing; /**< xSpacing */
Kojto 123:b0220dba8be7 1937 float32_t *pYData; /**< pointer to the table of Y values */
Kojto 123:b0220dba8be7 1938 } arm_linear_interp_instance_f32;
Kojto 123:b0220dba8be7 1939
Kojto 123:b0220dba8be7 1940 /**
Kojto 123:b0220dba8be7 1941 * @brief Instance structure for the floating-point bilinear interpolation function.
Kojto 123:b0220dba8be7 1942 */
Kojto 123:b0220dba8be7 1943
Kojto 123:b0220dba8be7 1944 typedef struct
Kojto 123:b0220dba8be7 1945 {
Kojto 123:b0220dba8be7 1946 uint16_t numRows; /**< number of rows in the data table. */
Kojto 123:b0220dba8be7 1947 uint16_t numCols; /**< number of columns in the data table. */
Kojto 123:b0220dba8be7 1948 float32_t *pData; /**< points to the data table. */
Kojto 123:b0220dba8be7 1949 } arm_bilinear_interp_instance_f32;
Kojto 123:b0220dba8be7 1950
Kojto 123:b0220dba8be7 1951 /**
Kojto 123:b0220dba8be7 1952 * @brief Instance structure for the Q31 bilinear interpolation function.
Kojto 123:b0220dba8be7 1953 */
Kojto 123:b0220dba8be7 1954
Kojto 123:b0220dba8be7 1955 typedef struct
Kojto 123:b0220dba8be7 1956 {
Kojto 123:b0220dba8be7 1957 uint16_t numRows; /**< number of rows in the data table. */
Kojto 123:b0220dba8be7 1958 uint16_t numCols; /**< number of columns in the data table. */
Kojto 123:b0220dba8be7 1959 q31_t *pData; /**< points to the data table. */
Kojto 123:b0220dba8be7 1960 } arm_bilinear_interp_instance_q31;
Kojto 123:b0220dba8be7 1961
Kojto 123:b0220dba8be7 1962 /**
Kojto 123:b0220dba8be7 1963 * @brief Instance structure for the Q15 bilinear interpolation function.
Kojto 123:b0220dba8be7 1964 */
Kojto 123:b0220dba8be7 1965
Kojto 123:b0220dba8be7 1966 typedef struct
Kojto 123:b0220dba8be7 1967 {
Kojto 123:b0220dba8be7 1968 uint16_t numRows; /**< number of rows in the data table. */
Kojto 123:b0220dba8be7 1969 uint16_t numCols; /**< number of columns in the data table. */
Kojto 123:b0220dba8be7 1970 q15_t *pData; /**< points to the data table. */
Kojto 123:b0220dba8be7 1971 } arm_bilinear_interp_instance_q15;
Kojto 123:b0220dba8be7 1972
Kojto 123:b0220dba8be7 1973 /**
Kojto 123:b0220dba8be7 1974 * @brief Instance structure for the Q15 bilinear interpolation function.
Kojto 123:b0220dba8be7 1975 */
Kojto 123:b0220dba8be7 1976
Kojto 123:b0220dba8be7 1977 typedef struct
Kojto 123:b0220dba8be7 1978 {
Kojto 123:b0220dba8be7 1979 uint16_t numRows; /**< number of rows in the data table. */
Kojto 123:b0220dba8be7 1980 uint16_t numCols; /**< number of columns in the data table. */
Kojto 123:b0220dba8be7 1981 q7_t *pData; /**< points to the data table. */
Kojto 123:b0220dba8be7 1982 } arm_bilinear_interp_instance_q7;
Kojto 123:b0220dba8be7 1983
Kojto 123:b0220dba8be7 1984
Kojto 123:b0220dba8be7 1985 /**
Kojto 123:b0220dba8be7 1986 * @brief Q7 vector multiplication.
Kojto 123:b0220dba8be7 1987 * @param[in] *pSrcA points to the first input vector
Kojto 123:b0220dba8be7 1988 * @param[in] *pSrcB points to the second input vector
Kojto 123:b0220dba8be7 1989 * @param[out] *pDst points to the output vector
Kojto 123:b0220dba8be7 1990 * @param[in] blockSize number of samples in each vector
Kojto 123:b0220dba8be7 1991 * @return none.
Kojto 123:b0220dba8be7 1992 */
Kojto 123:b0220dba8be7 1993
Kojto 123:b0220dba8be7 1994 void arm_mult_q7(
Kojto 123:b0220dba8be7 1995 q7_t * pSrcA,
Kojto 123:b0220dba8be7 1996 q7_t * pSrcB,
Kojto 123:b0220dba8be7 1997 q7_t * pDst,
Kojto 123:b0220dba8be7 1998 uint32_t blockSize);
Kojto 123:b0220dba8be7 1999
Kojto 123:b0220dba8be7 2000 /**
Kojto 123:b0220dba8be7 2001 * @brief Q15 vector multiplication.
Kojto 123:b0220dba8be7 2002 * @param[in] *pSrcA points to the first input vector
Kojto 123:b0220dba8be7 2003 * @param[in] *pSrcB points to the second input vector
Kojto 123:b0220dba8be7 2004 * @param[out] *pDst points to the output vector
Kojto 123:b0220dba8be7 2005 * @param[in] blockSize number of samples in each vector
Kojto 123:b0220dba8be7 2006 * @return none.
Kojto 123:b0220dba8be7 2007 */
Kojto 123:b0220dba8be7 2008
Kojto 123:b0220dba8be7 2009 void arm_mult_q15(
Kojto 123:b0220dba8be7 2010 q15_t * pSrcA,
Kojto 123:b0220dba8be7 2011 q15_t * pSrcB,
Kojto 123:b0220dba8be7 2012 q15_t * pDst,
Kojto 123:b0220dba8be7 2013 uint32_t blockSize);
Kojto 123:b0220dba8be7 2014
Kojto 123:b0220dba8be7 2015 /**
Kojto 123:b0220dba8be7 2016 * @brief Q31 vector multiplication.
Kojto 123:b0220dba8be7 2017 * @param[in] *pSrcA points to the first input vector
Kojto 123:b0220dba8be7 2018 * @param[in] *pSrcB points to the second input vector
Kojto 123:b0220dba8be7 2019 * @param[out] *pDst points to the output vector
Kojto 123:b0220dba8be7 2020 * @param[in] blockSize number of samples in each vector
Kojto 123:b0220dba8be7 2021 * @return none.
Kojto 123:b0220dba8be7 2022 */
Kojto 123:b0220dba8be7 2023
Kojto 123:b0220dba8be7 2024 void arm_mult_q31(
Kojto 123:b0220dba8be7 2025 q31_t * pSrcA,
Kojto 123:b0220dba8be7 2026 q31_t * pSrcB,
Kojto 123:b0220dba8be7 2027 q31_t * pDst,
Kojto 123:b0220dba8be7 2028 uint32_t blockSize);
Kojto 123:b0220dba8be7 2029
Kojto 123:b0220dba8be7 2030 /**
Kojto 123:b0220dba8be7 2031 * @brief Floating-point vector multiplication.
Kojto 123:b0220dba8be7 2032 * @param[in] *pSrcA points to the first input vector
Kojto 123:b0220dba8be7 2033 * @param[in] *pSrcB points to the second input vector
Kojto 123:b0220dba8be7 2034 * @param[out] *pDst points to the output vector
Kojto 123:b0220dba8be7 2035 * @param[in] blockSize number of samples in each vector
Kojto 123:b0220dba8be7 2036 * @return none.
Kojto 123:b0220dba8be7 2037 */
Kojto 123:b0220dba8be7 2038
Kojto 123:b0220dba8be7 2039 void arm_mult_f32(
Kojto 123:b0220dba8be7 2040 float32_t * pSrcA,
Kojto 123:b0220dba8be7 2041 float32_t * pSrcB,
Kojto 123:b0220dba8be7 2042 float32_t * pDst,
Kojto 123:b0220dba8be7 2043 uint32_t blockSize);
Kojto 123:b0220dba8be7 2044
Kojto 123:b0220dba8be7 2045
Kojto 123:b0220dba8be7 2046
Kojto 123:b0220dba8be7 2047
Kojto 123:b0220dba8be7 2048
Kojto 123:b0220dba8be7 2049
Kojto 123:b0220dba8be7 2050 /**
Kojto 123:b0220dba8be7 2051 * @brief Instance structure for the Q15 CFFT/CIFFT function.
Kojto 123:b0220dba8be7 2052 */
Kojto 123:b0220dba8be7 2053
Kojto 123:b0220dba8be7 2054 typedef struct
Kojto 123:b0220dba8be7 2055 {
Kojto 123:b0220dba8be7 2056 uint16_t fftLen; /**< length of the FFT. */
Kojto 123:b0220dba8be7 2057 uint8_t ifftFlag; /**< flag that selects forward (ifftFlag=0) or inverse (ifftFlag=1) transform. */
Kojto 123:b0220dba8be7 2058 uint8_t bitReverseFlag; /**< flag that enables (bitReverseFlag=1) or disables (bitReverseFlag=0) bit reversal of output. */
Kojto 123:b0220dba8be7 2059 q15_t *pTwiddle; /**< points to the Sin twiddle factor table. */
Kojto 123:b0220dba8be7 2060 uint16_t *pBitRevTable; /**< points to the bit reversal table. */
Kojto 123:b0220dba8be7 2061 uint16_t twidCoefModifier; /**< twiddle coefficient modifier that supports different size FFTs with the same twiddle factor table. */
Kojto 123:b0220dba8be7 2062 uint16_t bitRevFactor; /**< bit reversal modifier that supports different size FFTs with the same bit reversal table. */
Kojto 123:b0220dba8be7 2063 } arm_cfft_radix2_instance_q15;
Kojto 123:b0220dba8be7 2064
Kojto 123:b0220dba8be7 2065 /* Deprecated */
Kojto 123:b0220dba8be7 2066 arm_status arm_cfft_radix2_init_q15(
Kojto 123:b0220dba8be7 2067 arm_cfft_radix2_instance_q15 * S,
Kojto 123:b0220dba8be7 2068 uint16_t fftLen,
Kojto 123:b0220dba8be7 2069 uint8_t ifftFlag,
Kojto 123:b0220dba8be7 2070 uint8_t bitReverseFlag);
Kojto 123:b0220dba8be7 2071
Kojto 123:b0220dba8be7 2072 /* Deprecated */
Kojto 123:b0220dba8be7 2073 void arm_cfft_radix2_q15(
Kojto 123:b0220dba8be7 2074 const arm_cfft_radix2_instance_q15 * S,
Kojto 123:b0220dba8be7 2075 q15_t * pSrc);
Kojto 123:b0220dba8be7 2076
Kojto 123:b0220dba8be7 2077
Kojto 123:b0220dba8be7 2078
Kojto 123:b0220dba8be7 2079 /**
Kojto 123:b0220dba8be7 2080 * @brief Instance structure for the Q15 CFFT/CIFFT function.
Kojto 123:b0220dba8be7 2081 */
Kojto 123:b0220dba8be7 2082
Kojto 123:b0220dba8be7 2083 typedef struct
Kojto 123:b0220dba8be7 2084 {
Kojto 123:b0220dba8be7 2085 uint16_t fftLen; /**< length of the FFT. */
Kojto 123:b0220dba8be7 2086 uint8_t ifftFlag; /**< flag that selects forward (ifftFlag=0) or inverse (ifftFlag=1) transform. */
Kojto 123:b0220dba8be7 2087 uint8_t bitReverseFlag; /**< flag that enables (bitReverseFlag=1) or disables (bitReverseFlag=0) bit reversal of output. */
Kojto 123:b0220dba8be7 2088 q15_t *pTwiddle; /**< points to the twiddle factor table. */
Kojto 123:b0220dba8be7 2089 uint16_t *pBitRevTable; /**< points to the bit reversal table. */
Kojto 123:b0220dba8be7 2090 uint16_t twidCoefModifier; /**< twiddle coefficient modifier that supports different size FFTs with the same twiddle factor table. */
Kojto 123:b0220dba8be7 2091 uint16_t bitRevFactor; /**< bit reversal modifier that supports different size FFTs with the same bit reversal table. */
Kojto 123:b0220dba8be7 2092 } arm_cfft_radix4_instance_q15;
Kojto 123:b0220dba8be7 2093
Kojto 123:b0220dba8be7 2094 /* Deprecated */
Kojto 123:b0220dba8be7 2095 arm_status arm_cfft_radix4_init_q15(
Kojto 123:b0220dba8be7 2096 arm_cfft_radix4_instance_q15 * S,
Kojto 123:b0220dba8be7 2097 uint16_t fftLen,
Kojto 123:b0220dba8be7 2098 uint8_t ifftFlag,
Kojto 123:b0220dba8be7 2099 uint8_t bitReverseFlag);
Kojto 123:b0220dba8be7 2100
Kojto 123:b0220dba8be7 2101 /* Deprecated */
Kojto 123:b0220dba8be7 2102 void arm_cfft_radix4_q15(
Kojto 123:b0220dba8be7 2103 const arm_cfft_radix4_instance_q15 * S,
Kojto 123:b0220dba8be7 2104 q15_t * pSrc);
Kojto 123:b0220dba8be7 2105
Kojto 123:b0220dba8be7 2106 /**
Kojto 123:b0220dba8be7 2107 * @brief Instance structure for the Radix-2 Q31 CFFT/CIFFT function.
Kojto 123:b0220dba8be7 2108 */
Kojto 123:b0220dba8be7 2109
Kojto 123:b0220dba8be7 2110 typedef struct
Kojto 123:b0220dba8be7 2111 {
Kojto 123:b0220dba8be7 2112 uint16_t fftLen; /**< length of the FFT. */
Kojto 123:b0220dba8be7 2113 uint8_t ifftFlag; /**< flag that selects forward (ifftFlag=0) or inverse (ifftFlag=1) transform. */
Kojto 123:b0220dba8be7 2114 uint8_t bitReverseFlag; /**< flag that enables (bitReverseFlag=1) or disables (bitReverseFlag=0) bit reversal of output. */
Kojto 123:b0220dba8be7 2115 q31_t *pTwiddle; /**< points to the Twiddle factor table. */
Kojto 123:b0220dba8be7 2116 uint16_t *pBitRevTable; /**< points to the bit reversal table. */
Kojto 123:b0220dba8be7 2117 uint16_t twidCoefModifier; /**< twiddle coefficient modifier that supports different size FFTs with the same twiddle factor table. */
Kojto 123:b0220dba8be7 2118 uint16_t bitRevFactor; /**< bit reversal modifier that supports different size FFTs with the same bit reversal table. */
Kojto 123:b0220dba8be7 2119 } arm_cfft_radix2_instance_q31;
Kojto 123:b0220dba8be7 2120
Kojto 123:b0220dba8be7 2121 /* Deprecated */
Kojto 123:b0220dba8be7 2122 arm_status arm_cfft_radix2_init_q31(
Kojto 123:b0220dba8be7 2123 arm_cfft_radix2_instance_q31 * S,
Kojto 123:b0220dba8be7 2124 uint16_t fftLen,
Kojto 123:b0220dba8be7 2125 uint8_t ifftFlag,
Kojto 123:b0220dba8be7 2126 uint8_t bitReverseFlag);
Kojto 123:b0220dba8be7 2127
Kojto 123:b0220dba8be7 2128 /* Deprecated */
Kojto 123:b0220dba8be7 2129 void arm_cfft_radix2_q31(
Kojto 123:b0220dba8be7 2130 const arm_cfft_radix2_instance_q31 * S,
Kojto 123:b0220dba8be7 2131 q31_t * pSrc);
Kojto 123:b0220dba8be7 2132
Kojto 123:b0220dba8be7 2133 /**
Kojto 123:b0220dba8be7 2134 * @brief Instance structure for the Q31 CFFT/CIFFT function.
Kojto 123:b0220dba8be7 2135 */
Kojto 123:b0220dba8be7 2136
Kojto 123:b0220dba8be7 2137 typedef struct
Kojto 123:b0220dba8be7 2138 {
Kojto 123:b0220dba8be7 2139 uint16_t fftLen; /**< length of the FFT. */
Kojto 123:b0220dba8be7 2140 uint8_t ifftFlag; /**< flag that selects forward (ifftFlag=0) or inverse (ifftFlag=1) transform. */
Kojto 123:b0220dba8be7 2141 uint8_t bitReverseFlag; /**< flag that enables (bitReverseFlag=1) or disables (bitReverseFlag=0) bit reversal of output. */
Kojto 123:b0220dba8be7 2142 q31_t *pTwiddle; /**< points to the twiddle factor table. */
Kojto 123:b0220dba8be7 2143 uint16_t *pBitRevTable; /**< points to the bit reversal table. */
Kojto 123:b0220dba8be7 2144 uint16_t twidCoefModifier; /**< twiddle coefficient modifier that supports different size FFTs with the same twiddle factor table. */
Kojto 123:b0220dba8be7 2145 uint16_t bitRevFactor; /**< bit reversal modifier that supports different size FFTs with the same bit reversal table. */
Kojto 123:b0220dba8be7 2146 } arm_cfft_radix4_instance_q31;
Kojto 123:b0220dba8be7 2147
Kojto 123:b0220dba8be7 2148 /* Deprecated */
Kojto 123:b0220dba8be7 2149 void arm_cfft_radix4_q31(
Kojto 123:b0220dba8be7 2150 const arm_cfft_radix4_instance_q31 * S,
Kojto 123:b0220dba8be7 2151 q31_t * pSrc);
Kojto 123:b0220dba8be7 2152
Kojto 123:b0220dba8be7 2153 /* Deprecated */
Kojto 123:b0220dba8be7 2154 arm_status arm_cfft_radix4_init_q31(
Kojto 123:b0220dba8be7 2155 arm_cfft_radix4_instance_q31 * S,
Kojto 123:b0220dba8be7 2156 uint16_t fftLen,
Kojto 123:b0220dba8be7 2157 uint8_t ifftFlag,
Kojto 123:b0220dba8be7 2158 uint8_t bitReverseFlag);
Kojto 123:b0220dba8be7 2159
Kojto 123:b0220dba8be7 2160 /**
Kojto 123:b0220dba8be7 2161 * @brief Instance structure for the floating-point CFFT/CIFFT function.
Kojto 123:b0220dba8be7 2162 */
Kojto 123:b0220dba8be7 2163
Kojto 123:b0220dba8be7 2164 typedef struct
Kojto 123:b0220dba8be7 2165 {
Kojto 123:b0220dba8be7 2166 uint16_t fftLen; /**< length of the FFT. */
Kojto 123:b0220dba8be7 2167 uint8_t ifftFlag; /**< flag that selects forward (ifftFlag=0) or inverse (ifftFlag=1) transform. */
Kojto 123:b0220dba8be7 2168 uint8_t bitReverseFlag; /**< flag that enables (bitReverseFlag=1) or disables (bitReverseFlag=0) bit reversal of output. */
Kojto 123:b0220dba8be7 2169 float32_t *pTwiddle; /**< points to the Twiddle factor table. */
Kojto 123:b0220dba8be7 2170 uint16_t *pBitRevTable; /**< points to the bit reversal table. */
Kojto 123:b0220dba8be7 2171 uint16_t twidCoefModifier; /**< twiddle coefficient modifier that supports different size FFTs with the same twiddle factor table. */
Kojto 123:b0220dba8be7 2172 uint16_t bitRevFactor; /**< bit reversal modifier that supports different size FFTs with the same bit reversal table. */
Kojto 123:b0220dba8be7 2173 float32_t onebyfftLen; /**< value of 1/fftLen. */
Kojto 123:b0220dba8be7 2174 } arm_cfft_radix2_instance_f32;
Kojto 123:b0220dba8be7 2175
Kojto 123:b0220dba8be7 2176 /* Deprecated */
Kojto 123:b0220dba8be7 2177 arm_status arm_cfft_radix2_init_f32(
Kojto 123:b0220dba8be7 2178 arm_cfft_radix2_instance_f32 * S,
Kojto 123:b0220dba8be7 2179 uint16_t fftLen,
Kojto 123:b0220dba8be7 2180 uint8_t ifftFlag,
Kojto 123:b0220dba8be7 2181 uint8_t bitReverseFlag);
Kojto 123:b0220dba8be7 2182
Kojto 123:b0220dba8be7 2183 /* Deprecated */
Kojto 123:b0220dba8be7 2184 void arm_cfft_radix2_f32(
Kojto 123:b0220dba8be7 2185 const arm_cfft_radix2_instance_f32 * S,
Kojto 123:b0220dba8be7 2186 float32_t * pSrc);
Kojto 123:b0220dba8be7 2187
Kojto 123:b0220dba8be7 2188 /**
Kojto 123:b0220dba8be7 2189 * @brief Instance structure for the floating-point CFFT/CIFFT function.
Kojto 123:b0220dba8be7 2190 */
Kojto 123:b0220dba8be7 2191
Kojto 123:b0220dba8be7 2192 typedef struct
Kojto 123:b0220dba8be7 2193 {
Kojto 123:b0220dba8be7 2194 uint16_t fftLen; /**< length of the FFT. */
Kojto 123:b0220dba8be7 2195 uint8_t ifftFlag; /**< flag that selects forward (ifftFlag=0) or inverse (ifftFlag=1) transform. */
Kojto 123:b0220dba8be7 2196 uint8_t bitReverseFlag; /**< flag that enables (bitReverseFlag=1) or disables (bitReverseFlag=0) bit reversal of output. */
Kojto 123:b0220dba8be7 2197 float32_t *pTwiddle; /**< points to the Twiddle factor table. */
Kojto 123:b0220dba8be7 2198 uint16_t *pBitRevTable; /**< points to the bit reversal table. */
Kojto 123:b0220dba8be7 2199 uint16_t twidCoefModifier; /**< twiddle coefficient modifier that supports different size FFTs with the same twiddle factor table. */
Kojto 123:b0220dba8be7 2200 uint16_t bitRevFactor; /**< bit reversal modifier that supports different size FFTs with the same bit reversal table. */
Kojto 123:b0220dba8be7 2201 float32_t onebyfftLen; /**< value of 1/fftLen. */
Kojto 123:b0220dba8be7 2202 } arm_cfft_radix4_instance_f32;
Kojto 123:b0220dba8be7 2203
Kojto 123:b0220dba8be7 2204 /* Deprecated */
Kojto 123:b0220dba8be7 2205 arm_status arm_cfft_radix4_init_f32(
Kojto 123:b0220dba8be7 2206 arm_cfft_radix4_instance_f32 * S,
Kojto 123:b0220dba8be7 2207 uint16_t fftLen,
Kojto 123:b0220dba8be7 2208 uint8_t ifftFlag,
Kojto 123:b0220dba8be7 2209 uint8_t bitReverseFlag);
Kojto 123:b0220dba8be7 2210
Kojto 123:b0220dba8be7 2211 /* Deprecated */
Kojto 123:b0220dba8be7 2212 void arm_cfft_radix4_f32(
Kojto 123:b0220dba8be7 2213 const arm_cfft_radix4_instance_f32 * S,
Kojto 123:b0220dba8be7 2214 float32_t * pSrc);
Kojto 123:b0220dba8be7 2215
Kojto 123:b0220dba8be7 2216 /**
Kojto 123:b0220dba8be7 2217 * @brief Instance structure for the fixed-point CFFT/CIFFT function.
Kojto 123:b0220dba8be7 2218 */
Kojto 123:b0220dba8be7 2219
Kojto 123:b0220dba8be7 2220 typedef struct
Kojto 123:b0220dba8be7 2221 {
Kojto 123:b0220dba8be7 2222 uint16_t fftLen; /**< length of the FFT. */
Kojto 123:b0220dba8be7 2223 const q15_t *pTwiddle; /**< points to the Twiddle factor table. */
Kojto 123:b0220dba8be7 2224 const uint16_t *pBitRevTable; /**< points to the bit reversal table. */
Kojto 123:b0220dba8be7 2225 uint16_t bitRevLength; /**< bit reversal table length. */
Kojto 123:b0220dba8be7 2226 } arm_cfft_instance_q15;
Kojto 123:b0220dba8be7 2227
Kojto 123:b0220dba8be7 2228 void arm_cfft_q15(
Kojto 123:b0220dba8be7 2229 const arm_cfft_instance_q15 * S,
Kojto 123:b0220dba8be7 2230 q15_t * p1,
Kojto 123:b0220dba8be7 2231 uint8_t ifftFlag,
Kojto 123:b0220dba8be7 2232 uint8_t bitReverseFlag);
Kojto 123:b0220dba8be7 2233
Kojto 123:b0220dba8be7 2234 /**
Kojto 123:b0220dba8be7 2235 * @brief Instance structure for the fixed-point CFFT/CIFFT function.
Kojto 123:b0220dba8be7 2236 */
Kojto 123:b0220dba8be7 2237
Kojto 123:b0220dba8be7 2238 typedef struct
Kojto 123:b0220dba8be7 2239 {
Kojto 123:b0220dba8be7 2240 uint16_t fftLen; /**< length of the FFT. */
Kojto 123:b0220dba8be7 2241 const q31_t *pTwiddle; /**< points to the Twiddle factor table. */
Kojto 123:b0220dba8be7 2242 const uint16_t *pBitRevTable; /**< points to the bit reversal table. */
Kojto 123:b0220dba8be7 2243 uint16_t bitRevLength; /**< bit reversal table length. */
Kojto 123:b0220dba8be7 2244 } arm_cfft_instance_q31;
Kojto 123:b0220dba8be7 2245
Kojto 123:b0220dba8be7 2246 void arm_cfft_q31(
Kojto 123:b0220dba8be7 2247 const arm_cfft_instance_q31 * S,
Kojto 123:b0220dba8be7 2248 q31_t * p1,
Kojto 123:b0220dba8be7 2249 uint8_t ifftFlag,
Kojto 123:b0220dba8be7 2250 uint8_t bitReverseFlag);
Kojto 123:b0220dba8be7 2251
Kojto 123:b0220dba8be7 2252 /**
Kojto 123:b0220dba8be7 2253 * @brief Instance structure for the floating-point CFFT/CIFFT function.
Kojto 123:b0220dba8be7 2254 */
Kojto 123:b0220dba8be7 2255
Kojto 123:b0220dba8be7 2256 typedef struct
Kojto 123:b0220dba8be7 2257 {
Kojto 123:b0220dba8be7 2258 uint16_t fftLen; /**< length of the FFT. */
Kojto 123:b0220dba8be7 2259 const float32_t *pTwiddle; /**< points to the Twiddle factor table. */
Kojto 123:b0220dba8be7 2260 const uint16_t *pBitRevTable; /**< points to the bit reversal table. */
Kojto 123:b0220dba8be7 2261 uint16_t bitRevLength; /**< bit reversal table length. */
Kojto 123:b0220dba8be7 2262 } arm_cfft_instance_f32;
Kojto 123:b0220dba8be7 2263
Kojto 123:b0220dba8be7 2264 void arm_cfft_f32(
Kojto 123:b0220dba8be7 2265 const arm_cfft_instance_f32 * S,
Kojto 123:b0220dba8be7 2266 float32_t * p1,
Kojto 123:b0220dba8be7 2267 uint8_t ifftFlag,
Kojto 123:b0220dba8be7 2268 uint8_t bitReverseFlag);
Kojto 123:b0220dba8be7 2269
Kojto 123:b0220dba8be7 2270 /**
Kojto 123:b0220dba8be7 2271 * @brief Instance structure for the Q15 RFFT/RIFFT function.
Kojto 123:b0220dba8be7 2272 */
Kojto 123:b0220dba8be7 2273
Kojto 123:b0220dba8be7 2274 typedef struct
Kojto 123:b0220dba8be7 2275 {
Kojto 123:b0220dba8be7 2276 uint32_t fftLenReal; /**< length of the real FFT. */
Kojto 123:b0220dba8be7 2277 uint8_t ifftFlagR; /**< flag that selects forward (ifftFlagR=0) or inverse (ifftFlagR=1) transform. */
Kojto 123:b0220dba8be7 2278 uint8_t bitReverseFlagR; /**< flag that enables (bitReverseFlagR=1) or disables (bitReverseFlagR=0) bit reversal of output. */
Kojto 123:b0220dba8be7 2279 uint32_t twidCoefRModifier; /**< twiddle coefficient modifier that supports different size FFTs with the same twiddle factor table. */
Kojto 123:b0220dba8be7 2280 q15_t *pTwiddleAReal; /**< points to the real twiddle factor table. */
Kojto 123:b0220dba8be7 2281 q15_t *pTwiddleBReal; /**< points to the imag twiddle factor table. */
Kojto 123:b0220dba8be7 2282 const arm_cfft_instance_q15 *pCfft; /**< points to the complex FFT instance. */
Kojto 123:b0220dba8be7 2283 } arm_rfft_instance_q15;
Kojto 123:b0220dba8be7 2284
Kojto 123:b0220dba8be7 2285 arm_status arm_rfft_init_q15(
Kojto 123:b0220dba8be7 2286 arm_rfft_instance_q15 * S,
Kojto 123:b0220dba8be7 2287 uint32_t fftLenReal,
Kojto 123:b0220dba8be7 2288 uint32_t ifftFlagR,
Kojto 123:b0220dba8be7 2289 uint32_t bitReverseFlag);
Kojto 123:b0220dba8be7 2290
Kojto 123:b0220dba8be7 2291 void arm_rfft_q15(
Kojto 123:b0220dba8be7 2292 const arm_rfft_instance_q15 * S,
Kojto 123:b0220dba8be7 2293 q15_t * pSrc,
Kojto 123:b0220dba8be7 2294 q15_t * pDst);
Kojto 123:b0220dba8be7 2295
Kojto 123:b0220dba8be7 2296 /**
Kojto 123:b0220dba8be7 2297 * @brief Instance structure for the Q31 RFFT/RIFFT function.
Kojto 123:b0220dba8be7 2298 */
Kojto 123:b0220dba8be7 2299
Kojto 123:b0220dba8be7 2300 typedef struct
Kojto 123:b0220dba8be7 2301 {
Kojto 123:b0220dba8be7 2302 uint32_t fftLenReal; /**< length of the real FFT. */
Kojto 123:b0220dba8be7 2303 uint8_t ifftFlagR; /**< flag that selects forward (ifftFlagR=0) or inverse (ifftFlagR=1) transform. */
Kojto 123:b0220dba8be7 2304 uint8_t bitReverseFlagR; /**< flag that enables (bitReverseFlagR=1) or disables (bitReverseFlagR=0) bit reversal of output. */
Kojto 123:b0220dba8be7 2305 uint32_t twidCoefRModifier; /**< twiddle coefficient modifier that supports different size FFTs with the same twiddle factor table. */
Kojto 123:b0220dba8be7 2306 q31_t *pTwiddleAReal; /**< points to the real twiddle factor table. */
Kojto 123:b0220dba8be7 2307 q31_t *pTwiddleBReal; /**< points to the imag twiddle factor table. */
Kojto 123:b0220dba8be7 2308 const arm_cfft_instance_q31 *pCfft; /**< points to the complex FFT instance. */
Kojto 123:b0220dba8be7 2309 } arm_rfft_instance_q31;
Kojto 123:b0220dba8be7 2310
Kojto 123:b0220dba8be7 2311 arm_status arm_rfft_init_q31(
Kojto 123:b0220dba8be7 2312 arm_rfft_instance_q31 * S,
Kojto 123:b0220dba8be7 2313 uint32_t fftLenReal,
Kojto 123:b0220dba8be7 2314 uint32_t ifftFlagR,
Kojto 123:b0220dba8be7 2315 uint32_t bitReverseFlag);
Kojto 123:b0220dba8be7 2316
Kojto 123:b0220dba8be7 2317 void arm_rfft_q31(
Kojto 123:b0220dba8be7 2318 const arm_rfft_instance_q31 * S,
Kojto 123:b0220dba8be7 2319 q31_t * pSrc,
Kojto 123:b0220dba8be7 2320 q31_t * pDst);
Kojto 123:b0220dba8be7 2321
Kojto 123:b0220dba8be7 2322 /**
Kojto 123:b0220dba8be7 2323 * @brief Instance structure for the floating-point RFFT/RIFFT function.
Kojto 123:b0220dba8be7 2324 */
Kojto 123:b0220dba8be7 2325
Kojto 123:b0220dba8be7 2326 typedef struct
Kojto 123:b0220dba8be7 2327 {
Kojto 123:b0220dba8be7 2328 uint32_t fftLenReal; /**< length of the real FFT. */
Kojto 123:b0220dba8be7 2329 uint16_t fftLenBy2; /**< length of the complex FFT. */
Kojto 123:b0220dba8be7 2330 uint8_t ifftFlagR; /**< flag that selects forward (ifftFlagR=0) or inverse (ifftFlagR=1) transform. */
Kojto 123:b0220dba8be7 2331 uint8_t bitReverseFlagR; /**< flag that enables (bitReverseFlagR=1) or disables (bitReverseFlagR=0) bit reversal of output. */
Kojto 123:b0220dba8be7 2332 uint32_t twidCoefRModifier; /**< twiddle coefficient modifier that supports different size FFTs with the same twiddle factor table. */
Kojto 123:b0220dba8be7 2333 float32_t *pTwiddleAReal; /**< points to the real twiddle factor table. */
Kojto 123:b0220dba8be7 2334 float32_t *pTwiddleBReal; /**< points to the imag twiddle factor table. */
Kojto 123:b0220dba8be7 2335 arm_cfft_radix4_instance_f32 *pCfft; /**< points to the complex FFT instance. */
Kojto 123:b0220dba8be7 2336 } arm_rfft_instance_f32;
Kojto 123:b0220dba8be7 2337
Kojto 123:b0220dba8be7 2338 arm_status arm_rfft_init_f32(
Kojto 123:b0220dba8be7 2339 arm_rfft_instance_f32 * S,
Kojto 123:b0220dba8be7 2340 arm_cfft_radix4_instance_f32 * S_CFFT,
Kojto 123:b0220dba8be7 2341 uint32_t fftLenReal,
Kojto 123:b0220dba8be7 2342 uint32_t ifftFlagR,
Kojto 123:b0220dba8be7 2343 uint32_t bitReverseFlag);
Kojto 123:b0220dba8be7 2344
Kojto 123:b0220dba8be7 2345 void arm_rfft_f32(
Kojto 123:b0220dba8be7 2346 const arm_rfft_instance_f32 * S,
Kojto 123:b0220dba8be7 2347 float32_t * pSrc,
Kojto 123:b0220dba8be7 2348 float32_t * pDst);
Kojto 123:b0220dba8be7 2349
Kojto 123:b0220dba8be7 2350 /**
Kojto 123:b0220dba8be7 2351 * @brief Instance structure for the floating-point RFFT/RIFFT function.
Kojto 123:b0220dba8be7 2352 */
Kojto 123:b0220dba8be7 2353
Kojto 123:b0220dba8be7 2354 typedef struct
Kojto 123:b0220dba8be7 2355 {
Kojto 123:b0220dba8be7 2356 arm_cfft_instance_f32 Sint; /**< Internal CFFT structure. */
Kojto 123:b0220dba8be7 2357 uint16_t fftLenRFFT; /**< length of the real sequence */
Kojto 123:b0220dba8be7 2358 float32_t * pTwiddleRFFT; /**< Twiddle factors real stage */
Kojto 123:b0220dba8be7 2359 } arm_rfft_fast_instance_f32 ;
Kojto 123:b0220dba8be7 2360
Kojto 123:b0220dba8be7 2361 arm_status arm_rfft_fast_init_f32 (
Kojto 123:b0220dba8be7 2362 arm_rfft_fast_instance_f32 * S,
Kojto 123:b0220dba8be7 2363 uint16_t fftLen);
Kojto 123:b0220dba8be7 2364
Kojto 123:b0220dba8be7 2365 void arm_rfft_fast_f32(
Kojto 123:b0220dba8be7 2366 arm_rfft_fast_instance_f32 * S,
Kojto 123:b0220dba8be7 2367 float32_t * p, float32_t * pOut,
Kojto 123:b0220dba8be7 2368 uint8_t ifftFlag);
Kojto 123:b0220dba8be7 2369
Kojto 123:b0220dba8be7 2370 /**
Kojto 123:b0220dba8be7 2371 * @brief Instance structure for the floating-point DCT4/IDCT4 function.
Kojto 123:b0220dba8be7 2372 */
Kojto 123:b0220dba8be7 2373
Kojto 123:b0220dba8be7 2374 typedef struct
Kojto 123:b0220dba8be7 2375 {
Kojto 123:b0220dba8be7 2376 uint16_t N; /**< length of the DCT4. */
Kojto 123:b0220dba8be7 2377 uint16_t Nby2; /**< half of the length of the DCT4. */
Kojto 123:b0220dba8be7 2378 float32_t normalize; /**< normalizing factor. */
Kojto 123:b0220dba8be7 2379 float32_t *pTwiddle; /**< points to the twiddle factor table. */
Kojto 123:b0220dba8be7 2380 float32_t *pCosFactor; /**< points to the cosFactor table. */
Kojto 123:b0220dba8be7 2381 arm_rfft_instance_f32 *pRfft; /**< points to the real FFT instance. */
Kojto 123:b0220dba8be7 2382 arm_cfft_radix4_instance_f32 *pCfft; /**< points to the complex FFT instance. */
Kojto 123:b0220dba8be7 2383 } arm_dct4_instance_f32;
Kojto 123:b0220dba8be7 2384
Kojto 123:b0220dba8be7 2385 /**
Kojto 123:b0220dba8be7 2386 * @brief Initialization function for the floating-point DCT4/IDCT4.
Kojto 123:b0220dba8be7 2387 * @param[in,out] *S points to an instance of floating-point DCT4/IDCT4 structure.
Kojto 123:b0220dba8be7 2388 * @param[in] *S_RFFT points to an instance of floating-point RFFT/RIFFT structure.
Kojto 123:b0220dba8be7 2389 * @param[in] *S_CFFT points to an instance of floating-point CFFT/CIFFT structure.
Kojto 123:b0220dba8be7 2390 * @param[in] N length of the DCT4.
Kojto 123:b0220dba8be7 2391 * @param[in] Nby2 half of the length of the DCT4.
Kojto 123:b0220dba8be7 2392 * @param[in] normalize normalizing factor.
Kojto 123:b0220dba8be7 2393 * @return arm_status function returns ARM_MATH_SUCCESS if initialization is successful or ARM_MATH_ARGUMENT_ERROR if <code>fftLenReal</code> is not a supported transform length.
Kojto 123:b0220dba8be7 2394 */
Kojto 123:b0220dba8be7 2395
Kojto 123:b0220dba8be7 2396 arm_status arm_dct4_init_f32(
Kojto 123:b0220dba8be7 2397 arm_dct4_instance_f32 * S,
Kojto 123:b0220dba8be7 2398 arm_rfft_instance_f32 * S_RFFT,
Kojto 123:b0220dba8be7 2399 arm_cfft_radix4_instance_f32 * S_CFFT,
Kojto 123:b0220dba8be7 2400 uint16_t N,
Kojto 123:b0220dba8be7 2401 uint16_t Nby2,
Kojto 123:b0220dba8be7 2402 float32_t normalize);
Kojto 123:b0220dba8be7 2403
Kojto 123:b0220dba8be7 2404 /**
Kojto 123:b0220dba8be7 2405 * @brief Processing function for the floating-point DCT4/IDCT4.
Kojto 123:b0220dba8be7 2406 * @param[in] *S points to an instance of the floating-point DCT4/IDCT4 structure.
Kojto 123:b0220dba8be7 2407 * @param[in] *pState points to state buffer.
Kojto 123:b0220dba8be7 2408 * @param[in,out] *pInlineBuffer points to the in-place input and output buffer.
Kojto 123:b0220dba8be7 2409 * @return none.
Kojto 123:b0220dba8be7 2410 */
Kojto 123:b0220dba8be7 2411
Kojto 123:b0220dba8be7 2412 void arm_dct4_f32(
Kojto 123:b0220dba8be7 2413 const arm_dct4_instance_f32 * S,
Kojto 123:b0220dba8be7 2414 float32_t * pState,
Kojto 123:b0220dba8be7 2415 float32_t * pInlineBuffer);
Kojto 123:b0220dba8be7 2416
Kojto 123:b0220dba8be7 2417 /**
Kojto 123:b0220dba8be7 2418 * @brief Instance structure for the Q31 DCT4/IDCT4 function.
Kojto 123:b0220dba8be7 2419 */
Kojto 123:b0220dba8be7 2420
Kojto 123:b0220dba8be7 2421 typedef struct
Kojto 123:b0220dba8be7 2422 {
Kojto 123:b0220dba8be7 2423 uint16_t N; /**< length of the DCT4. */
Kojto 123:b0220dba8be7 2424 uint16_t Nby2; /**< half of the length of the DCT4. */
Kojto 123:b0220dba8be7 2425 q31_t normalize; /**< normalizing factor. */
Kojto 123:b0220dba8be7 2426 q31_t *pTwiddle; /**< points to the twiddle factor table. */
Kojto 123:b0220dba8be7 2427 q31_t *pCosFactor; /**< points to the cosFactor table. */
Kojto 123:b0220dba8be7 2428 arm_rfft_instance_q31 *pRfft; /**< points to the real FFT instance. */
Kojto 123:b0220dba8be7 2429 arm_cfft_radix4_instance_q31 *pCfft; /**< points to the complex FFT instance. */
Kojto 123:b0220dba8be7 2430 } arm_dct4_instance_q31;
Kojto 123:b0220dba8be7 2431
Kojto 123:b0220dba8be7 2432 /**
Kojto 123:b0220dba8be7 2433 * @brief Initialization function for the Q31 DCT4/IDCT4.
Kojto 123:b0220dba8be7 2434 * @param[in,out] *S points to an instance of Q31 DCT4/IDCT4 structure.
Kojto 123:b0220dba8be7 2435 * @param[in] *S_RFFT points to an instance of Q31 RFFT/RIFFT structure
Kojto 123:b0220dba8be7 2436 * @param[in] *S_CFFT points to an instance of Q31 CFFT/CIFFT structure
Kojto 123:b0220dba8be7 2437 * @param[in] N length of the DCT4.
Kojto 123:b0220dba8be7 2438 * @param[in] Nby2 half of the length of the DCT4.
Kojto 123:b0220dba8be7 2439 * @param[in] normalize normalizing factor.
Kojto 123:b0220dba8be7 2440 * @return arm_status function returns ARM_MATH_SUCCESS if initialization is successful or ARM_MATH_ARGUMENT_ERROR if <code>N</code> is not a supported transform length.
Kojto 123:b0220dba8be7 2441 */
Kojto 123:b0220dba8be7 2442
Kojto 123:b0220dba8be7 2443 arm_status arm_dct4_init_q31(
Kojto 123:b0220dba8be7 2444 arm_dct4_instance_q31 * S,
Kojto 123:b0220dba8be7 2445 arm_rfft_instance_q31 * S_RFFT,
Kojto 123:b0220dba8be7 2446 arm_cfft_radix4_instance_q31 * S_CFFT,
Kojto 123:b0220dba8be7 2447 uint16_t N,
Kojto 123:b0220dba8be7 2448 uint16_t Nby2,
Kojto 123:b0220dba8be7 2449 q31_t normalize);
Kojto 123:b0220dba8be7 2450
Kojto 123:b0220dba8be7 2451 /**
Kojto 123:b0220dba8be7 2452 * @brief Processing function for the Q31 DCT4/IDCT4.
Kojto 123:b0220dba8be7 2453 * @param[in] *S points to an instance of the Q31 DCT4 structure.
Kojto 123:b0220dba8be7 2454 * @param[in] *pState points to state buffer.
Kojto 123:b0220dba8be7 2455 * @param[in,out] *pInlineBuffer points to the in-place input and output buffer.
Kojto 123:b0220dba8be7 2456 * @return none.
Kojto 123:b0220dba8be7 2457 */
Kojto 123:b0220dba8be7 2458
Kojto 123:b0220dba8be7 2459 void arm_dct4_q31(
Kojto 123:b0220dba8be7 2460 const arm_dct4_instance_q31 * S,
Kojto 123:b0220dba8be7 2461 q31_t * pState,
Kojto 123:b0220dba8be7 2462 q31_t * pInlineBuffer);
Kojto 123:b0220dba8be7 2463
Kojto 123:b0220dba8be7 2464 /**
Kojto 123:b0220dba8be7 2465 * @brief Instance structure for the Q15 DCT4/IDCT4 function.
Kojto 123:b0220dba8be7 2466 */
Kojto 123:b0220dba8be7 2467
Kojto 123:b0220dba8be7 2468 typedef struct
Kojto 123:b0220dba8be7 2469 {
Kojto 123:b0220dba8be7 2470 uint16_t N; /**< length of the DCT4. */
Kojto 123:b0220dba8be7 2471 uint16_t Nby2; /**< half of the length of the DCT4. */
Kojto 123:b0220dba8be7 2472 q15_t normalize; /**< normalizing factor. */
Kojto 123:b0220dba8be7 2473 q15_t *pTwiddle; /**< points to the twiddle factor table. */
Kojto 123:b0220dba8be7 2474 q15_t *pCosFactor; /**< points to the cosFactor table. */
Kojto 123:b0220dba8be7 2475 arm_rfft_instance_q15 *pRfft; /**< points to the real FFT instance. */
Kojto 123:b0220dba8be7 2476 arm_cfft_radix4_instance_q15 *pCfft; /**< points to the complex FFT instance. */
Kojto 123:b0220dba8be7 2477 } arm_dct4_instance_q15;
Kojto 123:b0220dba8be7 2478
Kojto 123:b0220dba8be7 2479 /**
Kojto 123:b0220dba8be7 2480 * @brief Initialization function for the Q15 DCT4/IDCT4.
Kojto 123:b0220dba8be7 2481 * @param[in,out] *S points to an instance of Q15 DCT4/IDCT4 structure.
Kojto 123:b0220dba8be7 2482 * @param[in] *S_RFFT points to an instance of Q15 RFFT/RIFFT structure.
Kojto 123:b0220dba8be7 2483 * @param[in] *S_CFFT points to an instance of Q15 CFFT/CIFFT structure.
Kojto 123:b0220dba8be7 2484 * @param[in] N length of the DCT4.
Kojto 123:b0220dba8be7 2485 * @param[in] Nby2 half of the length of the DCT4.
Kojto 123:b0220dba8be7 2486 * @param[in] normalize normalizing factor.
Kojto 123:b0220dba8be7 2487 * @return arm_status function returns ARM_MATH_SUCCESS if initialization is successful or ARM_MATH_ARGUMENT_ERROR if <code>N</code> is not a supported transform length.
Kojto 123:b0220dba8be7 2488 */
Kojto 123:b0220dba8be7 2489
Kojto 123:b0220dba8be7 2490 arm_status arm_dct4_init_q15(
Kojto 123:b0220dba8be7 2491 arm_dct4_instance_q15 * S,
Kojto 123:b0220dba8be7 2492 arm_rfft_instance_q15 * S_RFFT,
Kojto 123:b0220dba8be7 2493 arm_cfft_radix4_instance_q15 * S_CFFT,
Kojto 123:b0220dba8be7 2494 uint16_t N,
Kojto 123:b0220dba8be7 2495 uint16_t Nby2,
Kojto 123:b0220dba8be7 2496 q15_t normalize);
Kojto 123:b0220dba8be7 2497
Kojto 123:b0220dba8be7 2498 /**
Kojto 123:b0220dba8be7 2499 * @brief Processing function for the Q15 DCT4/IDCT4.
Kojto 123:b0220dba8be7 2500 * @param[in] *S points to an instance of the Q15 DCT4 structure.
Kojto 123:b0220dba8be7 2501 * @param[in] *pState points to state buffer.
Kojto 123:b0220dba8be7 2502 * @param[in,out] *pInlineBuffer points to the in-place input and output buffer.
Kojto 123:b0220dba8be7 2503 * @return none.
Kojto 123:b0220dba8be7 2504 */
Kojto 123:b0220dba8be7 2505
Kojto 123:b0220dba8be7 2506 void arm_dct4_q15(
Kojto 123:b0220dba8be7 2507 const arm_dct4_instance_q15 * S,
Kojto 123:b0220dba8be7 2508 q15_t * pState,
Kojto 123:b0220dba8be7 2509 q15_t * pInlineBuffer);
Kojto 123:b0220dba8be7 2510
Kojto 123:b0220dba8be7 2511 /**
Kojto 123:b0220dba8be7 2512 * @brief Floating-point vector addition.
Kojto 123:b0220dba8be7 2513 * @param[in] *pSrcA points to the first input vector
Kojto 123:b0220dba8be7 2514 * @param[in] *pSrcB points to the second input vector
Kojto 123:b0220dba8be7 2515 * @param[out] *pDst points to the output vector
Kojto 123:b0220dba8be7 2516 * @param[in] blockSize number of samples in each vector
Kojto 123:b0220dba8be7 2517 * @return none.
Kojto 123:b0220dba8be7 2518 */
Kojto 123:b0220dba8be7 2519
Kojto 123:b0220dba8be7 2520 void arm_add_f32(
Kojto 123:b0220dba8be7 2521 float32_t * pSrcA,
Kojto 123:b0220dba8be7 2522 float32_t * pSrcB,
Kojto 123:b0220dba8be7 2523 float32_t * pDst,
Kojto 123:b0220dba8be7 2524 uint32_t blockSize);
Kojto 123:b0220dba8be7 2525
Kojto 123:b0220dba8be7 2526 /**
Kojto 123:b0220dba8be7 2527 * @brief Q7 vector addition.
Kojto 123:b0220dba8be7 2528 * @param[in] *pSrcA points to the first input vector
Kojto 123:b0220dba8be7 2529 * @param[in] *pSrcB points to the second input vector
Kojto 123:b0220dba8be7 2530 * @param[out] *pDst points to the output vector
Kojto 123:b0220dba8be7 2531 * @param[in] blockSize number of samples in each vector
Kojto 123:b0220dba8be7 2532 * @return none.
Kojto 123:b0220dba8be7 2533 */
Kojto 123:b0220dba8be7 2534
Kojto 123:b0220dba8be7 2535 void arm_add_q7(
Kojto 123:b0220dba8be7 2536 q7_t * pSrcA,
Kojto 123:b0220dba8be7 2537 q7_t * pSrcB,
Kojto 123:b0220dba8be7 2538 q7_t * pDst,
Kojto 123:b0220dba8be7 2539 uint32_t blockSize);
Kojto 123:b0220dba8be7 2540
Kojto 123:b0220dba8be7 2541 /**
Kojto 123:b0220dba8be7 2542 * @brief Q15 vector addition.
Kojto 123:b0220dba8be7 2543 * @param[in] *pSrcA points to the first input vector
Kojto 123:b0220dba8be7 2544 * @param[in] *pSrcB points to the second input vector
Kojto 123:b0220dba8be7 2545 * @param[out] *pDst points to the output vector
Kojto 123:b0220dba8be7 2546 * @param[in] blockSize number of samples in each vector
Kojto 123:b0220dba8be7 2547 * @return none.
Kojto 123:b0220dba8be7 2548 */
Kojto 123:b0220dba8be7 2549
Kojto 123:b0220dba8be7 2550 void arm_add_q15(
Kojto 123:b0220dba8be7 2551 q15_t * pSrcA,
Kojto 123:b0220dba8be7 2552 q15_t * pSrcB,
Kojto 123:b0220dba8be7 2553 q15_t * pDst,
Kojto 123:b0220dba8be7 2554 uint32_t blockSize);
Kojto 123:b0220dba8be7 2555
Kojto 123:b0220dba8be7 2556 /**
Kojto 123:b0220dba8be7 2557 * @brief Q31 vector addition.
Kojto 123:b0220dba8be7 2558 * @param[in] *pSrcA points to the first input vector
Kojto 123:b0220dba8be7 2559 * @param[in] *pSrcB points to the second input vector
Kojto 123:b0220dba8be7 2560 * @param[out] *pDst points to the output vector
Kojto 123:b0220dba8be7 2561 * @param[in] blockSize number of samples in each vector
Kojto 123:b0220dba8be7 2562 * @return none.
Kojto 123:b0220dba8be7 2563 */
Kojto 123:b0220dba8be7 2564
Kojto 123:b0220dba8be7 2565 void arm_add_q31(
Kojto 123:b0220dba8be7 2566 q31_t * pSrcA,
Kojto 123:b0220dba8be7 2567 q31_t * pSrcB,
Kojto 123:b0220dba8be7 2568 q31_t * pDst,
Kojto 123:b0220dba8be7 2569 uint32_t blockSize);
Kojto 123:b0220dba8be7 2570
Kojto 123:b0220dba8be7 2571 /**
Kojto 123:b0220dba8be7 2572 * @brief Floating-point vector subtraction.
Kojto 123:b0220dba8be7 2573 * @param[in] *pSrcA points to the first input vector
Kojto 123:b0220dba8be7 2574 * @param[in] *pSrcB points to the second input vector
Kojto 123:b0220dba8be7 2575 * @param[out] *pDst points to the output vector
Kojto 123:b0220dba8be7 2576 * @param[in] blockSize number of samples in each vector
Kojto 123:b0220dba8be7 2577 * @return none.
Kojto 123:b0220dba8be7 2578 */
Kojto 123:b0220dba8be7 2579
Kojto 123:b0220dba8be7 2580 void arm_sub_f32(
Kojto 123:b0220dba8be7 2581 float32_t * pSrcA,
Kojto 123:b0220dba8be7 2582 float32_t * pSrcB,
Kojto 123:b0220dba8be7 2583 float32_t * pDst,
Kojto 123:b0220dba8be7 2584 uint32_t blockSize);
Kojto 123:b0220dba8be7 2585
Kojto 123:b0220dba8be7 2586 /**
Kojto 123:b0220dba8be7 2587 * @brief Q7 vector subtraction.
Kojto 123:b0220dba8be7 2588 * @param[in] *pSrcA points to the first input vector
Kojto 123:b0220dba8be7 2589 * @param[in] *pSrcB points to the second input vector
Kojto 123:b0220dba8be7 2590 * @param[out] *pDst points to the output vector
Kojto 123:b0220dba8be7 2591 * @param[in] blockSize number of samples in each vector
Kojto 123:b0220dba8be7 2592 * @return none.
Kojto 123:b0220dba8be7 2593 */
Kojto 123:b0220dba8be7 2594
Kojto 123:b0220dba8be7 2595 void arm_sub_q7(
Kojto 123:b0220dba8be7 2596 q7_t * pSrcA,
Kojto 123:b0220dba8be7 2597 q7_t * pSrcB,
Kojto 123:b0220dba8be7 2598 q7_t * pDst,
Kojto 123:b0220dba8be7 2599 uint32_t blockSize);
Kojto 123:b0220dba8be7 2600
Kojto 123:b0220dba8be7 2601 /**
Kojto 123:b0220dba8be7 2602 * @brief Q15 vector subtraction.
Kojto 123:b0220dba8be7 2603 * @param[in] *pSrcA points to the first input vector
Kojto 123:b0220dba8be7 2604 * @param[in] *pSrcB points to the second input vector
Kojto 123:b0220dba8be7 2605 * @param[out] *pDst points to the output vector
Kojto 123:b0220dba8be7 2606 * @param[in] blockSize number of samples in each vector
Kojto 123:b0220dba8be7 2607 * @return none.
Kojto 123:b0220dba8be7 2608 */
Kojto 123:b0220dba8be7 2609
Kojto 123:b0220dba8be7 2610 void arm_sub_q15(
Kojto 123:b0220dba8be7 2611 q15_t * pSrcA,
Kojto 123:b0220dba8be7 2612 q15_t * pSrcB,
Kojto 123:b0220dba8be7 2613 q15_t * pDst,
Kojto 123:b0220dba8be7 2614 uint32_t blockSize);
Kojto 123:b0220dba8be7 2615
Kojto 123:b0220dba8be7 2616 /**
Kojto 123:b0220dba8be7 2617 * @brief Q31 vector subtraction.
Kojto 123:b0220dba8be7 2618 * @param[in] *pSrcA points to the first input vector
Kojto 123:b0220dba8be7 2619 * @param[in] *pSrcB points to the second input vector
Kojto 123:b0220dba8be7 2620 * @param[out] *pDst points to the output vector
Kojto 123:b0220dba8be7 2621 * @param[in] blockSize number of samples in each vector
Kojto 123:b0220dba8be7 2622 * @return none.
Kojto 123:b0220dba8be7 2623 */
Kojto 123:b0220dba8be7 2624
Kojto 123:b0220dba8be7 2625 void arm_sub_q31(
Kojto 123:b0220dba8be7 2626 q31_t * pSrcA,
Kojto 123:b0220dba8be7 2627 q31_t * pSrcB,
Kojto 123:b0220dba8be7 2628 q31_t * pDst,
Kojto 123:b0220dba8be7 2629 uint32_t blockSize);
Kojto 123:b0220dba8be7 2630
Kojto 123:b0220dba8be7 2631 /**
Kojto 123:b0220dba8be7 2632 * @brief Multiplies a floating-point vector by a scalar.
Kojto 123:b0220dba8be7 2633 * @param[in] *pSrc points to the input vector
Kojto 123:b0220dba8be7 2634 * @param[in] scale scale factor to be applied
Kojto 123:b0220dba8be7 2635 * @param[out] *pDst points to the output vector
Kojto 123:b0220dba8be7 2636 * @param[in] blockSize number of samples in the vector
Kojto 123:b0220dba8be7 2637 * @return none.
Kojto 123:b0220dba8be7 2638 */
Kojto 123:b0220dba8be7 2639
Kojto 123:b0220dba8be7 2640 void arm_scale_f32(
Kojto 123:b0220dba8be7 2641 float32_t * pSrc,
Kojto 123:b0220dba8be7 2642 float32_t scale,
Kojto 123:b0220dba8be7 2643 float32_t * pDst,
Kojto 123:b0220dba8be7 2644 uint32_t blockSize);
Kojto 123:b0220dba8be7 2645
Kojto 123:b0220dba8be7 2646 /**
Kojto 123:b0220dba8be7 2647 * @brief Multiplies a Q7 vector by a scalar.
Kojto 123:b0220dba8be7 2648 * @param[in] *pSrc points to the input vector
Kojto 123:b0220dba8be7 2649 * @param[in] scaleFract fractional portion of the scale value
Kojto 123:b0220dba8be7 2650 * @param[in] shift number of bits to shift the result by
Kojto 123:b0220dba8be7 2651 * @param[out] *pDst points to the output vector
Kojto 123:b0220dba8be7 2652 * @param[in] blockSize number of samples in the vector
Kojto 123:b0220dba8be7 2653 * @return none.
Kojto 123:b0220dba8be7 2654 */
Kojto 123:b0220dba8be7 2655
Kojto 123:b0220dba8be7 2656 void arm_scale_q7(
Kojto 123:b0220dba8be7 2657 q7_t * pSrc,
Kojto 123:b0220dba8be7 2658 q7_t scaleFract,
Kojto 123:b0220dba8be7 2659 int8_t shift,
Kojto 123:b0220dba8be7 2660 q7_t * pDst,
Kojto 123:b0220dba8be7 2661 uint32_t blockSize);
Kojto 123:b0220dba8be7 2662
Kojto 123:b0220dba8be7 2663 /**
Kojto 123:b0220dba8be7 2664 * @brief Multiplies a Q15 vector by a scalar.
Kojto 123:b0220dba8be7 2665 * @param[in] *pSrc points to the input vector
Kojto 123:b0220dba8be7 2666 * @param[in] scaleFract fractional portion of the scale value
Kojto 123:b0220dba8be7 2667 * @param[in] shift number of bits to shift the result by
Kojto 123:b0220dba8be7 2668 * @param[out] *pDst points to the output vector
Kojto 123:b0220dba8be7 2669 * @param[in] blockSize number of samples in the vector
Kojto 123:b0220dba8be7 2670 * @return none.
Kojto 123:b0220dba8be7 2671 */
Kojto 123:b0220dba8be7 2672
Kojto 123:b0220dba8be7 2673 void arm_scale_q15(
Kojto 123:b0220dba8be7 2674 q15_t * pSrc,
Kojto 123:b0220dba8be7 2675 q15_t scaleFract,
Kojto 123:b0220dba8be7 2676 int8_t shift,
Kojto 123:b0220dba8be7 2677 q15_t * pDst,
Kojto 123:b0220dba8be7 2678 uint32_t blockSize);
Kojto 123:b0220dba8be7 2679
Kojto 123:b0220dba8be7 2680 /**
Kojto 123:b0220dba8be7 2681 * @brief Multiplies a Q31 vector by a scalar.
Kojto 123:b0220dba8be7 2682 * @param[in] *pSrc points to the input vector
Kojto 123:b0220dba8be7 2683 * @param[in] scaleFract fractional portion of the scale value
Kojto 123:b0220dba8be7 2684 * @param[in] shift number of bits to shift the result by
Kojto 123:b0220dba8be7 2685 * @param[out] *pDst points to the output vector
Kojto 123:b0220dba8be7 2686 * @param[in] blockSize number of samples in the vector
Kojto 123:b0220dba8be7 2687 * @return none.
Kojto 123:b0220dba8be7 2688 */
Kojto 123:b0220dba8be7 2689
Kojto 123:b0220dba8be7 2690 void arm_scale_q31(
Kojto 123:b0220dba8be7 2691 q31_t * pSrc,
Kojto 123:b0220dba8be7 2692 q31_t scaleFract,
Kojto 123:b0220dba8be7 2693 int8_t shift,
Kojto 123:b0220dba8be7 2694 q31_t * pDst,
Kojto 123:b0220dba8be7 2695 uint32_t blockSize);
Kojto 123:b0220dba8be7 2696
Kojto 123:b0220dba8be7 2697 /**
Kojto 123:b0220dba8be7 2698 * @brief Q7 vector absolute value.
Kojto 123:b0220dba8be7 2699 * @param[in] *pSrc points to the input buffer
Kojto 123:b0220dba8be7 2700 * @param[out] *pDst points to the output buffer
Kojto 123:b0220dba8be7 2701 * @param[in] blockSize number of samples in each vector
Kojto 123:b0220dba8be7 2702 * @return none.
Kojto 123:b0220dba8be7 2703 */
Kojto 123:b0220dba8be7 2704
Kojto 123:b0220dba8be7 2705 void arm_abs_q7(
Kojto 123:b0220dba8be7 2706 q7_t * pSrc,
Kojto 123:b0220dba8be7 2707 q7_t * pDst,
Kojto 123:b0220dba8be7 2708 uint32_t blockSize);
Kojto 123:b0220dba8be7 2709
Kojto 123:b0220dba8be7 2710 /**
Kojto 123:b0220dba8be7 2711 * @brief Floating-point vector absolute value.
Kojto 123:b0220dba8be7 2712 * @param[in] *pSrc points to the input buffer
Kojto 123:b0220dba8be7 2713 * @param[out] *pDst points to the output buffer
Kojto 123:b0220dba8be7 2714 * @param[in] blockSize number of samples in each vector
Kojto 123:b0220dba8be7 2715 * @return none.
Kojto 123:b0220dba8be7 2716 */
Kojto 123:b0220dba8be7 2717
Kojto 123:b0220dba8be7 2718 void arm_abs_f32(
Kojto 123:b0220dba8be7 2719 float32_t * pSrc,
Kojto 123:b0220dba8be7 2720 float32_t * pDst,
Kojto 123:b0220dba8be7 2721 uint32_t blockSize);
Kojto 123:b0220dba8be7 2722
Kojto 123:b0220dba8be7 2723 /**
Kojto 123:b0220dba8be7 2724 * @brief Q15 vector absolute value.
Kojto 123:b0220dba8be7 2725 * @param[in] *pSrc points to the input buffer
Kojto 123:b0220dba8be7 2726 * @param[out] *pDst points to the output buffer
Kojto 123:b0220dba8be7 2727 * @param[in] blockSize number of samples in each vector
Kojto 123:b0220dba8be7 2728 * @return none.
Kojto 123:b0220dba8be7 2729 */
Kojto 123:b0220dba8be7 2730
Kojto 123:b0220dba8be7 2731 void arm_abs_q15(
Kojto 123:b0220dba8be7 2732 q15_t * pSrc,
Kojto 123:b0220dba8be7 2733 q15_t * pDst,
Kojto 123:b0220dba8be7 2734 uint32_t blockSize);
Kojto 123:b0220dba8be7 2735
Kojto 123:b0220dba8be7 2736 /**
Kojto 123:b0220dba8be7 2737 * @brief Q31 vector absolute value.
Kojto 123:b0220dba8be7 2738 * @param[in] *pSrc points to the input buffer
Kojto 123:b0220dba8be7 2739 * @param[out] *pDst points to the output buffer
Kojto 123:b0220dba8be7 2740 * @param[in] blockSize number of samples in each vector
Kojto 123:b0220dba8be7 2741 * @return none.
Kojto 123:b0220dba8be7 2742 */
Kojto 123:b0220dba8be7 2743
Kojto 123:b0220dba8be7 2744 void arm_abs_q31(
Kojto 123:b0220dba8be7 2745 q31_t * pSrc,
Kojto 123:b0220dba8be7 2746 q31_t * pDst,
Kojto 123:b0220dba8be7 2747 uint32_t blockSize);
Kojto 123:b0220dba8be7 2748
Kojto 123:b0220dba8be7 2749 /**
Kojto 123:b0220dba8be7 2750 * @brief Dot product of floating-point vectors.
Kojto 123:b0220dba8be7 2751 * @param[in] *pSrcA points to the first input vector
Kojto 123:b0220dba8be7 2752 * @param[in] *pSrcB points to the second input vector
Kojto 123:b0220dba8be7 2753 * @param[in] blockSize number of samples in each vector
Kojto 123:b0220dba8be7 2754 * @param[out] *result output result returned here
Kojto 123:b0220dba8be7 2755 * @return none.
Kojto 123:b0220dba8be7 2756 */
Kojto 123:b0220dba8be7 2757
Kojto 123:b0220dba8be7 2758 void arm_dot_prod_f32(
Kojto 123:b0220dba8be7 2759 float32_t * pSrcA,
Kojto 123:b0220dba8be7 2760 float32_t * pSrcB,
Kojto 123:b0220dba8be7 2761 uint32_t blockSize,
Kojto 123:b0220dba8be7 2762 float32_t * result);
Kojto 123:b0220dba8be7 2763
Kojto 123:b0220dba8be7 2764 /**
Kojto 123:b0220dba8be7 2765 * @brief Dot product of Q7 vectors.
Kojto 123:b0220dba8be7 2766 * @param[in] *pSrcA points to the first input vector
Kojto 123:b0220dba8be7 2767 * @param[in] *pSrcB points to the second input vector
Kojto 123:b0220dba8be7 2768 * @param[in] blockSize number of samples in each vector
Kojto 123:b0220dba8be7 2769 * @param[out] *result output result returned here
Kojto 123:b0220dba8be7 2770 * @return none.
Kojto 123:b0220dba8be7 2771 */
Kojto 123:b0220dba8be7 2772
Kojto 123:b0220dba8be7 2773 void arm_dot_prod_q7(
Kojto 123:b0220dba8be7 2774 q7_t * pSrcA,
Kojto 123:b0220dba8be7 2775 q7_t * pSrcB,
Kojto 123:b0220dba8be7 2776 uint32_t blockSize,
Kojto 123:b0220dba8be7 2777 q31_t * result);
Kojto 123:b0220dba8be7 2778
Kojto 123:b0220dba8be7 2779 /**
Kojto 123:b0220dba8be7 2780 * @brief Dot product of Q15 vectors.
Kojto 123:b0220dba8be7 2781 * @param[in] *pSrcA points to the first input vector
Kojto 123:b0220dba8be7 2782 * @param[in] *pSrcB points to the second input vector
Kojto 123:b0220dba8be7 2783 * @param[in] blockSize number of samples in each vector
Kojto 123:b0220dba8be7 2784 * @param[out] *result output result returned here
Kojto 123:b0220dba8be7 2785 * @return none.
Kojto 123:b0220dba8be7 2786 */
Kojto 123:b0220dba8be7 2787
Kojto 123:b0220dba8be7 2788 void arm_dot_prod_q15(
Kojto 123:b0220dba8be7 2789 q15_t * pSrcA,
Kojto 123:b0220dba8be7 2790 q15_t * pSrcB,
Kojto 123:b0220dba8be7 2791 uint32_t blockSize,
Kojto 123:b0220dba8be7 2792 q63_t * result);
Kojto 123:b0220dba8be7 2793
Kojto 123:b0220dba8be7 2794 /**
Kojto 123:b0220dba8be7 2795 * @brief Dot product of Q31 vectors.
Kojto 123:b0220dba8be7 2796 * @param[in] *pSrcA points to the first input vector
Kojto 123:b0220dba8be7 2797 * @param[in] *pSrcB points to the second input vector
Kojto 123:b0220dba8be7 2798 * @param[in] blockSize number of samples in each vector
Kojto 123:b0220dba8be7 2799 * @param[out] *result output result returned here
Kojto 123:b0220dba8be7 2800 * @return none.
Kojto 123:b0220dba8be7 2801 */
Kojto 123:b0220dba8be7 2802
Kojto 123:b0220dba8be7 2803 void arm_dot_prod_q31(
Kojto 123:b0220dba8be7 2804 q31_t * pSrcA,
Kojto 123:b0220dba8be7 2805 q31_t * pSrcB,
Kojto 123:b0220dba8be7 2806 uint32_t blockSize,
Kojto 123:b0220dba8be7 2807 q63_t * result);
Kojto 123:b0220dba8be7 2808
Kojto 123:b0220dba8be7 2809 /**
Kojto 123:b0220dba8be7 2810 * @brief Shifts the elements of a Q7 vector a specified number of bits.
Kojto 123:b0220dba8be7 2811 * @param[in] *pSrc points to the input vector
Kojto 123:b0220dba8be7 2812 * @param[in] shiftBits number of bits to shift. A positive value shifts left; a negative value shifts right.
Kojto 123:b0220dba8be7 2813 * @param[out] *pDst points to the output vector
Kojto 123:b0220dba8be7 2814 * @param[in] blockSize number of samples in the vector
Kojto 123:b0220dba8be7 2815 * @return none.
Kojto 123:b0220dba8be7 2816 */
Kojto 123:b0220dba8be7 2817
Kojto 123:b0220dba8be7 2818 void arm_shift_q7(
Kojto 123:b0220dba8be7 2819 q7_t * pSrc,
Kojto 123:b0220dba8be7 2820 int8_t shiftBits,
Kojto 123:b0220dba8be7 2821 q7_t * pDst,
Kojto 123:b0220dba8be7 2822 uint32_t blockSize);
Kojto 123:b0220dba8be7 2823
Kojto 123:b0220dba8be7 2824 /**
Kojto 123:b0220dba8be7 2825 * @brief Shifts the elements of a Q15 vector a specified number of bits.
Kojto 123:b0220dba8be7 2826 * @param[in] *pSrc points to the input vector
Kojto 123:b0220dba8be7 2827 * @param[in] shiftBits number of bits to shift. A positive value shifts left; a negative value shifts right.
Kojto 123:b0220dba8be7 2828 * @param[out] *pDst points to the output vector
Kojto 123:b0220dba8be7 2829 * @param[in] blockSize number of samples in the vector
Kojto 123:b0220dba8be7 2830 * @return none.
Kojto 123:b0220dba8be7 2831 */
Kojto 123:b0220dba8be7 2832
Kojto 123:b0220dba8be7 2833 void arm_shift_q15(
Kojto 123:b0220dba8be7 2834 q15_t * pSrc,
Kojto 123:b0220dba8be7 2835 int8_t shiftBits,
Kojto 123:b0220dba8be7 2836 q15_t * pDst,
Kojto 123:b0220dba8be7 2837 uint32_t blockSize);
Kojto 123:b0220dba8be7 2838
Kojto 123:b0220dba8be7 2839 /**
Kojto 123:b0220dba8be7 2840 * @brief Shifts the elements of a Q31 vector a specified number of bits.
Kojto 123:b0220dba8be7 2841 * @param[in] *pSrc points to the input vector
Kojto 123:b0220dba8be7 2842 * @param[in] shiftBits number of bits to shift. A positive value shifts left; a negative value shifts right.
Kojto 123:b0220dba8be7 2843 * @param[out] *pDst points to the output vector
Kojto 123:b0220dba8be7 2844 * @param[in] blockSize number of samples in the vector
Kojto 123:b0220dba8be7 2845 * @return none.
Kojto 123:b0220dba8be7 2846 */
Kojto 123:b0220dba8be7 2847
Kojto 123:b0220dba8be7 2848 void arm_shift_q31(
Kojto 123:b0220dba8be7 2849 q31_t * pSrc,
Kojto 123:b0220dba8be7 2850 int8_t shiftBits,
Kojto 123:b0220dba8be7 2851 q31_t * pDst,
Kojto 123:b0220dba8be7 2852 uint32_t blockSize);
Kojto 123:b0220dba8be7 2853
Kojto 123:b0220dba8be7 2854 /**
Kojto 123:b0220dba8be7 2855 * @brief Adds a constant offset to a floating-point vector.
Kojto 123:b0220dba8be7 2856 * @param[in] *pSrc points to the input vector
Kojto 123:b0220dba8be7 2857 * @param[in] offset is the offset to be added
Kojto 123:b0220dba8be7 2858 * @param[out] *pDst points to the output vector
Kojto 123:b0220dba8be7 2859 * @param[in] blockSize number of samples in the vector
Kojto 123:b0220dba8be7 2860 * @return none.
Kojto 123:b0220dba8be7 2861 */
Kojto 123:b0220dba8be7 2862
Kojto 123:b0220dba8be7 2863 void arm_offset_f32(
Kojto 123:b0220dba8be7 2864 float32_t * pSrc,
Kojto 123:b0220dba8be7 2865 float32_t offset,
Kojto 123:b0220dba8be7 2866 float32_t * pDst,
Kojto 123:b0220dba8be7 2867 uint32_t blockSize);
Kojto 123:b0220dba8be7 2868
Kojto 123:b0220dba8be7 2869 /**
Kojto 123:b0220dba8be7 2870 * @brief Adds a constant offset to a Q7 vector.
Kojto 123:b0220dba8be7 2871 * @param[in] *pSrc points to the input vector
Kojto 123:b0220dba8be7 2872 * @param[in] offset is the offset to be added
Kojto 123:b0220dba8be7 2873 * @param[out] *pDst points to the output vector
Kojto 123:b0220dba8be7 2874 * @param[in] blockSize number of samples in the vector
Kojto 123:b0220dba8be7 2875 * @return none.
Kojto 123:b0220dba8be7 2876 */
Kojto 123:b0220dba8be7 2877
Kojto 123:b0220dba8be7 2878 void arm_offset_q7(
Kojto 123:b0220dba8be7 2879 q7_t * pSrc,
Kojto 123:b0220dba8be7 2880 q7_t offset,
Kojto 123:b0220dba8be7 2881 q7_t * pDst,
Kojto 123:b0220dba8be7 2882 uint32_t blockSize);
Kojto 123:b0220dba8be7 2883
Kojto 123:b0220dba8be7 2884 /**
Kojto 123:b0220dba8be7 2885 * @brief Adds a constant offset to a Q15 vector.
Kojto 123:b0220dba8be7 2886 * @param[in] *pSrc points to the input vector
Kojto 123:b0220dba8be7 2887 * @param[in] offset is the offset to be added
Kojto 123:b0220dba8be7 2888 * @param[out] *pDst points to the output vector
Kojto 123:b0220dba8be7 2889 * @param[in] blockSize number of samples in the vector
Kojto 123:b0220dba8be7 2890 * @return none.
Kojto 123:b0220dba8be7 2891 */
Kojto 123:b0220dba8be7 2892
Kojto 123:b0220dba8be7 2893 void arm_offset_q15(
Kojto 123:b0220dba8be7 2894 q15_t * pSrc,
Kojto 123:b0220dba8be7 2895 q15_t offset,
Kojto 123:b0220dba8be7 2896 q15_t * pDst,
Kojto 123:b0220dba8be7 2897 uint32_t blockSize);
Kojto 123:b0220dba8be7 2898
Kojto 123:b0220dba8be7 2899 /**
Kojto 123:b0220dba8be7 2900 * @brief Adds a constant offset to a Q31 vector.
Kojto 123:b0220dba8be7 2901 * @param[in] *pSrc points to the input vector
Kojto 123:b0220dba8be7 2902 * @param[in] offset is the offset to be added
Kojto 123:b0220dba8be7 2903 * @param[out] *pDst points to the output vector
Kojto 123:b0220dba8be7 2904 * @param[in] blockSize number of samples in the vector
Kojto 123:b0220dba8be7 2905 * @return none.
Kojto 123:b0220dba8be7 2906 */
Kojto 123:b0220dba8be7 2907
Kojto 123:b0220dba8be7 2908 void arm_offset_q31(
Kojto 123:b0220dba8be7 2909 q31_t * pSrc,
Kojto 123:b0220dba8be7 2910 q31_t offset,
Kojto 123:b0220dba8be7 2911 q31_t * pDst,
Kojto 123:b0220dba8be7 2912 uint32_t blockSize);
Kojto 123:b0220dba8be7 2913
Kojto 123:b0220dba8be7 2914 /**
Kojto 123:b0220dba8be7 2915 * @brief Negates the elements of a floating-point vector.
Kojto 123:b0220dba8be7 2916 * @param[in] *pSrc points to the input vector
Kojto 123:b0220dba8be7 2917 * @param[out] *pDst points to the output vector
Kojto 123:b0220dba8be7 2918 * @param[in] blockSize number of samples in the vector
Kojto 123:b0220dba8be7 2919 * @return none.
Kojto 123:b0220dba8be7 2920 */
Kojto 123:b0220dba8be7 2921
Kojto 123:b0220dba8be7 2922 void arm_negate_f32(
Kojto 123:b0220dba8be7 2923 float32_t * pSrc,
Kojto 123:b0220dba8be7 2924 float32_t * pDst,
Kojto 123:b0220dba8be7 2925 uint32_t blockSize);
Kojto 123:b0220dba8be7 2926
Kojto 123:b0220dba8be7 2927 /**
Kojto 123:b0220dba8be7 2928 * @brief Negates the elements of a Q7 vector.
Kojto 123:b0220dba8be7 2929 * @param[in] *pSrc points to the input vector
Kojto 123:b0220dba8be7 2930 * @param[out] *pDst points to the output vector
Kojto 123:b0220dba8be7 2931 * @param[in] blockSize number of samples in the vector
Kojto 123:b0220dba8be7 2932 * @return none.
Kojto 123:b0220dba8be7 2933 */
Kojto 123:b0220dba8be7 2934
Kojto 123:b0220dba8be7 2935 void arm_negate_q7(
Kojto 123:b0220dba8be7 2936 q7_t * pSrc,
Kojto 123:b0220dba8be7 2937 q7_t * pDst,
Kojto 123:b0220dba8be7 2938 uint32_t blockSize);
Kojto 123:b0220dba8be7 2939
Kojto 123:b0220dba8be7 2940 /**
Kojto 123:b0220dba8be7 2941 * @brief Negates the elements of a Q15 vector.
Kojto 123:b0220dba8be7 2942 * @param[in] *pSrc points to the input vector
Kojto 123:b0220dba8be7 2943 * @param[out] *pDst points to the output vector
Kojto 123:b0220dba8be7 2944 * @param[in] blockSize number of samples in the vector
Kojto 123:b0220dba8be7 2945 * @return none.
Kojto 123:b0220dba8be7 2946 */
Kojto 123:b0220dba8be7 2947
Kojto 123:b0220dba8be7 2948 void arm_negate_q15(
Kojto 123:b0220dba8be7 2949 q15_t * pSrc,
Kojto 123:b0220dba8be7 2950 q15_t * pDst,
Kojto 123:b0220dba8be7 2951 uint32_t blockSize);
Kojto 123:b0220dba8be7 2952
Kojto 123:b0220dba8be7 2953 /**
Kojto 123:b0220dba8be7 2954 * @brief Negates the elements of a Q31 vector.
Kojto 123:b0220dba8be7 2955 * @param[in] *pSrc points to the input vector
Kojto 123:b0220dba8be7 2956 * @param[out] *pDst points to the output vector
Kojto 123:b0220dba8be7 2957 * @param[in] blockSize number of samples in the vector
Kojto 123:b0220dba8be7 2958 * @return none.
Kojto 123:b0220dba8be7 2959 */
Kojto 123:b0220dba8be7 2960
Kojto 123:b0220dba8be7 2961 void arm_negate_q31(
Kojto 123:b0220dba8be7 2962 q31_t * pSrc,
Kojto 123:b0220dba8be7 2963 q31_t * pDst,
Kojto 123:b0220dba8be7 2964 uint32_t blockSize);
Kojto 123:b0220dba8be7 2965 /**
Kojto 123:b0220dba8be7 2966 * @brief Copies the elements of a floating-point vector.
Kojto 123:b0220dba8be7 2967 * @param[in] *pSrc input pointer
Kojto 123:b0220dba8be7 2968 * @param[out] *pDst output pointer
Kojto 123:b0220dba8be7 2969 * @param[in] blockSize number of samples to process
Kojto 123:b0220dba8be7 2970 * @return none.
Kojto 123:b0220dba8be7 2971 */
Kojto 123:b0220dba8be7 2972 void arm_copy_f32(
Kojto 123:b0220dba8be7 2973 float32_t * pSrc,
Kojto 123:b0220dba8be7 2974 float32_t * pDst,
Kojto 123:b0220dba8be7 2975 uint32_t blockSize);
Kojto 123:b0220dba8be7 2976
Kojto 123:b0220dba8be7 2977 /**
Kojto 123:b0220dba8be7 2978 * @brief Copies the elements of a Q7 vector.
Kojto 123:b0220dba8be7 2979 * @param[in] *pSrc input pointer
Kojto 123:b0220dba8be7 2980 * @param[out] *pDst output pointer
Kojto 123:b0220dba8be7 2981 * @param[in] blockSize number of samples to process
Kojto 123:b0220dba8be7 2982 * @return none.
Kojto 123:b0220dba8be7 2983 */
Kojto 123:b0220dba8be7 2984 void arm_copy_q7(
Kojto 123:b0220dba8be7 2985 q7_t * pSrc,
Kojto 123:b0220dba8be7 2986 q7_t * pDst,
Kojto 123:b0220dba8be7 2987 uint32_t blockSize);
Kojto 123:b0220dba8be7 2988
Kojto 123:b0220dba8be7 2989 /**
Kojto 123:b0220dba8be7 2990 * @brief Copies the elements of a Q15 vector.
Kojto 123:b0220dba8be7 2991 * @param[in] *pSrc input pointer
Kojto 123:b0220dba8be7 2992 * @param[out] *pDst output pointer
Kojto 123:b0220dba8be7 2993 * @param[in] blockSize number of samples to process
Kojto 123:b0220dba8be7 2994 * @return none.
Kojto 123:b0220dba8be7 2995 */
Kojto 123:b0220dba8be7 2996 void arm_copy_q15(
Kojto 123:b0220dba8be7 2997 q15_t * pSrc,
Kojto 123:b0220dba8be7 2998 q15_t * pDst,
Kojto 123:b0220dba8be7 2999 uint32_t blockSize);
Kojto 123:b0220dba8be7 3000
Kojto 123:b0220dba8be7 3001 /**
Kojto 123:b0220dba8be7 3002 * @brief Copies the elements of a Q31 vector.
Kojto 123:b0220dba8be7 3003 * @param[in] *pSrc input pointer
Kojto 123:b0220dba8be7 3004 * @param[out] *pDst output pointer
Kojto 123:b0220dba8be7 3005 * @param[in] blockSize number of samples to process
Kojto 123:b0220dba8be7 3006 * @return none.
Kojto 123:b0220dba8be7 3007 */
Kojto 123:b0220dba8be7 3008 void arm_copy_q31(
Kojto 123:b0220dba8be7 3009 q31_t * pSrc,
Kojto 123:b0220dba8be7 3010 q31_t * pDst,
Kojto 123:b0220dba8be7 3011 uint32_t blockSize);
Kojto 123:b0220dba8be7 3012 /**
Kojto 123:b0220dba8be7 3013 * @brief Fills a constant value into a floating-point vector.
Kojto 123:b0220dba8be7 3014 * @param[in] value input value to be filled
Kojto 123:b0220dba8be7 3015 * @param[out] *pDst output pointer
Kojto 123:b0220dba8be7 3016 * @param[in] blockSize number of samples to process
Kojto 123:b0220dba8be7 3017 * @return none.
Kojto 123:b0220dba8be7 3018 */
Kojto 123:b0220dba8be7 3019 void arm_fill_f32(
Kojto 123:b0220dba8be7 3020 float32_t value,
Kojto 123:b0220dba8be7 3021 float32_t * pDst,
Kojto 123:b0220dba8be7 3022 uint32_t blockSize);
Kojto 123:b0220dba8be7 3023
Kojto 123:b0220dba8be7 3024 /**
Kojto 123:b0220dba8be7 3025 * @brief Fills a constant value into a Q7 vector.
Kojto 123:b0220dba8be7 3026 * @param[in] value input value to be filled
Kojto 123:b0220dba8be7 3027 * @param[out] *pDst output pointer
Kojto 123:b0220dba8be7 3028 * @param[in] blockSize number of samples to process
Kojto 123:b0220dba8be7 3029 * @return none.
Kojto 123:b0220dba8be7 3030 */
Kojto 123:b0220dba8be7 3031 void arm_fill_q7(
Kojto 123:b0220dba8be7 3032 q7_t value,
Kojto 123:b0220dba8be7 3033 q7_t * pDst,
Kojto 123:b0220dba8be7 3034 uint32_t blockSize);
Kojto 123:b0220dba8be7 3035
Kojto 123:b0220dba8be7 3036 /**
Kojto 123:b0220dba8be7 3037 * @brief Fills a constant value into a Q15 vector.
Kojto 123:b0220dba8be7 3038 * @param[in] value input value to be filled
Kojto 123:b0220dba8be7 3039 * @param[out] *pDst output pointer
Kojto 123:b0220dba8be7 3040 * @param[in] blockSize number of samples to process
Kojto 123:b0220dba8be7 3041 * @return none.
Kojto 123:b0220dba8be7 3042 */
Kojto 123:b0220dba8be7 3043 void arm_fill_q15(
Kojto 123:b0220dba8be7 3044 q15_t value,
Kojto 123:b0220dba8be7 3045 q15_t * pDst,
Kojto 123:b0220dba8be7 3046 uint32_t blockSize);
Kojto 123:b0220dba8be7 3047
Kojto 123:b0220dba8be7 3048 /**
Kojto 123:b0220dba8be7 3049 * @brief Fills a constant value into a Q31 vector.
Kojto 123:b0220dba8be7 3050 * @param[in] value input value to be filled
Kojto 123:b0220dba8be7 3051 * @param[out] *pDst output pointer
Kojto 123:b0220dba8be7 3052 * @param[in] blockSize number of samples to process
Kojto 123:b0220dba8be7 3053 * @return none.
Kojto 123:b0220dba8be7 3054 */
Kojto 123:b0220dba8be7 3055 void arm_fill_q31(
Kojto 123:b0220dba8be7 3056 q31_t value,
Kojto 123:b0220dba8be7 3057 q31_t * pDst,
Kojto 123:b0220dba8be7 3058 uint32_t blockSize);
Kojto 123:b0220dba8be7 3059
Kojto 123:b0220dba8be7 3060 /**
Kojto 123:b0220dba8be7 3061 * @brief Convolution of floating-point sequences.
Kojto 123:b0220dba8be7 3062 * @param[in] *pSrcA points to the first input sequence.
Kojto 123:b0220dba8be7 3063 * @param[in] srcALen length of the first input sequence.
Kojto 123:b0220dba8be7 3064 * @param[in] *pSrcB points to the second input sequence.
Kojto 123:b0220dba8be7 3065 * @param[in] srcBLen length of the second input sequence.
Kojto 123:b0220dba8be7 3066 * @param[out] *pDst points to the location where the output result is written. Length srcALen+srcBLen-1.
Kojto 123:b0220dba8be7 3067 * @return none.
Kojto 123:b0220dba8be7 3068 */
Kojto 123:b0220dba8be7 3069
Kojto 123:b0220dba8be7 3070 void arm_conv_f32(
Kojto 123:b0220dba8be7 3071 float32_t * pSrcA,
Kojto 123:b0220dba8be7 3072 uint32_t srcALen,
Kojto 123:b0220dba8be7 3073 float32_t * pSrcB,
Kojto 123:b0220dba8be7 3074 uint32_t srcBLen,
Kojto 123:b0220dba8be7 3075 float32_t * pDst);
Kojto 123:b0220dba8be7 3076
Kojto 123:b0220dba8be7 3077
Kojto 123:b0220dba8be7 3078 /**
Kojto 123:b0220dba8be7 3079 * @brief Convolution of Q15 sequences.
Kojto 123:b0220dba8be7 3080 * @param[in] *pSrcA points to the first input sequence.
Kojto 123:b0220dba8be7 3081 * @param[in] srcALen length of the first input sequence.
Kojto 123:b0220dba8be7 3082 * @param[in] *pSrcB points to the second input sequence.
Kojto 123:b0220dba8be7 3083 * @param[in] srcBLen length of the second input sequence.
Kojto 123:b0220dba8be7 3084 * @param[out] *pDst points to the block of output data Length srcALen+srcBLen-1.
Kojto 123:b0220dba8be7 3085 * @param[in] *pScratch1 points to scratch buffer of size max(srcALen, srcBLen) + 2*min(srcALen, srcBLen) - 2.
Kojto 123:b0220dba8be7 3086 * @param[in] *pScratch2 points to scratch buffer of size min(srcALen, srcBLen).
Kojto 123:b0220dba8be7 3087 * @return none.
Kojto 123:b0220dba8be7 3088 */
Kojto 123:b0220dba8be7 3089
Kojto 123:b0220dba8be7 3090
Kojto 123:b0220dba8be7 3091 void arm_conv_opt_q15(
Kojto 123:b0220dba8be7 3092 q15_t * pSrcA,
Kojto 123:b0220dba8be7 3093 uint32_t srcALen,
Kojto 123:b0220dba8be7 3094 q15_t * pSrcB,
Kojto 123:b0220dba8be7 3095 uint32_t srcBLen,
Kojto 123:b0220dba8be7 3096 q15_t * pDst,
Kojto 123:b0220dba8be7 3097 q15_t * pScratch1,
Kojto 123:b0220dba8be7 3098 q15_t * pScratch2);
Kojto 123:b0220dba8be7 3099
Kojto 123:b0220dba8be7 3100
Kojto 123:b0220dba8be7 3101 /**
Kojto 123:b0220dba8be7 3102 * @brief Convolution of Q15 sequences.
Kojto 123:b0220dba8be7 3103 * @param[in] *pSrcA points to the first input sequence.
Kojto 123:b0220dba8be7 3104 * @param[in] srcALen length of the first input sequence.
Kojto 123:b0220dba8be7 3105 * @param[in] *pSrcB points to the second input sequence.
Kojto 123:b0220dba8be7 3106 * @param[in] srcBLen length of the second input sequence.
Kojto 123:b0220dba8be7 3107 * @param[out] *pDst points to the location where the output result is written. Length srcALen+srcBLen-1.
Kojto 123:b0220dba8be7 3108 * @return none.
Kojto 123:b0220dba8be7 3109 */
Kojto 123:b0220dba8be7 3110
Kojto 123:b0220dba8be7 3111 void arm_conv_q15(
Kojto 123:b0220dba8be7 3112 q15_t * pSrcA,
Kojto 123:b0220dba8be7 3113 uint32_t srcALen,
Kojto 123:b0220dba8be7 3114 q15_t * pSrcB,
Kojto 123:b0220dba8be7 3115 uint32_t srcBLen,
Kojto 123:b0220dba8be7 3116 q15_t * pDst);
Kojto 123:b0220dba8be7 3117
Kojto 123:b0220dba8be7 3118 /**
Kojto 123:b0220dba8be7 3119 * @brief Convolution of Q15 sequences (fast version) for Cortex-M3 and Cortex-M4
Kojto 123:b0220dba8be7 3120 * @param[in] *pSrcA points to the first input sequence.
Kojto 123:b0220dba8be7 3121 * @param[in] srcALen length of the first input sequence.
Kojto 123:b0220dba8be7 3122 * @param[in] *pSrcB points to the second input sequence.
Kojto 123:b0220dba8be7 3123 * @param[in] srcBLen length of the second input sequence.
Kojto 123:b0220dba8be7 3124 * @param[out] *pDst points to the block of output data Length srcALen+srcBLen-1.
Kojto 123:b0220dba8be7 3125 * @return none.
Kojto 123:b0220dba8be7 3126 */
Kojto 123:b0220dba8be7 3127
Kojto 123:b0220dba8be7 3128 void arm_conv_fast_q15(
Kojto 123:b0220dba8be7 3129 q15_t * pSrcA,
Kojto 123:b0220dba8be7 3130 uint32_t srcALen,
Kojto 123:b0220dba8be7 3131 q15_t * pSrcB,
Kojto 123:b0220dba8be7 3132 uint32_t srcBLen,
Kojto 123:b0220dba8be7 3133 q15_t * pDst);
Kojto 123:b0220dba8be7 3134
Kojto 123:b0220dba8be7 3135 /**
Kojto 123:b0220dba8be7 3136 * @brief Convolution of Q15 sequences (fast version) for Cortex-M3 and Cortex-M4
Kojto 123:b0220dba8be7 3137 * @param[in] *pSrcA points to the first input sequence.
Kojto 123:b0220dba8be7 3138 * @param[in] srcALen length of the first input sequence.
Kojto 123:b0220dba8be7 3139 * @param[in] *pSrcB points to the second input sequence.
Kojto 123:b0220dba8be7 3140 * @param[in] srcBLen length of the second input sequence.
Kojto 123:b0220dba8be7 3141 * @param[out] *pDst points to the block of output data Length srcALen+srcBLen-1.
Kojto 123:b0220dba8be7 3142 * @param[in] *pScratch1 points to scratch buffer of size max(srcALen, srcBLen) + 2*min(srcALen, srcBLen) - 2.
Kojto 123:b0220dba8be7 3143 * @param[in] *pScratch2 points to scratch buffer of size min(srcALen, srcBLen).
Kojto 123:b0220dba8be7 3144 * @return none.
Kojto 123:b0220dba8be7 3145 */
Kojto 123:b0220dba8be7 3146
Kojto 123:b0220dba8be7 3147 void arm_conv_fast_opt_q15(
Kojto 123:b0220dba8be7 3148 q15_t * pSrcA,
Kojto 123:b0220dba8be7 3149 uint32_t srcALen,
Kojto 123:b0220dba8be7 3150 q15_t * pSrcB,
Kojto 123:b0220dba8be7 3151 uint32_t srcBLen,
Kojto 123:b0220dba8be7 3152 q15_t * pDst,
Kojto 123:b0220dba8be7 3153 q15_t * pScratch1,
Kojto 123:b0220dba8be7 3154 q15_t * pScratch2);
Kojto 123:b0220dba8be7 3155
Kojto 123:b0220dba8be7 3156
Kojto 123:b0220dba8be7 3157
Kojto 123:b0220dba8be7 3158 /**
Kojto 123:b0220dba8be7 3159 * @brief Convolution of Q31 sequences.
Kojto 123:b0220dba8be7 3160 * @param[in] *pSrcA points to the first input sequence.
Kojto 123:b0220dba8be7 3161 * @param[in] srcALen length of the first input sequence.
Kojto 123:b0220dba8be7 3162 * @param[in] *pSrcB points to the second input sequence.
Kojto 123:b0220dba8be7 3163 * @param[in] srcBLen length of the second input sequence.
Kojto 123:b0220dba8be7 3164 * @param[out] *pDst points to the block of output data Length srcALen+srcBLen-1.
Kojto 123:b0220dba8be7 3165 * @return none.
Kojto 123:b0220dba8be7 3166 */
Kojto 123:b0220dba8be7 3167
Kojto 123:b0220dba8be7 3168 void arm_conv_q31(
Kojto 123:b0220dba8be7 3169 q31_t * pSrcA,
Kojto 123:b0220dba8be7 3170 uint32_t srcALen,
Kojto 123:b0220dba8be7 3171 q31_t * pSrcB,
Kojto 123:b0220dba8be7 3172 uint32_t srcBLen,
Kojto 123:b0220dba8be7 3173 q31_t * pDst);
Kojto 123:b0220dba8be7 3174
Kojto 123:b0220dba8be7 3175 /**
Kojto 123:b0220dba8be7 3176 * @brief Convolution of Q31 sequences (fast version) for Cortex-M3 and Cortex-M4
Kojto 123:b0220dba8be7 3177 * @param[in] *pSrcA points to the first input sequence.
Kojto 123:b0220dba8be7 3178 * @param[in] srcALen length of the first input sequence.
Kojto 123:b0220dba8be7 3179 * @param[in] *pSrcB points to the second input sequence.
Kojto 123:b0220dba8be7 3180 * @param[in] srcBLen length of the second input sequence.
Kojto 123:b0220dba8be7 3181 * @param[out] *pDst points to the block of output data Length srcALen+srcBLen-1.
Kojto 123:b0220dba8be7 3182 * @return none.
Kojto 123:b0220dba8be7 3183 */
Kojto 123:b0220dba8be7 3184
Kojto 123:b0220dba8be7 3185 void arm_conv_fast_q31(
Kojto 123:b0220dba8be7 3186 q31_t * pSrcA,
Kojto 123:b0220dba8be7 3187 uint32_t srcALen,
Kojto 123:b0220dba8be7 3188 q31_t * pSrcB,
Kojto 123:b0220dba8be7 3189 uint32_t srcBLen,
Kojto 123:b0220dba8be7 3190 q31_t * pDst);
Kojto 123:b0220dba8be7 3191
Kojto 123:b0220dba8be7 3192
Kojto 123:b0220dba8be7 3193 /**
Kojto 123:b0220dba8be7 3194 * @brief Convolution of Q7 sequences.
Kojto 123:b0220dba8be7 3195 * @param[in] *pSrcA points to the first input sequence.
Kojto 123:b0220dba8be7 3196 * @param[in] srcALen length of the first input sequence.
Kojto 123:b0220dba8be7 3197 * @param[in] *pSrcB points to the second input sequence.
Kojto 123:b0220dba8be7 3198 * @param[in] srcBLen length of the second input sequence.
Kojto 123:b0220dba8be7 3199 * @param[out] *pDst points to the block of output data Length srcALen+srcBLen-1.
Kojto 123:b0220dba8be7 3200 * @param[in] *pScratch1 points to scratch buffer(of type q15_t) of size max(srcALen, srcBLen) + 2*min(srcALen, srcBLen) - 2.
Kojto 123:b0220dba8be7 3201 * @param[in] *pScratch2 points to scratch buffer (of type q15_t) of size min(srcALen, srcBLen).
Kojto 123:b0220dba8be7 3202 * @return none.
Kojto 123:b0220dba8be7 3203 */
Kojto 123:b0220dba8be7 3204
Kojto 123:b0220dba8be7 3205 void arm_conv_opt_q7(
Kojto 123:b0220dba8be7 3206 q7_t * pSrcA,
Kojto 123:b0220dba8be7 3207 uint32_t srcALen,
Kojto 123:b0220dba8be7 3208 q7_t * pSrcB,
Kojto 123:b0220dba8be7 3209 uint32_t srcBLen,
Kojto 123:b0220dba8be7 3210 q7_t * pDst,
Kojto 123:b0220dba8be7 3211 q15_t * pScratch1,
Kojto 123:b0220dba8be7 3212 q15_t * pScratch2);
Kojto 123:b0220dba8be7 3213
Kojto 123:b0220dba8be7 3214
Kojto 123:b0220dba8be7 3215
Kojto 123:b0220dba8be7 3216 /**
Kojto 123:b0220dba8be7 3217 * @brief Convolution of Q7 sequences.
Kojto 123:b0220dba8be7 3218 * @param[in] *pSrcA points to the first input sequence.
Kojto 123:b0220dba8be7 3219 * @param[in] srcALen length of the first input sequence.
Kojto 123:b0220dba8be7 3220 * @param[in] *pSrcB points to the second input sequence.
Kojto 123:b0220dba8be7 3221 * @param[in] srcBLen length of the second input sequence.
Kojto 123:b0220dba8be7 3222 * @param[out] *pDst points to the block of output data Length srcALen+srcBLen-1.
Kojto 123:b0220dba8be7 3223 * @return none.
Kojto 123:b0220dba8be7 3224 */
Kojto 123:b0220dba8be7 3225
Kojto 123:b0220dba8be7 3226 void arm_conv_q7(
Kojto 123:b0220dba8be7 3227 q7_t * pSrcA,
Kojto 123:b0220dba8be7 3228 uint32_t srcALen,
Kojto 123:b0220dba8be7 3229 q7_t * pSrcB,
Kojto 123:b0220dba8be7 3230 uint32_t srcBLen,
Kojto 123:b0220dba8be7 3231 q7_t * pDst);
Kojto 123:b0220dba8be7 3232
Kojto 123:b0220dba8be7 3233
Kojto 123:b0220dba8be7 3234 /**
Kojto 123:b0220dba8be7 3235 * @brief Partial convolution of floating-point sequences.
Kojto 123:b0220dba8be7 3236 * @param[in] *pSrcA points to the first input sequence.
Kojto 123:b0220dba8be7 3237 * @param[in] srcALen length of the first input sequence.
Kojto 123:b0220dba8be7 3238 * @param[in] *pSrcB points to the second input sequence.
Kojto 123:b0220dba8be7 3239 * @param[in] srcBLen length of the second input sequence.
Kojto 123:b0220dba8be7 3240 * @param[out] *pDst points to the block of output data
Kojto 123:b0220dba8be7 3241 * @param[in] firstIndex is the first output sample to start with.
Kojto 123:b0220dba8be7 3242 * @param[in] numPoints is the number of output points to be computed.
Kojto 123:b0220dba8be7 3243 * @return Returns either ARM_MATH_SUCCESS if the function completed correctly or ARM_MATH_ARGUMENT_ERROR if the requested subset is not in the range [0 srcALen+srcBLen-2].
Kojto 123:b0220dba8be7 3244 */
Kojto 123:b0220dba8be7 3245
Kojto 123:b0220dba8be7 3246 arm_status arm_conv_partial_f32(
Kojto 123:b0220dba8be7 3247 float32_t * pSrcA,
Kojto 123:b0220dba8be7 3248 uint32_t srcALen,
Kojto 123:b0220dba8be7 3249 float32_t * pSrcB,
Kojto 123:b0220dba8be7 3250 uint32_t srcBLen,
Kojto 123:b0220dba8be7 3251 float32_t * pDst,
Kojto 123:b0220dba8be7 3252 uint32_t firstIndex,
Kojto 123:b0220dba8be7 3253 uint32_t numPoints);
Kojto 123:b0220dba8be7 3254
Kojto 123:b0220dba8be7 3255 /**
Kojto 123:b0220dba8be7 3256 * @brief Partial convolution of Q15 sequences.
Kojto 123:b0220dba8be7 3257 * @param[in] *pSrcA points to the first input sequence.
Kojto 123:b0220dba8be7 3258 * @param[in] srcALen length of the first input sequence.
Kojto 123:b0220dba8be7 3259 * @param[in] *pSrcB points to the second input sequence.
Kojto 123:b0220dba8be7 3260 * @param[in] srcBLen length of the second input sequence.
Kojto 123:b0220dba8be7 3261 * @param[out] *pDst points to the block of output data
Kojto 123:b0220dba8be7 3262 * @param[in] firstIndex is the first output sample to start with.
Kojto 123:b0220dba8be7 3263 * @param[in] numPoints is the number of output points to be computed.
Kojto 123:b0220dba8be7 3264 * @param[in] * pScratch1 points to scratch buffer of size max(srcALen, srcBLen) + 2*min(srcALen, srcBLen) - 2.
Kojto 123:b0220dba8be7 3265 * @param[in] * pScratch2 points to scratch buffer of size min(srcALen, srcBLen).
Kojto 123:b0220dba8be7 3266 * @return Returns either ARM_MATH_SUCCESS if the function completed correctly or ARM_MATH_ARGUMENT_ERROR if the requested subset is not in the range [0 srcALen+srcBLen-2].
Kojto 123:b0220dba8be7 3267 */
Kojto 123:b0220dba8be7 3268
Kojto 123:b0220dba8be7 3269 arm_status arm_conv_partial_opt_q15(
Kojto 123:b0220dba8be7 3270 q15_t * pSrcA,
Kojto 123:b0220dba8be7 3271 uint32_t srcALen,
Kojto 123:b0220dba8be7 3272 q15_t * pSrcB,
Kojto 123:b0220dba8be7 3273 uint32_t srcBLen,
Kojto 123:b0220dba8be7 3274 q15_t * pDst,
Kojto 123:b0220dba8be7 3275 uint32_t firstIndex,
Kojto 123:b0220dba8be7 3276 uint32_t numPoints,
Kojto 123:b0220dba8be7 3277 q15_t * pScratch1,
Kojto 123:b0220dba8be7 3278 q15_t * pScratch2);
Kojto 123:b0220dba8be7 3279
Kojto 123:b0220dba8be7 3280
Kojto 123:b0220dba8be7 3281 /**
Kojto 123:b0220dba8be7 3282 * @brief Partial convolution of Q15 sequences.
Kojto 123:b0220dba8be7 3283 * @param[in] *pSrcA points to the first input sequence.
Kojto 123:b0220dba8be7 3284 * @param[in] srcALen length of the first input sequence.
Kojto 123:b0220dba8be7 3285 * @param[in] *pSrcB points to the second input sequence.
Kojto 123:b0220dba8be7 3286 * @param[in] srcBLen length of the second input sequence.
Kojto 123:b0220dba8be7 3287 * @param[out] *pDst points to the block of output data
Kojto 123:b0220dba8be7 3288 * @param[in] firstIndex is the first output sample to start with.
Kojto 123:b0220dba8be7 3289 * @param[in] numPoints is the number of output points to be computed.
Kojto 123:b0220dba8be7 3290 * @return Returns either ARM_MATH_SUCCESS if the function completed correctly or ARM_MATH_ARGUMENT_ERROR if the requested subset is not in the range [0 srcALen+srcBLen-2].
Kojto 123:b0220dba8be7 3291 */
Kojto 123:b0220dba8be7 3292
Kojto 123:b0220dba8be7 3293 arm_status arm_conv_partial_q15(
Kojto 123:b0220dba8be7 3294 q15_t * pSrcA,
Kojto 123:b0220dba8be7 3295 uint32_t srcALen,
Kojto 123:b0220dba8be7 3296 q15_t * pSrcB,
Kojto 123:b0220dba8be7 3297 uint32_t srcBLen,
Kojto 123:b0220dba8be7 3298 q15_t * pDst,
Kojto 123:b0220dba8be7 3299 uint32_t firstIndex,
Kojto 123:b0220dba8be7 3300 uint32_t numPoints);
Kojto 123:b0220dba8be7 3301
Kojto 123:b0220dba8be7 3302 /**
Kojto 123:b0220dba8be7 3303 * @brief Partial convolution of Q15 sequences (fast version) for Cortex-M3 and Cortex-M4
Kojto 123:b0220dba8be7 3304 * @param[in] *pSrcA points to the first input sequence.
Kojto 123:b0220dba8be7 3305 * @param[in] srcALen length of the first input sequence.
Kojto 123:b0220dba8be7 3306 * @param[in] *pSrcB points to the second input sequence.
Kojto 123:b0220dba8be7 3307 * @param[in] srcBLen length of the second input sequence.
Kojto 123:b0220dba8be7 3308 * @param[out] *pDst points to the block of output data
Kojto 123:b0220dba8be7 3309 * @param[in] firstIndex is the first output sample to start with.
Kojto 123:b0220dba8be7 3310 * @param[in] numPoints is the number of output points to be computed.
Kojto 123:b0220dba8be7 3311 * @return Returns either ARM_MATH_SUCCESS if the function completed correctly or ARM_MATH_ARGUMENT_ERROR if the requested subset is not in the range [0 srcALen+srcBLen-2].
Kojto 123:b0220dba8be7 3312 */
Kojto 123:b0220dba8be7 3313
Kojto 123:b0220dba8be7 3314 arm_status arm_conv_partial_fast_q15(
Kojto 123:b0220dba8be7 3315 q15_t * pSrcA,
Kojto 123:b0220dba8be7 3316 uint32_t srcALen,
Kojto 123:b0220dba8be7 3317 q15_t * pSrcB,
Kojto 123:b0220dba8be7 3318 uint32_t srcBLen,
Kojto 123:b0220dba8be7 3319 q15_t * pDst,
Kojto 123:b0220dba8be7 3320 uint32_t firstIndex,
Kojto 123:b0220dba8be7 3321 uint32_t numPoints);
Kojto 123:b0220dba8be7 3322
Kojto 123:b0220dba8be7 3323
Kojto 123:b0220dba8be7 3324 /**
Kojto 123:b0220dba8be7 3325 * @brief Partial convolution of Q15 sequences (fast version) for Cortex-M3 and Cortex-M4
Kojto 123:b0220dba8be7 3326 * @param[in] *pSrcA points to the first input sequence.
Kojto 123:b0220dba8be7 3327 * @param[in] srcALen length of the first input sequence.
Kojto 123:b0220dba8be7 3328 * @param[in] *pSrcB points to the second input sequence.
Kojto 123:b0220dba8be7 3329 * @param[in] srcBLen length of the second input sequence.
Kojto 123:b0220dba8be7 3330 * @param[out] *pDst points to the block of output data
Kojto 123:b0220dba8be7 3331 * @param[in] firstIndex is the first output sample to start with.
Kojto 123:b0220dba8be7 3332 * @param[in] numPoints is the number of output points to be computed.
Kojto 123:b0220dba8be7 3333 * @param[in] * pScratch1 points to scratch buffer of size max(srcALen, srcBLen) + 2*min(srcALen, srcBLen) - 2.
Kojto 123:b0220dba8be7 3334 * @param[in] * pScratch2 points to scratch buffer of size min(srcALen, srcBLen).
Kojto 123:b0220dba8be7 3335 * @return Returns either ARM_MATH_SUCCESS if the function completed correctly or ARM_MATH_ARGUMENT_ERROR if the requested subset is not in the range [0 srcALen+srcBLen-2].
Kojto 123:b0220dba8be7 3336 */
Kojto 123:b0220dba8be7 3337
Kojto 123:b0220dba8be7 3338 arm_status arm_conv_partial_fast_opt_q15(
Kojto 123:b0220dba8be7 3339 q15_t * pSrcA,
Kojto 123:b0220dba8be7 3340 uint32_t srcALen,
Kojto 123:b0220dba8be7 3341 q15_t * pSrcB,
Kojto 123:b0220dba8be7 3342 uint32_t srcBLen,
Kojto 123:b0220dba8be7 3343 q15_t * pDst,
Kojto 123:b0220dba8be7 3344 uint32_t firstIndex,
Kojto 123:b0220dba8be7 3345 uint32_t numPoints,
Kojto 123:b0220dba8be7 3346 q15_t * pScratch1,
Kojto 123:b0220dba8be7 3347 q15_t * pScratch2);
Kojto 123:b0220dba8be7 3348
Kojto 123:b0220dba8be7 3349
Kojto 123:b0220dba8be7 3350 /**
Kojto 123:b0220dba8be7 3351 * @brief Partial convolution of Q31 sequences.
Kojto 123:b0220dba8be7 3352 * @param[in] *pSrcA points to the first input sequence.
Kojto 123:b0220dba8be7 3353 * @param[in] srcALen length of the first input sequence.
Kojto 123:b0220dba8be7 3354 * @param[in] *pSrcB points to the second input sequence.
Kojto 123:b0220dba8be7 3355 * @param[in] srcBLen length of the second input sequence.
Kojto 123:b0220dba8be7 3356 * @param[out] *pDst points to the block of output data
Kojto 123:b0220dba8be7 3357 * @param[in] firstIndex is the first output sample to start with.
Kojto 123:b0220dba8be7 3358 * @param[in] numPoints is the number of output points to be computed.
Kojto 123:b0220dba8be7 3359 * @return Returns either ARM_MATH_SUCCESS if the function completed correctly or ARM_MATH_ARGUMENT_ERROR if the requested subset is not in the range [0 srcALen+srcBLen-2].
Kojto 123:b0220dba8be7 3360 */
Kojto 123:b0220dba8be7 3361
Kojto 123:b0220dba8be7 3362 arm_status arm_conv_partial_q31(
Kojto 123:b0220dba8be7 3363 q31_t * pSrcA,
Kojto 123:b0220dba8be7 3364 uint32_t srcALen,
Kojto 123:b0220dba8be7 3365 q31_t * pSrcB,
Kojto 123:b0220dba8be7 3366 uint32_t srcBLen,
Kojto 123:b0220dba8be7 3367 q31_t * pDst,
Kojto 123:b0220dba8be7 3368 uint32_t firstIndex,
Kojto 123:b0220dba8be7 3369 uint32_t numPoints);
Kojto 123:b0220dba8be7 3370
Kojto 123:b0220dba8be7 3371
Kojto 123:b0220dba8be7 3372 /**
Kojto 123:b0220dba8be7 3373 * @brief Partial convolution of Q31 sequences (fast version) for Cortex-M3 and Cortex-M4
Kojto 123:b0220dba8be7 3374 * @param[in] *pSrcA points to the first input sequence.
Kojto 123:b0220dba8be7 3375 * @param[in] srcALen length of the first input sequence.
Kojto 123:b0220dba8be7 3376 * @param[in] *pSrcB points to the second input sequence.
Kojto 123:b0220dba8be7 3377 * @param[in] srcBLen length of the second input sequence.
Kojto 123:b0220dba8be7 3378 * @param[out] *pDst points to the block of output data
Kojto 123:b0220dba8be7 3379 * @param[in] firstIndex is the first output sample to start with.
Kojto 123:b0220dba8be7 3380 * @param[in] numPoints is the number of output points to be computed.
Kojto 123:b0220dba8be7 3381 * @return Returns either ARM_MATH_SUCCESS if the function completed correctly or ARM_MATH_ARGUMENT_ERROR if the requested subset is not in the range [0 srcALen+srcBLen-2].
Kojto 123:b0220dba8be7 3382 */
Kojto 123:b0220dba8be7 3383
Kojto 123:b0220dba8be7 3384 arm_status arm_conv_partial_fast_q31(
Kojto 123:b0220dba8be7 3385 q31_t * pSrcA,
Kojto 123:b0220dba8be7 3386 uint32_t srcALen,
Kojto 123:b0220dba8be7 3387 q31_t * pSrcB,
Kojto 123:b0220dba8be7 3388 uint32_t srcBLen,
Kojto 123:b0220dba8be7 3389 q31_t * pDst,
Kojto 123:b0220dba8be7 3390 uint32_t firstIndex,
Kojto 123:b0220dba8be7 3391 uint32_t numPoints);
Kojto 123:b0220dba8be7 3392
Kojto 123:b0220dba8be7 3393
Kojto 123:b0220dba8be7 3394 /**
Kojto 123:b0220dba8be7 3395 * @brief Partial convolution of Q7 sequences
Kojto 123:b0220dba8be7 3396 * @param[in] *pSrcA points to the first input sequence.
Kojto 123:b0220dba8be7 3397 * @param[in] srcALen length of the first input sequence.
Kojto 123:b0220dba8be7 3398 * @param[in] *pSrcB points to the second input sequence.
Kojto 123:b0220dba8be7 3399 * @param[in] srcBLen length of the second input sequence.
Kojto 123:b0220dba8be7 3400 * @param[out] *pDst points to the block of output data
Kojto 123:b0220dba8be7 3401 * @param[in] firstIndex is the first output sample to start with.
Kojto 123:b0220dba8be7 3402 * @param[in] numPoints is the number of output points to be computed.
Kojto 123:b0220dba8be7 3403 * @param[in] *pScratch1 points to scratch buffer(of type q15_t) of size max(srcALen, srcBLen) + 2*min(srcALen, srcBLen) - 2.
Kojto 123:b0220dba8be7 3404 * @param[in] *pScratch2 points to scratch buffer (of type q15_t) of size min(srcALen, srcBLen).
Kojto 123:b0220dba8be7 3405 * @return Returns either ARM_MATH_SUCCESS if the function completed correctly or ARM_MATH_ARGUMENT_ERROR if the requested subset is not in the range [0 srcALen+srcBLen-2].
Kojto 123:b0220dba8be7 3406 */
Kojto 123:b0220dba8be7 3407
Kojto 123:b0220dba8be7 3408 arm_status arm_conv_partial_opt_q7(
Kojto 123:b0220dba8be7 3409 q7_t * pSrcA,
Kojto 123:b0220dba8be7 3410 uint32_t srcALen,
Kojto 123:b0220dba8be7 3411 q7_t * pSrcB,
Kojto 123:b0220dba8be7 3412 uint32_t srcBLen,
Kojto 123:b0220dba8be7 3413 q7_t * pDst,
Kojto 123:b0220dba8be7 3414 uint32_t firstIndex,
Kojto 123:b0220dba8be7 3415 uint32_t numPoints,
Kojto 123:b0220dba8be7 3416 q15_t * pScratch1,
Kojto 123:b0220dba8be7 3417 q15_t * pScratch2);
Kojto 123:b0220dba8be7 3418
Kojto 123:b0220dba8be7 3419
Kojto 123:b0220dba8be7 3420 /**
Kojto 123:b0220dba8be7 3421 * @brief Partial convolution of Q7 sequences.
Kojto 123:b0220dba8be7 3422 * @param[in] *pSrcA points to the first input sequence.
Kojto 123:b0220dba8be7 3423 * @param[in] srcALen length of the first input sequence.
Kojto 123:b0220dba8be7 3424 * @param[in] *pSrcB points to the second input sequence.
Kojto 123:b0220dba8be7 3425 * @param[in] srcBLen length of the second input sequence.
Kojto 123:b0220dba8be7 3426 * @param[out] *pDst points to the block of output data
Kojto 123:b0220dba8be7 3427 * @param[in] firstIndex is the first output sample to start with.
Kojto 123:b0220dba8be7 3428 * @param[in] numPoints is the number of output points to be computed.
Kojto 123:b0220dba8be7 3429 * @return Returns either ARM_MATH_SUCCESS if the function completed correctly or ARM_MATH_ARGUMENT_ERROR if the requested subset is not in the range [0 srcALen+srcBLen-2].
Kojto 123:b0220dba8be7 3430 */
Kojto 123:b0220dba8be7 3431
Kojto 123:b0220dba8be7 3432 arm_status arm_conv_partial_q7(
Kojto 123:b0220dba8be7 3433 q7_t * pSrcA,
Kojto 123:b0220dba8be7 3434 uint32_t srcALen,
Kojto 123:b0220dba8be7 3435 q7_t * pSrcB,
Kojto 123:b0220dba8be7 3436 uint32_t srcBLen,
Kojto 123:b0220dba8be7 3437 q7_t * pDst,
Kojto 123:b0220dba8be7 3438 uint32_t firstIndex,
Kojto 123:b0220dba8be7 3439 uint32_t numPoints);
Kojto 123:b0220dba8be7 3440
Kojto 123:b0220dba8be7 3441
Kojto 123:b0220dba8be7 3442
Kojto 123:b0220dba8be7 3443 /**
Kojto 123:b0220dba8be7 3444 * @brief Instance structure for the Q15 FIR decimator.
Kojto 123:b0220dba8be7 3445 */
Kojto 123:b0220dba8be7 3446
Kojto 123:b0220dba8be7 3447 typedef struct
Kojto 123:b0220dba8be7 3448 {
Kojto 123:b0220dba8be7 3449 uint8_t M; /**< decimation factor. */
Kojto 123:b0220dba8be7 3450 uint16_t numTaps; /**< number of coefficients in the filter. */
Kojto 123:b0220dba8be7 3451 q15_t *pCoeffs; /**< points to the coefficient array. The array is of length numTaps.*/
Kojto 123:b0220dba8be7 3452 q15_t *pState; /**< points to the state variable array. The array is of length numTaps+blockSize-1. */
Kojto 123:b0220dba8be7 3453 } arm_fir_decimate_instance_q15;
Kojto 123:b0220dba8be7 3454
Kojto 123:b0220dba8be7 3455 /**
Kojto 123:b0220dba8be7 3456 * @brief Instance structure for the Q31 FIR decimator.
Kojto 123:b0220dba8be7 3457 */
Kojto 123:b0220dba8be7 3458
Kojto 123:b0220dba8be7 3459 typedef struct
Kojto 123:b0220dba8be7 3460 {
Kojto 123:b0220dba8be7 3461 uint8_t M; /**< decimation factor. */
Kojto 123:b0220dba8be7 3462 uint16_t numTaps; /**< number of coefficients in the filter. */
Kojto 123:b0220dba8be7 3463 q31_t *pCoeffs; /**< points to the coefficient array. The array is of length numTaps.*/
Kojto 123:b0220dba8be7 3464 q31_t *pState; /**< points to the state variable array. The array is of length numTaps+blockSize-1. */
Kojto 123:b0220dba8be7 3465
Kojto 123:b0220dba8be7 3466 } arm_fir_decimate_instance_q31;
Kojto 123:b0220dba8be7 3467
Kojto 123:b0220dba8be7 3468 /**
Kojto 123:b0220dba8be7 3469 * @brief Instance structure for the floating-point FIR decimator.
Kojto 123:b0220dba8be7 3470 */
Kojto 123:b0220dba8be7 3471
Kojto 123:b0220dba8be7 3472 typedef struct
Kojto 123:b0220dba8be7 3473 {
Kojto 123:b0220dba8be7 3474 uint8_t M; /**< decimation factor. */
Kojto 123:b0220dba8be7 3475 uint16_t numTaps; /**< number of coefficients in the filter. */
Kojto 123:b0220dba8be7 3476 float32_t *pCoeffs; /**< points to the coefficient array. The array is of length numTaps.*/
Kojto 123:b0220dba8be7 3477 float32_t *pState; /**< points to the state variable array. The array is of length numTaps+blockSize-1. */
Kojto 123:b0220dba8be7 3478
Kojto 123:b0220dba8be7 3479 } arm_fir_decimate_instance_f32;
Kojto 123:b0220dba8be7 3480
Kojto 123:b0220dba8be7 3481
Kojto 123:b0220dba8be7 3482
Kojto 123:b0220dba8be7 3483 /**
Kojto 123:b0220dba8be7 3484 * @brief Processing function for the floating-point FIR decimator.
Kojto 123:b0220dba8be7 3485 * @param[in] *S points to an instance of the floating-point FIR decimator structure.
Kojto 123:b0220dba8be7 3486 * @param[in] *pSrc points to the block of input data.
Kojto 123:b0220dba8be7 3487 * @param[out] *pDst points to the block of output data
Kojto 123:b0220dba8be7 3488 * @param[in] blockSize number of input samples to process per call.
Kojto 123:b0220dba8be7 3489 * @return none
Kojto 123:b0220dba8be7 3490 */
Kojto 123:b0220dba8be7 3491
Kojto 123:b0220dba8be7 3492 void arm_fir_decimate_f32(
Kojto 123:b0220dba8be7 3493 const arm_fir_decimate_instance_f32 * S,
Kojto 123:b0220dba8be7 3494 float32_t * pSrc,
Kojto 123:b0220dba8be7 3495 float32_t * pDst,
Kojto 123:b0220dba8be7 3496 uint32_t blockSize);
Kojto 123:b0220dba8be7 3497
Kojto 123:b0220dba8be7 3498
Kojto 123:b0220dba8be7 3499 /**
Kojto 123:b0220dba8be7 3500 * @brief Initialization function for the floating-point FIR decimator.
Kojto 123:b0220dba8be7 3501 * @param[in,out] *S points to an instance of the floating-point FIR decimator structure.
Kojto 123:b0220dba8be7 3502 * @param[in] numTaps number of coefficients in the filter.
Kojto 123:b0220dba8be7 3503 * @param[in] M decimation factor.
Kojto 123:b0220dba8be7 3504 * @param[in] *pCoeffs points to the filter coefficients.
Kojto 123:b0220dba8be7 3505 * @param[in] *pState points to the state buffer.
Kojto 123:b0220dba8be7 3506 * @param[in] blockSize number of input samples to process per call.
Kojto 123:b0220dba8be7 3507 * @return The function returns ARM_MATH_SUCCESS if initialization is successful or ARM_MATH_LENGTH_ERROR if
Kojto 123:b0220dba8be7 3508 * <code>blockSize</code> is not a multiple of <code>M</code>.
Kojto 123:b0220dba8be7 3509 */
Kojto 123:b0220dba8be7 3510
Kojto 123:b0220dba8be7 3511 arm_status arm_fir_decimate_init_f32(
Kojto 123:b0220dba8be7 3512 arm_fir_decimate_instance_f32 * S,
Kojto 123:b0220dba8be7 3513 uint16_t numTaps,
Kojto 123:b0220dba8be7 3514 uint8_t M,
Kojto 123:b0220dba8be7 3515 float32_t * pCoeffs,
Kojto 123:b0220dba8be7 3516 float32_t * pState,
Kojto 123:b0220dba8be7 3517 uint32_t blockSize);
Kojto 123:b0220dba8be7 3518
Kojto 123:b0220dba8be7 3519 /**
Kojto 123:b0220dba8be7 3520 * @brief Processing function for the Q15 FIR decimator.
Kojto 123:b0220dba8be7 3521 * @param[in] *S points to an instance of the Q15 FIR decimator structure.
Kojto 123:b0220dba8be7 3522 * @param[in] *pSrc points to the block of input data.
Kojto 123:b0220dba8be7 3523 * @param[out] *pDst points to the block of output data
Kojto 123:b0220dba8be7 3524 * @param[in] blockSize number of input samples to process per call.
Kojto 123:b0220dba8be7 3525 * @return none
Kojto 123:b0220dba8be7 3526 */
Kojto 123:b0220dba8be7 3527
Kojto 123:b0220dba8be7 3528 void arm_fir_decimate_q15(
Kojto 123:b0220dba8be7 3529 const arm_fir_decimate_instance_q15 * S,
Kojto 123:b0220dba8be7 3530 q15_t * pSrc,
Kojto 123:b0220dba8be7 3531 q15_t * pDst,
Kojto 123:b0220dba8be7 3532 uint32_t blockSize);
Kojto 123:b0220dba8be7 3533
Kojto 123:b0220dba8be7 3534 /**
Kojto 123:b0220dba8be7 3535 * @brief Processing function for the Q15 FIR decimator (fast variant) for Cortex-M3 and Cortex-M4.
Kojto 123:b0220dba8be7 3536 * @param[in] *S points to an instance of the Q15 FIR decimator structure.
Kojto 123:b0220dba8be7 3537 * @param[in] *pSrc points to the block of input data.
Kojto 123:b0220dba8be7 3538 * @param[out] *pDst points to the block of output data
Kojto 123:b0220dba8be7 3539 * @param[in] blockSize number of input samples to process per call.
Kojto 123:b0220dba8be7 3540 * @return none
Kojto 123:b0220dba8be7 3541 */
Kojto 123:b0220dba8be7 3542
Kojto 123:b0220dba8be7 3543 void arm_fir_decimate_fast_q15(
Kojto 123:b0220dba8be7 3544 const arm_fir_decimate_instance_q15 * S,
Kojto 123:b0220dba8be7 3545 q15_t * pSrc,
Kojto 123:b0220dba8be7 3546 q15_t * pDst,
Kojto 123:b0220dba8be7 3547 uint32_t blockSize);
Kojto 123:b0220dba8be7 3548
Kojto 123:b0220dba8be7 3549
Kojto 123:b0220dba8be7 3550
Kojto 123:b0220dba8be7 3551 /**
Kojto 123:b0220dba8be7 3552 * @brief Initialization function for the Q15 FIR decimator.
Kojto 123:b0220dba8be7 3553 * @param[in,out] *S points to an instance of the Q15 FIR decimator structure.
Kojto 123:b0220dba8be7 3554 * @param[in] numTaps number of coefficients in the filter.
Kojto 123:b0220dba8be7 3555 * @param[in] M decimation factor.
Kojto 123:b0220dba8be7 3556 * @param[in] *pCoeffs points to the filter coefficients.
Kojto 123:b0220dba8be7 3557 * @param[in] *pState points to the state buffer.
Kojto 123:b0220dba8be7 3558 * @param[in] blockSize number of input samples to process per call.
Kojto 123:b0220dba8be7 3559 * @return The function returns ARM_MATH_SUCCESS if initialization is successful or ARM_MATH_LENGTH_ERROR if
Kojto 123:b0220dba8be7 3560 * <code>blockSize</code> is not a multiple of <code>M</code>.
Kojto 123:b0220dba8be7 3561 */
Kojto 123:b0220dba8be7 3562
Kojto 123:b0220dba8be7 3563 arm_status arm_fir_decimate_init_q15(
Kojto 123:b0220dba8be7 3564 arm_fir_decimate_instance_q15 * S,
Kojto 123:b0220dba8be7 3565 uint16_t numTaps,
Kojto 123:b0220dba8be7 3566 uint8_t M,
Kojto 123:b0220dba8be7 3567 q15_t * pCoeffs,
Kojto 123:b0220dba8be7 3568 q15_t * pState,
Kojto 123:b0220dba8be7 3569 uint32_t blockSize);
Kojto 123:b0220dba8be7 3570
Kojto 123:b0220dba8be7 3571 /**
Kojto 123:b0220dba8be7 3572 * @brief Processing function for the Q31 FIR decimator.
Kojto 123:b0220dba8be7 3573 * @param[in] *S points to an instance of the Q31 FIR decimator structure.
Kojto 123:b0220dba8be7 3574 * @param[in] *pSrc points to the block of input data.
Kojto 123:b0220dba8be7 3575 * @param[out] *pDst points to the block of output data
Kojto 123:b0220dba8be7 3576 * @param[in] blockSize number of input samples to process per call.
Kojto 123:b0220dba8be7 3577 * @return none
Kojto 123:b0220dba8be7 3578 */
Kojto 123:b0220dba8be7 3579
Kojto 123:b0220dba8be7 3580 void arm_fir_decimate_q31(
Kojto 123:b0220dba8be7 3581 const arm_fir_decimate_instance_q31 * S,
Kojto 123:b0220dba8be7 3582 q31_t * pSrc,
Kojto 123:b0220dba8be7 3583 q31_t * pDst,
Kojto 123:b0220dba8be7 3584 uint32_t blockSize);
Kojto 123:b0220dba8be7 3585
Kojto 123:b0220dba8be7 3586 /**
Kojto 123:b0220dba8be7 3587 * @brief Processing function for the Q31 FIR decimator (fast variant) for Cortex-M3 and Cortex-M4.
Kojto 123:b0220dba8be7 3588 * @param[in] *S points to an instance of the Q31 FIR decimator structure.
Kojto 123:b0220dba8be7 3589 * @param[in] *pSrc points to the block of input data.
Kojto 123:b0220dba8be7 3590 * @param[out] *pDst points to the block of output data
Kojto 123:b0220dba8be7 3591 * @param[in] blockSize number of input samples to process per call.
Kojto 123:b0220dba8be7 3592 * @return none
Kojto 123:b0220dba8be7 3593 */
Kojto 123:b0220dba8be7 3594
Kojto 123:b0220dba8be7 3595 void arm_fir_decimate_fast_q31(
Kojto 123:b0220dba8be7 3596 arm_fir_decimate_instance_q31 * S,
Kojto 123:b0220dba8be7 3597 q31_t * pSrc,
Kojto 123:b0220dba8be7 3598 q31_t * pDst,
Kojto 123:b0220dba8be7 3599 uint32_t blockSize);
Kojto 123:b0220dba8be7 3600
Kojto 123:b0220dba8be7 3601
Kojto 123:b0220dba8be7 3602 /**
Kojto 123:b0220dba8be7 3603 * @brief Initialization function for the Q31 FIR decimator.
Kojto 123:b0220dba8be7 3604 * @param[in,out] *S points to an instance of the Q31 FIR decimator structure.
Kojto 123:b0220dba8be7 3605 * @param[in] numTaps number of coefficients in the filter.
Kojto 123:b0220dba8be7 3606 * @param[in] M decimation factor.
Kojto 123:b0220dba8be7 3607 * @param[in] *pCoeffs points to the filter coefficients.
Kojto 123:b0220dba8be7 3608 * @param[in] *pState points to the state buffer.
Kojto 123:b0220dba8be7 3609 * @param[in] blockSize number of input samples to process per call.
Kojto 123:b0220dba8be7 3610 * @return The function returns ARM_MATH_SUCCESS if initialization is successful or ARM_MATH_LENGTH_ERROR if
Kojto 123:b0220dba8be7 3611 * <code>blockSize</code> is not a multiple of <code>M</code>.
Kojto 123:b0220dba8be7 3612 */
Kojto 123:b0220dba8be7 3613
Kojto 123:b0220dba8be7 3614 arm_status arm_fir_decimate_init_q31(
Kojto 123:b0220dba8be7 3615 arm_fir_decimate_instance_q31 * S,
Kojto 123:b0220dba8be7 3616 uint16_t numTaps,
Kojto 123:b0220dba8be7 3617 uint8_t M,
Kojto 123:b0220dba8be7 3618 q31_t * pCoeffs,
Kojto 123:b0220dba8be7 3619 q31_t * pState,
Kojto 123:b0220dba8be7 3620 uint32_t blockSize);
Kojto 123:b0220dba8be7 3621
Kojto 123:b0220dba8be7 3622
Kojto 123:b0220dba8be7 3623
Kojto 123:b0220dba8be7 3624 /**
Kojto 123:b0220dba8be7 3625 * @brief Instance structure for the Q15 FIR interpolator.
Kojto 123:b0220dba8be7 3626 */
Kojto 123:b0220dba8be7 3627
Kojto 123:b0220dba8be7 3628 typedef struct
Kojto 123:b0220dba8be7 3629 {
Kojto 123:b0220dba8be7 3630 uint8_t L; /**< upsample factor. */
Kojto 123:b0220dba8be7 3631 uint16_t phaseLength; /**< length of each polyphase filter component. */
Kojto 123:b0220dba8be7 3632 q15_t *pCoeffs; /**< points to the coefficient array. The array is of length L*phaseLength. */
Kojto 123:b0220dba8be7 3633 q15_t *pState; /**< points to the state variable array. The array is of length blockSize+phaseLength-1. */
Kojto 123:b0220dba8be7 3634 } arm_fir_interpolate_instance_q15;
Kojto 123:b0220dba8be7 3635
Kojto 123:b0220dba8be7 3636 /**
Kojto 123:b0220dba8be7 3637 * @brief Instance structure for the Q31 FIR interpolator.
Kojto 123:b0220dba8be7 3638 */
Kojto 123:b0220dba8be7 3639
Kojto 123:b0220dba8be7 3640 typedef struct
Kojto 123:b0220dba8be7 3641 {
Kojto 123:b0220dba8be7 3642 uint8_t L; /**< upsample factor. */
Kojto 123:b0220dba8be7 3643 uint16_t phaseLength; /**< length of each polyphase filter component. */
Kojto 123:b0220dba8be7 3644 q31_t *pCoeffs; /**< points to the coefficient array. The array is of length L*phaseLength. */
Kojto 123:b0220dba8be7 3645 q31_t *pState; /**< points to the state variable array. The array is of length blockSize+phaseLength-1. */
Kojto 123:b0220dba8be7 3646 } arm_fir_interpolate_instance_q31;
Kojto 123:b0220dba8be7 3647
Kojto 123:b0220dba8be7 3648 /**
Kojto 123:b0220dba8be7 3649 * @brief Instance structure for the floating-point FIR interpolator.
Kojto 123:b0220dba8be7 3650 */
Kojto 123:b0220dba8be7 3651
Kojto 123:b0220dba8be7 3652 typedef struct
Kojto 123:b0220dba8be7 3653 {
Kojto 123:b0220dba8be7 3654 uint8_t L; /**< upsample factor. */
Kojto 123:b0220dba8be7 3655 uint16_t phaseLength; /**< length of each polyphase filter component. */
Kojto 123:b0220dba8be7 3656 float32_t *pCoeffs; /**< points to the coefficient array. The array is of length L*phaseLength. */
Kojto 123:b0220dba8be7 3657 float32_t *pState; /**< points to the state variable array. The array is of length phaseLength+numTaps-1. */
Kojto 123:b0220dba8be7 3658 } arm_fir_interpolate_instance_f32;
Kojto 123:b0220dba8be7 3659
Kojto 123:b0220dba8be7 3660
Kojto 123:b0220dba8be7 3661 /**
Kojto 123:b0220dba8be7 3662 * @brief Processing function for the Q15 FIR interpolator.
Kojto 123:b0220dba8be7 3663 * @param[in] *S points to an instance of the Q15 FIR interpolator structure.
Kojto 123:b0220dba8be7 3664 * @param[in] *pSrc points to the block of input data.
Kojto 123:b0220dba8be7 3665 * @param[out] *pDst points to the block of output data.
Kojto 123:b0220dba8be7 3666 * @param[in] blockSize number of input samples to process per call.
Kojto 123:b0220dba8be7 3667 * @return none.
Kojto 123:b0220dba8be7 3668 */
Kojto 123:b0220dba8be7 3669
Kojto 123:b0220dba8be7 3670 void arm_fir_interpolate_q15(
Kojto 123:b0220dba8be7 3671 const arm_fir_interpolate_instance_q15 * S,
Kojto 123:b0220dba8be7 3672 q15_t * pSrc,
Kojto 123:b0220dba8be7 3673 q15_t * pDst,
Kojto 123:b0220dba8be7 3674 uint32_t blockSize);
Kojto 123:b0220dba8be7 3675
Kojto 123:b0220dba8be7 3676
Kojto 123:b0220dba8be7 3677 /**
Kojto 123:b0220dba8be7 3678 * @brief Initialization function for the Q15 FIR interpolator.
Kojto 123:b0220dba8be7 3679 * @param[in,out] *S points to an instance of the Q15 FIR interpolator structure.
Kojto 123:b0220dba8be7 3680 * @param[in] L upsample factor.
Kojto 123:b0220dba8be7 3681 * @param[in] numTaps number of filter coefficients in the filter.
Kojto 123:b0220dba8be7 3682 * @param[in] *pCoeffs points to the filter coefficient buffer.
Kojto 123:b0220dba8be7 3683 * @param[in] *pState points to the state buffer.
Kojto 123:b0220dba8be7 3684 * @param[in] blockSize number of input samples to process per call.
Kojto 123:b0220dba8be7 3685 * @return The function returns ARM_MATH_SUCCESS if initialization is successful or ARM_MATH_LENGTH_ERROR if
Kojto 123:b0220dba8be7 3686 * the filter length <code>numTaps</code> is not a multiple of the interpolation factor <code>L</code>.
Kojto 123:b0220dba8be7 3687 */
Kojto 123:b0220dba8be7 3688
Kojto 123:b0220dba8be7 3689 arm_status arm_fir_interpolate_init_q15(
Kojto 123:b0220dba8be7 3690 arm_fir_interpolate_instance_q15 * S,
Kojto 123:b0220dba8be7 3691 uint8_t L,
Kojto 123:b0220dba8be7 3692 uint16_t numTaps,
Kojto 123:b0220dba8be7 3693 q15_t * pCoeffs,
Kojto 123:b0220dba8be7 3694 q15_t * pState,
Kojto 123:b0220dba8be7 3695 uint32_t blockSize);
Kojto 123:b0220dba8be7 3696
Kojto 123:b0220dba8be7 3697 /**
Kojto 123:b0220dba8be7 3698 * @brief Processing function for the Q31 FIR interpolator.
Kojto 123:b0220dba8be7 3699 * @param[in] *S points to an instance of the Q15 FIR interpolator structure.
Kojto 123:b0220dba8be7 3700 * @param[in] *pSrc points to the block of input data.
Kojto 123:b0220dba8be7 3701 * @param[out] *pDst points to the block of output data.
Kojto 123:b0220dba8be7 3702 * @param[in] blockSize number of input samples to process per call.
Kojto 123:b0220dba8be7 3703 * @return none.
Kojto 123:b0220dba8be7 3704 */
Kojto 123:b0220dba8be7 3705
Kojto 123:b0220dba8be7 3706 void arm_fir_interpolate_q31(
Kojto 123:b0220dba8be7 3707 const arm_fir_interpolate_instance_q31 * S,
Kojto 123:b0220dba8be7 3708 q31_t * pSrc,
Kojto 123:b0220dba8be7 3709 q31_t * pDst,
Kojto 123:b0220dba8be7 3710 uint32_t blockSize);
Kojto 123:b0220dba8be7 3711
Kojto 123:b0220dba8be7 3712 /**
Kojto 123:b0220dba8be7 3713 * @brief Initialization function for the Q31 FIR interpolator.
Kojto 123:b0220dba8be7 3714 * @param[in,out] *S points to an instance of the Q31 FIR interpolator structure.
Kojto 123:b0220dba8be7 3715 * @param[in] L upsample factor.
Kojto 123:b0220dba8be7 3716 * @param[in] numTaps number of filter coefficients in the filter.
Kojto 123:b0220dba8be7 3717 * @param[in] *pCoeffs points to the filter coefficient buffer.
Kojto 123:b0220dba8be7 3718 * @param[in] *pState points to the state buffer.
Kojto 123:b0220dba8be7 3719 * @param[in] blockSize number of input samples to process per call.
Kojto 123:b0220dba8be7 3720 * @return The function returns ARM_MATH_SUCCESS if initialization is successful or ARM_MATH_LENGTH_ERROR if
Kojto 123:b0220dba8be7 3721 * the filter length <code>numTaps</code> is not a multiple of the interpolation factor <code>L</code>.
Kojto 123:b0220dba8be7 3722 */
Kojto 123:b0220dba8be7 3723
Kojto 123:b0220dba8be7 3724 arm_status arm_fir_interpolate_init_q31(
Kojto 123:b0220dba8be7 3725 arm_fir_interpolate_instance_q31 * S,
Kojto 123:b0220dba8be7 3726 uint8_t L,
Kojto 123:b0220dba8be7 3727 uint16_t numTaps,
Kojto 123:b0220dba8be7 3728 q31_t * pCoeffs,
Kojto 123:b0220dba8be7 3729 q31_t * pState,
Kojto 123:b0220dba8be7 3730 uint32_t blockSize);
Kojto 123:b0220dba8be7 3731
Kojto 123:b0220dba8be7 3732
Kojto 123:b0220dba8be7 3733 /**
Kojto 123:b0220dba8be7 3734 * @brief Processing function for the floating-point FIR interpolator.
Kojto 123:b0220dba8be7 3735 * @param[in] *S points to an instance of the floating-point FIR interpolator structure.
Kojto 123:b0220dba8be7 3736 * @param[in] *pSrc points to the block of input data.
Kojto 123:b0220dba8be7 3737 * @param[out] *pDst points to the block of output data.
Kojto 123:b0220dba8be7 3738 * @param[in] blockSize number of input samples to process per call.
Kojto 123:b0220dba8be7 3739 * @return none.
Kojto 123:b0220dba8be7 3740 */
Kojto 123:b0220dba8be7 3741
Kojto 123:b0220dba8be7 3742 void arm_fir_interpolate_f32(
Kojto 123:b0220dba8be7 3743 const arm_fir_interpolate_instance_f32 * S,
Kojto 123:b0220dba8be7 3744 float32_t * pSrc,
Kojto 123:b0220dba8be7 3745 float32_t * pDst,
Kojto 123:b0220dba8be7 3746 uint32_t blockSize);
Kojto 123:b0220dba8be7 3747
Kojto 123:b0220dba8be7 3748 /**
Kojto 123:b0220dba8be7 3749 * @brief Initialization function for the floating-point FIR interpolator.
Kojto 123:b0220dba8be7 3750 * @param[in,out] *S points to an instance of the floating-point FIR interpolator structure.
Kojto 123:b0220dba8be7 3751 * @param[in] L upsample factor.
Kojto 123:b0220dba8be7 3752 * @param[in] numTaps number of filter coefficients in the filter.
Kojto 123:b0220dba8be7 3753 * @param[in] *pCoeffs points to the filter coefficient buffer.
Kojto 123:b0220dba8be7 3754 * @param[in] *pState points to the state buffer.
Kojto 123:b0220dba8be7 3755 * @param[in] blockSize number of input samples to process per call.
Kojto 123:b0220dba8be7 3756 * @return The function returns ARM_MATH_SUCCESS if initialization is successful or ARM_MATH_LENGTH_ERROR if
Kojto 123:b0220dba8be7 3757 * the filter length <code>numTaps</code> is not a multiple of the interpolation factor <code>L</code>.
Kojto 123:b0220dba8be7 3758 */
Kojto 123:b0220dba8be7 3759
Kojto 123:b0220dba8be7 3760 arm_status arm_fir_interpolate_init_f32(
Kojto 123:b0220dba8be7 3761 arm_fir_interpolate_instance_f32 * S,
Kojto 123:b0220dba8be7 3762 uint8_t L,
Kojto 123:b0220dba8be7 3763 uint16_t numTaps,
Kojto 123:b0220dba8be7 3764 float32_t * pCoeffs,
Kojto 123:b0220dba8be7 3765 float32_t * pState,
Kojto 123:b0220dba8be7 3766 uint32_t blockSize);
Kojto 123:b0220dba8be7 3767
Kojto 123:b0220dba8be7 3768 /**
Kojto 123:b0220dba8be7 3769 * @brief Instance structure for the high precision Q31 Biquad cascade filter.
Kojto 123:b0220dba8be7 3770 */
Kojto 123:b0220dba8be7 3771
Kojto 123:b0220dba8be7 3772 typedef struct
Kojto 123:b0220dba8be7 3773 {
Kojto 123:b0220dba8be7 3774 uint8_t numStages; /**< number of 2nd order stages in the filter. Overall order is 2*numStages. */
Kojto 123:b0220dba8be7 3775 q63_t *pState; /**< points to the array of state coefficients. The array is of length 4*numStages. */
Kojto 123:b0220dba8be7 3776 q31_t *pCoeffs; /**< points to the array of coefficients. The array is of length 5*numStages. */
Kojto 123:b0220dba8be7 3777 uint8_t postShift; /**< additional shift, in bits, applied to each output sample. */
Kojto 123:b0220dba8be7 3778
Kojto 123:b0220dba8be7 3779 } arm_biquad_cas_df1_32x64_ins_q31;
Kojto 123:b0220dba8be7 3780
Kojto 123:b0220dba8be7 3781
Kojto 123:b0220dba8be7 3782 /**
Kojto 123:b0220dba8be7 3783 * @param[in] *S points to an instance of the high precision Q31 Biquad cascade filter structure.
Kojto 123:b0220dba8be7 3784 * @param[in] *pSrc points to the block of input data.
Kojto 123:b0220dba8be7 3785 * @param[out] *pDst points to the block of output data
Kojto 123:b0220dba8be7 3786 * @param[in] blockSize number of samples to process.
Kojto 123:b0220dba8be7 3787 * @return none.
Kojto 123:b0220dba8be7 3788 */
Kojto 123:b0220dba8be7 3789
Kojto 123:b0220dba8be7 3790 void arm_biquad_cas_df1_32x64_q31(
Kojto 123:b0220dba8be7 3791 const arm_biquad_cas_df1_32x64_ins_q31 * S,
Kojto 123:b0220dba8be7 3792 q31_t * pSrc,
Kojto 123:b0220dba8be7 3793 q31_t * pDst,
Kojto 123:b0220dba8be7 3794 uint32_t blockSize);
Kojto 123:b0220dba8be7 3795
Kojto 123:b0220dba8be7 3796
Kojto 123:b0220dba8be7 3797 /**
Kojto 123:b0220dba8be7 3798 * @param[in,out] *S points to an instance of the high precision Q31 Biquad cascade filter structure.
Kojto 123:b0220dba8be7 3799 * @param[in] numStages number of 2nd order stages in the filter.
Kojto 123:b0220dba8be7 3800 * @param[in] *pCoeffs points to the filter coefficients.
Kojto 123:b0220dba8be7 3801 * @param[in] *pState points to the state buffer.
Kojto 123:b0220dba8be7 3802 * @param[in] postShift shift to be applied to the output. Varies according to the coefficients format
Kojto 123:b0220dba8be7 3803 * @return none
Kojto 123:b0220dba8be7 3804 */
Kojto 123:b0220dba8be7 3805
Kojto 123:b0220dba8be7 3806 void arm_biquad_cas_df1_32x64_init_q31(
Kojto 123:b0220dba8be7 3807 arm_biquad_cas_df1_32x64_ins_q31 * S,
Kojto 123:b0220dba8be7 3808 uint8_t numStages,
Kojto 123:b0220dba8be7 3809 q31_t * pCoeffs,
Kojto 123:b0220dba8be7 3810 q63_t * pState,
Kojto 123:b0220dba8be7 3811 uint8_t postShift);
Kojto 123:b0220dba8be7 3812
Kojto 123:b0220dba8be7 3813
Kojto 123:b0220dba8be7 3814
Kojto 123:b0220dba8be7 3815 /**
Kojto 123:b0220dba8be7 3816 * @brief Instance structure for the floating-point transposed direct form II Biquad cascade filter.
Kojto 123:b0220dba8be7 3817 */
Kojto 123:b0220dba8be7 3818
Kojto 123:b0220dba8be7 3819 typedef struct
Kojto 123:b0220dba8be7 3820 {
Kojto 123:b0220dba8be7 3821 uint8_t numStages; /**< number of 2nd order stages in the filter. Overall order is 2*numStages. */
Kojto 123:b0220dba8be7 3822 float32_t *pState; /**< points to the array of state coefficients. The array is of length 2*numStages. */
Kojto 123:b0220dba8be7 3823 float32_t *pCoeffs; /**< points to the array of coefficients. The array is of length 5*numStages. */
Kojto 123:b0220dba8be7 3824 } arm_biquad_cascade_df2T_instance_f32;
Kojto 123:b0220dba8be7 3825
Kojto 123:b0220dba8be7 3826
Kojto 123:b0220dba8be7 3827
Kojto 123:b0220dba8be7 3828 /**
Kojto 123:b0220dba8be7 3829 * @brief Instance structure for the floating-point transposed direct form II Biquad cascade filter.
Kojto 123:b0220dba8be7 3830 */
Kojto 123:b0220dba8be7 3831
Kojto 123:b0220dba8be7 3832 typedef struct
Kojto 123:b0220dba8be7 3833 {
Kojto 123:b0220dba8be7 3834 uint8_t numStages; /**< number of 2nd order stages in the filter. Overall order is 2*numStages. */
Kojto 123:b0220dba8be7 3835 float32_t *pState; /**< points to the array of state coefficients. The array is of length 4*numStages. */
Kojto 123:b0220dba8be7 3836 float32_t *pCoeffs; /**< points to the array of coefficients. The array is of length 5*numStages. */
Kojto 123:b0220dba8be7 3837 } arm_biquad_cascade_stereo_df2T_instance_f32;
Kojto 123:b0220dba8be7 3838
Kojto 123:b0220dba8be7 3839
Kojto 123:b0220dba8be7 3840
Kojto 123:b0220dba8be7 3841 /**
Kojto 123:b0220dba8be7 3842 * @brief Instance structure for the floating-point transposed direct form II Biquad cascade filter.
Kojto 123:b0220dba8be7 3843 */
Kojto 123:b0220dba8be7 3844
Kojto 123:b0220dba8be7 3845 typedef struct
Kojto 123:b0220dba8be7 3846 {
Kojto 123:b0220dba8be7 3847 uint8_t numStages; /**< number of 2nd order stages in the filter. Overall order is 2*numStages. */
Kojto 123:b0220dba8be7 3848 float64_t *pState; /**< points to the array of state coefficients. The array is of length 2*numStages. */
Kojto 123:b0220dba8be7 3849 float64_t *pCoeffs; /**< points to the array of coefficients. The array is of length 5*numStages. */
Kojto 123:b0220dba8be7 3850 } arm_biquad_cascade_df2T_instance_f64;
Kojto 123:b0220dba8be7 3851
Kojto 123:b0220dba8be7 3852
Kojto 123:b0220dba8be7 3853 /**
Kojto 123:b0220dba8be7 3854 * @brief Processing function for the floating-point transposed direct form II Biquad cascade filter.
Kojto 123:b0220dba8be7 3855 * @param[in] *S points to an instance of the filter data structure.
Kojto 123:b0220dba8be7 3856 * @param[in] *pSrc points to the block of input data.
Kojto 123:b0220dba8be7 3857 * @param[out] *pDst points to the block of output data
Kojto 123:b0220dba8be7 3858 * @param[in] blockSize number of samples to process.
Kojto 123:b0220dba8be7 3859 * @return none.
Kojto 123:b0220dba8be7 3860 */
Kojto 123:b0220dba8be7 3861
Kojto 123:b0220dba8be7 3862 void arm_biquad_cascade_df2T_f32(
Kojto 123:b0220dba8be7 3863 const arm_biquad_cascade_df2T_instance_f32 * S,
Kojto 123:b0220dba8be7 3864 float32_t * pSrc,
Kojto 123:b0220dba8be7 3865 float32_t * pDst,
Kojto 123:b0220dba8be7 3866 uint32_t blockSize);
Kojto 123:b0220dba8be7 3867
Kojto 123:b0220dba8be7 3868
Kojto 123:b0220dba8be7 3869 /**
Kojto 123:b0220dba8be7 3870 * @brief Processing function for the floating-point transposed direct form II Biquad cascade filter. 2 channels
Kojto 123:b0220dba8be7 3871 * @param[in] *S points to an instance of the filter data structure.
Kojto 123:b0220dba8be7 3872 * @param[in] *pSrc points to the block of input data.
Kojto 123:b0220dba8be7 3873 * @param[out] *pDst points to the block of output data
Kojto 123:b0220dba8be7 3874 * @param[in] blockSize number of samples to process.
Kojto 123:b0220dba8be7 3875 * @return none.
Kojto 123:b0220dba8be7 3876 */
Kojto 123:b0220dba8be7 3877
Kojto 123:b0220dba8be7 3878 void arm_biquad_cascade_stereo_df2T_f32(
Kojto 123:b0220dba8be7 3879 const arm_biquad_cascade_stereo_df2T_instance_f32 * S,
Kojto 123:b0220dba8be7 3880 float32_t * pSrc,
Kojto 123:b0220dba8be7 3881 float32_t * pDst,
Kojto 123:b0220dba8be7 3882 uint32_t blockSize);
Kojto 123:b0220dba8be7 3883
Kojto 123:b0220dba8be7 3884 /**
Kojto 123:b0220dba8be7 3885 * @brief Processing function for the floating-point transposed direct form II Biquad cascade filter.
Kojto 123:b0220dba8be7 3886 * @param[in] *S points to an instance of the filter data structure.
Kojto 123:b0220dba8be7 3887 * @param[in] *pSrc points to the block of input data.
Kojto 123:b0220dba8be7 3888 * @param[out] *pDst points to the block of output data
Kojto 123:b0220dba8be7 3889 * @param[in] blockSize number of samples to process.
Kojto 123:b0220dba8be7 3890 * @return none.
Kojto 123:b0220dba8be7 3891 */
Kojto 123:b0220dba8be7 3892
Kojto 123:b0220dba8be7 3893 void arm_biquad_cascade_df2T_f64(
Kojto 123:b0220dba8be7 3894 const arm_biquad_cascade_df2T_instance_f64 * S,
Kojto 123:b0220dba8be7 3895 float64_t * pSrc,
Kojto 123:b0220dba8be7 3896 float64_t * pDst,
Kojto 123:b0220dba8be7 3897 uint32_t blockSize);
Kojto 123:b0220dba8be7 3898
Kojto 123:b0220dba8be7 3899
Kojto 123:b0220dba8be7 3900 /**
Kojto 123:b0220dba8be7 3901 * @brief Initialization function for the floating-point transposed direct form II Biquad cascade filter.
Kojto 123:b0220dba8be7 3902 * @param[in,out] *S points to an instance of the filter data structure.
Kojto 123:b0220dba8be7 3903 * @param[in] numStages number of 2nd order stages in the filter.
Kojto 123:b0220dba8be7 3904 * @param[in] *pCoeffs points to the filter coefficients.
Kojto 123:b0220dba8be7 3905 * @param[in] *pState points to the state buffer.
Kojto 123:b0220dba8be7 3906 * @return none
Kojto 123:b0220dba8be7 3907 */
Kojto 123:b0220dba8be7 3908
Kojto 123:b0220dba8be7 3909 void arm_biquad_cascade_df2T_init_f32(
Kojto 123:b0220dba8be7 3910 arm_biquad_cascade_df2T_instance_f32 * S,
Kojto 123:b0220dba8be7 3911 uint8_t numStages,
Kojto 123:b0220dba8be7 3912 float32_t * pCoeffs,
Kojto 123:b0220dba8be7 3913 float32_t * pState);
Kojto 123:b0220dba8be7 3914
Kojto 123:b0220dba8be7 3915
Kojto 123:b0220dba8be7 3916 /**
Kojto 123:b0220dba8be7 3917 * @brief Initialization function for the floating-point transposed direct form II Biquad cascade filter.
Kojto 123:b0220dba8be7 3918 * @param[in,out] *S points to an instance of the filter data structure.
Kojto 123:b0220dba8be7 3919 * @param[in] numStages number of 2nd order stages in the filter.
Kojto 123:b0220dba8be7 3920 * @param[in] *pCoeffs points to the filter coefficients.
Kojto 123:b0220dba8be7 3921 * @param[in] *pState points to the state buffer.
Kojto 123:b0220dba8be7 3922 * @return none
Kojto 123:b0220dba8be7 3923 */
Kojto 123:b0220dba8be7 3924
Kojto 123:b0220dba8be7 3925 void arm_biquad_cascade_stereo_df2T_init_f32(
Kojto 123:b0220dba8be7 3926 arm_biquad_cascade_stereo_df2T_instance_f32 * S,
Kojto 123:b0220dba8be7 3927 uint8_t numStages,
Kojto 123:b0220dba8be7 3928 float32_t * pCoeffs,
Kojto 123:b0220dba8be7 3929 float32_t * pState);
Kojto 123:b0220dba8be7 3930
Kojto 123:b0220dba8be7 3931
Kojto 123:b0220dba8be7 3932 /**
Kojto 123:b0220dba8be7 3933 * @brief Initialization function for the floating-point transposed direct form II Biquad cascade filter.
Kojto 123:b0220dba8be7 3934 * @param[in,out] *S points to an instance of the filter data structure.
Kojto 123:b0220dba8be7 3935 * @param[in] numStages number of 2nd order stages in the filter.
Kojto 123:b0220dba8be7 3936 * @param[in] *pCoeffs points to the filter coefficients.
Kojto 123:b0220dba8be7 3937 * @param[in] *pState points to the state buffer.
Kojto 123:b0220dba8be7 3938 * @return none
Kojto 123:b0220dba8be7 3939 */
Kojto 123:b0220dba8be7 3940
Kojto 123:b0220dba8be7 3941 void arm_biquad_cascade_df2T_init_f64(
Kojto 123:b0220dba8be7 3942 arm_biquad_cascade_df2T_instance_f64 * S,
Kojto 123:b0220dba8be7 3943 uint8_t numStages,
Kojto 123:b0220dba8be7 3944 float64_t * pCoeffs,
Kojto 123:b0220dba8be7 3945 float64_t * pState);
Kojto 123:b0220dba8be7 3946
Kojto 123:b0220dba8be7 3947
Kojto 123:b0220dba8be7 3948
Kojto 123:b0220dba8be7 3949 /**
Kojto 123:b0220dba8be7 3950 * @brief Instance structure for the Q15 FIR lattice filter.
Kojto 123:b0220dba8be7 3951 */
Kojto 123:b0220dba8be7 3952
Kojto 123:b0220dba8be7 3953 typedef struct
Kojto 123:b0220dba8be7 3954 {
Kojto 123:b0220dba8be7 3955 uint16_t numStages; /**< number of filter stages. */
Kojto 123:b0220dba8be7 3956 q15_t *pState; /**< points to the state variable array. The array is of length numStages. */
Kojto 123:b0220dba8be7 3957 q15_t *pCoeffs; /**< points to the coefficient array. The array is of length numStages. */
Kojto 123:b0220dba8be7 3958 } arm_fir_lattice_instance_q15;
Kojto 123:b0220dba8be7 3959
Kojto 123:b0220dba8be7 3960 /**
Kojto 123:b0220dba8be7 3961 * @brief Instance structure for the Q31 FIR lattice filter.
Kojto 123:b0220dba8be7 3962 */
Kojto 123:b0220dba8be7 3963
Kojto 123:b0220dba8be7 3964 typedef struct
Kojto 123:b0220dba8be7 3965 {
Kojto 123:b0220dba8be7 3966 uint16_t numStages; /**< number of filter stages. */
Kojto 123:b0220dba8be7 3967 q31_t *pState; /**< points to the state variable array. The array is of length numStages. */
Kojto 123:b0220dba8be7 3968 q31_t *pCoeffs; /**< points to the coefficient array. The array is of length numStages. */
Kojto 123:b0220dba8be7 3969 } arm_fir_lattice_instance_q31;
Kojto 123:b0220dba8be7 3970
Kojto 123:b0220dba8be7 3971 /**
Kojto 123:b0220dba8be7 3972 * @brief Instance structure for the floating-point FIR lattice filter.
Kojto 123:b0220dba8be7 3973 */
Kojto 123:b0220dba8be7 3974
Kojto 123:b0220dba8be7 3975 typedef struct
Kojto 123:b0220dba8be7 3976 {
Kojto 123:b0220dba8be7 3977 uint16_t numStages; /**< number of filter stages. */
Kojto 123:b0220dba8be7 3978 float32_t *pState; /**< points to the state variable array. The array is of length numStages. */
Kojto 123:b0220dba8be7 3979 float32_t *pCoeffs; /**< points to the coefficient array. The array is of length numStages. */
Kojto 123:b0220dba8be7 3980 } arm_fir_lattice_instance_f32;
Kojto 123:b0220dba8be7 3981
Kojto 123:b0220dba8be7 3982 /**
Kojto 123:b0220dba8be7 3983 * @brief Initialization function for the Q15 FIR lattice filter.
Kojto 123:b0220dba8be7 3984 * @param[in] *S points to an instance of the Q15 FIR lattice structure.
Kojto 123:b0220dba8be7 3985 * @param[in] numStages number of filter stages.
Kojto 123:b0220dba8be7 3986 * @param[in] *pCoeffs points to the coefficient buffer. The array is of length numStages.
Kojto 123:b0220dba8be7 3987 * @param[in] *pState points to the state buffer. The array is of length numStages.
Kojto 123:b0220dba8be7 3988 * @return none.
Kojto 123:b0220dba8be7 3989 */
Kojto 123:b0220dba8be7 3990
Kojto 123:b0220dba8be7 3991 void arm_fir_lattice_init_q15(
Kojto 123:b0220dba8be7 3992 arm_fir_lattice_instance_q15 * S,
Kojto 123:b0220dba8be7 3993 uint16_t numStages,
Kojto 123:b0220dba8be7 3994 q15_t * pCoeffs,
Kojto 123:b0220dba8be7 3995 q15_t * pState);
Kojto 123:b0220dba8be7 3996
Kojto 123:b0220dba8be7 3997
Kojto 123:b0220dba8be7 3998 /**
Kojto 123:b0220dba8be7 3999 * @brief Processing function for the Q15 FIR lattice filter.
Kojto 123:b0220dba8be7 4000 * @param[in] *S points to an instance of the Q15 FIR lattice structure.
Kojto 123:b0220dba8be7 4001 * @param[in] *pSrc points to the block of input data.
Kojto 123:b0220dba8be7 4002 * @param[out] *pDst points to the block of output data.
Kojto 123:b0220dba8be7 4003 * @param[in] blockSize number of samples to process.
Kojto 123:b0220dba8be7 4004 * @return none.
Kojto 123:b0220dba8be7 4005 */
Kojto 123:b0220dba8be7 4006 void arm_fir_lattice_q15(
Kojto 123:b0220dba8be7 4007 const arm_fir_lattice_instance_q15 * S,
Kojto 123:b0220dba8be7 4008 q15_t * pSrc,
Kojto 123:b0220dba8be7 4009 q15_t * pDst,
Kojto 123:b0220dba8be7 4010 uint32_t blockSize);
Kojto 123:b0220dba8be7 4011
Kojto 123:b0220dba8be7 4012 /**
Kojto 123:b0220dba8be7 4013 * @brief Initialization function for the Q31 FIR lattice filter.
Kojto 123:b0220dba8be7 4014 * @param[in] *S points to an instance of the Q31 FIR lattice structure.
Kojto 123:b0220dba8be7 4015 * @param[in] numStages number of filter stages.
Kojto 123:b0220dba8be7 4016 * @param[in] *pCoeffs points to the coefficient buffer. The array is of length numStages.
Kojto 123:b0220dba8be7 4017 * @param[in] *pState points to the state buffer. The array is of length numStages.
Kojto 123:b0220dba8be7 4018 * @return none.
Kojto 123:b0220dba8be7 4019 */
Kojto 123:b0220dba8be7 4020
Kojto 123:b0220dba8be7 4021 void arm_fir_lattice_init_q31(
Kojto 123:b0220dba8be7 4022 arm_fir_lattice_instance_q31 * S,
Kojto 123:b0220dba8be7 4023 uint16_t numStages,
Kojto 123:b0220dba8be7 4024 q31_t * pCoeffs,
Kojto 123:b0220dba8be7 4025 q31_t * pState);
Kojto 123:b0220dba8be7 4026
Kojto 123:b0220dba8be7 4027
Kojto 123:b0220dba8be7 4028 /**
Kojto 123:b0220dba8be7 4029 * @brief Processing function for the Q31 FIR lattice filter.
Kojto 123:b0220dba8be7 4030 * @param[in] *S points to an instance of the Q31 FIR lattice structure.
Kojto 123:b0220dba8be7 4031 * @param[in] *pSrc points to the block of input data.
Kojto 123:b0220dba8be7 4032 * @param[out] *pDst points to the block of output data
Kojto 123:b0220dba8be7 4033 * @param[in] blockSize number of samples to process.
Kojto 123:b0220dba8be7 4034 * @return none.
Kojto 123:b0220dba8be7 4035 */
Kojto 123:b0220dba8be7 4036
Kojto 123:b0220dba8be7 4037 void arm_fir_lattice_q31(
Kojto 123:b0220dba8be7 4038 const arm_fir_lattice_instance_q31 * S,
Kojto 123:b0220dba8be7 4039 q31_t * pSrc,
Kojto 123:b0220dba8be7 4040 q31_t * pDst,
Kojto 123:b0220dba8be7 4041 uint32_t blockSize);
Kojto 123:b0220dba8be7 4042
Kojto 123:b0220dba8be7 4043 /**
Kojto 123:b0220dba8be7 4044 * @brief Initialization function for the floating-point FIR lattice filter.
Kojto 123:b0220dba8be7 4045 * @param[in] *S points to an instance of the floating-point FIR lattice structure.
Kojto 123:b0220dba8be7 4046 * @param[in] numStages number of filter stages.
Kojto 123:b0220dba8be7 4047 * @param[in] *pCoeffs points to the coefficient buffer. The array is of length numStages.
Kojto 123:b0220dba8be7 4048 * @param[in] *pState points to the state buffer. The array is of length numStages.
Kojto 123:b0220dba8be7 4049 * @return none.
Kojto 123:b0220dba8be7 4050 */
Kojto 123:b0220dba8be7 4051
Kojto 123:b0220dba8be7 4052 void arm_fir_lattice_init_f32(
Kojto 123:b0220dba8be7 4053 arm_fir_lattice_instance_f32 * S,
Kojto 123:b0220dba8be7 4054 uint16_t numStages,
Kojto 123:b0220dba8be7 4055 float32_t * pCoeffs,
Kojto 123:b0220dba8be7 4056 float32_t * pState);
Kojto 123:b0220dba8be7 4057
Kojto 123:b0220dba8be7 4058 /**
Kojto 123:b0220dba8be7 4059 * @brief Processing function for the floating-point FIR lattice filter.
Kojto 123:b0220dba8be7 4060 * @param[in] *S points to an instance of the floating-point FIR lattice structure.
Kojto 123:b0220dba8be7 4061 * @param[in] *pSrc points to the block of input data.
Kojto 123:b0220dba8be7 4062 * @param[out] *pDst points to the block of output data
Kojto 123:b0220dba8be7 4063 * @param[in] blockSize number of samples to process.
Kojto 123:b0220dba8be7 4064 * @return none.
Kojto 123:b0220dba8be7 4065 */
Kojto 123:b0220dba8be7 4066
Kojto 123:b0220dba8be7 4067 void arm_fir_lattice_f32(
Kojto 123:b0220dba8be7 4068 const arm_fir_lattice_instance_f32 * S,
Kojto 123:b0220dba8be7 4069 float32_t * pSrc,
Kojto 123:b0220dba8be7 4070 float32_t * pDst,
Kojto 123:b0220dba8be7 4071 uint32_t blockSize);
Kojto 123:b0220dba8be7 4072
Kojto 123:b0220dba8be7 4073 /**
Kojto 123:b0220dba8be7 4074 * @brief Instance structure for the Q15 IIR lattice filter.
Kojto 123:b0220dba8be7 4075 */
Kojto 123:b0220dba8be7 4076 typedef struct
Kojto 123:b0220dba8be7 4077 {
Kojto 123:b0220dba8be7 4078 uint16_t numStages; /**< number of stages in the filter. */
Kojto 123:b0220dba8be7 4079 q15_t *pState; /**< points to the state variable array. The array is of length numStages+blockSize. */
Kojto 123:b0220dba8be7 4080 q15_t *pkCoeffs; /**< points to the reflection coefficient array. The array is of length numStages. */
Kojto 123:b0220dba8be7 4081 q15_t *pvCoeffs; /**< points to the ladder coefficient array. The array is of length numStages+1. */
Kojto 123:b0220dba8be7 4082 } arm_iir_lattice_instance_q15;
Kojto 123:b0220dba8be7 4083
Kojto 123:b0220dba8be7 4084 /**
Kojto 123:b0220dba8be7 4085 * @brief Instance structure for the Q31 IIR lattice filter.
Kojto 123:b0220dba8be7 4086 */
Kojto 123:b0220dba8be7 4087 typedef struct
Kojto 123:b0220dba8be7 4088 {
Kojto 123:b0220dba8be7 4089 uint16_t numStages; /**< number of stages in the filter. */
Kojto 123:b0220dba8be7 4090 q31_t *pState; /**< points to the state variable array. The array is of length numStages+blockSize. */
Kojto 123:b0220dba8be7 4091 q31_t *pkCoeffs; /**< points to the reflection coefficient array. The array is of length numStages. */
Kojto 123:b0220dba8be7 4092 q31_t *pvCoeffs; /**< points to the ladder coefficient array. The array is of length numStages+1. */
Kojto 123:b0220dba8be7 4093 } arm_iir_lattice_instance_q31;
Kojto 123:b0220dba8be7 4094
Kojto 123:b0220dba8be7 4095 /**
Kojto 123:b0220dba8be7 4096 * @brief Instance structure for the floating-point IIR lattice filter.
Kojto 123:b0220dba8be7 4097 */
Kojto 123:b0220dba8be7 4098 typedef struct
Kojto 123:b0220dba8be7 4099 {
Kojto 123:b0220dba8be7 4100 uint16_t numStages; /**< number of stages in the filter. */
Kojto 123:b0220dba8be7 4101 float32_t *pState; /**< points to the state variable array. The array is of length numStages+blockSize. */
Kojto 123:b0220dba8be7 4102 float32_t *pkCoeffs; /**< points to the reflection coefficient array. The array is of length numStages. */
Kojto 123:b0220dba8be7 4103 float32_t *pvCoeffs; /**< points to the ladder coefficient array. The array is of length numStages+1. */
Kojto 123:b0220dba8be7 4104 } arm_iir_lattice_instance_f32;
Kojto 123:b0220dba8be7 4105
Kojto 123:b0220dba8be7 4106 /**
Kojto 123:b0220dba8be7 4107 * @brief Processing function for the floating-point IIR lattice filter.
Kojto 123:b0220dba8be7 4108 * @param[in] *S points to an instance of the floating-point IIR lattice structure.
Kojto 123:b0220dba8be7 4109 * @param[in] *pSrc points to the block of input data.
Kojto 123:b0220dba8be7 4110 * @param[out] *pDst points to the block of output data.
Kojto 123:b0220dba8be7 4111 * @param[in] blockSize number of samples to process.
Kojto 123:b0220dba8be7 4112 * @return none.
Kojto 123:b0220dba8be7 4113 */
Kojto 123:b0220dba8be7 4114
Kojto 123:b0220dba8be7 4115 void arm_iir_lattice_f32(
Kojto 123:b0220dba8be7 4116 const arm_iir_lattice_instance_f32 * S,
Kojto 123:b0220dba8be7 4117 float32_t * pSrc,
Kojto 123:b0220dba8be7 4118 float32_t * pDst,
Kojto 123:b0220dba8be7 4119 uint32_t blockSize);
Kojto 123:b0220dba8be7 4120
Kojto 123:b0220dba8be7 4121 /**
Kojto 123:b0220dba8be7 4122 * @brief Initialization function for the floating-point IIR lattice filter.
Kojto 123:b0220dba8be7 4123 * @param[in] *S points to an instance of the floating-point IIR lattice structure.
Kojto 123:b0220dba8be7 4124 * @param[in] numStages number of stages in the filter.
Kojto 123:b0220dba8be7 4125 * @param[in] *pkCoeffs points to the reflection coefficient buffer. The array is of length numStages.
Kojto 123:b0220dba8be7 4126 * @param[in] *pvCoeffs points to the ladder coefficient buffer. The array is of length numStages+1.
Kojto 123:b0220dba8be7 4127 * @param[in] *pState points to the state buffer. The array is of length numStages+blockSize-1.
Kojto 123:b0220dba8be7 4128 * @param[in] blockSize number of samples to process.
Kojto 123:b0220dba8be7 4129 * @return none.
Kojto 123:b0220dba8be7 4130 */
Kojto 123:b0220dba8be7 4131
Kojto 123:b0220dba8be7 4132 void arm_iir_lattice_init_f32(
Kojto 123:b0220dba8be7 4133 arm_iir_lattice_instance_f32 * S,
Kojto 123:b0220dba8be7 4134 uint16_t numStages,
Kojto 123:b0220dba8be7 4135 float32_t * pkCoeffs,
Kojto 123:b0220dba8be7 4136 float32_t * pvCoeffs,
Kojto 123:b0220dba8be7 4137 float32_t * pState,
Kojto 123:b0220dba8be7 4138 uint32_t blockSize);
Kojto 123:b0220dba8be7 4139
Kojto 123:b0220dba8be7 4140
Kojto 123:b0220dba8be7 4141 /**
Kojto 123:b0220dba8be7 4142 * @brief Processing function for the Q31 IIR lattice filter.
Kojto 123:b0220dba8be7 4143 * @param[in] *S points to an instance of the Q31 IIR lattice structure.
Kojto 123:b0220dba8be7 4144 * @param[in] *pSrc points to the block of input data.
Kojto 123:b0220dba8be7 4145 * @param[out] *pDst points to the block of output data.
Kojto 123:b0220dba8be7 4146 * @param[in] blockSize number of samples to process.
Kojto 123:b0220dba8be7 4147 * @return none.
Kojto 123:b0220dba8be7 4148 */
Kojto 123:b0220dba8be7 4149
Kojto 123:b0220dba8be7 4150 void arm_iir_lattice_q31(
Kojto 123:b0220dba8be7 4151 const arm_iir_lattice_instance_q31 * S,
Kojto 123:b0220dba8be7 4152 q31_t * pSrc,
Kojto 123:b0220dba8be7 4153 q31_t * pDst,
Kojto 123:b0220dba8be7 4154 uint32_t blockSize);
Kojto 123:b0220dba8be7 4155
Kojto 123:b0220dba8be7 4156
Kojto 123:b0220dba8be7 4157 /**
Kojto 123:b0220dba8be7 4158 * @brief Initialization function for the Q31 IIR lattice filter.
Kojto 123:b0220dba8be7 4159 * @param[in] *S points to an instance of the Q31 IIR lattice structure.
Kojto 123:b0220dba8be7 4160 * @param[in] numStages number of stages in the filter.
Kojto 123:b0220dba8be7 4161 * @param[in] *pkCoeffs points to the reflection coefficient buffer. The array is of length numStages.
Kojto 123:b0220dba8be7 4162 * @param[in] *pvCoeffs points to the ladder coefficient buffer. The array is of length numStages+1.
Kojto 123:b0220dba8be7 4163 * @param[in] *pState points to the state buffer. The array is of length numStages+blockSize.
Kojto 123:b0220dba8be7 4164 * @param[in] blockSize number of samples to process.
Kojto 123:b0220dba8be7 4165 * @return none.
Kojto 123:b0220dba8be7 4166 */
Kojto 123:b0220dba8be7 4167
Kojto 123:b0220dba8be7 4168 void arm_iir_lattice_init_q31(
Kojto 123:b0220dba8be7 4169 arm_iir_lattice_instance_q31 * S,
Kojto 123:b0220dba8be7 4170 uint16_t numStages,
Kojto 123:b0220dba8be7 4171 q31_t * pkCoeffs,
Kojto 123:b0220dba8be7 4172 q31_t * pvCoeffs,
Kojto 123:b0220dba8be7 4173 q31_t * pState,
Kojto 123:b0220dba8be7 4174 uint32_t blockSize);
Kojto 123:b0220dba8be7 4175
Kojto 123:b0220dba8be7 4176
Kojto 123:b0220dba8be7 4177 /**
Kojto 123:b0220dba8be7 4178 * @brief Processing function for the Q15 IIR lattice filter.
Kojto 123:b0220dba8be7 4179 * @param[in] *S points to an instance of the Q15 IIR lattice structure.
Kojto 123:b0220dba8be7 4180 * @param[in] *pSrc points to the block of input data.
Kojto 123:b0220dba8be7 4181 * @param[out] *pDst points to the block of output data.
Kojto 123:b0220dba8be7 4182 * @param[in] blockSize number of samples to process.
Kojto 123:b0220dba8be7 4183 * @return none.
Kojto 123:b0220dba8be7 4184 */
Kojto 123:b0220dba8be7 4185
Kojto 123:b0220dba8be7 4186 void arm_iir_lattice_q15(
Kojto 123:b0220dba8be7 4187 const arm_iir_lattice_instance_q15 * S,
Kojto 123:b0220dba8be7 4188 q15_t * pSrc,
Kojto 123:b0220dba8be7 4189 q15_t * pDst,
Kojto 123:b0220dba8be7 4190 uint32_t blockSize);
Kojto 123:b0220dba8be7 4191
Kojto 123:b0220dba8be7 4192
Kojto 123:b0220dba8be7 4193 /**
Kojto 123:b0220dba8be7 4194 * @brief Initialization function for the Q15 IIR lattice filter.
Kojto 123:b0220dba8be7 4195 * @param[in] *S points to an instance of the fixed-point Q15 IIR lattice structure.
Kojto 123:b0220dba8be7 4196 * @param[in] numStages number of stages in the filter.
Kojto 123:b0220dba8be7 4197 * @param[in] *pkCoeffs points to reflection coefficient buffer. The array is of length numStages.
Kojto 123:b0220dba8be7 4198 * @param[in] *pvCoeffs points to ladder coefficient buffer. The array is of length numStages+1.
Kojto 123:b0220dba8be7 4199 * @param[in] *pState points to state buffer. The array is of length numStages+blockSize.
Kojto 123:b0220dba8be7 4200 * @param[in] blockSize number of samples to process per call.
Kojto 123:b0220dba8be7 4201 * @return none.
Kojto 123:b0220dba8be7 4202 */
Kojto 123:b0220dba8be7 4203
Kojto 123:b0220dba8be7 4204 void arm_iir_lattice_init_q15(
Kojto 123:b0220dba8be7 4205 arm_iir_lattice_instance_q15 * S,
Kojto 123:b0220dba8be7 4206 uint16_t numStages,
Kojto 123:b0220dba8be7 4207 q15_t * pkCoeffs,
Kojto 123:b0220dba8be7 4208 q15_t * pvCoeffs,
Kojto 123:b0220dba8be7 4209 q15_t * pState,
Kojto 123:b0220dba8be7 4210 uint32_t blockSize);
Kojto 123:b0220dba8be7 4211
Kojto 123:b0220dba8be7 4212 /**
Kojto 123:b0220dba8be7 4213 * @brief Instance structure for the floating-point LMS filter.
Kojto 123:b0220dba8be7 4214 */
Kojto 123:b0220dba8be7 4215
Kojto 123:b0220dba8be7 4216 typedef struct
Kojto 123:b0220dba8be7 4217 {
Kojto 123:b0220dba8be7 4218 uint16_t numTaps; /**< number of coefficients in the filter. */
Kojto 123:b0220dba8be7 4219 float32_t *pState; /**< points to the state variable array. The array is of length numTaps+blockSize-1. */
Kojto 123:b0220dba8be7 4220 float32_t *pCoeffs; /**< points to the coefficient array. The array is of length numTaps. */
Kojto 123:b0220dba8be7 4221 float32_t mu; /**< step size that controls filter coefficient updates. */
Kojto 123:b0220dba8be7 4222 } arm_lms_instance_f32;
Kojto 123:b0220dba8be7 4223
Kojto 123:b0220dba8be7 4224 /**
Kojto 123:b0220dba8be7 4225 * @brief Processing function for floating-point LMS filter.
Kojto 123:b0220dba8be7 4226 * @param[in] *S points to an instance of the floating-point LMS filter structure.
Kojto 123:b0220dba8be7 4227 * @param[in] *pSrc points to the block of input data.
Kojto 123:b0220dba8be7 4228 * @param[in] *pRef points to the block of reference data.
Kojto 123:b0220dba8be7 4229 * @param[out] *pOut points to the block of output data.
Kojto 123:b0220dba8be7 4230 * @param[out] *pErr points to the block of error data.
Kojto 123:b0220dba8be7 4231 * @param[in] blockSize number of samples to process.
Kojto 123:b0220dba8be7 4232 * @return none.
Kojto 123:b0220dba8be7 4233 */
Kojto 123:b0220dba8be7 4234
Kojto 123:b0220dba8be7 4235 void arm_lms_f32(
Kojto 123:b0220dba8be7 4236 const arm_lms_instance_f32 * S,
Kojto 123:b0220dba8be7 4237 float32_t * pSrc,
Kojto 123:b0220dba8be7 4238 float32_t * pRef,
Kojto 123:b0220dba8be7 4239 float32_t * pOut,
Kojto 123:b0220dba8be7 4240 float32_t * pErr,
Kojto 123:b0220dba8be7 4241 uint32_t blockSize);
Kojto 123:b0220dba8be7 4242
Kojto 123:b0220dba8be7 4243 /**
Kojto 123:b0220dba8be7 4244 * @brief Initialization function for floating-point LMS filter.
Kojto 123:b0220dba8be7 4245 * @param[in] *S points to an instance of the floating-point LMS filter structure.
Kojto 123:b0220dba8be7 4246 * @param[in] numTaps number of filter coefficients.
Kojto 123:b0220dba8be7 4247 * @param[in] *pCoeffs points to the coefficient buffer.
Kojto 123:b0220dba8be7 4248 * @param[in] *pState points to state buffer.
Kojto 123:b0220dba8be7 4249 * @param[in] mu step size that controls filter coefficient updates.
Kojto 123:b0220dba8be7 4250 * @param[in] blockSize number of samples to process.
Kojto 123:b0220dba8be7 4251 * @return none.
Kojto 123:b0220dba8be7 4252 */
Kojto 123:b0220dba8be7 4253
Kojto 123:b0220dba8be7 4254 void arm_lms_init_f32(
Kojto 123:b0220dba8be7 4255 arm_lms_instance_f32 * S,
Kojto 123:b0220dba8be7 4256 uint16_t numTaps,
Kojto 123:b0220dba8be7 4257 float32_t * pCoeffs,
Kojto 123:b0220dba8be7 4258 float32_t * pState,
Kojto 123:b0220dba8be7 4259 float32_t mu,
Kojto 123:b0220dba8be7 4260 uint32_t blockSize);
Kojto 123:b0220dba8be7 4261
Kojto 123:b0220dba8be7 4262 /**
Kojto 123:b0220dba8be7 4263 * @brief Instance structure for the Q15 LMS filter.
Kojto 123:b0220dba8be7 4264 */
Kojto 123:b0220dba8be7 4265
Kojto 123:b0220dba8be7 4266 typedef struct
Kojto 123:b0220dba8be7 4267 {
Kojto 123:b0220dba8be7 4268 uint16_t numTaps; /**< number of coefficients in the filter. */
Kojto 123:b0220dba8be7 4269 q15_t *pState; /**< points to the state variable array. The array is of length numTaps+blockSize-1. */
Kojto 123:b0220dba8be7 4270 q15_t *pCoeffs; /**< points to the coefficient array. The array is of length numTaps. */
Kojto 123:b0220dba8be7 4271 q15_t mu; /**< step size that controls filter coefficient updates. */
Kojto 123:b0220dba8be7 4272 uint32_t postShift; /**< bit shift applied to coefficients. */
Kojto 123:b0220dba8be7 4273 } arm_lms_instance_q15;
Kojto 123:b0220dba8be7 4274
Kojto 123:b0220dba8be7 4275
Kojto 123:b0220dba8be7 4276 /**
Kojto 123:b0220dba8be7 4277 * @brief Initialization function for the Q15 LMS filter.
Kojto 123:b0220dba8be7 4278 * @param[in] *S points to an instance of the Q15 LMS filter structure.
Kojto 123:b0220dba8be7 4279 * @param[in] numTaps number of filter coefficients.
Kojto 123:b0220dba8be7 4280 * @param[in] *pCoeffs points to the coefficient buffer.
Kojto 123:b0220dba8be7 4281 * @param[in] *pState points to the state buffer.
Kojto 123:b0220dba8be7 4282 * @param[in] mu step size that controls filter coefficient updates.
Kojto 123:b0220dba8be7 4283 * @param[in] blockSize number of samples to process.
Kojto 123:b0220dba8be7 4284 * @param[in] postShift bit shift applied to coefficients.
Kojto 123:b0220dba8be7 4285 * @return none.
Kojto 123:b0220dba8be7 4286 */
Kojto 123:b0220dba8be7 4287
Kojto 123:b0220dba8be7 4288 void arm_lms_init_q15(
Kojto 123:b0220dba8be7 4289 arm_lms_instance_q15 * S,
Kojto 123:b0220dba8be7 4290 uint16_t numTaps,
Kojto 123:b0220dba8be7 4291 q15_t * pCoeffs,
Kojto 123:b0220dba8be7 4292 q15_t * pState,
Kojto 123:b0220dba8be7 4293 q15_t mu,
Kojto 123:b0220dba8be7 4294 uint32_t blockSize,
Kojto 123:b0220dba8be7 4295 uint32_t postShift);
Kojto 123:b0220dba8be7 4296
Kojto 123:b0220dba8be7 4297 /**
Kojto 123:b0220dba8be7 4298 * @brief Processing function for Q15 LMS filter.
Kojto 123:b0220dba8be7 4299 * @param[in] *S points to an instance of the Q15 LMS filter structure.
Kojto 123:b0220dba8be7 4300 * @param[in] *pSrc points to the block of input data.
Kojto 123:b0220dba8be7 4301 * @param[in] *pRef points to the block of reference data.
Kojto 123:b0220dba8be7 4302 * @param[out] *pOut points to the block of output data.
Kojto 123:b0220dba8be7 4303 * @param[out] *pErr points to the block of error data.
Kojto 123:b0220dba8be7 4304 * @param[in] blockSize number of samples to process.
Kojto 123:b0220dba8be7 4305 * @return none.
Kojto 123:b0220dba8be7 4306 */
Kojto 123:b0220dba8be7 4307
Kojto 123:b0220dba8be7 4308 void arm_lms_q15(
Kojto 123:b0220dba8be7 4309 const arm_lms_instance_q15 * S,
Kojto 123:b0220dba8be7 4310 q15_t * pSrc,
Kojto 123:b0220dba8be7 4311 q15_t * pRef,
Kojto 123:b0220dba8be7 4312 q15_t * pOut,
Kojto 123:b0220dba8be7 4313 q15_t * pErr,
Kojto 123:b0220dba8be7 4314 uint32_t blockSize);
Kojto 123:b0220dba8be7 4315
Kojto 123:b0220dba8be7 4316
Kojto 123:b0220dba8be7 4317 /**
Kojto 123:b0220dba8be7 4318 * @brief Instance structure for the Q31 LMS filter.
Kojto 123:b0220dba8be7 4319 */
Kojto 123:b0220dba8be7 4320
Kojto 123:b0220dba8be7 4321 typedef struct
Kojto 123:b0220dba8be7 4322 {
Kojto 123:b0220dba8be7 4323 uint16_t numTaps; /**< number of coefficients in the filter. */
Kojto 123:b0220dba8be7 4324 q31_t *pState; /**< points to the state variable array. The array is of length numTaps+blockSize-1. */
Kojto 123:b0220dba8be7 4325 q31_t *pCoeffs; /**< points to the coefficient array. The array is of length numTaps. */
Kojto 123:b0220dba8be7 4326 q31_t mu; /**< step size that controls filter coefficient updates. */
Kojto 123:b0220dba8be7 4327 uint32_t postShift; /**< bit shift applied to coefficients. */
Kojto 123:b0220dba8be7 4328
Kojto 123:b0220dba8be7 4329 } arm_lms_instance_q31;
Kojto 123:b0220dba8be7 4330
Kojto 123:b0220dba8be7 4331 /**
Kojto 123:b0220dba8be7 4332 * @brief Processing function for Q31 LMS filter.
Kojto 123:b0220dba8be7 4333 * @param[in] *S points to an instance of the Q15 LMS filter structure.
Kojto 123:b0220dba8be7 4334 * @param[in] *pSrc points to the block of input data.
Kojto 123:b0220dba8be7 4335 * @param[in] *pRef points to the block of reference data.
Kojto 123:b0220dba8be7 4336 * @param[out] *pOut points to the block of output data.
Kojto 123:b0220dba8be7 4337 * @param[out] *pErr points to the block of error data.
Kojto 123:b0220dba8be7 4338 * @param[in] blockSize number of samples to process.
Kojto 123:b0220dba8be7 4339 * @return none.
Kojto 123:b0220dba8be7 4340 */
Kojto 123:b0220dba8be7 4341
Kojto 123:b0220dba8be7 4342 void arm_lms_q31(
Kojto 123:b0220dba8be7 4343 const arm_lms_instance_q31 * S,
Kojto 123:b0220dba8be7 4344 q31_t * pSrc,
Kojto 123:b0220dba8be7 4345 q31_t * pRef,
Kojto 123:b0220dba8be7 4346 q31_t * pOut,
Kojto 123:b0220dba8be7 4347 q31_t * pErr,
Kojto 123:b0220dba8be7 4348 uint32_t blockSize);
Kojto 123:b0220dba8be7 4349
Kojto 123:b0220dba8be7 4350 /**
Kojto 123:b0220dba8be7 4351 * @brief Initialization function for Q31 LMS filter.
Kojto 123:b0220dba8be7 4352 * @param[in] *S points to an instance of the Q31 LMS filter structure.
Kojto 123:b0220dba8be7 4353 * @param[in] numTaps number of filter coefficients.
Kojto 123:b0220dba8be7 4354 * @param[in] *pCoeffs points to coefficient buffer.
Kojto 123:b0220dba8be7 4355 * @param[in] *pState points to state buffer.
Kojto 123:b0220dba8be7 4356 * @param[in] mu step size that controls filter coefficient updates.
Kojto 123:b0220dba8be7 4357 * @param[in] blockSize number of samples to process.
Kojto 123:b0220dba8be7 4358 * @param[in] postShift bit shift applied to coefficients.
Kojto 123:b0220dba8be7 4359 * @return none.
Kojto 123:b0220dba8be7 4360 */
Kojto 123:b0220dba8be7 4361
Kojto 123:b0220dba8be7 4362 void arm_lms_init_q31(
Kojto 123:b0220dba8be7 4363 arm_lms_instance_q31 * S,
Kojto 123:b0220dba8be7 4364 uint16_t numTaps,
Kojto 123:b0220dba8be7 4365 q31_t * pCoeffs,
Kojto 123:b0220dba8be7 4366 q31_t * pState,
Kojto 123:b0220dba8be7 4367 q31_t mu,
Kojto 123:b0220dba8be7 4368 uint32_t blockSize,
Kojto 123:b0220dba8be7 4369 uint32_t postShift);
Kojto 123:b0220dba8be7 4370
Kojto 123:b0220dba8be7 4371 /**
Kojto 123:b0220dba8be7 4372 * @brief Instance structure for the floating-point normalized LMS filter.
Kojto 123:b0220dba8be7 4373 */
Kojto 123:b0220dba8be7 4374
Kojto 123:b0220dba8be7 4375 typedef struct
Kojto 123:b0220dba8be7 4376 {
Kojto 123:b0220dba8be7 4377 uint16_t numTaps; /**< number of coefficients in the filter. */
Kojto 123:b0220dba8be7 4378 float32_t *pState; /**< points to the state variable array. The array is of length numTaps+blockSize-1. */
Kojto 123:b0220dba8be7 4379 float32_t *pCoeffs; /**< points to the coefficient array. The array is of length numTaps. */
Kojto 123:b0220dba8be7 4380 float32_t mu; /**< step size that control filter coefficient updates. */
Kojto 123:b0220dba8be7 4381 float32_t energy; /**< saves previous frame energy. */
Kojto 123:b0220dba8be7 4382 float32_t x0; /**< saves previous input sample. */
Kojto 123:b0220dba8be7 4383 } arm_lms_norm_instance_f32;
Kojto 123:b0220dba8be7 4384
Kojto 123:b0220dba8be7 4385 /**
Kojto 123:b0220dba8be7 4386 * @brief Processing function for floating-point normalized LMS filter.
Kojto 123:b0220dba8be7 4387 * @param[in] *S points to an instance of the floating-point normalized LMS filter structure.
Kojto 123:b0220dba8be7 4388 * @param[in] *pSrc points to the block of input data.
Kojto 123:b0220dba8be7 4389 * @param[in] *pRef points to the block of reference data.
Kojto 123:b0220dba8be7 4390 * @param[out] *pOut points to the block of output data.
Kojto 123:b0220dba8be7 4391 * @param[out] *pErr points to the block of error data.
Kojto 123:b0220dba8be7 4392 * @param[in] blockSize number of samples to process.
Kojto 123:b0220dba8be7 4393 * @return none.
Kojto 123:b0220dba8be7 4394 */
Kojto 123:b0220dba8be7 4395
Kojto 123:b0220dba8be7 4396 void arm_lms_norm_f32(
Kojto 123:b0220dba8be7 4397 arm_lms_norm_instance_f32 * S,
Kojto 123:b0220dba8be7 4398 float32_t * pSrc,
Kojto 123:b0220dba8be7 4399 float32_t * pRef,
Kojto 123:b0220dba8be7 4400 float32_t * pOut,
Kojto 123:b0220dba8be7 4401 float32_t * pErr,
Kojto 123:b0220dba8be7 4402 uint32_t blockSize);
Kojto 123:b0220dba8be7 4403
Kojto 123:b0220dba8be7 4404 /**
Kojto 123:b0220dba8be7 4405 * @brief Initialization function for floating-point normalized LMS filter.
Kojto 123:b0220dba8be7 4406 * @param[in] *S points to an instance of the floating-point LMS filter structure.
Kojto 123:b0220dba8be7 4407 * @param[in] numTaps number of filter coefficients.
Kojto 123:b0220dba8be7 4408 * @param[in] *pCoeffs points to coefficient buffer.
Kojto 123:b0220dba8be7 4409 * @param[in] *pState points to state buffer.
Kojto 123:b0220dba8be7 4410 * @param[in] mu step size that controls filter coefficient updates.
Kojto 123:b0220dba8be7 4411 * @param[in] blockSize number of samples to process.
Kojto 123:b0220dba8be7 4412 * @return none.
Kojto 123:b0220dba8be7 4413 */
Kojto 123:b0220dba8be7 4414
Kojto 123:b0220dba8be7 4415 void arm_lms_norm_init_f32(
Kojto 123:b0220dba8be7 4416 arm_lms_norm_instance_f32 * S,
Kojto 123:b0220dba8be7 4417 uint16_t numTaps,
Kojto 123:b0220dba8be7 4418 float32_t * pCoeffs,
Kojto 123:b0220dba8be7 4419 float32_t * pState,
Kojto 123:b0220dba8be7 4420 float32_t mu,
Kojto 123:b0220dba8be7 4421 uint32_t blockSize);
Kojto 123:b0220dba8be7 4422
Kojto 123:b0220dba8be7 4423
Kojto 123:b0220dba8be7 4424 /**
Kojto 123:b0220dba8be7 4425 * @brief Instance structure for the Q31 normalized LMS filter.
Kojto 123:b0220dba8be7 4426 */
Kojto 123:b0220dba8be7 4427 typedef struct
Kojto 123:b0220dba8be7 4428 {
Kojto 123:b0220dba8be7 4429 uint16_t numTaps; /**< number of coefficients in the filter. */
Kojto 123:b0220dba8be7 4430 q31_t *pState; /**< points to the state variable array. The array is of length numTaps+blockSize-1. */
Kojto 123:b0220dba8be7 4431 q31_t *pCoeffs; /**< points to the coefficient array. The array is of length numTaps. */
Kojto 123:b0220dba8be7 4432 q31_t mu; /**< step size that controls filter coefficient updates. */
Kojto 123:b0220dba8be7 4433 uint8_t postShift; /**< bit shift applied to coefficients. */
Kojto 123:b0220dba8be7 4434 q31_t *recipTable; /**< points to the reciprocal initial value table. */
Kojto 123:b0220dba8be7 4435 q31_t energy; /**< saves previous frame energy. */
Kojto 123:b0220dba8be7 4436 q31_t x0; /**< saves previous input sample. */
Kojto 123:b0220dba8be7 4437 } arm_lms_norm_instance_q31;
Kojto 123:b0220dba8be7 4438
Kojto 123:b0220dba8be7 4439 /**
Kojto 123:b0220dba8be7 4440 * @brief Processing function for Q31 normalized LMS filter.
Kojto 123:b0220dba8be7 4441 * @param[in] *S points to an instance of the Q31 normalized LMS filter structure.
Kojto 123:b0220dba8be7 4442 * @param[in] *pSrc points to the block of input data.
Kojto 123:b0220dba8be7 4443 * @param[in] *pRef points to the block of reference data.
Kojto 123:b0220dba8be7 4444 * @param[out] *pOut points to the block of output data.
Kojto 123:b0220dba8be7 4445 * @param[out] *pErr points to the block of error data.
Kojto 123:b0220dba8be7 4446 * @param[in] blockSize number of samples to process.
Kojto 123:b0220dba8be7 4447 * @return none.
Kojto 123:b0220dba8be7 4448 */
Kojto 123:b0220dba8be7 4449
Kojto 123:b0220dba8be7 4450 void arm_lms_norm_q31(
Kojto 123:b0220dba8be7 4451 arm_lms_norm_instance_q31 * S,
Kojto 123:b0220dba8be7 4452 q31_t * pSrc,
Kojto 123:b0220dba8be7 4453 q31_t * pRef,
Kojto 123:b0220dba8be7 4454 q31_t * pOut,
Kojto 123:b0220dba8be7 4455 q31_t * pErr,
Kojto 123:b0220dba8be7 4456 uint32_t blockSize);
Kojto 123:b0220dba8be7 4457
Kojto 123:b0220dba8be7 4458 /**
Kojto 123:b0220dba8be7 4459 * @brief Initialization function for Q31 normalized LMS filter.
Kojto 123:b0220dba8be7 4460 * @param[in] *S points to an instance of the Q31 normalized LMS filter structure.
Kojto 123:b0220dba8be7 4461 * @param[in] numTaps number of filter coefficients.
Kojto 123:b0220dba8be7 4462 * @param[in] *pCoeffs points to coefficient buffer.
Kojto 123:b0220dba8be7 4463 * @param[in] *pState points to state buffer.
Kojto 123:b0220dba8be7 4464 * @param[in] mu step size that controls filter coefficient updates.
Kojto 123:b0220dba8be7 4465 * @param[in] blockSize number of samples to process.
Kojto 123:b0220dba8be7 4466 * @param[in] postShift bit shift applied to coefficients.
Kojto 123:b0220dba8be7 4467 * @return none.
Kojto 123:b0220dba8be7 4468 */
Kojto 123:b0220dba8be7 4469
Kojto 123:b0220dba8be7 4470 void arm_lms_norm_init_q31(
Kojto 123:b0220dba8be7 4471 arm_lms_norm_instance_q31 * S,
Kojto 123:b0220dba8be7 4472 uint16_t numTaps,
Kojto 123:b0220dba8be7 4473 q31_t * pCoeffs,
Kojto 123:b0220dba8be7 4474 q31_t * pState,
Kojto 123:b0220dba8be7 4475 q31_t mu,
Kojto 123:b0220dba8be7 4476 uint32_t blockSize,
Kojto 123:b0220dba8be7 4477 uint8_t postShift);
Kojto 123:b0220dba8be7 4478
Kojto 123:b0220dba8be7 4479 /**
Kojto 123:b0220dba8be7 4480 * @brief Instance structure for the Q15 normalized LMS filter.
Kojto 123:b0220dba8be7 4481 */
Kojto 123:b0220dba8be7 4482
Kojto 123:b0220dba8be7 4483 typedef struct
Kojto 123:b0220dba8be7 4484 {
Kojto 123:b0220dba8be7 4485 uint16_t numTaps; /**< Number of coefficients in the filter. */
Kojto 123:b0220dba8be7 4486 q15_t *pState; /**< points to the state variable array. The array is of length numTaps+blockSize-1. */
Kojto 123:b0220dba8be7 4487 q15_t *pCoeffs; /**< points to the coefficient array. The array is of length numTaps. */
Kojto 123:b0220dba8be7 4488 q15_t mu; /**< step size that controls filter coefficient updates. */
Kojto 123:b0220dba8be7 4489 uint8_t postShift; /**< bit shift applied to coefficients. */
Kojto 123:b0220dba8be7 4490 q15_t *recipTable; /**< Points to the reciprocal initial value table. */
Kojto 123:b0220dba8be7 4491 q15_t energy; /**< saves previous frame energy. */
Kojto 123:b0220dba8be7 4492 q15_t x0; /**< saves previous input sample. */
Kojto 123:b0220dba8be7 4493 } arm_lms_norm_instance_q15;
Kojto 123:b0220dba8be7 4494
Kojto 123:b0220dba8be7 4495 /**
Kojto 123:b0220dba8be7 4496 * @brief Processing function for Q15 normalized LMS filter.
Kojto 123:b0220dba8be7 4497 * @param[in] *S points to an instance of the Q15 normalized LMS filter structure.
Kojto 123:b0220dba8be7 4498 * @param[in] *pSrc points to the block of input data.
Kojto 123:b0220dba8be7 4499 * @param[in] *pRef points to the block of reference data.
Kojto 123:b0220dba8be7 4500 * @param[out] *pOut points to the block of output data.
Kojto 123:b0220dba8be7 4501 * @param[out] *pErr points to the block of error data.
Kojto 123:b0220dba8be7 4502 * @param[in] blockSize number of samples to process.
Kojto 123:b0220dba8be7 4503 * @return none.
Kojto 123:b0220dba8be7 4504 */
Kojto 123:b0220dba8be7 4505
Kojto 123:b0220dba8be7 4506 void arm_lms_norm_q15(
Kojto 123:b0220dba8be7 4507 arm_lms_norm_instance_q15 * S,
Kojto 123:b0220dba8be7 4508 q15_t * pSrc,
Kojto 123:b0220dba8be7 4509 q15_t * pRef,
Kojto 123:b0220dba8be7 4510 q15_t * pOut,
Kojto 123:b0220dba8be7 4511 q15_t * pErr,
Kojto 123:b0220dba8be7 4512 uint32_t blockSize);
Kojto 123:b0220dba8be7 4513
Kojto 123:b0220dba8be7 4514
Kojto 123:b0220dba8be7 4515 /**
Kojto 123:b0220dba8be7 4516 * @brief Initialization function for Q15 normalized LMS filter.
Kojto 123:b0220dba8be7 4517 * @param[in] *S points to an instance of the Q15 normalized LMS filter structure.
Kojto 123:b0220dba8be7 4518 * @param[in] numTaps number of filter coefficients.
Kojto 123:b0220dba8be7 4519 * @param[in] *pCoeffs points to coefficient buffer.
Kojto 123:b0220dba8be7 4520 * @param[in] *pState points to state buffer.
Kojto 123:b0220dba8be7 4521 * @param[in] mu step size that controls filter coefficient updates.
Kojto 123:b0220dba8be7 4522 * @param[in] blockSize number of samples to process.
Kojto 123:b0220dba8be7 4523 * @param[in] postShift bit shift applied to coefficients.
Kojto 123:b0220dba8be7 4524 * @return none.
Kojto 123:b0220dba8be7 4525 */
Kojto 123:b0220dba8be7 4526
Kojto 123:b0220dba8be7 4527 void arm_lms_norm_init_q15(
Kojto 123:b0220dba8be7 4528 arm_lms_norm_instance_q15 * S,
Kojto 123:b0220dba8be7 4529 uint16_t numTaps,
Kojto 123:b0220dba8be7 4530 q15_t * pCoeffs,
Kojto 123:b0220dba8be7 4531 q15_t * pState,
Kojto 123:b0220dba8be7 4532 q15_t mu,
Kojto 123:b0220dba8be7 4533 uint32_t blockSize,
Kojto 123:b0220dba8be7 4534 uint8_t postShift);
Kojto 123:b0220dba8be7 4535
Kojto 123:b0220dba8be7 4536 /**
Kojto 123:b0220dba8be7 4537 * @brief Correlation of floating-point sequences.
Kojto 123:b0220dba8be7 4538 * @param[in] *pSrcA points to the first input sequence.
Kojto 123:b0220dba8be7 4539 * @param[in] srcALen length of the first input sequence.
Kojto 123:b0220dba8be7 4540 * @param[in] *pSrcB points to the second input sequence.
Kojto 123:b0220dba8be7 4541 * @param[in] srcBLen length of the second input sequence.
Kojto 123:b0220dba8be7 4542 * @param[out] *pDst points to the block of output data Length 2 * max(srcALen, srcBLen) - 1.
Kojto 123:b0220dba8be7 4543 * @return none.
Kojto 123:b0220dba8be7 4544 */
Kojto 123:b0220dba8be7 4545
Kojto 123:b0220dba8be7 4546 void arm_correlate_f32(
Kojto 123:b0220dba8be7 4547 float32_t * pSrcA,
Kojto 123:b0220dba8be7 4548 uint32_t srcALen,
Kojto 123:b0220dba8be7 4549 float32_t * pSrcB,
Kojto 123:b0220dba8be7 4550 uint32_t srcBLen,
Kojto 123:b0220dba8be7 4551 float32_t * pDst);
Kojto 123:b0220dba8be7 4552
Kojto 123:b0220dba8be7 4553
Kojto 123:b0220dba8be7 4554 /**
Kojto 123:b0220dba8be7 4555 * @brief Correlation of Q15 sequences
Kojto 123:b0220dba8be7 4556 * @param[in] *pSrcA points to the first input sequence.
Kojto 123:b0220dba8be7 4557 * @param[in] srcALen length of the first input sequence.
Kojto 123:b0220dba8be7 4558 * @param[in] *pSrcB points to the second input sequence.
Kojto 123:b0220dba8be7 4559 * @param[in] srcBLen length of the second input sequence.
Kojto 123:b0220dba8be7 4560 * @param[out] *pDst points to the block of output data Length 2 * max(srcALen, srcBLen) - 1.
Kojto 123:b0220dba8be7 4561 * @param[in] *pScratch points to scratch buffer of size max(srcALen, srcBLen) + 2*min(srcALen, srcBLen) - 2.
Kojto 123:b0220dba8be7 4562 * @return none.
Kojto 123:b0220dba8be7 4563 */
Kojto 123:b0220dba8be7 4564 void arm_correlate_opt_q15(
Kojto 123:b0220dba8be7 4565 q15_t * pSrcA,
Kojto 123:b0220dba8be7 4566 uint32_t srcALen,
Kojto 123:b0220dba8be7 4567 q15_t * pSrcB,
Kojto 123:b0220dba8be7 4568 uint32_t srcBLen,
Kojto 123:b0220dba8be7 4569 q15_t * pDst,
Kojto 123:b0220dba8be7 4570 q15_t * pScratch);
Kojto 123:b0220dba8be7 4571
Kojto 123:b0220dba8be7 4572
Kojto 123:b0220dba8be7 4573 /**
Kojto 123:b0220dba8be7 4574 * @brief Correlation of Q15 sequences.
Kojto 123:b0220dba8be7 4575 * @param[in] *pSrcA points to the first input sequence.
Kojto 123:b0220dba8be7 4576 * @param[in] srcALen length of the first input sequence.
Kojto 123:b0220dba8be7 4577 * @param[in] *pSrcB points to the second input sequence.
Kojto 123:b0220dba8be7 4578 * @param[in] srcBLen length of the second input sequence.
Kojto 123:b0220dba8be7 4579 * @param[out] *pDst points to the block of output data Length 2 * max(srcALen, srcBLen) - 1.
Kojto 123:b0220dba8be7 4580 * @return none.
Kojto 123:b0220dba8be7 4581 */
Kojto 123:b0220dba8be7 4582
Kojto 123:b0220dba8be7 4583 void arm_correlate_q15(
Kojto 123:b0220dba8be7 4584 q15_t * pSrcA,
Kojto 123:b0220dba8be7 4585 uint32_t srcALen,
Kojto 123:b0220dba8be7 4586 q15_t * pSrcB,
Kojto 123:b0220dba8be7 4587 uint32_t srcBLen,
Kojto 123:b0220dba8be7 4588 q15_t * pDst);
Kojto 123:b0220dba8be7 4589
Kojto 123:b0220dba8be7 4590 /**
Kojto 123:b0220dba8be7 4591 * @brief Correlation of Q15 sequences (fast version) for Cortex-M3 and Cortex-M4.
Kojto 123:b0220dba8be7 4592 * @param[in] *pSrcA points to the first input sequence.
Kojto 123:b0220dba8be7 4593 * @param[in] srcALen length of the first input sequence.
Kojto 123:b0220dba8be7 4594 * @param[in] *pSrcB points to the second input sequence.
Kojto 123:b0220dba8be7 4595 * @param[in] srcBLen length of the second input sequence.
Kojto 123:b0220dba8be7 4596 * @param[out] *pDst points to the block of output data Length 2 * max(srcALen, srcBLen) - 1.
Kojto 123:b0220dba8be7 4597 * @return none.
Kojto 123:b0220dba8be7 4598 */
Kojto 123:b0220dba8be7 4599
Kojto 123:b0220dba8be7 4600 void arm_correlate_fast_q15(
Kojto 123:b0220dba8be7 4601 q15_t * pSrcA,
Kojto 123:b0220dba8be7 4602 uint32_t srcALen,
Kojto 123:b0220dba8be7 4603 q15_t * pSrcB,
Kojto 123:b0220dba8be7 4604 uint32_t srcBLen,
Kojto 123:b0220dba8be7 4605 q15_t * pDst);
Kojto 123:b0220dba8be7 4606
Kojto 123:b0220dba8be7 4607
Kojto 123:b0220dba8be7 4608
Kojto 123:b0220dba8be7 4609 /**
Kojto 123:b0220dba8be7 4610 * @brief Correlation of Q15 sequences (fast version) for Cortex-M3 and Cortex-M4.
Kojto 123:b0220dba8be7 4611 * @param[in] *pSrcA points to the first input sequence.
Kojto 123:b0220dba8be7 4612 * @param[in] srcALen length of the first input sequence.
Kojto 123:b0220dba8be7 4613 * @param[in] *pSrcB points to the second input sequence.
Kojto 123:b0220dba8be7 4614 * @param[in] srcBLen length of the second input sequence.
Kojto 123:b0220dba8be7 4615 * @param[out] *pDst points to the block of output data Length 2 * max(srcALen, srcBLen) - 1.
Kojto 123:b0220dba8be7 4616 * @param[in] *pScratch points to scratch buffer of size max(srcALen, srcBLen) + 2*min(srcALen, srcBLen) - 2.
Kojto 123:b0220dba8be7 4617 * @return none.
Kojto 123:b0220dba8be7 4618 */
Kojto 123:b0220dba8be7 4619
Kojto 123:b0220dba8be7 4620 void arm_correlate_fast_opt_q15(
Kojto 123:b0220dba8be7 4621 q15_t * pSrcA,
Kojto 123:b0220dba8be7 4622 uint32_t srcALen,
Kojto 123:b0220dba8be7 4623 q15_t * pSrcB,
Kojto 123:b0220dba8be7 4624 uint32_t srcBLen,
Kojto 123:b0220dba8be7 4625 q15_t * pDst,
Kojto 123:b0220dba8be7 4626 q15_t * pScratch);
Kojto 123:b0220dba8be7 4627
Kojto 123:b0220dba8be7 4628 /**
Kojto 123:b0220dba8be7 4629 * @brief Correlation of Q31 sequences.
Kojto 123:b0220dba8be7 4630 * @param[in] *pSrcA points to the first input sequence.
Kojto 123:b0220dba8be7 4631 * @param[in] srcALen length of the first input sequence.
Kojto 123:b0220dba8be7 4632 * @param[in] *pSrcB points to the second input sequence.
Kojto 123:b0220dba8be7 4633 * @param[in] srcBLen length of the second input sequence.
Kojto 123:b0220dba8be7 4634 * @param[out] *pDst points to the block of output data Length 2 * max(srcALen, srcBLen) - 1.
Kojto 123:b0220dba8be7 4635 * @return none.
Kojto 123:b0220dba8be7 4636 */
Kojto 123:b0220dba8be7 4637
Kojto 123:b0220dba8be7 4638 void arm_correlate_q31(
Kojto 123:b0220dba8be7 4639 q31_t * pSrcA,
Kojto 123:b0220dba8be7 4640 uint32_t srcALen,
Kojto 123:b0220dba8be7 4641 q31_t * pSrcB,
Kojto 123:b0220dba8be7 4642 uint32_t srcBLen,
Kojto 123:b0220dba8be7 4643 q31_t * pDst);
Kojto 123:b0220dba8be7 4644
Kojto 123:b0220dba8be7 4645 /**
Kojto 123:b0220dba8be7 4646 * @brief Correlation of Q31 sequences (fast version) for Cortex-M3 and Cortex-M4
Kojto 123:b0220dba8be7 4647 * @param[in] *pSrcA points to the first input sequence.
Kojto 123:b0220dba8be7 4648 * @param[in] srcALen length of the first input sequence.
Kojto 123:b0220dba8be7 4649 * @param[in] *pSrcB points to the second input sequence.
Kojto 123:b0220dba8be7 4650 * @param[in] srcBLen length of the second input sequence.
Kojto 123:b0220dba8be7 4651 * @param[out] *pDst points to the block of output data Length 2 * max(srcALen, srcBLen) - 1.
Kojto 123:b0220dba8be7 4652 * @return none.
Kojto 123:b0220dba8be7 4653 */
Kojto 123:b0220dba8be7 4654
Kojto 123:b0220dba8be7 4655 void arm_correlate_fast_q31(
Kojto 123:b0220dba8be7 4656 q31_t * pSrcA,
Kojto 123:b0220dba8be7 4657 uint32_t srcALen,
Kojto 123:b0220dba8be7 4658 q31_t * pSrcB,
Kojto 123:b0220dba8be7 4659 uint32_t srcBLen,
Kojto 123:b0220dba8be7 4660 q31_t * pDst);
Kojto 123:b0220dba8be7 4661
Kojto 123:b0220dba8be7 4662
Kojto 123:b0220dba8be7 4663
Kojto 123:b0220dba8be7 4664 /**
Kojto 123:b0220dba8be7 4665 * @brief Correlation of Q7 sequences.
Kojto 123:b0220dba8be7 4666 * @param[in] *pSrcA points to the first input sequence.
Kojto 123:b0220dba8be7 4667 * @param[in] srcALen length of the first input sequence.
Kojto 123:b0220dba8be7 4668 * @param[in] *pSrcB points to the second input sequence.
Kojto 123:b0220dba8be7 4669 * @param[in] srcBLen length of the second input sequence.
Kojto 123:b0220dba8be7 4670 * @param[out] *pDst points to the block of output data Length 2 * max(srcALen, srcBLen) - 1.
Kojto 123:b0220dba8be7 4671 * @param[in] *pScratch1 points to scratch buffer(of type q15_t) of size max(srcALen, srcBLen) + 2*min(srcALen, srcBLen) - 2.
Kojto 123:b0220dba8be7 4672 * @param[in] *pScratch2 points to scratch buffer (of type q15_t) of size min(srcALen, srcBLen).
Kojto 123:b0220dba8be7 4673 * @return none.
Kojto 123:b0220dba8be7 4674 */
Kojto 123:b0220dba8be7 4675
Kojto 123:b0220dba8be7 4676 void arm_correlate_opt_q7(
Kojto 123:b0220dba8be7 4677 q7_t * pSrcA,
Kojto 123:b0220dba8be7 4678 uint32_t srcALen,
Kojto 123:b0220dba8be7 4679 q7_t * pSrcB,
Kojto 123:b0220dba8be7 4680 uint32_t srcBLen,
Kojto 123:b0220dba8be7 4681 q7_t * pDst,
Kojto 123:b0220dba8be7 4682 q15_t * pScratch1,
Kojto 123:b0220dba8be7 4683 q15_t * pScratch2);
Kojto 123:b0220dba8be7 4684
Kojto 123:b0220dba8be7 4685
Kojto 123:b0220dba8be7 4686 /**
Kojto 123:b0220dba8be7 4687 * @brief Correlation of Q7 sequences.
Kojto 123:b0220dba8be7 4688 * @param[in] *pSrcA points to the first input sequence.
Kojto 123:b0220dba8be7 4689 * @param[in] srcALen length of the first input sequence.
Kojto 123:b0220dba8be7 4690 * @param[in] *pSrcB points to the second input sequence.
Kojto 123:b0220dba8be7 4691 * @param[in] srcBLen length of the second input sequence.
Kojto 123:b0220dba8be7 4692 * @param[out] *pDst points to the block of output data Length 2 * max(srcALen, srcBLen) - 1.
Kojto 123:b0220dba8be7 4693 * @return none.
Kojto 123:b0220dba8be7 4694 */
Kojto 123:b0220dba8be7 4695
Kojto 123:b0220dba8be7 4696 void arm_correlate_q7(
Kojto 123:b0220dba8be7 4697 q7_t * pSrcA,
Kojto 123:b0220dba8be7 4698 uint32_t srcALen,
Kojto 123:b0220dba8be7 4699 q7_t * pSrcB,
Kojto 123:b0220dba8be7 4700 uint32_t srcBLen,
Kojto 123:b0220dba8be7 4701 q7_t * pDst);
Kojto 123:b0220dba8be7 4702
Kojto 123:b0220dba8be7 4703
Kojto 123:b0220dba8be7 4704 /**
Kojto 123:b0220dba8be7 4705 * @brief Instance structure for the floating-point sparse FIR filter.
Kojto 123:b0220dba8be7 4706 */
Kojto 123:b0220dba8be7 4707 typedef struct
Kojto 123:b0220dba8be7 4708 {
Kojto 123:b0220dba8be7 4709 uint16_t numTaps; /**< number of coefficients in the filter. */
Kojto 123:b0220dba8be7 4710 uint16_t stateIndex; /**< state buffer index. Points to the oldest sample in the state buffer. */
Kojto 123:b0220dba8be7 4711 float32_t *pState; /**< points to the state buffer array. The array is of length maxDelay+blockSize-1. */
Kojto 123:b0220dba8be7 4712 float32_t *pCoeffs; /**< points to the coefficient array. The array is of length numTaps.*/
Kojto 123:b0220dba8be7 4713 uint16_t maxDelay; /**< maximum offset specified by the pTapDelay array. */
Kojto 123:b0220dba8be7 4714 int32_t *pTapDelay; /**< points to the array of delay values. The array is of length numTaps. */
Kojto 123:b0220dba8be7 4715 } arm_fir_sparse_instance_f32;
Kojto 123:b0220dba8be7 4716
Kojto 123:b0220dba8be7 4717 /**
Kojto 123:b0220dba8be7 4718 * @brief Instance structure for the Q31 sparse FIR filter.
Kojto 123:b0220dba8be7 4719 */
Kojto 123:b0220dba8be7 4720
Kojto 123:b0220dba8be7 4721 typedef struct
Kojto 123:b0220dba8be7 4722 {
Kojto 123:b0220dba8be7 4723 uint16_t numTaps; /**< number of coefficients in the filter. */
Kojto 123:b0220dba8be7 4724 uint16_t stateIndex; /**< state buffer index. Points to the oldest sample in the state buffer. */
Kojto 123:b0220dba8be7 4725 q31_t *pState; /**< points to the state buffer array. The array is of length maxDelay+blockSize-1. */
Kojto 123:b0220dba8be7 4726 q31_t *pCoeffs; /**< points to the coefficient array. The array is of length numTaps.*/
Kojto 123:b0220dba8be7 4727 uint16_t maxDelay; /**< maximum offset specified by the pTapDelay array. */
Kojto 123:b0220dba8be7 4728 int32_t *pTapDelay; /**< points to the array of delay values. The array is of length numTaps. */
Kojto 123:b0220dba8be7 4729 } arm_fir_sparse_instance_q31;
Kojto 123:b0220dba8be7 4730
Kojto 123:b0220dba8be7 4731 /**
Kojto 123:b0220dba8be7 4732 * @brief Instance structure for the Q15 sparse FIR filter.
Kojto 123:b0220dba8be7 4733 */
Kojto 123:b0220dba8be7 4734
Kojto 123:b0220dba8be7 4735 typedef struct
Kojto 123:b0220dba8be7 4736 {
Kojto 123:b0220dba8be7 4737 uint16_t numTaps; /**< number of coefficients in the filter. */
Kojto 123:b0220dba8be7 4738 uint16_t stateIndex; /**< state buffer index. Points to the oldest sample in the state buffer. */
Kojto 123:b0220dba8be7 4739 q15_t *pState; /**< points to the state buffer array. The array is of length maxDelay+blockSize-1. */
Kojto 123:b0220dba8be7 4740 q15_t *pCoeffs; /**< points to the coefficient array. The array is of length numTaps.*/
Kojto 123:b0220dba8be7 4741 uint16_t maxDelay; /**< maximum offset specified by the pTapDelay array. */
Kojto 123:b0220dba8be7 4742 int32_t *pTapDelay; /**< points to the array of delay values. The array is of length numTaps. */
Kojto 123:b0220dba8be7 4743 } arm_fir_sparse_instance_q15;
Kojto 123:b0220dba8be7 4744
Kojto 123:b0220dba8be7 4745 /**
Kojto 123:b0220dba8be7 4746 * @brief Instance structure for the Q7 sparse FIR filter.
Kojto 123:b0220dba8be7 4747 */
Kojto 123:b0220dba8be7 4748
Kojto 123:b0220dba8be7 4749 typedef struct
Kojto 123:b0220dba8be7 4750 {
Kojto 123:b0220dba8be7 4751 uint16_t numTaps; /**< number of coefficients in the filter. */
Kojto 123:b0220dba8be7 4752 uint16_t stateIndex; /**< state buffer index. Points to the oldest sample in the state buffer. */
Kojto 123:b0220dba8be7 4753 q7_t *pState; /**< points to the state buffer array. The array is of length maxDelay+blockSize-1. */
Kojto 123:b0220dba8be7 4754 q7_t *pCoeffs; /**< points to the coefficient array. The array is of length numTaps.*/
Kojto 123:b0220dba8be7 4755 uint16_t maxDelay; /**< maximum offset specified by the pTapDelay array. */
Kojto 123:b0220dba8be7 4756 int32_t *pTapDelay; /**< points to the array of delay values. The array is of length numTaps. */
Kojto 123:b0220dba8be7 4757 } arm_fir_sparse_instance_q7;
Kojto 123:b0220dba8be7 4758
Kojto 123:b0220dba8be7 4759 /**
Kojto 123:b0220dba8be7 4760 * @brief Processing function for the floating-point sparse FIR filter.
Kojto 123:b0220dba8be7 4761 * @param[in] *S points to an instance of the floating-point sparse FIR structure.
Kojto 123:b0220dba8be7 4762 * @param[in] *pSrc points to the block of input data.
Kojto 123:b0220dba8be7 4763 * @param[out] *pDst points to the block of output data
Kojto 123:b0220dba8be7 4764 * @param[in] *pScratchIn points to a temporary buffer of size blockSize.
Kojto 123:b0220dba8be7 4765 * @param[in] blockSize number of input samples to process per call.
Kojto 123:b0220dba8be7 4766 * @return none.
Kojto 123:b0220dba8be7 4767 */
Kojto 123:b0220dba8be7 4768
Kojto 123:b0220dba8be7 4769 void arm_fir_sparse_f32(
Kojto 123:b0220dba8be7 4770 arm_fir_sparse_instance_f32 * S,
Kojto 123:b0220dba8be7 4771 float32_t * pSrc,
Kojto 123:b0220dba8be7 4772 float32_t * pDst,
Kojto 123:b0220dba8be7 4773 float32_t * pScratchIn,
Kojto 123:b0220dba8be7 4774 uint32_t blockSize);
Kojto 123:b0220dba8be7 4775
Kojto 123:b0220dba8be7 4776 /**
Kojto 123:b0220dba8be7 4777 * @brief Initialization function for the floating-point sparse FIR filter.
Kojto 123:b0220dba8be7 4778 * @param[in,out] *S points to an instance of the floating-point sparse FIR structure.
Kojto 123:b0220dba8be7 4779 * @param[in] numTaps number of nonzero coefficients in the filter.
Kojto 123:b0220dba8be7 4780 * @param[in] *pCoeffs points to the array of filter coefficients.
Kojto 123:b0220dba8be7 4781 * @param[in] *pState points to the state buffer.
Kojto 123:b0220dba8be7 4782 * @param[in] *pTapDelay points to the array of offset times.
Kojto 123:b0220dba8be7 4783 * @param[in] maxDelay maximum offset time supported.
Kojto 123:b0220dba8be7 4784 * @param[in] blockSize number of samples that will be processed per block.
Kojto 123:b0220dba8be7 4785 * @return none
Kojto 123:b0220dba8be7 4786 */
Kojto 123:b0220dba8be7 4787
Kojto 123:b0220dba8be7 4788 void arm_fir_sparse_init_f32(
Kojto 123:b0220dba8be7 4789 arm_fir_sparse_instance_f32 * S,
Kojto 123:b0220dba8be7 4790 uint16_t numTaps,
Kojto 123:b0220dba8be7 4791 float32_t * pCoeffs,
Kojto 123:b0220dba8be7 4792 float32_t * pState,
Kojto 123:b0220dba8be7 4793 int32_t * pTapDelay,
Kojto 123:b0220dba8be7 4794 uint16_t maxDelay,
Kojto 123:b0220dba8be7 4795 uint32_t blockSize);
Kojto 123:b0220dba8be7 4796
Kojto 123:b0220dba8be7 4797 /**
Kojto 123:b0220dba8be7 4798 * @brief Processing function for the Q31 sparse FIR filter.
Kojto 123:b0220dba8be7 4799 * @param[in] *S points to an instance of the Q31 sparse FIR structure.
Kojto 123:b0220dba8be7 4800 * @param[in] *pSrc points to the block of input data.
Kojto 123:b0220dba8be7 4801 * @param[out] *pDst points to the block of output data
Kojto 123:b0220dba8be7 4802 * @param[in] *pScratchIn points to a temporary buffer of size blockSize.
Kojto 123:b0220dba8be7 4803 * @param[in] blockSize number of input samples to process per call.
Kojto 123:b0220dba8be7 4804 * @return none.
Kojto 123:b0220dba8be7 4805 */
Kojto 123:b0220dba8be7 4806
Kojto 123:b0220dba8be7 4807 void arm_fir_sparse_q31(
Kojto 123:b0220dba8be7 4808 arm_fir_sparse_instance_q31 * S,
Kojto 123:b0220dba8be7 4809 q31_t * pSrc,
Kojto 123:b0220dba8be7 4810 q31_t * pDst,
Kojto 123:b0220dba8be7 4811 q31_t * pScratchIn,
Kojto 123:b0220dba8be7 4812 uint32_t blockSize);
Kojto 123:b0220dba8be7 4813
Kojto 123:b0220dba8be7 4814 /**
Kojto 123:b0220dba8be7 4815 * @brief Initialization function for the Q31 sparse FIR filter.
Kojto 123:b0220dba8be7 4816 * @param[in,out] *S points to an instance of the Q31 sparse FIR structure.
Kojto 123:b0220dba8be7 4817 * @param[in] numTaps number of nonzero coefficients in the filter.
Kojto 123:b0220dba8be7 4818 * @param[in] *pCoeffs points to the array of filter coefficients.
Kojto 123:b0220dba8be7 4819 * @param[in] *pState points to the state buffer.
Kojto 123:b0220dba8be7 4820 * @param[in] *pTapDelay points to the array of offset times.
Kojto 123:b0220dba8be7 4821 * @param[in] maxDelay maximum offset time supported.
Kojto 123:b0220dba8be7 4822 * @param[in] blockSize number of samples that will be processed per block.
Kojto 123:b0220dba8be7 4823 * @return none
Kojto 123:b0220dba8be7 4824 */
Kojto 123:b0220dba8be7 4825
Kojto 123:b0220dba8be7 4826 void arm_fir_sparse_init_q31(
Kojto 123:b0220dba8be7 4827 arm_fir_sparse_instance_q31 * S,
Kojto 123:b0220dba8be7 4828 uint16_t numTaps,
Kojto 123:b0220dba8be7 4829 q31_t * pCoeffs,
Kojto 123:b0220dba8be7 4830 q31_t * pState,
Kojto 123:b0220dba8be7 4831 int32_t * pTapDelay,
Kojto 123:b0220dba8be7 4832 uint16_t maxDelay,
Kojto 123:b0220dba8be7 4833 uint32_t blockSize);
Kojto 123:b0220dba8be7 4834
Kojto 123:b0220dba8be7 4835 /**
Kojto 123:b0220dba8be7 4836 * @brief Processing function for the Q15 sparse FIR filter.
Kojto 123:b0220dba8be7 4837 * @param[in] *S points to an instance of the Q15 sparse FIR structure.
Kojto 123:b0220dba8be7 4838 * @param[in] *pSrc points to the block of input data.
Kojto 123:b0220dba8be7 4839 * @param[out] *pDst points to the block of output data
Kojto 123:b0220dba8be7 4840 * @param[in] *pScratchIn points to a temporary buffer of size blockSize.
Kojto 123:b0220dba8be7 4841 * @param[in] *pScratchOut points to a temporary buffer of size blockSize.
Kojto 123:b0220dba8be7 4842 * @param[in] blockSize number of input samples to process per call.
Kojto 123:b0220dba8be7 4843 * @return none.
Kojto 123:b0220dba8be7 4844 */
Kojto 123:b0220dba8be7 4845
Kojto 123:b0220dba8be7 4846 void arm_fir_sparse_q15(
Kojto 123:b0220dba8be7 4847 arm_fir_sparse_instance_q15 * S,
Kojto 123:b0220dba8be7 4848 q15_t * pSrc,
Kojto 123:b0220dba8be7 4849 q15_t * pDst,
Kojto 123:b0220dba8be7 4850 q15_t * pScratchIn,
Kojto 123:b0220dba8be7 4851 q31_t * pScratchOut,
Kojto 123:b0220dba8be7 4852 uint32_t blockSize);
Kojto 123:b0220dba8be7 4853
Kojto 123:b0220dba8be7 4854
Kojto 123:b0220dba8be7 4855 /**
Kojto 123:b0220dba8be7 4856 * @brief Initialization function for the Q15 sparse FIR filter.
Kojto 123:b0220dba8be7 4857 * @param[in,out] *S points to an instance of the Q15 sparse FIR structure.
Kojto 123:b0220dba8be7 4858 * @param[in] numTaps number of nonzero coefficients in the filter.
Kojto 123:b0220dba8be7 4859 * @param[in] *pCoeffs points to the array of filter coefficients.
Kojto 123:b0220dba8be7 4860 * @param[in] *pState points to the state buffer.
Kojto 123:b0220dba8be7 4861 * @param[in] *pTapDelay points to the array of offset times.
Kojto 123:b0220dba8be7 4862 * @param[in] maxDelay maximum offset time supported.
Kojto 123:b0220dba8be7 4863 * @param[in] blockSize number of samples that will be processed per block.
Kojto 123:b0220dba8be7 4864 * @return none
Kojto 123:b0220dba8be7 4865 */
Kojto 123:b0220dba8be7 4866
Kojto 123:b0220dba8be7 4867 void arm_fir_sparse_init_q15(
Kojto 123:b0220dba8be7 4868 arm_fir_sparse_instance_q15 * S,
Kojto 123:b0220dba8be7 4869 uint16_t numTaps,
Kojto 123:b0220dba8be7 4870 q15_t * pCoeffs,
Kojto 123:b0220dba8be7 4871 q15_t * pState,
Kojto 123:b0220dba8be7 4872 int32_t * pTapDelay,
Kojto 123:b0220dba8be7 4873 uint16_t maxDelay,
Kojto 123:b0220dba8be7 4874 uint32_t blockSize);
Kojto 123:b0220dba8be7 4875
Kojto 123:b0220dba8be7 4876 /**
Kojto 123:b0220dba8be7 4877 * @brief Processing function for the Q7 sparse FIR filter.
Kojto 123:b0220dba8be7 4878 * @param[in] *S points to an instance of the Q7 sparse FIR structure.
Kojto 123:b0220dba8be7 4879 * @param[in] *pSrc points to the block of input data.
Kojto 123:b0220dba8be7 4880 * @param[out] *pDst points to the block of output data
Kojto 123:b0220dba8be7 4881 * @param[in] *pScratchIn points to a temporary buffer of size blockSize.
Kojto 123:b0220dba8be7 4882 * @param[in] *pScratchOut points to a temporary buffer of size blockSize.
Kojto 123:b0220dba8be7 4883 * @param[in] blockSize number of input samples to process per call.
Kojto 123:b0220dba8be7 4884 * @return none.
Kojto 123:b0220dba8be7 4885 */
Kojto 123:b0220dba8be7 4886
Kojto 123:b0220dba8be7 4887 void arm_fir_sparse_q7(
Kojto 123:b0220dba8be7 4888 arm_fir_sparse_instance_q7 * S,
Kojto 123:b0220dba8be7 4889 q7_t * pSrc,
Kojto 123:b0220dba8be7 4890 q7_t * pDst,
Kojto 123:b0220dba8be7 4891 q7_t * pScratchIn,
Kojto 123:b0220dba8be7 4892 q31_t * pScratchOut,
Kojto 123:b0220dba8be7 4893 uint32_t blockSize);
Kojto 123:b0220dba8be7 4894
Kojto 123:b0220dba8be7 4895 /**
Kojto 123:b0220dba8be7 4896 * @brief Initialization function for the Q7 sparse FIR filter.
Kojto 123:b0220dba8be7 4897 * @param[in,out] *S points to an instance of the Q7 sparse FIR structure.
Kojto 123:b0220dba8be7 4898 * @param[in] numTaps number of nonzero coefficients in the filter.
Kojto 123:b0220dba8be7 4899 * @param[in] *pCoeffs points to the array of filter coefficients.
Kojto 123:b0220dba8be7 4900 * @param[in] *pState points to the state buffer.
Kojto 123:b0220dba8be7 4901 * @param[in] *pTapDelay points to the array of offset times.
Kojto 123:b0220dba8be7 4902 * @param[in] maxDelay maximum offset time supported.
Kojto 123:b0220dba8be7 4903 * @param[in] blockSize number of samples that will be processed per block.
Kojto 123:b0220dba8be7 4904 * @return none
Kojto 123:b0220dba8be7 4905 */
Kojto 123:b0220dba8be7 4906
Kojto 123:b0220dba8be7 4907 void arm_fir_sparse_init_q7(
Kojto 123:b0220dba8be7 4908 arm_fir_sparse_instance_q7 * S,
Kojto 123:b0220dba8be7 4909 uint16_t numTaps,
Kojto 123:b0220dba8be7 4910 q7_t * pCoeffs,
Kojto 123:b0220dba8be7 4911 q7_t * pState,
Kojto 123:b0220dba8be7 4912 int32_t * pTapDelay,
Kojto 123:b0220dba8be7 4913 uint16_t maxDelay,
Kojto 123:b0220dba8be7 4914 uint32_t blockSize);
Kojto 123:b0220dba8be7 4915
Kojto 123:b0220dba8be7 4916
Kojto 123:b0220dba8be7 4917 /*
Kojto 123:b0220dba8be7 4918 * @brief Floating-point sin_cos function.
Kojto 123:b0220dba8be7 4919 * @param[in] theta input value in degrees
Kojto 123:b0220dba8be7 4920 * @param[out] *pSinVal points to the processed sine output.
Kojto 123:b0220dba8be7 4921 * @param[out] *pCosVal points to the processed cos output.
Kojto 123:b0220dba8be7 4922 * @return none.
Kojto 123:b0220dba8be7 4923 */
Kojto 123:b0220dba8be7 4924
Kojto 123:b0220dba8be7 4925 void arm_sin_cos_f32(
Kojto 123:b0220dba8be7 4926 float32_t theta,
Kojto 123:b0220dba8be7 4927 float32_t * pSinVal,
Kojto 123:b0220dba8be7 4928 float32_t * pCcosVal);
Kojto 123:b0220dba8be7 4929
Kojto 123:b0220dba8be7 4930 /*
Kojto 123:b0220dba8be7 4931 * @brief Q31 sin_cos function.
Kojto 123:b0220dba8be7 4932 * @param[in] theta scaled input value in degrees
Kojto 123:b0220dba8be7 4933 * @param[out] *pSinVal points to the processed sine output.
Kojto 123:b0220dba8be7 4934 * @param[out] *pCosVal points to the processed cosine output.
Kojto 123:b0220dba8be7 4935 * @return none.
Kojto 123:b0220dba8be7 4936 */
Kojto 123:b0220dba8be7 4937
Kojto 123:b0220dba8be7 4938 void arm_sin_cos_q31(
Kojto 123:b0220dba8be7 4939 q31_t theta,
Kojto 123:b0220dba8be7 4940 q31_t * pSinVal,
Kojto 123:b0220dba8be7 4941 q31_t * pCosVal);
Kojto 123:b0220dba8be7 4942
Kojto 123:b0220dba8be7 4943
Kojto 123:b0220dba8be7 4944 /**
Kojto 123:b0220dba8be7 4945 * @brief Floating-point complex conjugate.
Kojto 123:b0220dba8be7 4946 * @param[in] *pSrc points to the input vector
Kojto 123:b0220dba8be7 4947 * @param[out] *pDst points to the output vector
Kojto 123:b0220dba8be7 4948 * @param[in] numSamples number of complex samples in each vector
Kojto 123:b0220dba8be7 4949 * @return none.
Kojto 123:b0220dba8be7 4950 */
Kojto 123:b0220dba8be7 4951
Kojto 123:b0220dba8be7 4952 void arm_cmplx_conj_f32(
Kojto 123:b0220dba8be7 4953 float32_t * pSrc,
Kojto 123:b0220dba8be7 4954 float32_t * pDst,
Kojto 123:b0220dba8be7 4955 uint32_t numSamples);
Kojto 123:b0220dba8be7 4956
Kojto 123:b0220dba8be7 4957 /**
Kojto 123:b0220dba8be7 4958 * @brief Q31 complex conjugate.
Kojto 123:b0220dba8be7 4959 * @param[in] *pSrc points to the input vector
Kojto 123:b0220dba8be7 4960 * @param[out] *pDst points to the output vector
Kojto 123:b0220dba8be7 4961 * @param[in] numSamples number of complex samples in each vector
Kojto 123:b0220dba8be7 4962 * @return none.
Kojto 123:b0220dba8be7 4963 */
Kojto 123:b0220dba8be7 4964
Kojto 123:b0220dba8be7 4965 void arm_cmplx_conj_q31(
Kojto 123:b0220dba8be7 4966 q31_t * pSrc,
Kojto 123:b0220dba8be7 4967 q31_t * pDst,
Kojto 123:b0220dba8be7 4968 uint32_t numSamples);
Kojto 123:b0220dba8be7 4969
Kojto 123:b0220dba8be7 4970 /**
Kojto 123:b0220dba8be7 4971 * @brief Q15 complex conjugate.
Kojto 123:b0220dba8be7 4972 * @param[in] *pSrc points to the input vector
Kojto 123:b0220dba8be7 4973 * @param[out] *pDst points to the output vector
Kojto 123:b0220dba8be7 4974 * @param[in] numSamples number of complex samples in each vector
Kojto 123:b0220dba8be7 4975 * @return none.
Kojto 123:b0220dba8be7 4976 */
Kojto 123:b0220dba8be7 4977
Kojto 123:b0220dba8be7 4978 void arm_cmplx_conj_q15(
Kojto 123:b0220dba8be7 4979 q15_t * pSrc,
Kojto 123:b0220dba8be7 4980 q15_t * pDst,
Kojto 123:b0220dba8be7 4981 uint32_t numSamples);
Kojto 123:b0220dba8be7 4982
Kojto 123:b0220dba8be7 4983
Kojto 123:b0220dba8be7 4984
Kojto 123:b0220dba8be7 4985 /**
Kojto 123:b0220dba8be7 4986 * @brief Floating-point complex magnitude squared
Kojto 123:b0220dba8be7 4987 * @param[in] *pSrc points to the complex input vector
Kojto 123:b0220dba8be7 4988 * @param[out] *pDst points to the real output vector
Kojto 123:b0220dba8be7 4989 * @param[in] numSamples number of complex samples in the input vector
Kojto 123:b0220dba8be7 4990 * @return none.
Kojto 123:b0220dba8be7 4991 */
Kojto 123:b0220dba8be7 4992
Kojto 123:b0220dba8be7 4993 void arm_cmplx_mag_squared_f32(
Kojto 123:b0220dba8be7 4994 float32_t * pSrc,
Kojto 123:b0220dba8be7 4995 float32_t * pDst,
Kojto 123:b0220dba8be7 4996 uint32_t numSamples);
Kojto 123:b0220dba8be7 4997
Kojto 123:b0220dba8be7 4998 /**
Kojto 123:b0220dba8be7 4999 * @brief Q31 complex magnitude squared
Kojto 123:b0220dba8be7 5000 * @param[in] *pSrc points to the complex input vector
Kojto 123:b0220dba8be7 5001 * @param[out] *pDst points to the real output vector
Kojto 123:b0220dba8be7 5002 * @param[in] numSamples number of complex samples in the input vector
Kojto 123:b0220dba8be7 5003 * @return none.
Kojto 123:b0220dba8be7 5004 */
Kojto 123:b0220dba8be7 5005
Kojto 123:b0220dba8be7 5006 void arm_cmplx_mag_squared_q31(
Kojto 123:b0220dba8be7 5007 q31_t * pSrc,
Kojto 123:b0220dba8be7 5008 q31_t * pDst,
Kojto 123:b0220dba8be7 5009 uint32_t numSamples);
Kojto 123:b0220dba8be7 5010
Kojto 123:b0220dba8be7 5011 /**
Kojto 123:b0220dba8be7 5012 * @brief Q15 complex magnitude squared
Kojto 123:b0220dba8be7 5013 * @param[in] *pSrc points to the complex input vector
Kojto 123:b0220dba8be7 5014 * @param[out] *pDst points to the real output vector
Kojto 123:b0220dba8be7 5015 * @param[in] numSamples number of complex samples in the input vector
Kojto 123:b0220dba8be7 5016 * @return none.
Kojto 123:b0220dba8be7 5017 */
Kojto 123:b0220dba8be7 5018
Kojto 123:b0220dba8be7 5019 void arm_cmplx_mag_squared_q15(
Kojto 123:b0220dba8be7 5020 q15_t * pSrc,
Kojto 123:b0220dba8be7 5021 q15_t * pDst,
Kojto 123:b0220dba8be7 5022 uint32_t numSamples);
Kojto 123:b0220dba8be7 5023
Kojto 123:b0220dba8be7 5024
Kojto 123:b0220dba8be7 5025 /**
Kojto 123:b0220dba8be7 5026 * @ingroup groupController
Kojto 123:b0220dba8be7 5027 */
Kojto 123:b0220dba8be7 5028
Kojto 123:b0220dba8be7 5029 /**
Kojto 123:b0220dba8be7 5030 * @defgroup PID PID Motor Control
Kojto 123:b0220dba8be7 5031 *
Kojto 123:b0220dba8be7 5032 * A Proportional Integral Derivative (PID) controller is a generic feedback control
Kojto 123:b0220dba8be7 5033 * loop mechanism widely used in industrial control systems.
Kojto 123:b0220dba8be7 5034 * A PID controller is the most commonly used type of feedback controller.
Kojto 123:b0220dba8be7 5035 *
Kojto 123:b0220dba8be7 5036 * This set of functions implements (PID) controllers
Kojto 123:b0220dba8be7 5037 * for Q15, Q31, and floating-point data types. The functions operate on a single sample
Kojto 123:b0220dba8be7 5038 * of data and each call to the function returns a single processed value.
Kojto 123:b0220dba8be7 5039 * <code>S</code> points to an instance of the PID control data structure. <code>in</code>
Kojto 123:b0220dba8be7 5040 * is the input sample value. The functions return the output value.
Kojto 123:b0220dba8be7 5041 *
Kojto 123:b0220dba8be7 5042 * \par Algorithm:
Kojto 123:b0220dba8be7 5043 * <pre>
Kojto 123:b0220dba8be7 5044 * y[n] = y[n-1] + A0 * x[n] + A1 * x[n-1] + A2 * x[n-2]
Kojto 123:b0220dba8be7 5045 * A0 = Kp + Ki + Kd
Kojto 123:b0220dba8be7 5046 * A1 = (-Kp ) - (2 * Kd )
Kojto 123:b0220dba8be7 5047 * A2 = Kd </pre>
Kojto 123:b0220dba8be7 5048 *
Kojto 123:b0220dba8be7 5049 * \par
Kojto 123:b0220dba8be7 5050 * where \c Kp is proportional constant, \c Ki is Integral constant and \c Kd is Derivative constant
Kojto 123:b0220dba8be7 5051 *
Kojto 123:b0220dba8be7 5052 * \par
Kojto 123:b0220dba8be7 5053 * \image html PID.gif "Proportional Integral Derivative Controller"
Kojto 123:b0220dba8be7 5054 *
Kojto 123:b0220dba8be7 5055 * \par
Kojto 123:b0220dba8be7 5056 * The PID controller calculates an "error" value as the difference between
Kojto 123:b0220dba8be7 5057 * the measured output and the reference input.
Kojto 123:b0220dba8be7 5058 * The controller attempts to minimize the error by adjusting the process control inputs.
Kojto 123:b0220dba8be7 5059 * The proportional value determines the reaction to the current error,
Kojto 123:b0220dba8be7 5060 * the integral value determines the reaction based on the sum of recent errors,
Kojto 123:b0220dba8be7 5061 * and the derivative value determines the reaction based on the rate at which the error has been changing.
Kojto 123:b0220dba8be7 5062 *
Kojto 123:b0220dba8be7 5063 * \par Instance Structure
Kojto 123:b0220dba8be7 5064 * The Gains A0, A1, A2 and state variables for a PID controller are stored together in an instance data structure.
Kojto 123:b0220dba8be7 5065 * A separate instance structure must be defined for each PID Controller.
Kojto 123:b0220dba8be7 5066 * There are separate instance structure declarations for each of the 3 supported data types.
Kojto 123:b0220dba8be7 5067 *
Kojto 123:b0220dba8be7 5068 * \par Reset Functions
Kojto 123:b0220dba8be7 5069 * There is also an associated reset function for each data type which clears the state array.
Kojto 123:b0220dba8be7 5070 *
Kojto 123:b0220dba8be7 5071 * \par Initialization Functions
Kojto 123:b0220dba8be7 5072 * There is also an associated initialization function for each data type.
Kojto 123:b0220dba8be7 5073 * The initialization function performs the following operations:
Kojto 123:b0220dba8be7 5074 * - Initializes the Gains A0, A1, A2 from Kp,Ki, Kd gains.
Kojto 123:b0220dba8be7 5075 * - Zeros out the values in the state buffer.
Kojto 123:b0220dba8be7 5076 *
Kojto 123:b0220dba8be7 5077 * \par
Kojto 123:b0220dba8be7 5078 * Instance structure cannot be placed into a const data section and it is recommended to use the initialization function.
Kojto 123:b0220dba8be7 5079 *
Kojto 123:b0220dba8be7 5080 * \par Fixed-Point Behavior
Kojto 123:b0220dba8be7 5081 * Care must be taken when using the fixed-point versions of the PID Controller functions.
Kojto 123:b0220dba8be7 5082 * In particular, the overflow and saturation behavior of the accumulator used in each function must be considered.
Kojto 123:b0220dba8be7 5083 * Refer to the function specific documentation below for usage guidelines.
Kojto 123:b0220dba8be7 5084 */
Kojto 123:b0220dba8be7 5085
Kojto 123:b0220dba8be7 5086 /**
Kojto 123:b0220dba8be7 5087 * @addtogroup PID
Kojto 123:b0220dba8be7 5088 * @{
Kojto 123:b0220dba8be7 5089 */
Kojto 123:b0220dba8be7 5090
Kojto 123:b0220dba8be7 5091 /**
Kojto 123:b0220dba8be7 5092 * @brief Process function for the floating-point PID Control.
Kojto 123:b0220dba8be7 5093 * @param[in,out] *S is an instance of the floating-point PID Control structure
Kojto 123:b0220dba8be7 5094 * @param[in] in input sample to process
Kojto 123:b0220dba8be7 5095 * @return out processed output sample.
Kojto 123:b0220dba8be7 5096 */
Kojto 123:b0220dba8be7 5097
Kojto 123:b0220dba8be7 5098
Kojto 123:b0220dba8be7 5099 static __INLINE float32_t arm_pid_f32(
Kojto 123:b0220dba8be7 5100 arm_pid_instance_f32 * S,
Kojto 123:b0220dba8be7 5101 float32_t in)
Kojto 123:b0220dba8be7 5102 {
Kojto 123:b0220dba8be7 5103 float32_t out;
Kojto 123:b0220dba8be7 5104
Kojto 123:b0220dba8be7 5105 /* y[n] = y[n-1] + A0 * x[n] + A1 * x[n-1] + A2 * x[n-2] */
Kojto 123:b0220dba8be7 5106 out = (S->A0 * in) +
Kojto 123:b0220dba8be7 5107 (S->A1 * S->state[0]) + (S->A2 * S->state[1]) + (S->state[2]);
Kojto 123:b0220dba8be7 5108
Kojto 123:b0220dba8be7 5109 /* Update state */
Kojto 123:b0220dba8be7 5110 S->state[1] = S->state[0];
Kojto 123:b0220dba8be7 5111 S->state[0] = in;
Kojto 123:b0220dba8be7 5112 S->state[2] = out;
Kojto 123:b0220dba8be7 5113
Kojto 123:b0220dba8be7 5114 /* return to application */
Kojto 123:b0220dba8be7 5115 return (out);
Kojto 123:b0220dba8be7 5116
Kojto 123:b0220dba8be7 5117 }
Kojto 123:b0220dba8be7 5118
Kojto 123:b0220dba8be7 5119 /**
Kojto 123:b0220dba8be7 5120 * @brief Process function for the Q31 PID Control.
Kojto 123:b0220dba8be7 5121 * @param[in,out] *S points to an instance of the Q31 PID Control structure
Kojto 123:b0220dba8be7 5122 * @param[in] in input sample to process
Kojto 123:b0220dba8be7 5123 * @return out processed output sample.
Kojto 123:b0220dba8be7 5124 *
Kojto 123:b0220dba8be7 5125 * <b>Scaling and Overflow Behavior:</b>
Kojto 123:b0220dba8be7 5126 * \par
Kojto 123:b0220dba8be7 5127 * The function is implemented using an internal 64-bit accumulator.
Kojto 123:b0220dba8be7 5128 * The accumulator has a 2.62 format and maintains full precision of the intermediate multiplication results but provides only a single guard bit.
Kojto 123:b0220dba8be7 5129 * Thus, if the accumulator result overflows it wraps around rather than clip.
Kojto 123:b0220dba8be7 5130 * In order to avoid overflows completely the input signal must be scaled down by 2 bits as there are four additions.
Kojto 123:b0220dba8be7 5131 * After all multiply-accumulates are performed, the 2.62 accumulator is truncated to 1.32 format and then saturated to 1.31 format.
Kojto 123:b0220dba8be7 5132 */
Kojto 123:b0220dba8be7 5133
Kojto 123:b0220dba8be7 5134 static __INLINE q31_t arm_pid_q31(
Kojto 123:b0220dba8be7 5135 arm_pid_instance_q31 * S,
Kojto 123:b0220dba8be7 5136 q31_t in)
Kojto 123:b0220dba8be7 5137 {
Kojto 123:b0220dba8be7 5138 q63_t acc;
Kojto 123:b0220dba8be7 5139 q31_t out;
Kojto 123:b0220dba8be7 5140
Kojto 123:b0220dba8be7 5141 /* acc = A0 * x[n] */
Kojto 123:b0220dba8be7 5142 acc = (q63_t) S->A0 * in;
Kojto 123:b0220dba8be7 5143
Kojto 123:b0220dba8be7 5144 /* acc += A1 * x[n-1] */
Kojto 123:b0220dba8be7 5145 acc += (q63_t) S->A1 * S->state[0];
Kojto 123:b0220dba8be7 5146
Kojto 123:b0220dba8be7 5147 /* acc += A2 * x[n-2] */
Kojto 123:b0220dba8be7 5148 acc += (q63_t) S->A2 * S->state[1];
Kojto 123:b0220dba8be7 5149
Kojto 123:b0220dba8be7 5150 /* convert output to 1.31 format to add y[n-1] */
Kojto 123:b0220dba8be7 5151 out = (q31_t) (acc >> 31u);
Kojto 123:b0220dba8be7 5152
Kojto 123:b0220dba8be7 5153 /* out += y[n-1] */
Kojto 123:b0220dba8be7 5154 out += S->state[2];
Kojto 123:b0220dba8be7 5155
Kojto 123:b0220dba8be7 5156 /* Update state */
Kojto 123:b0220dba8be7 5157 S->state[1] = S->state[0];
Kojto 123:b0220dba8be7 5158 S->state[0] = in;
Kojto 123:b0220dba8be7 5159 S->state[2] = out;
Kojto 123:b0220dba8be7 5160
Kojto 123:b0220dba8be7 5161 /* return to application */
Kojto 123:b0220dba8be7 5162 return (out);
Kojto 123:b0220dba8be7 5163
Kojto 123:b0220dba8be7 5164 }
Kojto 123:b0220dba8be7 5165
Kojto 123:b0220dba8be7 5166 /**
Kojto 123:b0220dba8be7 5167 * @brief Process function for the Q15 PID Control.
Kojto 123:b0220dba8be7 5168 * @param[in,out] *S points to an instance of the Q15 PID Control structure
Kojto 123:b0220dba8be7 5169 * @param[in] in input sample to process
Kojto 123:b0220dba8be7 5170 * @return out processed output sample.
Kojto 123:b0220dba8be7 5171 *
Kojto 123:b0220dba8be7 5172 * <b>Scaling and Overflow Behavior:</b>
Kojto 123:b0220dba8be7 5173 * \par
Kojto 123:b0220dba8be7 5174 * The function is implemented using a 64-bit internal accumulator.
Kojto 123:b0220dba8be7 5175 * Both Gains and state variables are represented in 1.15 format and multiplications yield a 2.30 result.
Kojto 123:b0220dba8be7 5176 * The 2.30 intermediate results are accumulated in a 64-bit accumulator in 34.30 format.
Kojto 123:b0220dba8be7 5177 * There is no risk of internal overflow with this approach and the full precision of intermediate multiplications is preserved.
Kojto 123:b0220dba8be7 5178 * After all additions have been performed, the accumulator is truncated to 34.15 format by discarding low 15 bits.
Kojto 123:b0220dba8be7 5179 * Lastly, the accumulator is saturated to yield a result in 1.15 format.
Kojto 123:b0220dba8be7 5180 */
Kojto 123:b0220dba8be7 5181
Kojto 123:b0220dba8be7 5182 static __INLINE q15_t arm_pid_q15(
Kojto 123:b0220dba8be7 5183 arm_pid_instance_q15 * S,
Kojto 123:b0220dba8be7 5184 q15_t in)
Kojto 123:b0220dba8be7 5185 {
Kojto 123:b0220dba8be7 5186 q63_t acc;
Kojto 123:b0220dba8be7 5187 q15_t out;
Kojto 123:b0220dba8be7 5188
Kojto 123:b0220dba8be7 5189 #ifndef ARM_MATH_CM0_FAMILY
Kojto 123:b0220dba8be7 5190 __SIMD32_TYPE *vstate;
Kojto 123:b0220dba8be7 5191
Kojto 123:b0220dba8be7 5192 /* Implementation of PID controller */
Kojto 123:b0220dba8be7 5193
Kojto 123:b0220dba8be7 5194 /* acc = A0 * x[n] */
Kojto 123:b0220dba8be7 5195 acc = (q31_t) __SMUAD(S->A0, in);
Kojto 123:b0220dba8be7 5196
Kojto 123:b0220dba8be7 5197 /* acc += A1 * x[n-1] + A2 * x[n-2] */
Kojto 123:b0220dba8be7 5198 vstate = __SIMD32_CONST(S->state);
Kojto 123:b0220dba8be7 5199 acc = __SMLALD(S->A1, (q31_t) *vstate, acc);
Kojto 123:b0220dba8be7 5200
Kojto 123:b0220dba8be7 5201 #else
Kojto 123:b0220dba8be7 5202 /* acc = A0 * x[n] */
Kojto 123:b0220dba8be7 5203 acc = ((q31_t) S->A0) * in;
Kojto 123:b0220dba8be7 5204
Kojto 123:b0220dba8be7 5205 /* acc += A1 * x[n-1] + A2 * x[n-2] */
Kojto 123:b0220dba8be7 5206 acc += (q31_t) S->A1 * S->state[0];
Kojto 123:b0220dba8be7 5207 acc += (q31_t) S->A2 * S->state[1];
Kojto 123:b0220dba8be7 5208
Kojto 123:b0220dba8be7 5209 #endif
Kojto 123:b0220dba8be7 5210
Kojto 123:b0220dba8be7 5211 /* acc += y[n-1] */
Kojto 123:b0220dba8be7 5212 acc += (q31_t) S->state[2] << 15;
Kojto 123:b0220dba8be7 5213
Kojto 123:b0220dba8be7 5214 /* saturate the output */
Kojto 123:b0220dba8be7 5215 out = (q15_t) (__SSAT((acc >> 15), 16));
Kojto 123:b0220dba8be7 5216
Kojto 123:b0220dba8be7 5217 /* Update state */
Kojto 123:b0220dba8be7 5218 S->state[1] = S->state[0];
Kojto 123:b0220dba8be7 5219 S->state[0] = in;
Kojto 123:b0220dba8be7 5220 S->state[2] = out;
Kojto 123:b0220dba8be7 5221
Kojto 123:b0220dba8be7 5222 /* return to application */
Kojto 123:b0220dba8be7 5223 return (out);
Kojto 123:b0220dba8be7 5224
Kojto 123:b0220dba8be7 5225 }
Kojto 123:b0220dba8be7 5226
Kojto 123:b0220dba8be7 5227 /**
Kojto 123:b0220dba8be7 5228 * @} end of PID group
Kojto 123:b0220dba8be7 5229 */
Kojto 123:b0220dba8be7 5230
Kojto 123:b0220dba8be7 5231
Kojto 123:b0220dba8be7 5232 /**
Kojto 123:b0220dba8be7 5233 * @brief Floating-point matrix inverse.
Kojto 123:b0220dba8be7 5234 * @param[in] *src points to the instance of the input floating-point matrix structure.
Kojto 123:b0220dba8be7 5235 * @param[out] *dst points to the instance of the output floating-point matrix structure.
Kojto 123:b0220dba8be7 5236 * @return The function returns ARM_MATH_SIZE_MISMATCH, if the dimensions do not match.
Kojto 123:b0220dba8be7 5237 * If the input matrix is singular (does not have an inverse), then the algorithm terminates and returns error status ARM_MATH_SINGULAR.
Kojto 123:b0220dba8be7 5238 */
Kojto 123:b0220dba8be7 5239
Kojto 123:b0220dba8be7 5240 arm_status arm_mat_inverse_f32(
Kojto 123:b0220dba8be7 5241 const arm_matrix_instance_f32 * src,
Kojto 123:b0220dba8be7 5242 arm_matrix_instance_f32 * dst);
Kojto 123:b0220dba8be7 5243
Kojto 123:b0220dba8be7 5244
Kojto 123:b0220dba8be7 5245 /**
Kojto 123:b0220dba8be7 5246 * @brief Floating-point matrix inverse.
Kojto 123:b0220dba8be7 5247 * @param[in] *src points to the instance of the input floating-point matrix structure.
Kojto 123:b0220dba8be7 5248 * @param[out] *dst points to the instance of the output floating-point matrix structure.
Kojto 123:b0220dba8be7 5249 * @return The function returns ARM_MATH_SIZE_MISMATCH, if the dimensions do not match.
Kojto 123:b0220dba8be7 5250 * If the input matrix is singular (does not have an inverse), then the algorithm terminates and returns error status ARM_MATH_SINGULAR.
Kojto 123:b0220dba8be7 5251 */
Kojto 123:b0220dba8be7 5252
Kojto 123:b0220dba8be7 5253 arm_status arm_mat_inverse_f64(
Kojto 123:b0220dba8be7 5254 const arm_matrix_instance_f64 * src,
Kojto 123:b0220dba8be7 5255 arm_matrix_instance_f64 * dst);
Kojto 123:b0220dba8be7 5256
Kojto 123:b0220dba8be7 5257
Kojto 123:b0220dba8be7 5258
Kojto 123:b0220dba8be7 5259 /**
Kojto 123:b0220dba8be7 5260 * @ingroup groupController
Kojto 123:b0220dba8be7 5261 */
Kojto 123:b0220dba8be7 5262
Kojto 123:b0220dba8be7 5263
Kojto 123:b0220dba8be7 5264 /**
Kojto 123:b0220dba8be7 5265 * @defgroup clarke Vector Clarke Transform
Kojto 123:b0220dba8be7 5266 * Forward Clarke transform converts the instantaneous stator phases into a two-coordinate time invariant vector.
Kojto 123:b0220dba8be7 5267 * Generally the Clarke transform uses three-phase currents <code>Ia, Ib and Ic</code> to calculate currents
Kojto 123:b0220dba8be7 5268 * in the two-phase orthogonal stator axis <code>Ialpha</code> and <code>Ibeta</code>.
Kojto 123:b0220dba8be7 5269 * When <code>Ialpha</code> is superposed with <code>Ia</code> as shown in the figure below
Kojto 123:b0220dba8be7 5270 * \image html clarke.gif Stator current space vector and its components in (a,b).
Kojto 123:b0220dba8be7 5271 * and <code>Ia + Ib + Ic = 0</code>, in this condition <code>Ialpha</code> and <code>Ibeta</code>
Kojto 123:b0220dba8be7 5272 * can be calculated using only <code>Ia</code> and <code>Ib</code>.
Kojto 123:b0220dba8be7 5273 *
Kojto 123:b0220dba8be7 5274 * The function operates on a single sample of data and each call to the function returns the processed output.
Kojto 123:b0220dba8be7 5275 * The library provides separate functions for Q31 and floating-point data types.
Kojto 123:b0220dba8be7 5276 * \par Algorithm
Kojto 123:b0220dba8be7 5277 * \image html clarkeFormula.gif
Kojto 123:b0220dba8be7 5278 * where <code>Ia</code> and <code>Ib</code> are the instantaneous stator phases and
Kojto 123:b0220dba8be7 5279 * <code>pIalpha</code> and <code>pIbeta</code> are the two coordinates of time invariant vector.
Kojto 123:b0220dba8be7 5280 * \par Fixed-Point Behavior
Kojto 123:b0220dba8be7 5281 * Care must be taken when using the Q31 version of the Clarke transform.
Kojto 123:b0220dba8be7 5282 * In particular, the overflow and saturation behavior of the accumulator used must be considered.
Kojto 123:b0220dba8be7 5283 * Refer to the function specific documentation below for usage guidelines.
Kojto 123:b0220dba8be7 5284 */
Kojto 123:b0220dba8be7 5285
Kojto 123:b0220dba8be7 5286 /**
Kojto 123:b0220dba8be7 5287 * @addtogroup clarke
Kojto 123:b0220dba8be7 5288 * @{
Kojto 123:b0220dba8be7 5289 */
Kojto 123:b0220dba8be7 5290
Kojto 123:b0220dba8be7 5291 /**
Kojto 123:b0220dba8be7 5292 *
Kojto 123:b0220dba8be7 5293 * @brief Floating-point Clarke transform
Kojto 123:b0220dba8be7 5294 * @param[in] Ia input three-phase coordinate <code>a</code>
Kojto 123:b0220dba8be7 5295 * @param[in] Ib input three-phase coordinate <code>b</code>
Kojto 123:b0220dba8be7 5296 * @param[out] *pIalpha points to output two-phase orthogonal vector axis alpha
Kojto 123:b0220dba8be7 5297 * @param[out] *pIbeta points to output two-phase orthogonal vector axis beta
Kojto 123:b0220dba8be7 5298 * @return none.
Kojto 123:b0220dba8be7 5299 */
Kojto 123:b0220dba8be7 5300
Kojto 123:b0220dba8be7 5301 static __INLINE void arm_clarke_f32(
Kojto 123:b0220dba8be7 5302 float32_t Ia,
Kojto 123:b0220dba8be7 5303 float32_t Ib,
Kojto 123:b0220dba8be7 5304 float32_t * pIalpha,
Kojto 123:b0220dba8be7 5305 float32_t * pIbeta)
Kojto 123:b0220dba8be7 5306 {
Kojto 123:b0220dba8be7 5307 /* Calculate pIalpha using the equation, pIalpha = Ia */
Kojto 123:b0220dba8be7 5308 *pIalpha = Ia;
Kojto 123:b0220dba8be7 5309
Kojto 123:b0220dba8be7 5310 /* Calculate pIbeta using the equation, pIbeta = (1/sqrt(3)) * Ia + (2/sqrt(3)) * Ib */
Kojto 123:b0220dba8be7 5311 *pIbeta =
Kojto 123:b0220dba8be7 5312 ((float32_t) 0.57735026919 * Ia + (float32_t) 1.15470053838 * Ib);
Kojto 123:b0220dba8be7 5313
Kojto 123:b0220dba8be7 5314 }
Kojto 123:b0220dba8be7 5315
Kojto 123:b0220dba8be7 5316 /**
Kojto 123:b0220dba8be7 5317 * @brief Clarke transform for Q31 version
Kojto 123:b0220dba8be7 5318 * @param[in] Ia input three-phase coordinate <code>a</code>
Kojto 123:b0220dba8be7 5319 * @param[in] Ib input three-phase coordinate <code>b</code>
Kojto 123:b0220dba8be7 5320 * @param[out] *pIalpha points to output two-phase orthogonal vector axis alpha
Kojto 123:b0220dba8be7 5321 * @param[out] *pIbeta points to output two-phase orthogonal vector axis beta
Kojto 123:b0220dba8be7 5322 * @return none.
Kojto 123:b0220dba8be7 5323 *
Kojto 123:b0220dba8be7 5324 * <b>Scaling and Overflow Behavior:</b>
Kojto 123:b0220dba8be7 5325 * \par
Kojto 123:b0220dba8be7 5326 * The function is implemented using an internal 32-bit accumulator.
Kojto 123:b0220dba8be7 5327 * The accumulator maintains 1.31 format by truncating lower 31 bits of the intermediate multiplication in 2.62 format.
Kojto 123:b0220dba8be7 5328 * There is saturation on the addition, hence there is no risk of overflow.
Kojto 123:b0220dba8be7 5329 */
Kojto 123:b0220dba8be7 5330
Kojto 123:b0220dba8be7 5331 static __INLINE void arm_clarke_q31(
Kojto 123:b0220dba8be7 5332 q31_t Ia,
Kojto 123:b0220dba8be7 5333 q31_t Ib,
Kojto 123:b0220dba8be7 5334 q31_t * pIalpha,
Kojto 123:b0220dba8be7 5335 q31_t * pIbeta)
Kojto 123:b0220dba8be7 5336 {
Kojto 123:b0220dba8be7 5337 q31_t product1, product2; /* Temporary variables used to store intermediate results */
Kojto 123:b0220dba8be7 5338
Kojto 123:b0220dba8be7 5339 /* Calculating pIalpha from Ia by equation pIalpha = Ia */
Kojto 123:b0220dba8be7 5340 *pIalpha = Ia;
Kojto 123:b0220dba8be7 5341
Kojto 123:b0220dba8be7 5342 /* Intermediate product is calculated by (1/(sqrt(3)) * Ia) */
Kojto 123:b0220dba8be7 5343 product1 = (q31_t) (((q63_t) Ia * 0x24F34E8B) >> 30);
Kojto 123:b0220dba8be7 5344
Kojto 123:b0220dba8be7 5345 /* Intermediate product is calculated by (2/sqrt(3) * Ib) */
Kojto 123:b0220dba8be7 5346 product2 = (q31_t) (((q63_t) Ib * 0x49E69D16) >> 30);
Kojto 123:b0220dba8be7 5347
Kojto 123:b0220dba8be7 5348 /* pIbeta is calculated by adding the intermediate products */
Kojto 123:b0220dba8be7 5349 *pIbeta = __QADD(product1, product2);
Kojto 123:b0220dba8be7 5350 }
Kojto 123:b0220dba8be7 5351
Kojto 123:b0220dba8be7 5352 /**
Kojto 123:b0220dba8be7 5353 * @} end of clarke group
Kojto 123:b0220dba8be7 5354 */
Kojto 123:b0220dba8be7 5355
Kojto 123:b0220dba8be7 5356 /**
Kojto 123:b0220dba8be7 5357 * @brief Converts the elements of the Q7 vector to Q31 vector.
Kojto 123:b0220dba8be7 5358 * @param[in] *pSrc input pointer
Kojto 123:b0220dba8be7 5359 * @param[out] *pDst output pointer
Kojto 123:b0220dba8be7 5360 * @param[in] blockSize number of samples to process
Kojto 123:b0220dba8be7 5361 * @return none.
Kojto 123:b0220dba8be7 5362 */
Kojto 123:b0220dba8be7 5363 void arm_q7_to_q31(
Kojto 123:b0220dba8be7 5364 q7_t * pSrc,
Kojto 123:b0220dba8be7 5365 q31_t * pDst,
Kojto 123:b0220dba8be7 5366 uint32_t blockSize);
Kojto 123:b0220dba8be7 5367
Kojto 123:b0220dba8be7 5368
Kojto 123:b0220dba8be7 5369
Kojto 123:b0220dba8be7 5370
Kojto 123:b0220dba8be7 5371 /**
Kojto 123:b0220dba8be7 5372 * @ingroup groupController
Kojto 123:b0220dba8be7 5373 */
Kojto 123:b0220dba8be7 5374
Kojto 123:b0220dba8be7 5375 /**
Kojto 123:b0220dba8be7 5376 * @defgroup inv_clarke Vector Inverse Clarke Transform
Kojto 123:b0220dba8be7 5377 * Inverse Clarke transform converts the two-coordinate time invariant vector into instantaneous stator phases.
Kojto 123:b0220dba8be7 5378 *
Kojto 123:b0220dba8be7 5379 * The function operates on a single sample of data and each call to the function returns the processed output.
Kojto 123:b0220dba8be7 5380 * The library provides separate functions for Q31 and floating-point data types.
Kojto 123:b0220dba8be7 5381 * \par Algorithm
Kojto 123:b0220dba8be7 5382 * \image html clarkeInvFormula.gif
Kojto 123:b0220dba8be7 5383 * where <code>pIa</code> and <code>pIb</code> are the instantaneous stator phases and
Kojto 123:b0220dba8be7 5384 * <code>Ialpha</code> and <code>Ibeta</code> are the two coordinates of time invariant vector.
Kojto 123:b0220dba8be7 5385 * \par Fixed-Point Behavior
Kojto 123:b0220dba8be7 5386 * Care must be taken when using the Q31 version of the Clarke transform.
Kojto 123:b0220dba8be7 5387 * In particular, the overflow and saturation behavior of the accumulator used must be considered.
Kojto 123:b0220dba8be7 5388 * Refer to the function specific documentation below for usage guidelines.
Kojto 123:b0220dba8be7 5389 */
Kojto 123:b0220dba8be7 5390
Kojto 123:b0220dba8be7 5391 /**
Kojto 123:b0220dba8be7 5392 * @addtogroup inv_clarke
Kojto 123:b0220dba8be7 5393 * @{
Kojto 123:b0220dba8be7 5394 */
Kojto 123:b0220dba8be7 5395
Kojto 123:b0220dba8be7 5396 /**
Kojto 123:b0220dba8be7 5397 * @brief Floating-point Inverse Clarke transform
Kojto 123:b0220dba8be7 5398 * @param[in] Ialpha input two-phase orthogonal vector axis alpha
Kojto 123:b0220dba8be7 5399 * @param[in] Ibeta input two-phase orthogonal vector axis beta
Kojto 123:b0220dba8be7 5400 * @param[out] *pIa points to output three-phase coordinate <code>a</code>
Kojto 123:b0220dba8be7 5401 * @param[out] *pIb points to output three-phase coordinate <code>b</code>
Kojto 123:b0220dba8be7 5402 * @return none.
Kojto 123:b0220dba8be7 5403 */
Kojto 123:b0220dba8be7 5404
Kojto 123:b0220dba8be7 5405
Kojto 123:b0220dba8be7 5406 static __INLINE void arm_inv_clarke_f32(
Kojto 123:b0220dba8be7 5407 float32_t Ialpha,
Kojto 123:b0220dba8be7 5408 float32_t Ibeta,
Kojto 123:b0220dba8be7 5409 float32_t * pIa,
Kojto 123:b0220dba8be7 5410 float32_t * pIb)
Kojto 123:b0220dba8be7 5411 {
Kojto 123:b0220dba8be7 5412 /* Calculating pIa from Ialpha by equation pIa = Ialpha */
Kojto 123:b0220dba8be7 5413 *pIa = Ialpha;
Kojto 123:b0220dba8be7 5414
Kojto 123:b0220dba8be7 5415 /* Calculating pIb from Ialpha and Ibeta by equation pIb = -(1/2) * Ialpha + (sqrt(3)/2) * Ibeta */
Kojto 123:b0220dba8be7 5416 *pIb = -0.5 * Ialpha + (float32_t) 0.8660254039 *Ibeta;
Kojto 123:b0220dba8be7 5417
Kojto 123:b0220dba8be7 5418 }
Kojto 123:b0220dba8be7 5419
Kojto 123:b0220dba8be7 5420 /**
Kojto 123:b0220dba8be7 5421 * @brief Inverse Clarke transform for Q31 version
Kojto 123:b0220dba8be7 5422 * @param[in] Ialpha input two-phase orthogonal vector axis alpha
Kojto 123:b0220dba8be7 5423 * @param[in] Ibeta input two-phase orthogonal vector axis beta
Kojto 123:b0220dba8be7 5424 * @param[out] *pIa points to output three-phase coordinate <code>a</code>
Kojto 123:b0220dba8be7 5425 * @param[out] *pIb points to output three-phase coordinate <code>b</code>
Kojto 123:b0220dba8be7 5426 * @return none.
Kojto 123:b0220dba8be7 5427 *
Kojto 123:b0220dba8be7 5428 * <b>Scaling and Overflow Behavior:</b>
Kojto 123:b0220dba8be7 5429 * \par
Kojto 123:b0220dba8be7 5430 * The function is implemented using an internal 32-bit accumulator.
Kojto 123:b0220dba8be7 5431 * The accumulator maintains 1.31 format by truncating lower 31 bits of the intermediate multiplication in 2.62 format.
Kojto 123:b0220dba8be7 5432 * There is saturation on the subtraction, hence there is no risk of overflow.
Kojto 123:b0220dba8be7 5433 */
Kojto 123:b0220dba8be7 5434
Kojto 123:b0220dba8be7 5435 static __INLINE void arm_inv_clarke_q31(
Kojto 123:b0220dba8be7 5436 q31_t Ialpha,
Kojto 123:b0220dba8be7 5437 q31_t Ibeta,
Kojto 123:b0220dba8be7 5438 q31_t * pIa,
Kojto 123:b0220dba8be7 5439 q31_t * pIb)
Kojto 123:b0220dba8be7 5440 {
Kojto 123:b0220dba8be7 5441 q31_t product1, product2; /* Temporary variables used to store intermediate results */
Kojto 123:b0220dba8be7 5442
Kojto 123:b0220dba8be7 5443 /* Calculating pIa from Ialpha by equation pIa = Ialpha */
Kojto 123:b0220dba8be7 5444 *pIa = Ialpha;
Kojto 123:b0220dba8be7 5445
Kojto 123:b0220dba8be7 5446 /* Intermediate product is calculated by (1/(2*sqrt(3)) * Ia) */
Kojto 123:b0220dba8be7 5447 product1 = (q31_t) (((q63_t) (Ialpha) * (0x40000000)) >> 31);
Kojto 123:b0220dba8be7 5448
Kojto 123:b0220dba8be7 5449 /* Intermediate product is calculated by (1/sqrt(3) * pIb) */
Kojto 123:b0220dba8be7 5450 product2 = (q31_t) (((q63_t) (Ibeta) * (0x6ED9EBA1)) >> 31);
Kojto 123:b0220dba8be7 5451
Kojto 123:b0220dba8be7 5452 /* pIb is calculated by subtracting the products */
Kojto 123:b0220dba8be7 5453 *pIb = __QSUB(product2, product1);
Kojto 123:b0220dba8be7 5454
Kojto 123:b0220dba8be7 5455 }
Kojto 123:b0220dba8be7 5456
Kojto 123:b0220dba8be7 5457 /**
Kojto 123:b0220dba8be7 5458 * @} end of inv_clarke group
Kojto 123:b0220dba8be7 5459 */
Kojto 123:b0220dba8be7 5460
Kojto 123:b0220dba8be7 5461 /**
Kojto 123:b0220dba8be7 5462 * @brief Converts the elements of the Q7 vector to Q15 vector.
Kojto 123:b0220dba8be7 5463 * @param[in] *pSrc input pointer
Kojto 123:b0220dba8be7 5464 * @param[out] *pDst output pointer
Kojto 123:b0220dba8be7 5465 * @param[in] blockSize number of samples to process
Kojto 123:b0220dba8be7 5466 * @return none.
Kojto 123:b0220dba8be7 5467 */
Kojto 123:b0220dba8be7 5468 void arm_q7_to_q15(
Kojto 123:b0220dba8be7 5469 q7_t * pSrc,
Kojto 123:b0220dba8be7 5470 q15_t * pDst,
Kojto 123:b0220dba8be7 5471 uint32_t blockSize);
Kojto 123:b0220dba8be7 5472
Kojto 123:b0220dba8be7 5473
Kojto 123:b0220dba8be7 5474
Kojto 123:b0220dba8be7 5475 /**
Kojto 123:b0220dba8be7 5476 * @ingroup groupController
Kojto 123:b0220dba8be7 5477 */
Kojto 123:b0220dba8be7 5478
Kojto 123:b0220dba8be7 5479 /**
Kojto 123:b0220dba8be7 5480 * @defgroup park Vector Park Transform
Kojto 123:b0220dba8be7 5481 *
Kojto 123:b0220dba8be7 5482 * Forward Park transform converts the input two-coordinate vector to flux and torque components.
Kojto 123:b0220dba8be7 5483 * The Park transform can be used to realize the transformation of the <code>Ialpha</code> and the <code>Ibeta</code> currents
Kojto 123:b0220dba8be7 5484 * from the stationary to the moving reference frame and control the spatial relationship between
Kojto 123:b0220dba8be7 5485 * the stator vector current and rotor flux vector.
Kojto 123:b0220dba8be7 5486 * If we consider the d axis aligned with the rotor flux, the diagram below shows the
Kojto 123:b0220dba8be7 5487 * current vector and the relationship from the two reference frames:
Kojto 123:b0220dba8be7 5488 * \image html park.gif "Stator current space vector and its component in (a,b) and in the d,q rotating reference frame"
Kojto 123:b0220dba8be7 5489 *
Kojto 123:b0220dba8be7 5490 * The function operates on a single sample of data and each call to the function returns the processed output.
Kojto 123:b0220dba8be7 5491 * The library provides separate functions for Q31 and floating-point data types.
Kojto 123:b0220dba8be7 5492 * \par Algorithm
Kojto 123:b0220dba8be7 5493 * \image html parkFormula.gif
Kojto 123:b0220dba8be7 5494 * where <code>Ialpha</code> and <code>Ibeta</code> are the stator vector components,
Kojto 123:b0220dba8be7 5495 * <code>pId</code> and <code>pIq</code> are rotor vector components and <code>cosVal</code> and <code>sinVal</code> are the
Kojto 123:b0220dba8be7 5496 * cosine and sine values of theta (rotor flux position).
Kojto 123:b0220dba8be7 5497 * \par Fixed-Point Behavior
Kojto 123:b0220dba8be7 5498 * Care must be taken when using the Q31 version of the Park transform.
Kojto 123:b0220dba8be7 5499 * In particular, the overflow and saturation behavior of the accumulator used must be considered.
Kojto 123:b0220dba8be7 5500 * Refer to the function specific documentation below for usage guidelines.
Kojto 123:b0220dba8be7 5501 */
Kojto 123:b0220dba8be7 5502
Kojto 123:b0220dba8be7 5503 /**
Kojto 123:b0220dba8be7 5504 * @addtogroup park
Kojto 123:b0220dba8be7 5505 * @{
Kojto 123:b0220dba8be7 5506 */
Kojto 123:b0220dba8be7 5507
Kojto 123:b0220dba8be7 5508 /**
Kojto 123:b0220dba8be7 5509 * @brief Floating-point Park transform
Kojto 123:b0220dba8be7 5510 * @param[in] Ialpha input two-phase vector coordinate alpha
Kojto 123:b0220dba8be7 5511 * @param[in] Ibeta input two-phase vector coordinate beta
Kojto 123:b0220dba8be7 5512 * @param[out] *pId points to output rotor reference frame d
Kojto 123:b0220dba8be7 5513 * @param[out] *pIq points to output rotor reference frame q
Kojto 123:b0220dba8be7 5514 * @param[in] sinVal sine value of rotation angle theta
Kojto 123:b0220dba8be7 5515 * @param[in] cosVal cosine value of rotation angle theta
Kojto 123:b0220dba8be7 5516 * @return none.
Kojto 123:b0220dba8be7 5517 *
Kojto 123:b0220dba8be7 5518 * The function implements the forward Park transform.
Kojto 123:b0220dba8be7 5519 *
Kojto 123:b0220dba8be7 5520 */
Kojto 123:b0220dba8be7 5521
Kojto 123:b0220dba8be7 5522 static __INLINE void arm_park_f32(
Kojto 123:b0220dba8be7 5523 float32_t Ialpha,
Kojto 123:b0220dba8be7 5524 float32_t Ibeta,
Kojto 123:b0220dba8be7 5525 float32_t * pId,
Kojto 123:b0220dba8be7 5526 float32_t * pIq,
Kojto 123:b0220dba8be7 5527 float32_t sinVal,
Kojto 123:b0220dba8be7 5528 float32_t cosVal)
Kojto 123:b0220dba8be7 5529 {
Kojto 123:b0220dba8be7 5530 /* Calculate pId using the equation, pId = Ialpha * cosVal + Ibeta * sinVal */
Kojto 123:b0220dba8be7 5531 *pId = Ialpha * cosVal + Ibeta * sinVal;
Kojto 123:b0220dba8be7 5532
Kojto 123:b0220dba8be7 5533 /* Calculate pIq using the equation, pIq = - Ialpha * sinVal + Ibeta * cosVal */
Kojto 123:b0220dba8be7 5534 *pIq = -Ialpha * sinVal + Ibeta * cosVal;
Kojto 123:b0220dba8be7 5535
Kojto 123:b0220dba8be7 5536 }
Kojto 123:b0220dba8be7 5537
Kojto 123:b0220dba8be7 5538 /**
Kojto 123:b0220dba8be7 5539 * @brief Park transform for Q31 version
Kojto 123:b0220dba8be7 5540 * @param[in] Ialpha input two-phase vector coordinate alpha
Kojto 123:b0220dba8be7 5541 * @param[in] Ibeta input two-phase vector coordinate beta
Kojto 123:b0220dba8be7 5542 * @param[out] *pId points to output rotor reference frame d
Kojto 123:b0220dba8be7 5543 * @param[out] *pIq points to output rotor reference frame q
Kojto 123:b0220dba8be7 5544 * @param[in] sinVal sine value of rotation angle theta
Kojto 123:b0220dba8be7 5545 * @param[in] cosVal cosine value of rotation angle theta
Kojto 123:b0220dba8be7 5546 * @return none.
Kojto 123:b0220dba8be7 5547 *
Kojto 123:b0220dba8be7 5548 * <b>Scaling and Overflow Behavior:</b>
Kojto 123:b0220dba8be7 5549 * \par
Kojto 123:b0220dba8be7 5550 * The function is implemented using an internal 32-bit accumulator.
Kojto 123:b0220dba8be7 5551 * The accumulator maintains 1.31 format by truncating lower 31 bits of the intermediate multiplication in 2.62 format.
Kojto 123:b0220dba8be7 5552 * There is saturation on the addition and subtraction, hence there is no risk of overflow.
Kojto 123:b0220dba8be7 5553 */
Kojto 123:b0220dba8be7 5554
Kojto 123:b0220dba8be7 5555
Kojto 123:b0220dba8be7 5556 static __INLINE void arm_park_q31(
Kojto 123:b0220dba8be7 5557 q31_t Ialpha,
Kojto 123:b0220dba8be7 5558 q31_t Ibeta,
Kojto 123:b0220dba8be7 5559 q31_t * pId,
Kojto 123:b0220dba8be7 5560 q31_t * pIq,
Kojto 123:b0220dba8be7 5561 q31_t sinVal,
Kojto 123:b0220dba8be7 5562 q31_t cosVal)
Kojto 123:b0220dba8be7 5563 {
Kojto 123:b0220dba8be7 5564 q31_t product1, product2; /* Temporary variables used to store intermediate results */
Kojto 123:b0220dba8be7 5565 q31_t product3, product4; /* Temporary variables used to store intermediate results */
Kojto 123:b0220dba8be7 5566
Kojto 123:b0220dba8be7 5567 /* Intermediate product is calculated by (Ialpha * cosVal) */
Kojto 123:b0220dba8be7 5568 product1 = (q31_t) (((q63_t) (Ialpha) * (cosVal)) >> 31);
Kojto 123:b0220dba8be7 5569
Kojto 123:b0220dba8be7 5570 /* Intermediate product is calculated by (Ibeta * sinVal) */
Kojto 123:b0220dba8be7 5571 product2 = (q31_t) (((q63_t) (Ibeta) * (sinVal)) >> 31);
Kojto 123:b0220dba8be7 5572
Kojto 123:b0220dba8be7 5573
Kojto 123:b0220dba8be7 5574 /* Intermediate product is calculated by (Ialpha * sinVal) */
Kojto 123:b0220dba8be7 5575 product3 = (q31_t) (((q63_t) (Ialpha) * (sinVal)) >> 31);
Kojto 123:b0220dba8be7 5576
Kojto 123:b0220dba8be7 5577 /* Intermediate product is calculated by (Ibeta * cosVal) */
Kojto 123:b0220dba8be7 5578 product4 = (q31_t) (((q63_t) (Ibeta) * (cosVal)) >> 31);
Kojto 123:b0220dba8be7 5579
Kojto 123:b0220dba8be7 5580 /* Calculate pId by adding the two intermediate products 1 and 2 */
Kojto 123:b0220dba8be7 5581 *pId = __QADD(product1, product2);
Kojto 123:b0220dba8be7 5582
Kojto 123:b0220dba8be7 5583 /* Calculate pIq by subtracting the two intermediate products 3 from 4 */
Kojto 123:b0220dba8be7 5584 *pIq = __QSUB(product4, product3);
Kojto 123:b0220dba8be7 5585 }
Kojto 123:b0220dba8be7 5586
Kojto 123:b0220dba8be7 5587 /**
Kojto 123:b0220dba8be7 5588 * @} end of park group
Kojto 123:b0220dba8be7 5589 */
Kojto 123:b0220dba8be7 5590
Kojto 123:b0220dba8be7 5591 /**
Kojto 123:b0220dba8be7 5592 * @brief Converts the elements of the Q7 vector to floating-point vector.
Kojto 123:b0220dba8be7 5593 * @param[in] *pSrc is input pointer
Kojto 123:b0220dba8be7 5594 * @param[out] *pDst is output pointer
Kojto 123:b0220dba8be7 5595 * @param[in] blockSize is the number of samples to process
Kojto 123:b0220dba8be7 5596 * @return none.
Kojto 123:b0220dba8be7 5597 */
Kojto 123:b0220dba8be7 5598 void arm_q7_to_float(
Kojto 123:b0220dba8be7 5599 q7_t * pSrc,
Kojto 123:b0220dba8be7 5600 float32_t * pDst,
Kojto 123:b0220dba8be7 5601 uint32_t blockSize);
Kojto 123:b0220dba8be7 5602
Kojto 123:b0220dba8be7 5603
Kojto 123:b0220dba8be7 5604 /**
Kojto 123:b0220dba8be7 5605 * @ingroup groupController
Kojto 123:b0220dba8be7 5606 */
Kojto 123:b0220dba8be7 5607
Kojto 123:b0220dba8be7 5608 /**
Kojto 123:b0220dba8be7 5609 * @defgroup inv_park Vector Inverse Park transform
Kojto 123:b0220dba8be7 5610 * Inverse Park transform converts the input flux and torque components to two-coordinate vector.
Kojto 123:b0220dba8be7 5611 *
Kojto 123:b0220dba8be7 5612 * The function operates on a single sample of data and each call to the function returns the processed output.
Kojto 123:b0220dba8be7 5613 * The library provides separate functions for Q31 and floating-point data types.
Kojto 123:b0220dba8be7 5614 * \par Algorithm
Kojto 123:b0220dba8be7 5615 * \image html parkInvFormula.gif
Kojto 123:b0220dba8be7 5616 * where <code>pIalpha</code> and <code>pIbeta</code> are the stator vector components,
Kojto 123:b0220dba8be7 5617 * <code>Id</code> and <code>Iq</code> are rotor vector components and <code>cosVal</code> and <code>sinVal</code> are the
Kojto 123:b0220dba8be7 5618 * cosine and sine values of theta (rotor flux position).
Kojto 123:b0220dba8be7 5619 * \par Fixed-Point Behavior
Kojto 123:b0220dba8be7 5620 * Care must be taken when using the Q31 version of the Park transform.
Kojto 123:b0220dba8be7 5621 * In particular, the overflow and saturation behavior of the accumulator used must be considered.
Kojto 123:b0220dba8be7 5622 * Refer to the function specific documentation below for usage guidelines.
Kojto 123:b0220dba8be7 5623 */
Kojto 123:b0220dba8be7 5624
Kojto 123:b0220dba8be7 5625 /**
Kojto 123:b0220dba8be7 5626 * @addtogroup inv_park
Kojto 123:b0220dba8be7 5627 * @{
Kojto 123:b0220dba8be7 5628 */
Kojto 123:b0220dba8be7 5629
Kojto 123:b0220dba8be7 5630 /**
Kojto 123:b0220dba8be7 5631 * @brief Floating-point Inverse Park transform
Kojto 123:b0220dba8be7 5632 * @param[in] Id input coordinate of rotor reference frame d
Kojto 123:b0220dba8be7 5633 * @param[in] Iq input coordinate of rotor reference frame q
Kojto 123:b0220dba8be7 5634 * @param[out] *pIalpha points to output two-phase orthogonal vector axis alpha
Kojto 123:b0220dba8be7 5635 * @param[out] *pIbeta points to output two-phase orthogonal vector axis beta
Kojto 123:b0220dba8be7 5636 * @param[in] sinVal sine value of rotation angle theta
Kojto 123:b0220dba8be7 5637 * @param[in] cosVal cosine value of rotation angle theta
Kojto 123:b0220dba8be7 5638 * @return none.
Kojto 123:b0220dba8be7 5639 */
Kojto 123:b0220dba8be7 5640
Kojto 123:b0220dba8be7 5641 static __INLINE void arm_inv_park_f32(
Kojto 123:b0220dba8be7 5642 float32_t Id,
Kojto 123:b0220dba8be7 5643 float32_t Iq,
Kojto 123:b0220dba8be7 5644 float32_t * pIalpha,
Kojto 123:b0220dba8be7 5645 float32_t * pIbeta,
Kojto 123:b0220dba8be7 5646 float32_t sinVal,
Kojto 123:b0220dba8be7 5647 float32_t cosVal)
Kojto 123:b0220dba8be7 5648 {
Kojto 123:b0220dba8be7 5649 /* Calculate pIalpha using the equation, pIalpha = Id * cosVal - Iq * sinVal */
Kojto 123:b0220dba8be7 5650 *pIalpha = Id * cosVal - Iq * sinVal;
Kojto 123:b0220dba8be7 5651
Kojto 123:b0220dba8be7 5652 /* Calculate pIbeta using the equation, pIbeta = Id * sinVal + Iq * cosVal */
Kojto 123:b0220dba8be7 5653 *pIbeta = Id * sinVal + Iq * cosVal;
Kojto 123:b0220dba8be7 5654
Kojto 123:b0220dba8be7 5655 }
Kojto 123:b0220dba8be7 5656
Kojto 123:b0220dba8be7 5657
Kojto 123:b0220dba8be7 5658 /**
Kojto 123:b0220dba8be7 5659 * @brief Inverse Park transform for Q31 version
Kojto 123:b0220dba8be7 5660 * @param[in] Id input coordinate of rotor reference frame d
Kojto 123:b0220dba8be7 5661 * @param[in] Iq input coordinate of rotor reference frame q
Kojto 123:b0220dba8be7 5662 * @param[out] *pIalpha points to output two-phase orthogonal vector axis alpha
Kojto 123:b0220dba8be7 5663 * @param[out] *pIbeta points to output two-phase orthogonal vector axis beta
Kojto 123:b0220dba8be7 5664 * @param[in] sinVal sine value of rotation angle theta
Kojto 123:b0220dba8be7 5665 * @param[in] cosVal cosine value of rotation angle theta
Kojto 123:b0220dba8be7 5666 * @return none.
Kojto 123:b0220dba8be7 5667 *
Kojto 123:b0220dba8be7 5668 * <b>Scaling and Overflow Behavior:</b>
Kojto 123:b0220dba8be7 5669 * \par
Kojto 123:b0220dba8be7 5670 * The function is implemented using an internal 32-bit accumulator.
Kojto 123:b0220dba8be7 5671 * The accumulator maintains 1.31 format by truncating lower 31 bits of the intermediate multiplication in 2.62 format.
Kojto 123:b0220dba8be7 5672 * There is saturation on the addition, hence there is no risk of overflow.
Kojto 123:b0220dba8be7 5673 */
Kojto 123:b0220dba8be7 5674
Kojto 123:b0220dba8be7 5675
Kojto 123:b0220dba8be7 5676 static __INLINE void arm_inv_park_q31(
Kojto 123:b0220dba8be7 5677 q31_t Id,
Kojto 123:b0220dba8be7 5678 q31_t Iq,
Kojto 123:b0220dba8be7 5679 q31_t * pIalpha,
Kojto 123:b0220dba8be7 5680 q31_t * pIbeta,
Kojto 123:b0220dba8be7 5681 q31_t sinVal,
Kojto 123:b0220dba8be7 5682 q31_t cosVal)
Kojto 123:b0220dba8be7 5683 {
Kojto 123:b0220dba8be7 5684 q31_t product1, product2; /* Temporary variables used to store intermediate results */
Kojto 123:b0220dba8be7 5685 q31_t product3, product4; /* Temporary variables used to store intermediate results */
Kojto 123:b0220dba8be7 5686
Kojto 123:b0220dba8be7 5687 /* Intermediate product is calculated by (Id * cosVal) */
Kojto 123:b0220dba8be7 5688 product1 = (q31_t) (((q63_t) (Id) * (cosVal)) >> 31);
Kojto 123:b0220dba8be7 5689
Kojto 123:b0220dba8be7 5690 /* Intermediate product is calculated by (Iq * sinVal) */
Kojto 123:b0220dba8be7 5691 product2 = (q31_t) (((q63_t) (Iq) * (sinVal)) >> 31);
Kojto 123:b0220dba8be7 5692
Kojto 123:b0220dba8be7 5693
Kojto 123:b0220dba8be7 5694 /* Intermediate product is calculated by (Id * sinVal) */
Kojto 123:b0220dba8be7 5695 product3 = (q31_t) (((q63_t) (Id) * (sinVal)) >> 31);
Kojto 123:b0220dba8be7 5696
Kojto 123:b0220dba8be7 5697 /* Intermediate product is calculated by (Iq * cosVal) */
Kojto 123:b0220dba8be7 5698 product4 = (q31_t) (((q63_t) (Iq) * (cosVal)) >> 31);
Kojto 123:b0220dba8be7 5699
Kojto 123:b0220dba8be7 5700 /* Calculate pIalpha by using the two intermediate products 1 and 2 */
Kojto 123:b0220dba8be7 5701 *pIalpha = __QSUB(product1, product2);
Kojto 123:b0220dba8be7 5702
Kojto 123:b0220dba8be7 5703 /* Calculate pIbeta by using the two intermediate products 3 and 4 */
Kojto 123:b0220dba8be7 5704 *pIbeta = __QADD(product4, product3);
Kojto 123:b0220dba8be7 5705
Kojto 123:b0220dba8be7 5706 }
Kojto 123:b0220dba8be7 5707
Kojto 123:b0220dba8be7 5708 /**
Kojto 123:b0220dba8be7 5709 * @} end of Inverse park group
Kojto 123:b0220dba8be7 5710 */
Kojto 123:b0220dba8be7 5711
Kojto 123:b0220dba8be7 5712
Kojto 123:b0220dba8be7 5713 /**
Kojto 123:b0220dba8be7 5714 * @brief Converts the elements of the Q31 vector to floating-point vector.
Kojto 123:b0220dba8be7 5715 * @param[in] *pSrc is input pointer
Kojto 123:b0220dba8be7 5716 * @param[out] *pDst is output pointer
Kojto 123:b0220dba8be7 5717 * @param[in] blockSize is the number of samples to process
Kojto 123:b0220dba8be7 5718 * @return none.
Kojto 123:b0220dba8be7 5719 */
Kojto 123:b0220dba8be7 5720 void arm_q31_to_float(
Kojto 123:b0220dba8be7 5721 q31_t * pSrc,
Kojto 123:b0220dba8be7 5722 float32_t * pDst,
Kojto 123:b0220dba8be7 5723 uint32_t blockSize);
Kojto 123:b0220dba8be7 5724
Kojto 123:b0220dba8be7 5725 /**
Kojto 123:b0220dba8be7 5726 * @ingroup groupInterpolation
Kojto 123:b0220dba8be7 5727 */
Kojto 123:b0220dba8be7 5728
Kojto 123:b0220dba8be7 5729 /**
Kojto 123:b0220dba8be7 5730 * @defgroup LinearInterpolate Linear Interpolation
Kojto 123:b0220dba8be7 5731 *
Kojto 123:b0220dba8be7 5732 * Linear interpolation is a method of curve fitting using linear polynomials.
Kojto 123:b0220dba8be7 5733 * Linear interpolation works by effectively drawing a straight line between two neighboring samples and returning the appropriate point along that line
Kojto 123:b0220dba8be7 5734 *
Kojto 123:b0220dba8be7 5735 * \par
Kojto 123:b0220dba8be7 5736 * \image html LinearInterp.gif "Linear interpolation"
Kojto 123:b0220dba8be7 5737 *
Kojto 123:b0220dba8be7 5738 * \par
Kojto 123:b0220dba8be7 5739 * A Linear Interpolate function calculates an output value(y), for the input(x)
Kojto 123:b0220dba8be7 5740 * using linear interpolation of the input values x0, x1( nearest input values) and the output values y0 and y1(nearest output values)
Kojto 123:b0220dba8be7 5741 *
Kojto 123:b0220dba8be7 5742 * \par Algorithm:
Kojto 123:b0220dba8be7 5743 * <pre>
Kojto 123:b0220dba8be7 5744 * y = y0 + (x - x0) * ((y1 - y0)/(x1-x0))
Kojto 123:b0220dba8be7 5745 * where x0, x1 are nearest values of input x
Kojto 123:b0220dba8be7 5746 * y0, y1 are nearest values to output y
Kojto 123:b0220dba8be7 5747 * </pre>
Kojto 123:b0220dba8be7 5748 *
Kojto 123:b0220dba8be7 5749 * \par
Kojto 123:b0220dba8be7 5750 * This set of functions implements Linear interpolation process
Kojto 123:b0220dba8be7 5751 * for Q7, Q15, Q31, and floating-point data types. The functions operate on a single
Kojto 123:b0220dba8be7 5752 * sample of data and each call to the function returns a single processed value.
Kojto 123:b0220dba8be7 5753 * <code>S</code> points to an instance of the Linear Interpolate function data structure.
Kojto 123:b0220dba8be7 5754 * <code>x</code> is the input sample value. The functions returns the output value.
Kojto 123:b0220dba8be7 5755 *
Kojto 123:b0220dba8be7 5756 * \par
Kojto 123:b0220dba8be7 5757 * if x is outside of the table boundary, Linear interpolation returns first value of the table
Kojto 123:b0220dba8be7 5758 * if x is below input range and returns last value of table if x is above range.
Kojto 123:b0220dba8be7 5759 */
Kojto 123:b0220dba8be7 5760
Kojto 123:b0220dba8be7 5761 /**
Kojto 123:b0220dba8be7 5762 * @addtogroup LinearInterpolate
Kojto 123:b0220dba8be7 5763 * @{
Kojto 123:b0220dba8be7 5764 */
Kojto 123:b0220dba8be7 5765
Kojto 123:b0220dba8be7 5766 /**
Kojto 123:b0220dba8be7 5767 * @brief Process function for the floating-point Linear Interpolation Function.
Kojto 123:b0220dba8be7 5768 * @param[in,out] *S is an instance of the floating-point Linear Interpolation structure
Kojto 123:b0220dba8be7 5769 * @param[in] x input sample to process
Kojto 123:b0220dba8be7 5770 * @return y processed output sample.
Kojto 123:b0220dba8be7 5771 *
Kojto 123:b0220dba8be7 5772 */
Kojto 123:b0220dba8be7 5773
Kojto 123:b0220dba8be7 5774 static __INLINE float32_t arm_linear_interp_f32(
Kojto 123:b0220dba8be7 5775 arm_linear_interp_instance_f32 * S,
Kojto 123:b0220dba8be7 5776 float32_t x)
Kojto 123:b0220dba8be7 5777 {
Kojto 123:b0220dba8be7 5778
Kojto 123:b0220dba8be7 5779 float32_t y;
Kojto 123:b0220dba8be7 5780 float32_t x0, x1; /* Nearest input values */
Kojto 123:b0220dba8be7 5781 float32_t y0, y1; /* Nearest output values */
Kojto 123:b0220dba8be7 5782 float32_t xSpacing = S->xSpacing; /* spacing between input values */
Kojto 123:b0220dba8be7 5783 int32_t i; /* Index variable */
Kojto 123:b0220dba8be7 5784 float32_t *pYData = S->pYData; /* pointer to output table */
Kojto 123:b0220dba8be7 5785
Kojto 123:b0220dba8be7 5786 /* Calculation of index */
Kojto 123:b0220dba8be7 5787 i = (int32_t) ((x - S->x1) / xSpacing);
Kojto 123:b0220dba8be7 5788
Kojto 123:b0220dba8be7 5789 if(i < 0)
Kojto 123:b0220dba8be7 5790 {
Kojto 123:b0220dba8be7 5791 /* Iniatilize output for below specified range as least output value of table */
Kojto 123:b0220dba8be7 5792 y = pYData[0];
Kojto 123:b0220dba8be7 5793 }
Kojto 123:b0220dba8be7 5794 else if((uint32_t)i >= S->nValues)
Kojto 123:b0220dba8be7 5795 {
Kojto 123:b0220dba8be7 5796 /* Iniatilize output for above specified range as last output value of table */
Kojto 123:b0220dba8be7 5797 y = pYData[S->nValues - 1];
Kojto 123:b0220dba8be7 5798 }
Kojto 123:b0220dba8be7 5799 else
Kojto 123:b0220dba8be7 5800 {
Kojto 123:b0220dba8be7 5801 /* Calculation of nearest input values */
Kojto 123:b0220dba8be7 5802 x0 = S->x1 + i * xSpacing;
Kojto 123:b0220dba8be7 5803 x1 = S->x1 + (i + 1) * xSpacing;
Kojto 123:b0220dba8be7 5804
Kojto 123:b0220dba8be7 5805 /* Read of nearest output values */
Kojto 123:b0220dba8be7 5806 y0 = pYData[i];
Kojto 123:b0220dba8be7 5807 y1 = pYData[i + 1];
Kojto 123:b0220dba8be7 5808
Kojto 123:b0220dba8be7 5809 /* Calculation of output */
Kojto 123:b0220dba8be7 5810 y = y0 + (x - x0) * ((y1 - y0) / (x1 - x0));
Kojto 123:b0220dba8be7 5811
Kojto 123:b0220dba8be7 5812 }
Kojto 123:b0220dba8be7 5813
Kojto 123:b0220dba8be7 5814 /* returns output value */
Kojto 123:b0220dba8be7 5815 return (y);
Kojto 123:b0220dba8be7 5816 }
Kojto 123:b0220dba8be7 5817
Kojto 123:b0220dba8be7 5818 /**
Kojto 123:b0220dba8be7 5819 *
Kojto 123:b0220dba8be7 5820 * @brief Process function for the Q31 Linear Interpolation Function.
Kojto 123:b0220dba8be7 5821 * @param[in] *pYData pointer to Q31 Linear Interpolation table
Kojto 123:b0220dba8be7 5822 * @param[in] x input sample to process
Kojto 123:b0220dba8be7 5823 * @param[in] nValues number of table values
Kojto 123:b0220dba8be7 5824 * @return y processed output sample.
Kojto 123:b0220dba8be7 5825 *
Kojto 123:b0220dba8be7 5826 * \par
Kojto 123:b0220dba8be7 5827 * Input sample <code>x</code> is in 12.20 format which contains 12 bits for table index and 20 bits for fractional part.
Kojto 123:b0220dba8be7 5828 * This function can support maximum of table size 2^12.
Kojto 123:b0220dba8be7 5829 *
Kojto 123:b0220dba8be7 5830 */
Kojto 123:b0220dba8be7 5831
Kojto 123:b0220dba8be7 5832
Kojto 123:b0220dba8be7 5833 static __INLINE q31_t arm_linear_interp_q31(
Kojto 123:b0220dba8be7 5834 q31_t * pYData,
Kojto 123:b0220dba8be7 5835 q31_t x,
Kojto 123:b0220dba8be7 5836 uint32_t nValues)
Kojto 123:b0220dba8be7 5837 {
Kojto 123:b0220dba8be7 5838 q31_t y; /* output */
Kojto 123:b0220dba8be7 5839 q31_t y0, y1; /* Nearest output values */
Kojto 123:b0220dba8be7 5840 q31_t fract; /* fractional part */
Kojto 123:b0220dba8be7 5841 int32_t index; /* Index to read nearest output values */
Kojto 123:b0220dba8be7 5842
Kojto 123:b0220dba8be7 5843 /* Input is in 12.20 format */
Kojto 123:b0220dba8be7 5844 /* 12 bits for the table index */
Kojto 123:b0220dba8be7 5845 /* Index value calculation */
Kojto 123:b0220dba8be7 5846 index = ((x & 0xFFF00000) >> 20);
Kojto 123:b0220dba8be7 5847
Kojto 123:b0220dba8be7 5848 if(index >= (int32_t)(nValues - 1))
Kojto 123:b0220dba8be7 5849 {
Kojto 123:b0220dba8be7 5850 return (pYData[nValues - 1]);
Kojto 123:b0220dba8be7 5851 }
Kojto 123:b0220dba8be7 5852 else if(index < 0)
Kojto 123:b0220dba8be7 5853 {
Kojto 123:b0220dba8be7 5854 return (pYData[0]);
Kojto 123:b0220dba8be7 5855 }
Kojto 123:b0220dba8be7 5856 else
Kojto 123:b0220dba8be7 5857 {
Kojto 123:b0220dba8be7 5858
Kojto 123:b0220dba8be7 5859 /* 20 bits for the fractional part */
Kojto 123:b0220dba8be7 5860 /* shift left by 11 to keep fract in 1.31 format */
Kojto 123:b0220dba8be7 5861 fract = (x & 0x000FFFFF) << 11;
Kojto 123:b0220dba8be7 5862
Kojto 123:b0220dba8be7 5863 /* Read two nearest output values from the index in 1.31(q31) format */
Kojto 123:b0220dba8be7 5864 y0 = pYData[index];
Kojto 123:b0220dba8be7 5865 y1 = pYData[index + 1u];
Kojto 123:b0220dba8be7 5866
Kojto 123:b0220dba8be7 5867 /* Calculation of y0 * (1-fract) and y is in 2.30 format */
Kojto 123:b0220dba8be7 5868 y = ((q31_t) ((q63_t) y0 * (0x7FFFFFFF - fract) >> 32));
Kojto 123:b0220dba8be7 5869
Kojto 123:b0220dba8be7 5870 /* Calculation of y0 * (1-fract) + y1 *fract and y is in 2.30 format */
Kojto 123:b0220dba8be7 5871 y += ((q31_t) (((q63_t) y1 * fract) >> 32));
Kojto 123:b0220dba8be7 5872
Kojto 123:b0220dba8be7 5873 /* Convert y to 1.31 format */
Kojto 123:b0220dba8be7 5874 return (y << 1u);
Kojto 123:b0220dba8be7 5875
Kojto 123:b0220dba8be7 5876 }
Kojto 123:b0220dba8be7 5877
Kojto 123:b0220dba8be7 5878 }
Kojto 123:b0220dba8be7 5879
Kojto 123:b0220dba8be7 5880 /**
Kojto 123:b0220dba8be7 5881 *
Kojto 123:b0220dba8be7 5882 * @brief Process function for the Q15 Linear Interpolation Function.
Kojto 123:b0220dba8be7 5883 * @param[in] *pYData pointer to Q15 Linear Interpolation table
Kojto 123:b0220dba8be7 5884 * @param[in] x input sample to process
Kojto 123:b0220dba8be7 5885 * @param[in] nValues number of table values
Kojto 123:b0220dba8be7 5886 * @return y processed output sample.
Kojto 123:b0220dba8be7 5887 *
Kojto 123:b0220dba8be7 5888 * \par
Kojto 123:b0220dba8be7 5889 * Input sample <code>x</code> is in 12.20 format which contains 12 bits for table index and 20 bits for fractional part.
Kojto 123:b0220dba8be7 5890 * This function can support maximum of table size 2^12.
Kojto 123:b0220dba8be7 5891 *
Kojto 123:b0220dba8be7 5892 */
Kojto 123:b0220dba8be7 5893
Kojto 123:b0220dba8be7 5894
Kojto 123:b0220dba8be7 5895 static __INLINE q15_t arm_linear_interp_q15(
Kojto 123:b0220dba8be7 5896 q15_t * pYData,
Kojto 123:b0220dba8be7 5897 q31_t x,
Kojto 123:b0220dba8be7 5898 uint32_t nValues)
Kojto 123:b0220dba8be7 5899 {
Kojto 123:b0220dba8be7 5900 q63_t y; /* output */
Kojto 123:b0220dba8be7 5901 q15_t y0, y1; /* Nearest output values */
Kojto 123:b0220dba8be7 5902 q31_t fract; /* fractional part */
Kojto 123:b0220dba8be7 5903 int32_t index; /* Index to read nearest output values */
Kojto 123:b0220dba8be7 5904
Kojto 123:b0220dba8be7 5905 /* Input is in 12.20 format */
Kojto 123:b0220dba8be7 5906 /* 12 bits for the table index */
Kojto 123:b0220dba8be7 5907 /* Index value calculation */
Kojto 123:b0220dba8be7 5908 index = ((x & 0xFFF00000) >> 20u);
Kojto 123:b0220dba8be7 5909
Kojto 123:b0220dba8be7 5910 if(index >= (int32_t)(nValues - 1))
Kojto 123:b0220dba8be7 5911 {
Kojto 123:b0220dba8be7 5912 return (pYData[nValues - 1]);
Kojto 123:b0220dba8be7 5913 }
Kojto 123:b0220dba8be7 5914 else if(index < 0)
Kojto 123:b0220dba8be7 5915 {
Kojto 123:b0220dba8be7 5916 return (pYData[0]);
Kojto 123:b0220dba8be7 5917 }
Kojto 123:b0220dba8be7 5918 else
Kojto 123:b0220dba8be7 5919 {
Kojto 123:b0220dba8be7 5920 /* 20 bits for the fractional part */
Kojto 123:b0220dba8be7 5921 /* fract is in 12.20 format */
Kojto 123:b0220dba8be7 5922 fract = (x & 0x000FFFFF);
Kojto 123:b0220dba8be7 5923
Kojto 123:b0220dba8be7 5924 /* Read two nearest output values from the index */
Kojto 123:b0220dba8be7 5925 y0 = pYData[index];
Kojto 123:b0220dba8be7 5926 y1 = pYData[index + 1u];
Kojto 123:b0220dba8be7 5927
Kojto 123:b0220dba8be7 5928 /* Calculation of y0 * (1-fract) and y is in 13.35 format */
Kojto 123:b0220dba8be7 5929 y = ((q63_t) y0 * (0xFFFFF - fract));
Kojto 123:b0220dba8be7 5930
Kojto 123:b0220dba8be7 5931 /* Calculation of (y0 * (1-fract) + y1 * fract) and y is in 13.35 format */
Kojto 123:b0220dba8be7 5932 y += ((q63_t) y1 * (fract));
Kojto 123:b0220dba8be7 5933
Kojto 123:b0220dba8be7 5934 /* convert y to 1.15 format */
Kojto 123:b0220dba8be7 5935 return (y >> 20);
Kojto 123:b0220dba8be7 5936 }
Kojto 123:b0220dba8be7 5937
Kojto 123:b0220dba8be7 5938
Kojto 123:b0220dba8be7 5939 }
Kojto 123:b0220dba8be7 5940
Kojto 123:b0220dba8be7 5941 /**
Kojto 123:b0220dba8be7 5942 *
Kojto 123:b0220dba8be7 5943 * @brief Process function for the Q7 Linear Interpolation Function.
Kojto 123:b0220dba8be7 5944 * @param[in] *pYData pointer to Q7 Linear Interpolation table
Kojto 123:b0220dba8be7 5945 * @param[in] x input sample to process
Kojto 123:b0220dba8be7 5946 * @param[in] nValues number of table values
Kojto 123:b0220dba8be7 5947 * @return y processed output sample.
Kojto 123:b0220dba8be7 5948 *
Kojto 123:b0220dba8be7 5949 * \par
Kojto 123:b0220dba8be7 5950 * Input sample <code>x</code> is in 12.20 format which contains 12 bits for table index and 20 bits for fractional part.
Kojto 123:b0220dba8be7 5951 * This function can support maximum of table size 2^12.
Kojto 123:b0220dba8be7 5952 */
Kojto 123:b0220dba8be7 5953
Kojto 123:b0220dba8be7 5954
Kojto 123:b0220dba8be7 5955 static __INLINE q7_t arm_linear_interp_q7(
Kojto 123:b0220dba8be7 5956 q7_t * pYData,
Kojto 123:b0220dba8be7 5957 q31_t x,
Kojto 123:b0220dba8be7 5958 uint32_t nValues)
Kojto 123:b0220dba8be7 5959 {
Kojto 123:b0220dba8be7 5960 q31_t y; /* output */
Kojto 123:b0220dba8be7 5961 q7_t y0, y1; /* Nearest output values */
Kojto 123:b0220dba8be7 5962 q31_t fract; /* fractional part */
Kojto 123:b0220dba8be7 5963 uint32_t index; /* Index to read nearest output values */
Kojto 123:b0220dba8be7 5964
Kojto 123:b0220dba8be7 5965 /* Input is in 12.20 format */
Kojto 123:b0220dba8be7 5966 /* 12 bits for the table index */
Kojto 123:b0220dba8be7 5967 /* Index value calculation */
Kojto 123:b0220dba8be7 5968 if (x < 0)
Kojto 123:b0220dba8be7 5969 {
Kojto 123:b0220dba8be7 5970 return (pYData[0]);
Kojto 123:b0220dba8be7 5971 }
Kojto 123:b0220dba8be7 5972 index = (x >> 20) & 0xfff;
Kojto 123:b0220dba8be7 5973
Kojto 123:b0220dba8be7 5974
Kojto 123:b0220dba8be7 5975 if(index >= (nValues - 1))
Kojto 123:b0220dba8be7 5976 {
Kojto 123:b0220dba8be7 5977 return (pYData[nValues - 1]);
Kojto 123:b0220dba8be7 5978 }
Kojto 123:b0220dba8be7 5979 else
Kojto 123:b0220dba8be7 5980 {
Kojto 123:b0220dba8be7 5981
Kojto 123:b0220dba8be7 5982 /* 20 bits for the fractional part */
Kojto 123:b0220dba8be7 5983 /* fract is in 12.20 format */
Kojto 123:b0220dba8be7 5984 fract = (x & 0x000FFFFF);
Kojto 123:b0220dba8be7 5985
Kojto 123:b0220dba8be7 5986 /* Read two nearest output values from the index and are in 1.7(q7) format */
Kojto 123:b0220dba8be7 5987 y0 = pYData[index];
Kojto 123:b0220dba8be7 5988 y1 = pYData[index + 1u];
Kojto 123:b0220dba8be7 5989
Kojto 123:b0220dba8be7 5990 /* Calculation of y0 * (1-fract ) and y is in 13.27(q27) format */
Kojto 123:b0220dba8be7 5991 y = ((y0 * (0xFFFFF - fract)));
Kojto 123:b0220dba8be7 5992
Kojto 123:b0220dba8be7 5993 /* Calculation of y1 * fract + y0 * (1-fract) and y is in 13.27(q27) format */
Kojto 123:b0220dba8be7 5994 y += (y1 * fract);
Kojto 123:b0220dba8be7 5995
Kojto 123:b0220dba8be7 5996 /* convert y to 1.7(q7) format */
Kojto 123:b0220dba8be7 5997 return (y >> 20u);
Kojto 123:b0220dba8be7 5998
Kojto 123:b0220dba8be7 5999 }
Kojto 123:b0220dba8be7 6000
Kojto 123:b0220dba8be7 6001 }
Kojto 123:b0220dba8be7 6002 /**
Kojto 123:b0220dba8be7 6003 * @} end of LinearInterpolate group
Kojto 123:b0220dba8be7 6004 */
Kojto 123:b0220dba8be7 6005
Kojto 123:b0220dba8be7 6006 /**
Kojto 123:b0220dba8be7 6007 * @brief Fast approximation to the trigonometric sine function for floating-point data.
Kojto 123:b0220dba8be7 6008 * @param[in] x input value in radians.
Kojto 123:b0220dba8be7 6009 * @return sin(x).
Kojto 123:b0220dba8be7 6010 */
Kojto 123:b0220dba8be7 6011
Kojto 123:b0220dba8be7 6012 float32_t arm_sin_f32(
Kojto 123:b0220dba8be7 6013 float32_t x);
Kojto 123:b0220dba8be7 6014
Kojto 123:b0220dba8be7 6015 /**
Kojto 123:b0220dba8be7 6016 * @brief Fast approximation to the trigonometric sine function for Q31 data.
Kojto 123:b0220dba8be7 6017 * @param[in] x Scaled input value in radians.
Kojto 123:b0220dba8be7 6018 * @return sin(x).
Kojto 123:b0220dba8be7 6019 */
Kojto 123:b0220dba8be7 6020
Kojto 123:b0220dba8be7 6021 q31_t arm_sin_q31(
Kojto 123:b0220dba8be7 6022 q31_t x);
Kojto 123:b0220dba8be7 6023
Kojto 123:b0220dba8be7 6024 /**
Kojto 123:b0220dba8be7 6025 * @brief Fast approximation to the trigonometric sine function for Q15 data.
Kojto 123:b0220dba8be7 6026 * @param[in] x Scaled input value in radians.
Kojto 123:b0220dba8be7 6027 * @return sin(x).
Kojto 123:b0220dba8be7 6028 */
Kojto 123:b0220dba8be7 6029
Kojto 123:b0220dba8be7 6030 q15_t arm_sin_q15(
Kojto 123:b0220dba8be7 6031 q15_t x);
Kojto 123:b0220dba8be7 6032
Kojto 123:b0220dba8be7 6033 /**
Kojto 123:b0220dba8be7 6034 * @brief Fast approximation to the trigonometric cosine function for floating-point data.
Kojto 123:b0220dba8be7 6035 * @param[in] x input value in radians.
Kojto 123:b0220dba8be7 6036 * @return cos(x).
Kojto 123:b0220dba8be7 6037 */
Kojto 123:b0220dba8be7 6038
Kojto 123:b0220dba8be7 6039 float32_t arm_cos_f32(
Kojto 123:b0220dba8be7 6040 float32_t x);
Kojto 123:b0220dba8be7 6041
Kojto 123:b0220dba8be7 6042 /**
Kojto 123:b0220dba8be7 6043 * @brief Fast approximation to the trigonometric cosine function for Q31 data.
Kojto 123:b0220dba8be7 6044 * @param[in] x Scaled input value in radians.
Kojto 123:b0220dba8be7 6045 * @return cos(x).
Kojto 123:b0220dba8be7 6046 */
Kojto 123:b0220dba8be7 6047
Kojto 123:b0220dba8be7 6048 q31_t arm_cos_q31(
Kojto 123:b0220dba8be7 6049 q31_t x);
Kojto 123:b0220dba8be7 6050
Kojto 123:b0220dba8be7 6051 /**
Kojto 123:b0220dba8be7 6052 * @brief Fast approximation to the trigonometric cosine function for Q15 data.
Kojto 123:b0220dba8be7 6053 * @param[in] x Scaled input value in radians.
Kojto 123:b0220dba8be7 6054 * @return cos(x).
Kojto 123:b0220dba8be7 6055 */
Kojto 123:b0220dba8be7 6056
Kojto 123:b0220dba8be7 6057 q15_t arm_cos_q15(
Kojto 123:b0220dba8be7 6058 q15_t x);
Kojto 123:b0220dba8be7 6059
Kojto 123:b0220dba8be7 6060
Kojto 123:b0220dba8be7 6061 /**
Kojto 123:b0220dba8be7 6062 * @ingroup groupFastMath
Kojto 123:b0220dba8be7 6063 */
Kojto 123:b0220dba8be7 6064
Kojto 123:b0220dba8be7 6065
Kojto 123:b0220dba8be7 6066 /**
Kojto 123:b0220dba8be7 6067 * @defgroup SQRT Square Root
Kojto 123:b0220dba8be7 6068 *
Kojto 123:b0220dba8be7 6069 * Computes the square root of a number.
Kojto 123:b0220dba8be7 6070 * There are separate functions for Q15, Q31, and floating-point data types.
Kojto 123:b0220dba8be7 6071 * The square root function is computed using the Newton-Raphson algorithm.
Kojto 123:b0220dba8be7 6072 * This is an iterative algorithm of the form:
Kojto 123:b0220dba8be7 6073 * <pre>
Kojto 123:b0220dba8be7 6074 * x1 = x0 - f(x0)/f'(x0)
Kojto 123:b0220dba8be7 6075 * </pre>
Kojto 123:b0220dba8be7 6076 * where <code>x1</code> is the current estimate,
Kojto 123:b0220dba8be7 6077 * <code>x0</code> is the previous estimate, and
Kojto 123:b0220dba8be7 6078 * <code>f'(x0)</code> is the derivative of <code>f()</code> evaluated at <code>x0</code>.
Kojto 123:b0220dba8be7 6079 * For the square root function, the algorithm reduces to:
Kojto 123:b0220dba8be7 6080 * <pre>
Kojto 123:b0220dba8be7 6081 * x0 = in/2 [initial guess]
Kojto 123:b0220dba8be7 6082 * x1 = 1/2 * ( x0 + in / x0) [each iteration]
Kojto 123:b0220dba8be7 6083 * </pre>
Kojto 123:b0220dba8be7 6084 */
Kojto 123:b0220dba8be7 6085
Kojto 123:b0220dba8be7 6086
Kojto 123:b0220dba8be7 6087 /**
Kojto 123:b0220dba8be7 6088 * @addtogroup SQRT
Kojto 123:b0220dba8be7 6089 * @{
Kojto 123:b0220dba8be7 6090 */
Kojto 123:b0220dba8be7 6091
Kojto 123:b0220dba8be7 6092 /**
Kojto 123:b0220dba8be7 6093 * @brief Floating-point square root function.
Kojto 123:b0220dba8be7 6094 * @param[in] in input value.
Kojto 123:b0220dba8be7 6095 * @param[out] *pOut square root of input value.
Kojto 123:b0220dba8be7 6096 * @return The function returns ARM_MATH_SUCCESS if input value is positive value or ARM_MATH_ARGUMENT_ERROR if
Kojto 123:b0220dba8be7 6097 * <code>in</code> is negative value and returns zero output for negative values.
Kojto 123:b0220dba8be7 6098 */
Kojto 123:b0220dba8be7 6099
Kojto 123:b0220dba8be7 6100 static __INLINE arm_status arm_sqrt_f32(
Kojto 123:b0220dba8be7 6101 float32_t in,
Kojto 123:b0220dba8be7 6102 float32_t * pOut)
Kojto 123:b0220dba8be7 6103 {
Kojto 123:b0220dba8be7 6104 if(in >= 0.0f)
Kojto 123:b0220dba8be7 6105 {
Kojto 123:b0220dba8be7 6106
Kojto 123:b0220dba8be7 6107 // #if __FPU_USED
Kojto 123:b0220dba8be7 6108 #if (__FPU_USED == 1) && defined ( __CC_ARM )
Kojto 123:b0220dba8be7 6109 *pOut = __sqrtf(in);
Kojto 123:b0220dba8be7 6110 #else
Kojto 123:b0220dba8be7 6111 *pOut = sqrtf(in);
Kojto 123:b0220dba8be7 6112 #endif
Kojto 123:b0220dba8be7 6113
Kojto 123:b0220dba8be7 6114 return (ARM_MATH_SUCCESS);
Kojto 123:b0220dba8be7 6115 }
Kojto 123:b0220dba8be7 6116 else
Kojto 123:b0220dba8be7 6117 {
Kojto 123:b0220dba8be7 6118 *pOut = 0.0f;
Kojto 123:b0220dba8be7 6119 return (ARM_MATH_ARGUMENT_ERROR);
Kojto 123:b0220dba8be7 6120 }
Kojto 123:b0220dba8be7 6121
Kojto 123:b0220dba8be7 6122 }
Kojto 123:b0220dba8be7 6123
Kojto 123:b0220dba8be7 6124
Kojto 123:b0220dba8be7 6125 /**
Kojto 123:b0220dba8be7 6126 * @brief Q31 square root function.
Kojto 123:b0220dba8be7 6127 * @param[in] in input value. The range of the input value is [0 +1) or 0x00000000 to 0x7FFFFFFF.
Kojto 123:b0220dba8be7 6128 * @param[out] *pOut square root of input value.
Kojto 123:b0220dba8be7 6129 * @return The function returns ARM_MATH_SUCCESS if input value is positive value or ARM_MATH_ARGUMENT_ERROR if
Kojto 123:b0220dba8be7 6130 * <code>in</code> is negative value and returns zero output for negative values.
Kojto 123:b0220dba8be7 6131 */
Kojto 123:b0220dba8be7 6132 arm_status arm_sqrt_q31(
Kojto 123:b0220dba8be7 6133 q31_t in,
Kojto 123:b0220dba8be7 6134 q31_t * pOut);
Kojto 123:b0220dba8be7 6135
Kojto 123:b0220dba8be7 6136 /**
Kojto 123:b0220dba8be7 6137 * @brief Q15 square root function.
Kojto 123:b0220dba8be7 6138 * @param[in] in input value. The range of the input value is [0 +1) or 0x0000 to 0x7FFF.
Kojto 123:b0220dba8be7 6139 * @param[out] *pOut square root of input value.
Kojto 123:b0220dba8be7 6140 * @return The function returns ARM_MATH_SUCCESS if input value is positive value or ARM_MATH_ARGUMENT_ERROR if
Kojto 123:b0220dba8be7 6141 * <code>in</code> is negative value and returns zero output for negative values.
Kojto 123:b0220dba8be7 6142 */
Kojto 123:b0220dba8be7 6143 arm_status arm_sqrt_q15(
Kojto 123:b0220dba8be7 6144 q15_t in,
Kojto 123:b0220dba8be7 6145 q15_t * pOut);
Kojto 123:b0220dba8be7 6146
Kojto 123:b0220dba8be7 6147 /**
Kojto 123:b0220dba8be7 6148 * @} end of SQRT group
Kojto 123:b0220dba8be7 6149 */
Kojto 123:b0220dba8be7 6150
Kojto 123:b0220dba8be7 6151
Kojto 123:b0220dba8be7 6152
Kojto 123:b0220dba8be7 6153
Kojto 123:b0220dba8be7 6154
Kojto 123:b0220dba8be7 6155
Kojto 123:b0220dba8be7 6156 /**
Kojto 123:b0220dba8be7 6157 * @brief floating-point Circular write function.
Kojto 123:b0220dba8be7 6158 */
Kojto 123:b0220dba8be7 6159
Kojto 123:b0220dba8be7 6160 static __INLINE void arm_circularWrite_f32(
Kojto 123:b0220dba8be7 6161 int32_t * circBuffer,
Kojto 123:b0220dba8be7 6162 int32_t L,
Kojto 123:b0220dba8be7 6163 uint16_t * writeOffset,
Kojto 123:b0220dba8be7 6164 int32_t bufferInc,
Kojto 123:b0220dba8be7 6165 const int32_t * src,
Kojto 123:b0220dba8be7 6166 int32_t srcInc,
Kojto 123:b0220dba8be7 6167 uint32_t blockSize)
Kojto 123:b0220dba8be7 6168 {
Kojto 123:b0220dba8be7 6169 uint32_t i = 0u;
Kojto 123:b0220dba8be7 6170 int32_t wOffset;
Kojto 123:b0220dba8be7 6171
Kojto 123:b0220dba8be7 6172 /* Copy the value of Index pointer that points
Kojto 123:b0220dba8be7 6173 * to the current location where the input samples to be copied */
Kojto 123:b0220dba8be7 6174 wOffset = *writeOffset;
Kojto 123:b0220dba8be7 6175
Kojto 123:b0220dba8be7 6176 /* Loop over the blockSize */
Kojto 123:b0220dba8be7 6177 i = blockSize;
Kojto 123:b0220dba8be7 6178
Kojto 123:b0220dba8be7 6179 while(i > 0u)
Kojto 123:b0220dba8be7 6180 {
Kojto 123:b0220dba8be7 6181 /* copy the input sample to the circular buffer */
Kojto 123:b0220dba8be7 6182 circBuffer[wOffset] = *src;
Kojto 123:b0220dba8be7 6183
Kojto 123:b0220dba8be7 6184 /* Update the input pointer */
Kojto 123:b0220dba8be7 6185 src += srcInc;
Kojto 123:b0220dba8be7 6186
Kojto 123:b0220dba8be7 6187 /* Circularly update wOffset. Watch out for positive and negative value */
Kojto 123:b0220dba8be7 6188 wOffset += bufferInc;
Kojto 123:b0220dba8be7 6189 if(wOffset >= L)
Kojto 123:b0220dba8be7 6190 wOffset -= L;
Kojto 123:b0220dba8be7 6191
Kojto 123:b0220dba8be7 6192 /* Decrement the loop counter */
Kojto 123:b0220dba8be7 6193 i--;
Kojto 123:b0220dba8be7 6194 }
Kojto 123:b0220dba8be7 6195
Kojto 123:b0220dba8be7 6196 /* Update the index pointer */
Kojto 123:b0220dba8be7 6197 *writeOffset = wOffset;
Kojto 123:b0220dba8be7 6198 }
Kojto 123:b0220dba8be7 6199
Kojto 123:b0220dba8be7 6200
Kojto 123:b0220dba8be7 6201
Kojto 123:b0220dba8be7 6202 /**
Kojto 123:b0220dba8be7 6203 * @brief floating-point Circular Read function.
Kojto 123:b0220dba8be7 6204 */
Kojto 123:b0220dba8be7 6205 static __INLINE void arm_circularRead_f32(
Kojto 123:b0220dba8be7 6206 int32_t * circBuffer,
Kojto 123:b0220dba8be7 6207 int32_t L,
Kojto 123:b0220dba8be7 6208 int32_t * readOffset,
Kojto 123:b0220dba8be7 6209 int32_t bufferInc,
Kojto 123:b0220dba8be7 6210 int32_t * dst,
Kojto 123:b0220dba8be7 6211 int32_t * dst_base,
Kojto 123:b0220dba8be7 6212 int32_t dst_length,
Kojto 123:b0220dba8be7 6213 int32_t dstInc,
Kojto 123:b0220dba8be7 6214 uint32_t blockSize)
Kojto 123:b0220dba8be7 6215 {
Kojto 123:b0220dba8be7 6216 uint32_t i = 0u;
Kojto 123:b0220dba8be7 6217 int32_t rOffset, dst_end;
Kojto 123:b0220dba8be7 6218
Kojto 123:b0220dba8be7 6219 /* Copy the value of Index pointer that points
Kojto 123:b0220dba8be7 6220 * to the current location from where the input samples to be read */
Kojto 123:b0220dba8be7 6221 rOffset = *readOffset;
Kojto 123:b0220dba8be7 6222 dst_end = (int32_t) (dst_base + dst_length);
Kojto 123:b0220dba8be7 6223
Kojto 123:b0220dba8be7 6224 /* Loop over the blockSize */
Kojto 123:b0220dba8be7 6225 i = blockSize;
Kojto 123:b0220dba8be7 6226
Kojto 123:b0220dba8be7 6227 while(i > 0u)
Kojto 123:b0220dba8be7 6228 {
Kojto 123:b0220dba8be7 6229 /* copy the sample from the circular buffer to the destination buffer */
Kojto 123:b0220dba8be7 6230 *dst = circBuffer[rOffset];
Kojto 123:b0220dba8be7 6231
Kojto 123:b0220dba8be7 6232 /* Update the input pointer */
Kojto 123:b0220dba8be7 6233 dst += dstInc;
Kojto 123:b0220dba8be7 6234
Kojto 123:b0220dba8be7 6235 if(dst == (int32_t *) dst_end)
Kojto 123:b0220dba8be7 6236 {
Kojto 123:b0220dba8be7 6237 dst = dst_base;
Kojto 123:b0220dba8be7 6238 }
Kojto 123:b0220dba8be7 6239
Kojto 123:b0220dba8be7 6240 /* Circularly update rOffset. Watch out for positive and negative value */
Kojto 123:b0220dba8be7 6241 rOffset += bufferInc;
Kojto 123:b0220dba8be7 6242
Kojto 123:b0220dba8be7 6243 if(rOffset >= L)
Kojto 123:b0220dba8be7 6244 {
Kojto 123:b0220dba8be7 6245 rOffset -= L;
Kojto 123:b0220dba8be7 6246 }
Kojto 123:b0220dba8be7 6247
Kojto 123:b0220dba8be7 6248 /* Decrement the loop counter */
Kojto 123:b0220dba8be7 6249 i--;
Kojto 123:b0220dba8be7 6250 }
Kojto 123:b0220dba8be7 6251
Kojto 123:b0220dba8be7 6252 /* Update the index pointer */
Kojto 123:b0220dba8be7 6253 *readOffset = rOffset;
Kojto 123:b0220dba8be7 6254 }
Kojto 123:b0220dba8be7 6255
Kojto 123:b0220dba8be7 6256 /**
Kojto 123:b0220dba8be7 6257 * @brief Q15 Circular write function.
Kojto 123:b0220dba8be7 6258 */
Kojto 123:b0220dba8be7 6259
Kojto 123:b0220dba8be7 6260 static __INLINE void arm_circularWrite_q15(
Kojto 123:b0220dba8be7 6261 q15_t * circBuffer,
Kojto 123:b0220dba8be7 6262 int32_t L,
Kojto 123:b0220dba8be7 6263 uint16_t * writeOffset,
Kojto 123:b0220dba8be7 6264 int32_t bufferInc,
Kojto 123:b0220dba8be7 6265 const q15_t * src,
Kojto 123:b0220dba8be7 6266 int32_t srcInc,
Kojto 123:b0220dba8be7 6267 uint32_t blockSize)
Kojto 123:b0220dba8be7 6268 {
Kojto 123:b0220dba8be7 6269 uint32_t i = 0u;
Kojto 123:b0220dba8be7 6270 int32_t wOffset;
Kojto 123:b0220dba8be7 6271
Kojto 123:b0220dba8be7 6272 /* Copy the value of Index pointer that points
Kojto 123:b0220dba8be7 6273 * to the current location where the input samples to be copied */
Kojto 123:b0220dba8be7 6274 wOffset = *writeOffset;
Kojto 123:b0220dba8be7 6275
Kojto 123:b0220dba8be7 6276 /* Loop over the blockSize */
Kojto 123:b0220dba8be7 6277 i = blockSize;
Kojto 123:b0220dba8be7 6278
Kojto 123:b0220dba8be7 6279 while(i > 0u)
Kojto 123:b0220dba8be7 6280 {
Kojto 123:b0220dba8be7 6281 /* copy the input sample to the circular buffer */
Kojto 123:b0220dba8be7 6282 circBuffer[wOffset] = *src;
Kojto 123:b0220dba8be7 6283
Kojto 123:b0220dba8be7 6284 /* Update the input pointer */
Kojto 123:b0220dba8be7 6285 src += srcInc;
Kojto 123:b0220dba8be7 6286
Kojto 123:b0220dba8be7 6287 /* Circularly update wOffset. Watch out for positive and negative value */
Kojto 123:b0220dba8be7 6288 wOffset += bufferInc;
Kojto 123:b0220dba8be7 6289 if(wOffset >= L)
Kojto 123:b0220dba8be7 6290 wOffset -= L;
Kojto 123:b0220dba8be7 6291
Kojto 123:b0220dba8be7 6292 /* Decrement the loop counter */
Kojto 123:b0220dba8be7 6293 i--;
Kojto 123:b0220dba8be7 6294 }
Kojto 123:b0220dba8be7 6295
Kojto 123:b0220dba8be7 6296 /* Update the index pointer */
Kojto 123:b0220dba8be7 6297 *writeOffset = wOffset;
Kojto 123:b0220dba8be7 6298 }
Kojto 123:b0220dba8be7 6299
Kojto 123:b0220dba8be7 6300
Kojto 123:b0220dba8be7 6301
Kojto 123:b0220dba8be7 6302 /**
Kojto 123:b0220dba8be7 6303 * @brief Q15 Circular Read function.
Kojto 123:b0220dba8be7 6304 */
Kojto 123:b0220dba8be7 6305 static __INLINE void arm_circularRead_q15(
Kojto 123:b0220dba8be7 6306 q15_t * circBuffer,
Kojto 123:b0220dba8be7 6307 int32_t L,
Kojto 123:b0220dba8be7 6308 int32_t * readOffset,
Kojto 123:b0220dba8be7 6309 int32_t bufferInc,
Kojto 123:b0220dba8be7 6310 q15_t * dst,
Kojto 123:b0220dba8be7 6311 q15_t * dst_base,
Kojto 123:b0220dba8be7 6312 int32_t dst_length,
Kojto 123:b0220dba8be7 6313 int32_t dstInc,
Kojto 123:b0220dba8be7 6314 uint32_t blockSize)
Kojto 123:b0220dba8be7 6315 {
Kojto 123:b0220dba8be7 6316 uint32_t i = 0;
Kojto 123:b0220dba8be7 6317 int32_t rOffset, dst_end;
Kojto 123:b0220dba8be7 6318
Kojto 123:b0220dba8be7 6319 /* Copy the value of Index pointer that points
Kojto 123:b0220dba8be7 6320 * to the current location from where the input samples to be read */
Kojto 123:b0220dba8be7 6321 rOffset = *readOffset;
Kojto 123:b0220dba8be7 6322
Kojto 123:b0220dba8be7 6323 dst_end = (int32_t) (dst_base + dst_length);
Kojto 123:b0220dba8be7 6324
Kojto 123:b0220dba8be7 6325 /* Loop over the blockSize */
Kojto 123:b0220dba8be7 6326 i = blockSize;
Kojto 123:b0220dba8be7 6327
Kojto 123:b0220dba8be7 6328 while(i > 0u)
Kojto 123:b0220dba8be7 6329 {
Kojto 123:b0220dba8be7 6330 /* copy the sample from the circular buffer to the destination buffer */
Kojto 123:b0220dba8be7 6331 *dst = circBuffer[rOffset];
Kojto 123:b0220dba8be7 6332
Kojto 123:b0220dba8be7 6333 /* Update the input pointer */
Kojto 123:b0220dba8be7 6334 dst += dstInc;
Kojto 123:b0220dba8be7 6335
Kojto 123:b0220dba8be7 6336 if(dst == (q15_t *) dst_end)
Kojto 123:b0220dba8be7 6337 {
Kojto 123:b0220dba8be7 6338 dst = dst_base;
Kojto 123:b0220dba8be7 6339 }
Kojto 123:b0220dba8be7 6340
Kojto 123:b0220dba8be7 6341 /* Circularly update wOffset. Watch out for positive and negative value */
Kojto 123:b0220dba8be7 6342 rOffset += bufferInc;
Kojto 123:b0220dba8be7 6343
Kojto 123:b0220dba8be7 6344 if(rOffset >= L)
Kojto 123:b0220dba8be7 6345 {
Kojto 123:b0220dba8be7 6346 rOffset -= L;
Kojto 123:b0220dba8be7 6347 }
Kojto 123:b0220dba8be7 6348
Kojto 123:b0220dba8be7 6349 /* Decrement the loop counter */
Kojto 123:b0220dba8be7 6350 i--;
Kojto 123:b0220dba8be7 6351 }
Kojto 123:b0220dba8be7 6352
Kojto 123:b0220dba8be7 6353 /* Update the index pointer */
Kojto 123:b0220dba8be7 6354 *readOffset = rOffset;
Kojto 123:b0220dba8be7 6355 }
Kojto 123:b0220dba8be7 6356
Kojto 123:b0220dba8be7 6357
Kojto 123:b0220dba8be7 6358 /**
Kojto 123:b0220dba8be7 6359 * @brief Q7 Circular write function.
Kojto 123:b0220dba8be7 6360 */
Kojto 123:b0220dba8be7 6361
Kojto 123:b0220dba8be7 6362 static __INLINE void arm_circularWrite_q7(
Kojto 123:b0220dba8be7 6363 q7_t * circBuffer,
Kojto 123:b0220dba8be7 6364 int32_t L,
Kojto 123:b0220dba8be7 6365 uint16_t * writeOffset,
Kojto 123:b0220dba8be7 6366 int32_t bufferInc,
Kojto 123:b0220dba8be7 6367 const q7_t * src,
Kojto 123:b0220dba8be7 6368 int32_t srcInc,
Kojto 123:b0220dba8be7 6369 uint32_t blockSize)
Kojto 123:b0220dba8be7 6370 {
Kojto 123:b0220dba8be7 6371 uint32_t i = 0u;
Kojto 123:b0220dba8be7 6372 int32_t wOffset;
Kojto 123:b0220dba8be7 6373
Kojto 123:b0220dba8be7 6374 /* Copy the value of Index pointer that points
Kojto 123:b0220dba8be7 6375 * to the current location where the input samples to be copied */
Kojto 123:b0220dba8be7 6376 wOffset = *writeOffset;
Kojto 123:b0220dba8be7 6377
Kojto 123:b0220dba8be7 6378 /* Loop over the blockSize */
Kojto 123:b0220dba8be7 6379 i = blockSize;
Kojto 123:b0220dba8be7 6380
Kojto 123:b0220dba8be7 6381 while(i > 0u)
Kojto 123:b0220dba8be7 6382 {
Kojto 123:b0220dba8be7 6383 /* copy the input sample to the circular buffer */
Kojto 123:b0220dba8be7 6384 circBuffer[wOffset] = *src;
Kojto 123:b0220dba8be7 6385
Kojto 123:b0220dba8be7 6386 /* Update the input pointer */
Kojto 123:b0220dba8be7 6387 src += srcInc;
Kojto 123:b0220dba8be7 6388
Kojto 123:b0220dba8be7 6389 /* Circularly update wOffset. Watch out for positive and negative value */
Kojto 123:b0220dba8be7 6390 wOffset += bufferInc;
Kojto 123:b0220dba8be7 6391 if(wOffset >= L)
Kojto 123:b0220dba8be7 6392 wOffset -= L;
Kojto 123:b0220dba8be7 6393
Kojto 123:b0220dba8be7 6394 /* Decrement the loop counter */
Kojto 123:b0220dba8be7 6395 i--;
Kojto 123:b0220dba8be7 6396 }
Kojto 123:b0220dba8be7 6397
Kojto 123:b0220dba8be7 6398 /* Update the index pointer */
Kojto 123:b0220dba8be7 6399 *writeOffset = wOffset;
Kojto 123:b0220dba8be7 6400 }
Kojto 123:b0220dba8be7 6401
Kojto 123:b0220dba8be7 6402
Kojto 123:b0220dba8be7 6403
Kojto 123:b0220dba8be7 6404 /**
Kojto 123:b0220dba8be7 6405 * @brief Q7 Circular Read function.
Kojto 123:b0220dba8be7 6406 */
Kojto 123:b0220dba8be7 6407 static __INLINE void arm_circularRead_q7(
Kojto 123:b0220dba8be7 6408 q7_t * circBuffer,
Kojto 123:b0220dba8be7 6409 int32_t L,
Kojto 123:b0220dba8be7 6410 int32_t * readOffset,
Kojto 123:b0220dba8be7 6411 int32_t bufferInc,
Kojto 123:b0220dba8be7 6412 q7_t * dst,
Kojto 123:b0220dba8be7 6413 q7_t * dst_base,
Kojto 123:b0220dba8be7 6414 int32_t dst_length,
Kojto 123:b0220dba8be7 6415 int32_t dstInc,
Kojto 123:b0220dba8be7 6416 uint32_t blockSize)
Kojto 123:b0220dba8be7 6417 {
Kojto 123:b0220dba8be7 6418 uint32_t i = 0;
Kojto 123:b0220dba8be7 6419 int32_t rOffset, dst_end;
Kojto 123:b0220dba8be7 6420
Kojto 123:b0220dba8be7 6421 /* Copy the value of Index pointer that points
Kojto 123:b0220dba8be7 6422 * to the current location from where the input samples to be read */
Kojto 123:b0220dba8be7 6423 rOffset = *readOffset;
Kojto 123:b0220dba8be7 6424
Kojto 123:b0220dba8be7 6425 dst_end = (int32_t) (dst_base + dst_length);
Kojto 123:b0220dba8be7 6426
Kojto 123:b0220dba8be7 6427 /* Loop over the blockSize */
Kojto 123:b0220dba8be7 6428 i = blockSize;
Kojto 123:b0220dba8be7 6429
Kojto 123:b0220dba8be7 6430 while(i > 0u)
Kojto 123:b0220dba8be7 6431 {
Kojto 123:b0220dba8be7 6432 /* copy the sample from the circular buffer to the destination buffer */
Kojto 123:b0220dba8be7 6433 *dst = circBuffer[rOffset];
Kojto 123:b0220dba8be7 6434
Kojto 123:b0220dba8be7 6435 /* Update the input pointer */
Kojto 123:b0220dba8be7 6436 dst += dstInc;
Kojto 123:b0220dba8be7 6437
Kojto 123:b0220dba8be7 6438 if(dst == (q7_t *) dst_end)
Kojto 123:b0220dba8be7 6439 {
Kojto 123:b0220dba8be7 6440 dst = dst_base;
Kojto 123:b0220dba8be7 6441 }
Kojto 123:b0220dba8be7 6442
Kojto 123:b0220dba8be7 6443 /* Circularly update rOffset. Watch out for positive and negative value */
Kojto 123:b0220dba8be7 6444 rOffset += bufferInc;
Kojto 123:b0220dba8be7 6445
Kojto 123:b0220dba8be7 6446 if(rOffset >= L)
Kojto 123:b0220dba8be7 6447 {
Kojto 123:b0220dba8be7 6448 rOffset -= L;
Kojto 123:b0220dba8be7 6449 }
Kojto 123:b0220dba8be7 6450
Kojto 123:b0220dba8be7 6451 /* Decrement the loop counter */
Kojto 123:b0220dba8be7 6452 i--;
Kojto 123:b0220dba8be7 6453 }
Kojto 123:b0220dba8be7 6454
Kojto 123:b0220dba8be7 6455 /* Update the index pointer */
Kojto 123:b0220dba8be7 6456 *readOffset = rOffset;
Kojto 123:b0220dba8be7 6457 }
Kojto 123:b0220dba8be7 6458
Kojto 123:b0220dba8be7 6459
Kojto 123:b0220dba8be7 6460 /**
Kojto 123:b0220dba8be7 6461 * @brief Sum of the squares of the elements of a Q31 vector.
Kojto 123:b0220dba8be7 6462 * @param[in] *pSrc is input pointer
Kojto 123:b0220dba8be7 6463 * @param[in] blockSize is the number of samples to process
Kojto 123:b0220dba8be7 6464 * @param[out] *pResult is output value.
Kojto 123:b0220dba8be7 6465 * @return none.
Kojto 123:b0220dba8be7 6466 */
Kojto 123:b0220dba8be7 6467
Kojto 123:b0220dba8be7 6468 void arm_power_q31(
Kojto 123:b0220dba8be7 6469 q31_t * pSrc,
Kojto 123:b0220dba8be7 6470 uint32_t blockSize,
Kojto 123:b0220dba8be7 6471 q63_t * pResult);
Kojto 123:b0220dba8be7 6472
Kojto 123:b0220dba8be7 6473 /**
Kojto 123:b0220dba8be7 6474 * @brief Sum of the squares of the elements of a floating-point vector.
Kojto 123:b0220dba8be7 6475 * @param[in] *pSrc is input pointer
Kojto 123:b0220dba8be7 6476 * @param[in] blockSize is the number of samples to process
Kojto 123:b0220dba8be7 6477 * @param[out] *pResult is output value.
Kojto 123:b0220dba8be7 6478 * @return none.
Kojto 123:b0220dba8be7 6479 */
Kojto 123:b0220dba8be7 6480
Kojto 123:b0220dba8be7 6481 void arm_power_f32(
Kojto 123:b0220dba8be7 6482 float32_t * pSrc,
Kojto 123:b0220dba8be7 6483 uint32_t blockSize,
Kojto 123:b0220dba8be7 6484 float32_t * pResult);
Kojto 123:b0220dba8be7 6485
Kojto 123:b0220dba8be7 6486 /**
Kojto 123:b0220dba8be7 6487 * @brief Sum of the squares of the elements of a Q15 vector.
Kojto 123:b0220dba8be7 6488 * @param[in] *pSrc is input pointer
Kojto 123:b0220dba8be7 6489 * @param[in] blockSize is the number of samples to process
Kojto 123:b0220dba8be7 6490 * @param[out] *pResult is output value.
Kojto 123:b0220dba8be7 6491 * @return none.
Kojto 123:b0220dba8be7 6492 */
Kojto 123:b0220dba8be7 6493
Kojto 123:b0220dba8be7 6494 void arm_power_q15(
Kojto 123:b0220dba8be7 6495 q15_t * pSrc,
Kojto 123:b0220dba8be7 6496 uint32_t blockSize,
Kojto 123:b0220dba8be7 6497 q63_t * pResult);
Kojto 123:b0220dba8be7 6498
Kojto 123:b0220dba8be7 6499 /**
Kojto 123:b0220dba8be7 6500 * @brief Sum of the squares of the elements of a Q7 vector.
Kojto 123:b0220dba8be7 6501 * @param[in] *pSrc is input pointer
Kojto 123:b0220dba8be7 6502 * @param[in] blockSize is the number of samples to process
Kojto 123:b0220dba8be7 6503 * @param[out] *pResult is output value.
Kojto 123:b0220dba8be7 6504 * @return none.
Kojto 123:b0220dba8be7 6505 */
Kojto 123:b0220dba8be7 6506
Kojto 123:b0220dba8be7 6507 void arm_power_q7(
Kojto 123:b0220dba8be7 6508 q7_t * pSrc,
Kojto 123:b0220dba8be7 6509 uint32_t blockSize,
Kojto 123:b0220dba8be7 6510 q31_t * pResult);
Kojto 123:b0220dba8be7 6511
Kojto 123:b0220dba8be7 6512 /**
Kojto 123:b0220dba8be7 6513 * @brief Mean value of a Q7 vector.
Kojto 123:b0220dba8be7 6514 * @param[in] *pSrc is input pointer
Kojto 123:b0220dba8be7 6515 * @param[in] blockSize is the number of samples to process
Kojto 123:b0220dba8be7 6516 * @param[out] *pResult is output value.
Kojto 123:b0220dba8be7 6517 * @return none.
Kojto 123:b0220dba8be7 6518 */
Kojto 123:b0220dba8be7 6519
Kojto 123:b0220dba8be7 6520 void arm_mean_q7(
Kojto 123:b0220dba8be7 6521 q7_t * pSrc,
Kojto 123:b0220dba8be7 6522 uint32_t blockSize,
Kojto 123:b0220dba8be7 6523 q7_t * pResult);
Kojto 123:b0220dba8be7 6524
Kojto 123:b0220dba8be7 6525 /**
Kojto 123:b0220dba8be7 6526 * @brief Mean value of a Q15 vector.
Kojto 123:b0220dba8be7 6527 * @param[in] *pSrc is input pointer
Kojto 123:b0220dba8be7 6528 * @param[in] blockSize is the number of samples to process
Kojto 123:b0220dba8be7 6529 * @param[out] *pResult is output value.
Kojto 123:b0220dba8be7 6530 * @return none.
Kojto 123:b0220dba8be7 6531 */
Kojto 123:b0220dba8be7 6532 void arm_mean_q15(
Kojto 123:b0220dba8be7 6533 q15_t * pSrc,
Kojto 123:b0220dba8be7 6534 uint32_t blockSize,
Kojto 123:b0220dba8be7 6535 q15_t * pResult);
Kojto 123:b0220dba8be7 6536
Kojto 123:b0220dba8be7 6537 /**
Kojto 123:b0220dba8be7 6538 * @brief Mean value of a Q31 vector.
Kojto 123:b0220dba8be7 6539 * @param[in] *pSrc is input pointer
Kojto 123:b0220dba8be7 6540 * @param[in] blockSize is the number of samples to process
Kojto 123:b0220dba8be7 6541 * @param[out] *pResult is output value.
Kojto 123:b0220dba8be7 6542 * @return none.
Kojto 123:b0220dba8be7 6543 */
Kojto 123:b0220dba8be7 6544 void arm_mean_q31(
Kojto 123:b0220dba8be7 6545 q31_t * pSrc,
Kojto 123:b0220dba8be7 6546 uint32_t blockSize,
Kojto 123:b0220dba8be7 6547 q31_t * pResult);
Kojto 123:b0220dba8be7 6548
Kojto 123:b0220dba8be7 6549 /**
Kojto 123:b0220dba8be7 6550 * @brief Mean value of a floating-point vector.
Kojto 123:b0220dba8be7 6551 * @param[in] *pSrc is input pointer
Kojto 123:b0220dba8be7 6552 * @param[in] blockSize is the number of samples to process
Kojto 123:b0220dba8be7 6553 * @param[out] *pResult is output value.
Kojto 123:b0220dba8be7 6554 * @return none.
Kojto 123:b0220dba8be7 6555 */
Kojto 123:b0220dba8be7 6556 void arm_mean_f32(
Kojto 123:b0220dba8be7 6557 float32_t * pSrc,
Kojto 123:b0220dba8be7 6558 uint32_t blockSize,
Kojto 123:b0220dba8be7 6559 float32_t * pResult);
Kojto 123:b0220dba8be7 6560
Kojto 123:b0220dba8be7 6561 /**
Kojto 123:b0220dba8be7 6562 * @brief Variance of the elements of a floating-point vector.
Kojto 123:b0220dba8be7 6563 * @param[in] *pSrc is input pointer
Kojto 123:b0220dba8be7 6564 * @param[in] blockSize is the number of samples to process
Kojto 123:b0220dba8be7 6565 * @param[out] *pResult is output value.
Kojto 123:b0220dba8be7 6566 * @return none.
Kojto 123:b0220dba8be7 6567 */
Kojto 123:b0220dba8be7 6568
Kojto 123:b0220dba8be7 6569 void arm_var_f32(
Kojto 123:b0220dba8be7 6570 float32_t * pSrc,
Kojto 123:b0220dba8be7 6571 uint32_t blockSize,
Kojto 123:b0220dba8be7 6572 float32_t * pResult);
Kojto 123:b0220dba8be7 6573
Kojto 123:b0220dba8be7 6574 /**
Kojto 123:b0220dba8be7 6575 * @brief Variance of the elements of a Q31 vector.
Kojto 123:b0220dba8be7 6576 * @param[in] *pSrc is input pointer
Kojto 123:b0220dba8be7 6577 * @param[in] blockSize is the number of samples to process
Kojto 123:b0220dba8be7 6578 * @param[out] *pResult is output value.
Kojto 123:b0220dba8be7 6579 * @return none.
Kojto 123:b0220dba8be7 6580 */
Kojto 123:b0220dba8be7 6581
Kojto 123:b0220dba8be7 6582 void arm_var_q31(
Kojto 123:b0220dba8be7 6583 q31_t * pSrc,
Kojto 123:b0220dba8be7 6584 uint32_t blockSize,
Kojto 123:b0220dba8be7 6585 q31_t * pResult);
Kojto 123:b0220dba8be7 6586
Kojto 123:b0220dba8be7 6587 /**
Kojto 123:b0220dba8be7 6588 * @brief Variance of the elements of a Q15 vector.
Kojto 123:b0220dba8be7 6589 * @param[in] *pSrc is input pointer
Kojto 123:b0220dba8be7 6590 * @param[in] blockSize is the number of samples to process
Kojto 123:b0220dba8be7 6591 * @param[out] *pResult is output value.
Kojto 123:b0220dba8be7 6592 * @return none.
Kojto 123:b0220dba8be7 6593 */
Kojto 123:b0220dba8be7 6594
Kojto 123:b0220dba8be7 6595 void arm_var_q15(
Kojto 123:b0220dba8be7 6596 q15_t * pSrc,
Kojto 123:b0220dba8be7 6597 uint32_t blockSize,
Kojto 123:b0220dba8be7 6598 q15_t * pResult);
Kojto 123:b0220dba8be7 6599
Kojto 123:b0220dba8be7 6600 /**
Kojto 123:b0220dba8be7 6601 * @brief Root Mean Square of the elements of a floating-point vector.
Kojto 123:b0220dba8be7 6602 * @param[in] *pSrc is input pointer
Kojto 123:b0220dba8be7 6603 * @param[in] blockSize is the number of samples to process
Kojto 123:b0220dba8be7 6604 * @param[out] *pResult is output value.
Kojto 123:b0220dba8be7 6605 * @return none.
Kojto 123:b0220dba8be7 6606 */
Kojto 123:b0220dba8be7 6607
Kojto 123:b0220dba8be7 6608 void arm_rms_f32(
Kojto 123:b0220dba8be7 6609 float32_t * pSrc,
Kojto 123:b0220dba8be7 6610 uint32_t blockSize,
Kojto 123:b0220dba8be7 6611 float32_t * pResult);
Kojto 123:b0220dba8be7 6612
Kojto 123:b0220dba8be7 6613 /**
Kojto 123:b0220dba8be7 6614 * @brief Root Mean Square of the elements of a Q31 vector.
Kojto 123:b0220dba8be7 6615 * @param[in] *pSrc is input pointer
Kojto 123:b0220dba8be7 6616 * @param[in] blockSize is the number of samples to process
Kojto 123:b0220dba8be7 6617 * @param[out] *pResult is output value.
Kojto 123:b0220dba8be7 6618 * @return none.
Kojto 123:b0220dba8be7 6619 */
Kojto 123:b0220dba8be7 6620
Kojto 123:b0220dba8be7 6621 void arm_rms_q31(
Kojto 123:b0220dba8be7 6622 q31_t * pSrc,
Kojto 123:b0220dba8be7 6623 uint32_t blockSize,
Kojto 123:b0220dba8be7 6624 q31_t * pResult);
Kojto 123:b0220dba8be7 6625
Kojto 123:b0220dba8be7 6626 /**
Kojto 123:b0220dba8be7 6627 * @brief Root Mean Square of the elements of a Q15 vector.
Kojto 123:b0220dba8be7 6628 * @param[in] *pSrc is input pointer
Kojto 123:b0220dba8be7 6629 * @param[in] blockSize is the number of samples to process
Kojto 123:b0220dba8be7 6630 * @param[out] *pResult is output value.
Kojto 123:b0220dba8be7 6631 * @return none.
Kojto 123:b0220dba8be7 6632 */
Kojto 123:b0220dba8be7 6633
Kojto 123:b0220dba8be7 6634 void arm_rms_q15(
Kojto 123:b0220dba8be7 6635 q15_t * pSrc,
Kojto 123:b0220dba8be7 6636 uint32_t blockSize,
Kojto 123:b0220dba8be7 6637 q15_t * pResult);
Kojto 123:b0220dba8be7 6638
Kojto 123:b0220dba8be7 6639 /**
Kojto 123:b0220dba8be7 6640 * @brief Standard deviation of the elements of a floating-point vector.
Kojto 123:b0220dba8be7 6641 * @param[in] *pSrc is input pointer
Kojto 123:b0220dba8be7 6642 * @param[in] blockSize is the number of samples to process
Kojto 123:b0220dba8be7 6643 * @param[out] *pResult is output value.
Kojto 123:b0220dba8be7 6644 * @return none.
Kojto 123:b0220dba8be7 6645 */
Kojto 123:b0220dba8be7 6646
Kojto 123:b0220dba8be7 6647 void arm_std_f32(
Kojto 123:b0220dba8be7 6648 float32_t * pSrc,
Kojto 123:b0220dba8be7 6649 uint32_t blockSize,
Kojto 123:b0220dba8be7 6650 float32_t * pResult);
Kojto 123:b0220dba8be7 6651
Kojto 123:b0220dba8be7 6652 /**
Kojto 123:b0220dba8be7 6653 * @brief Standard deviation of the elements of a Q31 vector.
Kojto 123:b0220dba8be7 6654 * @param[in] *pSrc is input pointer
Kojto 123:b0220dba8be7 6655 * @param[in] blockSize is the number of samples to process
Kojto 123:b0220dba8be7 6656 * @param[out] *pResult is output value.
Kojto 123:b0220dba8be7 6657 * @return none.
Kojto 123:b0220dba8be7 6658 */
Kojto 123:b0220dba8be7 6659
Kojto 123:b0220dba8be7 6660 void arm_std_q31(
Kojto 123:b0220dba8be7 6661 q31_t * pSrc,
Kojto 123:b0220dba8be7 6662 uint32_t blockSize,
Kojto 123:b0220dba8be7 6663 q31_t * pResult);
Kojto 123:b0220dba8be7 6664
Kojto 123:b0220dba8be7 6665 /**
Kojto 123:b0220dba8be7 6666 * @brief Standard deviation of the elements of a Q15 vector.
Kojto 123:b0220dba8be7 6667 * @param[in] *pSrc is input pointer
Kojto 123:b0220dba8be7 6668 * @param[in] blockSize is the number of samples to process
Kojto 123:b0220dba8be7 6669 * @param[out] *pResult is output value.
Kojto 123:b0220dba8be7 6670 * @return none.
Kojto 123:b0220dba8be7 6671 */
Kojto 123:b0220dba8be7 6672
Kojto 123:b0220dba8be7 6673 void arm_std_q15(
Kojto 123:b0220dba8be7 6674 q15_t * pSrc,
Kojto 123:b0220dba8be7 6675 uint32_t blockSize,
Kojto 123:b0220dba8be7 6676 q15_t * pResult);
Kojto 123:b0220dba8be7 6677
Kojto 123:b0220dba8be7 6678 /**
Kojto 123:b0220dba8be7 6679 * @brief Floating-point complex magnitude
Kojto 123:b0220dba8be7 6680 * @param[in] *pSrc points to the complex input vector
Kojto 123:b0220dba8be7 6681 * @param[out] *pDst points to the real output vector
Kojto 123:b0220dba8be7 6682 * @param[in] numSamples number of complex samples in the input vector
Kojto 123:b0220dba8be7 6683 * @return none.
Kojto 123:b0220dba8be7 6684 */
Kojto 123:b0220dba8be7 6685
Kojto 123:b0220dba8be7 6686 void arm_cmplx_mag_f32(
Kojto 123:b0220dba8be7 6687 float32_t * pSrc,
Kojto 123:b0220dba8be7 6688 float32_t * pDst,
Kojto 123:b0220dba8be7 6689 uint32_t numSamples);
Kojto 123:b0220dba8be7 6690
Kojto 123:b0220dba8be7 6691 /**
Kojto 123:b0220dba8be7 6692 * @brief Q31 complex magnitude
Kojto 123:b0220dba8be7 6693 * @param[in] *pSrc points to the complex input vector
Kojto 123:b0220dba8be7 6694 * @param[out] *pDst points to the real output vector
Kojto 123:b0220dba8be7 6695 * @param[in] numSamples number of complex samples in the input vector
Kojto 123:b0220dba8be7 6696 * @return none.
Kojto 123:b0220dba8be7 6697 */
Kojto 123:b0220dba8be7 6698
Kojto 123:b0220dba8be7 6699 void arm_cmplx_mag_q31(
Kojto 123:b0220dba8be7 6700 q31_t * pSrc,
Kojto 123:b0220dba8be7 6701 q31_t * pDst,
Kojto 123:b0220dba8be7 6702 uint32_t numSamples);
Kojto 123:b0220dba8be7 6703
Kojto 123:b0220dba8be7 6704 /**
Kojto 123:b0220dba8be7 6705 * @brief Q15 complex magnitude
Kojto 123:b0220dba8be7 6706 * @param[in] *pSrc points to the complex input vector
Kojto 123:b0220dba8be7 6707 * @param[out] *pDst points to the real output vector
Kojto 123:b0220dba8be7 6708 * @param[in] numSamples number of complex samples in the input vector
Kojto 123:b0220dba8be7 6709 * @return none.
Kojto 123:b0220dba8be7 6710 */
Kojto 123:b0220dba8be7 6711
Kojto 123:b0220dba8be7 6712 void arm_cmplx_mag_q15(
Kojto 123:b0220dba8be7 6713 q15_t * pSrc,
Kojto 123:b0220dba8be7 6714 q15_t * pDst,
Kojto 123:b0220dba8be7 6715 uint32_t numSamples);
Kojto 123:b0220dba8be7 6716
Kojto 123:b0220dba8be7 6717 /**
Kojto 123:b0220dba8be7 6718 * @brief Q15 complex dot product
Kojto 123:b0220dba8be7 6719 * @param[in] *pSrcA points to the first input vector
Kojto 123:b0220dba8be7 6720 * @param[in] *pSrcB points to the second input vector
Kojto 123:b0220dba8be7 6721 * @param[in] numSamples number of complex samples in each vector
Kojto 123:b0220dba8be7 6722 * @param[out] *realResult real part of the result returned here
Kojto 123:b0220dba8be7 6723 * @param[out] *imagResult imaginary part of the result returned here
Kojto 123:b0220dba8be7 6724 * @return none.
Kojto 123:b0220dba8be7 6725 */
Kojto 123:b0220dba8be7 6726
Kojto 123:b0220dba8be7 6727 void arm_cmplx_dot_prod_q15(
Kojto 123:b0220dba8be7 6728 q15_t * pSrcA,
Kojto 123:b0220dba8be7 6729 q15_t * pSrcB,
Kojto 123:b0220dba8be7 6730 uint32_t numSamples,
Kojto 123:b0220dba8be7 6731 q31_t * realResult,
Kojto 123:b0220dba8be7 6732 q31_t * imagResult);
Kojto 123:b0220dba8be7 6733
Kojto 123:b0220dba8be7 6734 /**
Kojto 123:b0220dba8be7 6735 * @brief Q31 complex dot product
Kojto 123:b0220dba8be7 6736 * @param[in] *pSrcA points to the first input vector
Kojto 123:b0220dba8be7 6737 * @param[in] *pSrcB points to the second input vector
Kojto 123:b0220dba8be7 6738 * @param[in] numSamples number of complex samples in each vector
Kojto 123:b0220dba8be7 6739 * @param[out] *realResult real part of the result returned here
Kojto 123:b0220dba8be7 6740 * @param[out] *imagResult imaginary part of the result returned here
Kojto 123:b0220dba8be7 6741 * @return none.
Kojto 123:b0220dba8be7 6742 */
Kojto 123:b0220dba8be7 6743
Kojto 123:b0220dba8be7 6744 void arm_cmplx_dot_prod_q31(
Kojto 123:b0220dba8be7 6745 q31_t * pSrcA,
Kojto 123:b0220dba8be7 6746 q31_t * pSrcB,
Kojto 123:b0220dba8be7 6747 uint32_t numSamples,
Kojto 123:b0220dba8be7 6748 q63_t * realResult,
Kojto 123:b0220dba8be7 6749 q63_t * imagResult);
Kojto 123:b0220dba8be7 6750
Kojto 123:b0220dba8be7 6751 /**
Kojto 123:b0220dba8be7 6752 * @brief Floating-point complex dot product
Kojto 123:b0220dba8be7 6753 * @param[in] *pSrcA points to the first input vector
Kojto 123:b0220dba8be7 6754 * @param[in] *pSrcB points to the second input vector
Kojto 123:b0220dba8be7 6755 * @param[in] numSamples number of complex samples in each vector
Kojto 123:b0220dba8be7 6756 * @param[out] *realResult real part of the result returned here
Kojto 123:b0220dba8be7 6757 * @param[out] *imagResult imaginary part of the result returned here
Kojto 123:b0220dba8be7 6758 * @return none.
Kojto 123:b0220dba8be7 6759 */
Kojto 123:b0220dba8be7 6760
Kojto 123:b0220dba8be7 6761 void arm_cmplx_dot_prod_f32(
Kojto 123:b0220dba8be7 6762 float32_t * pSrcA,
Kojto 123:b0220dba8be7 6763 float32_t * pSrcB,
Kojto 123:b0220dba8be7 6764 uint32_t numSamples,
Kojto 123:b0220dba8be7 6765 float32_t * realResult,
Kojto 123:b0220dba8be7 6766 float32_t * imagResult);
Kojto 123:b0220dba8be7 6767
Kojto 123:b0220dba8be7 6768 /**
Kojto 123:b0220dba8be7 6769 * @brief Q15 complex-by-real multiplication
Kojto 123:b0220dba8be7 6770 * @param[in] *pSrcCmplx points to the complex input vector
Kojto 123:b0220dba8be7 6771 * @param[in] *pSrcReal points to the real input vector
Kojto 123:b0220dba8be7 6772 * @param[out] *pCmplxDst points to the complex output vector
Kojto 123:b0220dba8be7 6773 * @param[in] numSamples number of samples in each vector
Kojto 123:b0220dba8be7 6774 * @return none.
Kojto 123:b0220dba8be7 6775 */
Kojto 123:b0220dba8be7 6776
Kojto 123:b0220dba8be7 6777 void arm_cmplx_mult_real_q15(
Kojto 123:b0220dba8be7 6778 q15_t * pSrcCmplx,
Kojto 123:b0220dba8be7 6779 q15_t * pSrcReal,
Kojto 123:b0220dba8be7 6780 q15_t * pCmplxDst,
Kojto 123:b0220dba8be7 6781 uint32_t numSamples);
Kojto 123:b0220dba8be7 6782
Kojto 123:b0220dba8be7 6783 /**
Kojto 123:b0220dba8be7 6784 * @brief Q31 complex-by-real multiplication
Kojto 123:b0220dba8be7 6785 * @param[in] *pSrcCmplx points to the complex input vector
Kojto 123:b0220dba8be7 6786 * @param[in] *pSrcReal points to the real input vector
Kojto 123:b0220dba8be7 6787 * @param[out] *pCmplxDst points to the complex output vector
Kojto 123:b0220dba8be7 6788 * @param[in] numSamples number of samples in each vector
Kojto 123:b0220dba8be7 6789 * @return none.
Kojto 123:b0220dba8be7 6790 */
Kojto 123:b0220dba8be7 6791
Kojto 123:b0220dba8be7 6792 void arm_cmplx_mult_real_q31(
Kojto 123:b0220dba8be7 6793 q31_t * pSrcCmplx,
Kojto 123:b0220dba8be7 6794 q31_t * pSrcReal,
Kojto 123:b0220dba8be7 6795 q31_t * pCmplxDst,
Kojto 123:b0220dba8be7 6796 uint32_t numSamples);
Kojto 123:b0220dba8be7 6797
Kojto 123:b0220dba8be7 6798 /**
Kojto 123:b0220dba8be7 6799 * @brief Floating-point complex-by-real multiplication
Kojto 123:b0220dba8be7 6800 * @param[in] *pSrcCmplx points to the complex input vector
Kojto 123:b0220dba8be7 6801 * @param[in] *pSrcReal points to the real input vector
Kojto 123:b0220dba8be7 6802 * @param[out] *pCmplxDst points to the complex output vector
Kojto 123:b0220dba8be7 6803 * @param[in] numSamples number of samples in each vector
Kojto 123:b0220dba8be7 6804 * @return none.
Kojto 123:b0220dba8be7 6805 */
Kojto 123:b0220dba8be7 6806
Kojto 123:b0220dba8be7 6807 void arm_cmplx_mult_real_f32(
Kojto 123:b0220dba8be7 6808 float32_t * pSrcCmplx,
Kojto 123:b0220dba8be7 6809 float32_t * pSrcReal,
Kojto 123:b0220dba8be7 6810 float32_t * pCmplxDst,
Kojto 123:b0220dba8be7 6811 uint32_t numSamples);
Kojto 123:b0220dba8be7 6812
Kojto 123:b0220dba8be7 6813 /**
Kojto 123:b0220dba8be7 6814 * @brief Minimum value of a Q7 vector.
Kojto 123:b0220dba8be7 6815 * @param[in] *pSrc is input pointer
Kojto 123:b0220dba8be7 6816 * @param[in] blockSize is the number of samples to process
Kojto 123:b0220dba8be7 6817 * @param[out] *result is output pointer
Kojto 123:b0220dba8be7 6818 * @param[in] index is the array index of the minimum value in the input buffer.
Kojto 123:b0220dba8be7 6819 * @return none.
Kojto 123:b0220dba8be7 6820 */
Kojto 123:b0220dba8be7 6821
Kojto 123:b0220dba8be7 6822 void arm_min_q7(
Kojto 123:b0220dba8be7 6823 q7_t * pSrc,
Kojto 123:b0220dba8be7 6824 uint32_t blockSize,
Kojto 123:b0220dba8be7 6825 q7_t * result,
Kojto 123:b0220dba8be7 6826 uint32_t * index);
Kojto 123:b0220dba8be7 6827
Kojto 123:b0220dba8be7 6828 /**
Kojto 123:b0220dba8be7 6829 * @brief Minimum value of a Q15 vector.
Kojto 123:b0220dba8be7 6830 * @param[in] *pSrc is input pointer
Kojto 123:b0220dba8be7 6831 * @param[in] blockSize is the number of samples to process
Kojto 123:b0220dba8be7 6832 * @param[out] *pResult is output pointer
Kojto 123:b0220dba8be7 6833 * @param[in] *pIndex is the array index of the minimum value in the input buffer.
Kojto 123:b0220dba8be7 6834 * @return none.
Kojto 123:b0220dba8be7 6835 */
Kojto 123:b0220dba8be7 6836
Kojto 123:b0220dba8be7 6837 void arm_min_q15(
Kojto 123:b0220dba8be7 6838 q15_t * pSrc,
Kojto 123:b0220dba8be7 6839 uint32_t blockSize,
Kojto 123:b0220dba8be7 6840 q15_t * pResult,
Kojto 123:b0220dba8be7 6841 uint32_t * pIndex);
Kojto 123:b0220dba8be7 6842
Kojto 123:b0220dba8be7 6843 /**
Kojto 123:b0220dba8be7 6844 * @brief Minimum value of a Q31 vector.
Kojto 123:b0220dba8be7 6845 * @param[in] *pSrc is input pointer
Kojto 123:b0220dba8be7 6846 * @param[in] blockSize is the number of samples to process
Kojto 123:b0220dba8be7 6847 * @param[out] *pResult is output pointer
Kojto 123:b0220dba8be7 6848 * @param[out] *pIndex is the array index of the minimum value in the input buffer.
Kojto 123:b0220dba8be7 6849 * @return none.
Kojto 123:b0220dba8be7 6850 */
Kojto 123:b0220dba8be7 6851 void arm_min_q31(
Kojto 123:b0220dba8be7 6852 q31_t * pSrc,
Kojto 123:b0220dba8be7 6853 uint32_t blockSize,
Kojto 123:b0220dba8be7 6854 q31_t * pResult,
Kojto 123:b0220dba8be7 6855 uint32_t * pIndex);
Kojto 123:b0220dba8be7 6856
Kojto 123:b0220dba8be7 6857 /**
Kojto 123:b0220dba8be7 6858 * @brief Minimum value of a floating-point vector.
Kojto 123:b0220dba8be7 6859 * @param[in] *pSrc is input pointer
Kojto 123:b0220dba8be7 6860 * @param[in] blockSize is the number of samples to process
Kojto 123:b0220dba8be7 6861 * @param[out] *pResult is output pointer
Kojto 123:b0220dba8be7 6862 * @param[out] *pIndex is the array index of the minimum value in the input buffer.
Kojto 123:b0220dba8be7 6863 * @return none.
Kojto 123:b0220dba8be7 6864 */
Kojto 123:b0220dba8be7 6865
Kojto 123:b0220dba8be7 6866 void arm_min_f32(
Kojto 123:b0220dba8be7 6867 float32_t * pSrc,
Kojto 123:b0220dba8be7 6868 uint32_t blockSize,
Kojto 123:b0220dba8be7 6869 float32_t * pResult,
Kojto 123:b0220dba8be7 6870 uint32_t * pIndex);
Kojto 123:b0220dba8be7 6871
Kojto 123:b0220dba8be7 6872 /**
Kojto 123:b0220dba8be7 6873 * @brief Maximum value of a Q7 vector.
Kojto 123:b0220dba8be7 6874 * @param[in] *pSrc points to the input buffer
Kojto 123:b0220dba8be7 6875 * @param[in] blockSize length of the input vector
Kojto 123:b0220dba8be7 6876 * @param[out] *pResult maximum value returned here
Kojto 123:b0220dba8be7 6877 * @param[out] *pIndex index of maximum value returned here
Kojto 123:b0220dba8be7 6878 * @return none.
Kojto 123:b0220dba8be7 6879 */
Kojto 123:b0220dba8be7 6880
Kojto 123:b0220dba8be7 6881 void arm_max_q7(
Kojto 123:b0220dba8be7 6882 q7_t * pSrc,
Kojto 123:b0220dba8be7 6883 uint32_t blockSize,
Kojto 123:b0220dba8be7 6884 q7_t * pResult,
Kojto 123:b0220dba8be7 6885 uint32_t * pIndex);
Kojto 123:b0220dba8be7 6886
Kojto 123:b0220dba8be7 6887 /**
Kojto 123:b0220dba8be7 6888 * @brief Maximum value of a Q15 vector.
Kojto 123:b0220dba8be7 6889 * @param[in] *pSrc points to the input buffer
Kojto 123:b0220dba8be7 6890 * @param[in] blockSize length of the input vector
Kojto 123:b0220dba8be7 6891 * @param[out] *pResult maximum value returned here
Kojto 123:b0220dba8be7 6892 * @param[out] *pIndex index of maximum value returned here
Kojto 123:b0220dba8be7 6893 * @return none.
Kojto 123:b0220dba8be7 6894 */
Kojto 123:b0220dba8be7 6895
Kojto 123:b0220dba8be7 6896 void arm_max_q15(
Kojto 123:b0220dba8be7 6897 q15_t * pSrc,
Kojto 123:b0220dba8be7 6898 uint32_t blockSize,
Kojto 123:b0220dba8be7 6899 q15_t * pResult,
Kojto 123:b0220dba8be7 6900 uint32_t * pIndex);
Kojto 123:b0220dba8be7 6901
Kojto 123:b0220dba8be7 6902 /**
Kojto 123:b0220dba8be7 6903 * @brief Maximum value of a Q31 vector.
Kojto 123:b0220dba8be7 6904 * @param[in] *pSrc points to the input buffer
Kojto 123:b0220dba8be7 6905 * @param[in] blockSize length of the input vector
Kojto 123:b0220dba8be7 6906 * @param[out] *pResult maximum value returned here
Kojto 123:b0220dba8be7 6907 * @param[out] *pIndex index of maximum value returned here
Kojto 123:b0220dba8be7 6908 * @return none.
Kojto 123:b0220dba8be7 6909 */
Kojto 123:b0220dba8be7 6910
Kojto 123:b0220dba8be7 6911 void arm_max_q31(
Kojto 123:b0220dba8be7 6912 q31_t * pSrc,
Kojto 123:b0220dba8be7 6913 uint32_t blockSize,
Kojto 123:b0220dba8be7 6914 q31_t * pResult,
Kojto 123:b0220dba8be7 6915 uint32_t * pIndex);
Kojto 123:b0220dba8be7 6916
Kojto 123:b0220dba8be7 6917 /**
Kojto 123:b0220dba8be7 6918 * @brief Maximum value of a floating-point vector.
Kojto 123:b0220dba8be7 6919 * @param[in] *pSrc points to the input buffer
Kojto 123:b0220dba8be7 6920 * @param[in] blockSize length of the input vector
Kojto 123:b0220dba8be7 6921 * @param[out] *pResult maximum value returned here
Kojto 123:b0220dba8be7 6922 * @param[out] *pIndex index of maximum value returned here
Kojto 123:b0220dba8be7 6923 * @return none.
Kojto 123:b0220dba8be7 6924 */
Kojto 123:b0220dba8be7 6925
Kojto 123:b0220dba8be7 6926 void arm_max_f32(
Kojto 123:b0220dba8be7 6927 float32_t * pSrc,
Kojto 123:b0220dba8be7 6928 uint32_t blockSize,
Kojto 123:b0220dba8be7 6929 float32_t * pResult,
Kojto 123:b0220dba8be7 6930 uint32_t * pIndex);
Kojto 123:b0220dba8be7 6931
Kojto 123:b0220dba8be7 6932 /**
Kojto 123:b0220dba8be7 6933 * @brief Q15 complex-by-complex multiplication
Kojto 123:b0220dba8be7 6934 * @param[in] *pSrcA points to the first input vector
Kojto 123:b0220dba8be7 6935 * @param[in] *pSrcB points to the second input vector
Kojto 123:b0220dba8be7 6936 * @param[out] *pDst points to the output vector
Kojto 123:b0220dba8be7 6937 * @param[in] numSamples number of complex samples in each vector
Kojto 123:b0220dba8be7 6938 * @return none.
Kojto 123:b0220dba8be7 6939 */
Kojto 123:b0220dba8be7 6940
Kojto 123:b0220dba8be7 6941 void arm_cmplx_mult_cmplx_q15(
Kojto 123:b0220dba8be7 6942 q15_t * pSrcA,
Kojto 123:b0220dba8be7 6943 q15_t * pSrcB,
Kojto 123:b0220dba8be7 6944 q15_t * pDst,
Kojto 123:b0220dba8be7 6945 uint32_t numSamples);
Kojto 123:b0220dba8be7 6946
Kojto 123:b0220dba8be7 6947 /**
Kojto 123:b0220dba8be7 6948 * @brief Q31 complex-by-complex multiplication
Kojto 123:b0220dba8be7 6949 * @param[in] *pSrcA points to the first input vector
Kojto 123:b0220dba8be7 6950 * @param[in] *pSrcB points to the second input vector
Kojto 123:b0220dba8be7 6951 * @param[out] *pDst points to the output vector
Kojto 123:b0220dba8be7 6952 * @param[in] numSamples number of complex samples in each vector
Kojto 123:b0220dba8be7 6953 * @return none.
Kojto 123:b0220dba8be7 6954 */
Kojto 123:b0220dba8be7 6955
Kojto 123:b0220dba8be7 6956 void arm_cmplx_mult_cmplx_q31(
Kojto 123:b0220dba8be7 6957 q31_t * pSrcA,
Kojto 123:b0220dba8be7 6958 q31_t * pSrcB,
Kojto 123:b0220dba8be7 6959 q31_t * pDst,
Kojto 123:b0220dba8be7 6960 uint32_t numSamples);
Kojto 123:b0220dba8be7 6961
Kojto 123:b0220dba8be7 6962 /**
Kojto 123:b0220dba8be7 6963 * @brief Floating-point complex-by-complex multiplication
Kojto 123:b0220dba8be7 6964 * @param[in] *pSrcA points to the first input vector
Kojto 123:b0220dba8be7 6965 * @param[in] *pSrcB points to the second input vector
Kojto 123:b0220dba8be7 6966 * @param[out] *pDst points to the output vector
Kojto 123:b0220dba8be7 6967 * @param[in] numSamples number of complex samples in each vector
Kojto 123:b0220dba8be7 6968 * @return none.
Kojto 123:b0220dba8be7 6969 */
Kojto 123:b0220dba8be7 6970
Kojto 123:b0220dba8be7 6971 void arm_cmplx_mult_cmplx_f32(
Kojto 123:b0220dba8be7 6972 float32_t * pSrcA,
Kojto 123:b0220dba8be7 6973 float32_t * pSrcB,
Kojto 123:b0220dba8be7 6974 float32_t * pDst,
Kojto 123:b0220dba8be7 6975 uint32_t numSamples);
Kojto 123:b0220dba8be7 6976
Kojto 123:b0220dba8be7 6977 /**
Kojto 123:b0220dba8be7 6978 * @brief Converts the elements of the floating-point vector to Q31 vector.
Kojto 123:b0220dba8be7 6979 * @param[in] *pSrc points to the floating-point input vector
Kojto 123:b0220dba8be7 6980 * @param[out] *pDst points to the Q31 output vector
Kojto 123:b0220dba8be7 6981 * @param[in] blockSize length of the input vector
Kojto 123:b0220dba8be7 6982 * @return none.
Kojto 123:b0220dba8be7 6983 */
Kojto 123:b0220dba8be7 6984 void arm_float_to_q31(
Kojto 123:b0220dba8be7 6985 float32_t * pSrc,
Kojto 123:b0220dba8be7 6986 q31_t * pDst,
Kojto 123:b0220dba8be7 6987 uint32_t blockSize);
Kojto 123:b0220dba8be7 6988
Kojto 123:b0220dba8be7 6989 /**
Kojto 123:b0220dba8be7 6990 * @brief Converts the elements of the floating-point vector to Q15 vector.
Kojto 123:b0220dba8be7 6991 * @param[in] *pSrc points to the floating-point input vector
Kojto 123:b0220dba8be7 6992 * @param[out] *pDst points to the Q15 output vector
Kojto 123:b0220dba8be7 6993 * @param[in] blockSize length of the input vector
Kojto 123:b0220dba8be7 6994 * @return none
Kojto 123:b0220dba8be7 6995 */
Kojto 123:b0220dba8be7 6996 void arm_float_to_q15(
Kojto 123:b0220dba8be7 6997 float32_t * pSrc,
Kojto 123:b0220dba8be7 6998 q15_t * pDst,
Kojto 123:b0220dba8be7 6999 uint32_t blockSize);
Kojto 123:b0220dba8be7 7000
Kojto 123:b0220dba8be7 7001 /**
Kojto 123:b0220dba8be7 7002 * @brief Converts the elements of the floating-point vector to Q7 vector.
Kojto 123:b0220dba8be7 7003 * @param[in] *pSrc points to the floating-point input vector
Kojto 123:b0220dba8be7 7004 * @param[out] *pDst points to the Q7 output vector
Kojto 123:b0220dba8be7 7005 * @param[in] blockSize length of the input vector
Kojto 123:b0220dba8be7 7006 * @return none
Kojto 123:b0220dba8be7 7007 */
Kojto 123:b0220dba8be7 7008 void arm_float_to_q7(
Kojto 123:b0220dba8be7 7009 float32_t * pSrc,
Kojto 123:b0220dba8be7 7010 q7_t * pDst,
Kojto 123:b0220dba8be7 7011 uint32_t blockSize);
Kojto 123:b0220dba8be7 7012
Kojto 123:b0220dba8be7 7013
Kojto 123:b0220dba8be7 7014 /**
Kojto 123:b0220dba8be7 7015 * @brief Converts the elements of the Q31 vector to Q15 vector.
Kojto 123:b0220dba8be7 7016 * @param[in] *pSrc is input pointer
Kojto 123:b0220dba8be7 7017 * @param[out] *pDst is output pointer
Kojto 123:b0220dba8be7 7018 * @param[in] blockSize is the number of samples to process
Kojto 123:b0220dba8be7 7019 * @return none.
Kojto 123:b0220dba8be7 7020 */
Kojto 123:b0220dba8be7 7021 void arm_q31_to_q15(
Kojto 123:b0220dba8be7 7022 q31_t * pSrc,
Kojto 123:b0220dba8be7 7023 q15_t * pDst,
Kojto 123:b0220dba8be7 7024 uint32_t blockSize);
Kojto 123:b0220dba8be7 7025
Kojto 123:b0220dba8be7 7026 /**
Kojto 123:b0220dba8be7 7027 * @brief Converts the elements of the Q31 vector to Q7 vector.
Kojto 123:b0220dba8be7 7028 * @param[in] *pSrc is input pointer
Kojto 123:b0220dba8be7 7029 * @param[out] *pDst is output pointer
Kojto 123:b0220dba8be7 7030 * @param[in] blockSize is the number of samples to process
Kojto 123:b0220dba8be7 7031 * @return none.
Kojto 123:b0220dba8be7 7032 */
Kojto 123:b0220dba8be7 7033 void arm_q31_to_q7(
Kojto 123:b0220dba8be7 7034 q31_t * pSrc,
Kojto 123:b0220dba8be7 7035 q7_t * pDst,
Kojto 123:b0220dba8be7 7036 uint32_t blockSize);
Kojto 123:b0220dba8be7 7037
Kojto 123:b0220dba8be7 7038 /**
Kojto 123:b0220dba8be7 7039 * @brief Converts the elements of the Q15 vector to floating-point vector.
Kojto 123:b0220dba8be7 7040 * @param[in] *pSrc is input pointer
Kojto 123:b0220dba8be7 7041 * @param[out] *pDst is output pointer
Kojto 123:b0220dba8be7 7042 * @param[in] blockSize is the number of samples to process
Kojto 123:b0220dba8be7 7043 * @return none.
Kojto 123:b0220dba8be7 7044 */
Kojto 123:b0220dba8be7 7045 void arm_q15_to_float(
Kojto 123:b0220dba8be7 7046 q15_t * pSrc,
Kojto 123:b0220dba8be7 7047 float32_t * pDst,
Kojto 123:b0220dba8be7 7048 uint32_t blockSize);
Kojto 123:b0220dba8be7 7049
Kojto 123:b0220dba8be7 7050
Kojto 123:b0220dba8be7 7051 /**
Kojto 123:b0220dba8be7 7052 * @brief Converts the elements of the Q15 vector to Q31 vector.
Kojto 123:b0220dba8be7 7053 * @param[in] *pSrc is input pointer
Kojto 123:b0220dba8be7 7054 * @param[out] *pDst is output pointer
Kojto 123:b0220dba8be7 7055 * @param[in] blockSize is the number of samples to process
Kojto 123:b0220dba8be7 7056 * @return none.
Kojto 123:b0220dba8be7 7057 */
Kojto 123:b0220dba8be7 7058 void arm_q15_to_q31(
Kojto 123:b0220dba8be7 7059 q15_t * pSrc,
Kojto 123:b0220dba8be7 7060 q31_t * pDst,
Kojto 123:b0220dba8be7 7061 uint32_t blockSize);
Kojto 123:b0220dba8be7 7062
Kojto 123:b0220dba8be7 7063
Kojto 123:b0220dba8be7 7064 /**
Kojto 123:b0220dba8be7 7065 * @brief Converts the elements of the Q15 vector to Q7 vector.
Kojto 123:b0220dba8be7 7066 * @param[in] *pSrc is input pointer
Kojto 123:b0220dba8be7 7067 * @param[out] *pDst is output pointer
Kojto 123:b0220dba8be7 7068 * @param[in] blockSize is the number of samples to process
Kojto 123:b0220dba8be7 7069 * @return none.
Kojto 123:b0220dba8be7 7070 */
Kojto 123:b0220dba8be7 7071 void arm_q15_to_q7(
Kojto 123:b0220dba8be7 7072 q15_t * pSrc,
Kojto 123:b0220dba8be7 7073 q7_t * pDst,
Kojto 123:b0220dba8be7 7074 uint32_t blockSize);
Kojto 123:b0220dba8be7 7075
Kojto 123:b0220dba8be7 7076
Kojto 123:b0220dba8be7 7077 /**
Kojto 123:b0220dba8be7 7078 * @ingroup groupInterpolation
Kojto 123:b0220dba8be7 7079 */
Kojto 123:b0220dba8be7 7080
Kojto 123:b0220dba8be7 7081 /**
Kojto 123:b0220dba8be7 7082 * @defgroup BilinearInterpolate Bilinear Interpolation
Kojto 123:b0220dba8be7 7083 *
Kojto 123:b0220dba8be7 7084 * Bilinear interpolation is an extension of linear interpolation applied to a two dimensional grid.
Kojto 123:b0220dba8be7 7085 * The underlying function <code>f(x, y)</code> is sampled on a regular grid and the interpolation process
Kojto 123:b0220dba8be7 7086 * determines values between the grid points.
Kojto 123:b0220dba8be7 7087 * Bilinear interpolation is equivalent to two step linear interpolation, first in the x-dimension and then in the y-dimension.
Kojto 123:b0220dba8be7 7088 * Bilinear interpolation is often used in image processing to rescale images.
Kojto 123:b0220dba8be7 7089 * The CMSIS DSP library provides bilinear interpolation functions for Q7, Q15, Q31, and floating-point data types.
Kojto 123:b0220dba8be7 7090 *
Kojto 123:b0220dba8be7 7091 * <b>Algorithm</b>
Kojto 123:b0220dba8be7 7092 * \par
Kojto 123:b0220dba8be7 7093 * The instance structure used by the bilinear interpolation functions describes a two dimensional data table.
Kojto 123:b0220dba8be7 7094 * For floating-point, the instance structure is defined as:
Kojto 123:b0220dba8be7 7095 * <pre>
Kojto 123:b0220dba8be7 7096 * typedef struct
Kojto 123:b0220dba8be7 7097 * {
Kojto 123:b0220dba8be7 7098 * uint16_t numRows;
Kojto 123:b0220dba8be7 7099 * uint16_t numCols;
Kojto 123:b0220dba8be7 7100 * float32_t *pData;
Kojto 123:b0220dba8be7 7101 * } arm_bilinear_interp_instance_f32;
Kojto 123:b0220dba8be7 7102 * </pre>
Kojto 123:b0220dba8be7 7103 *
Kojto 123:b0220dba8be7 7104 * \par
Kojto 123:b0220dba8be7 7105 * where <code>numRows</code> specifies the number of rows in the table;
Kojto 123:b0220dba8be7 7106 * <code>numCols</code> specifies the number of columns in the table;
Kojto 123:b0220dba8be7 7107 * and <code>pData</code> points to an array of size <code>numRows*numCols</code> values.
Kojto 123:b0220dba8be7 7108 * The data table <code>pTable</code> is organized in row order and the supplied data values fall on integer indexes.
Kojto 123:b0220dba8be7 7109 * That is, table element (x,y) is located at <code>pTable[x + y*numCols]</code> where x and y are integers.
Kojto 123:b0220dba8be7 7110 *
Kojto 123:b0220dba8be7 7111 * \par
Kojto 123:b0220dba8be7 7112 * Let <code>(x, y)</code> specify the desired interpolation point. Then define:
Kojto 123:b0220dba8be7 7113 * <pre>
Kojto 123:b0220dba8be7 7114 * XF = floor(x)
Kojto 123:b0220dba8be7 7115 * YF = floor(y)
Kojto 123:b0220dba8be7 7116 * </pre>
Kojto 123:b0220dba8be7 7117 * \par
Kojto 123:b0220dba8be7 7118 * The interpolated output point is computed as:
Kojto 123:b0220dba8be7 7119 * <pre>
Kojto 123:b0220dba8be7 7120 * f(x, y) = f(XF, YF) * (1-(x-XF)) * (1-(y-YF))
Kojto 123:b0220dba8be7 7121 * + f(XF+1, YF) * (x-XF)*(1-(y-YF))
Kojto 123:b0220dba8be7 7122 * + f(XF, YF+1) * (1-(x-XF))*(y-YF)
Kojto 123:b0220dba8be7 7123 * + f(XF+1, YF+1) * (x-XF)*(y-YF)
Kojto 123:b0220dba8be7 7124 * </pre>
Kojto 123:b0220dba8be7 7125 * Note that the coordinates (x, y) contain integer and fractional components.
Kojto 123:b0220dba8be7 7126 * The integer components specify which portion of the table to use while the
Kojto 123:b0220dba8be7 7127 * fractional components control the interpolation processor.
Kojto 123:b0220dba8be7 7128 *
Kojto 123:b0220dba8be7 7129 * \par
Kojto 123:b0220dba8be7 7130 * if (x,y) are outside of the table boundary, Bilinear interpolation returns zero output.
Kojto 123:b0220dba8be7 7131 */
Kojto 123:b0220dba8be7 7132
Kojto 123:b0220dba8be7 7133 /**
Kojto 123:b0220dba8be7 7134 * @addtogroup BilinearInterpolate
Kojto 123:b0220dba8be7 7135 * @{
Kojto 123:b0220dba8be7 7136 */
Kojto 123:b0220dba8be7 7137
Kojto 123:b0220dba8be7 7138 /**
Kojto 123:b0220dba8be7 7139 *
Kojto 123:b0220dba8be7 7140 * @brief Floating-point bilinear interpolation.
Kojto 123:b0220dba8be7 7141 * @param[in,out] *S points to an instance of the interpolation structure.
Kojto 123:b0220dba8be7 7142 * @param[in] X interpolation coordinate.
Kojto 123:b0220dba8be7 7143 * @param[in] Y interpolation coordinate.
Kojto 123:b0220dba8be7 7144 * @return out interpolated value.
Kojto 123:b0220dba8be7 7145 */
Kojto 123:b0220dba8be7 7146
Kojto 123:b0220dba8be7 7147
Kojto 123:b0220dba8be7 7148 static __INLINE float32_t arm_bilinear_interp_f32(
Kojto 123:b0220dba8be7 7149 const arm_bilinear_interp_instance_f32 * S,
Kojto 123:b0220dba8be7 7150 float32_t X,
Kojto 123:b0220dba8be7 7151 float32_t Y)
Kojto 123:b0220dba8be7 7152 {
Kojto 123:b0220dba8be7 7153 float32_t out;
Kojto 123:b0220dba8be7 7154 float32_t f00, f01, f10, f11;
Kojto 123:b0220dba8be7 7155 float32_t *pData = S->pData;
Kojto 123:b0220dba8be7 7156 int32_t xIndex, yIndex, index;
Kojto 123:b0220dba8be7 7157 float32_t xdiff, ydiff;
Kojto 123:b0220dba8be7 7158 float32_t b1, b2, b3, b4;
Kojto 123:b0220dba8be7 7159
Kojto 123:b0220dba8be7 7160 xIndex = (int32_t) X;
Kojto 123:b0220dba8be7 7161 yIndex = (int32_t) Y;
Kojto 123:b0220dba8be7 7162
Kojto 123:b0220dba8be7 7163 /* Care taken for table outside boundary */
Kojto 123:b0220dba8be7 7164 /* Returns zero output when values are outside table boundary */
Kojto 123:b0220dba8be7 7165 if(xIndex < 0 || xIndex > (S->numRows - 1) || yIndex < 0
Kojto 123:b0220dba8be7 7166 || yIndex > (S->numCols - 1))
Kojto 123:b0220dba8be7 7167 {
Kojto 123:b0220dba8be7 7168 return (0);
Kojto 123:b0220dba8be7 7169 }
Kojto 123:b0220dba8be7 7170
Kojto 123:b0220dba8be7 7171 /* Calculation of index for two nearest points in X-direction */
Kojto 123:b0220dba8be7 7172 index = (xIndex - 1) + (yIndex - 1) * S->numCols;
Kojto 123:b0220dba8be7 7173
Kojto 123:b0220dba8be7 7174
Kojto 123:b0220dba8be7 7175 /* Read two nearest points in X-direction */
Kojto 123:b0220dba8be7 7176 f00 = pData[index];
Kojto 123:b0220dba8be7 7177 f01 = pData[index + 1];
Kojto 123:b0220dba8be7 7178
Kojto 123:b0220dba8be7 7179 /* Calculation of index for two nearest points in Y-direction */
Kojto 123:b0220dba8be7 7180 index = (xIndex - 1) + (yIndex) * S->numCols;
Kojto 123:b0220dba8be7 7181
Kojto 123:b0220dba8be7 7182
Kojto 123:b0220dba8be7 7183 /* Read two nearest points in Y-direction */
Kojto 123:b0220dba8be7 7184 f10 = pData[index];
Kojto 123:b0220dba8be7 7185 f11 = pData[index + 1];
Kojto 123:b0220dba8be7 7186
Kojto 123:b0220dba8be7 7187 /* Calculation of intermediate values */
Kojto 123:b0220dba8be7 7188 b1 = f00;
Kojto 123:b0220dba8be7 7189 b2 = f01 - f00;
Kojto 123:b0220dba8be7 7190 b3 = f10 - f00;
Kojto 123:b0220dba8be7 7191 b4 = f00 - f01 - f10 + f11;
Kojto 123:b0220dba8be7 7192
Kojto 123:b0220dba8be7 7193 /* Calculation of fractional part in X */
Kojto 123:b0220dba8be7 7194 xdiff = X - xIndex;
Kojto 123:b0220dba8be7 7195
Kojto 123:b0220dba8be7 7196 /* Calculation of fractional part in Y */
Kojto 123:b0220dba8be7 7197 ydiff = Y - yIndex;
Kojto 123:b0220dba8be7 7198
Kojto 123:b0220dba8be7 7199 /* Calculation of bi-linear interpolated output */
Kojto 123:b0220dba8be7 7200 out = b1 + b2 * xdiff + b3 * ydiff + b4 * xdiff * ydiff;
Kojto 123:b0220dba8be7 7201
Kojto 123:b0220dba8be7 7202 /* return to application */
Kojto 123:b0220dba8be7 7203 return (out);
Kojto 123:b0220dba8be7 7204
Kojto 123:b0220dba8be7 7205 }
Kojto 123:b0220dba8be7 7206
Kojto 123:b0220dba8be7 7207 /**
Kojto 123:b0220dba8be7 7208 *
Kojto 123:b0220dba8be7 7209 * @brief Q31 bilinear interpolation.
Kojto 123:b0220dba8be7 7210 * @param[in,out] *S points to an instance of the interpolation structure.
Kojto 123:b0220dba8be7 7211 * @param[in] X interpolation coordinate in 12.20 format.
Kojto 123:b0220dba8be7 7212 * @param[in] Y interpolation coordinate in 12.20 format.
Kojto 123:b0220dba8be7 7213 * @return out interpolated value.
Kojto 123:b0220dba8be7 7214 */
Kojto 123:b0220dba8be7 7215
Kojto 123:b0220dba8be7 7216 static __INLINE q31_t arm_bilinear_interp_q31(
Kojto 123:b0220dba8be7 7217 arm_bilinear_interp_instance_q31 * S,
Kojto 123:b0220dba8be7 7218 q31_t X,
Kojto 123:b0220dba8be7 7219 q31_t Y)
Kojto 123:b0220dba8be7 7220 {
Kojto 123:b0220dba8be7 7221 q31_t out; /* Temporary output */
Kojto 123:b0220dba8be7 7222 q31_t acc = 0; /* output */
Kojto 123:b0220dba8be7 7223 q31_t xfract, yfract; /* X, Y fractional parts */
Kojto 123:b0220dba8be7 7224 q31_t x1, x2, y1, y2; /* Nearest output values */
Kojto 123:b0220dba8be7 7225 int32_t rI, cI; /* Row and column indices */
Kojto 123:b0220dba8be7 7226 q31_t *pYData = S->pData; /* pointer to output table values */
Kojto 123:b0220dba8be7 7227 uint32_t nCols = S->numCols; /* num of rows */
Kojto 123:b0220dba8be7 7228
Kojto 123:b0220dba8be7 7229
Kojto 123:b0220dba8be7 7230 /* Input is in 12.20 format */
Kojto 123:b0220dba8be7 7231 /* 12 bits for the table index */
Kojto 123:b0220dba8be7 7232 /* Index value calculation */
Kojto 123:b0220dba8be7 7233 rI = ((X & 0xFFF00000) >> 20u);
Kojto 123:b0220dba8be7 7234
Kojto 123:b0220dba8be7 7235 /* Input is in 12.20 format */
Kojto 123:b0220dba8be7 7236 /* 12 bits for the table index */
Kojto 123:b0220dba8be7 7237 /* Index value calculation */
Kojto 123:b0220dba8be7 7238 cI = ((Y & 0xFFF00000) >> 20u);
Kojto 123:b0220dba8be7 7239
Kojto 123:b0220dba8be7 7240 /* Care taken for table outside boundary */
Kojto 123:b0220dba8be7 7241 /* Returns zero output when values are outside table boundary */
Kojto 123:b0220dba8be7 7242 if(rI < 0 || rI > (S->numRows - 1) || cI < 0 || cI > (S->numCols - 1))
Kojto 123:b0220dba8be7 7243 {
Kojto 123:b0220dba8be7 7244 return (0);
Kojto 123:b0220dba8be7 7245 }
Kojto 123:b0220dba8be7 7246
Kojto 123:b0220dba8be7 7247 /* 20 bits for the fractional part */
Kojto 123:b0220dba8be7 7248 /* shift left xfract by 11 to keep 1.31 format */
Kojto 123:b0220dba8be7 7249 xfract = (X & 0x000FFFFF) << 11u;
Kojto 123:b0220dba8be7 7250
Kojto 123:b0220dba8be7 7251 /* Read two nearest output values from the index */
Kojto 123:b0220dba8be7 7252 x1 = pYData[(rI) + nCols * (cI)];
Kojto 123:b0220dba8be7 7253 x2 = pYData[(rI) + nCols * (cI) + 1u];
Kojto 123:b0220dba8be7 7254
Kojto 123:b0220dba8be7 7255 /* 20 bits for the fractional part */
Kojto 123:b0220dba8be7 7256 /* shift left yfract by 11 to keep 1.31 format */
Kojto 123:b0220dba8be7 7257 yfract = (Y & 0x000FFFFF) << 11u;
Kojto 123:b0220dba8be7 7258
Kojto 123:b0220dba8be7 7259 /* Read two nearest output values from the index */
Kojto 123:b0220dba8be7 7260 y1 = pYData[(rI) + nCols * (cI + 1)];
Kojto 123:b0220dba8be7 7261 y2 = pYData[(rI) + nCols * (cI + 1) + 1u];
Kojto 123:b0220dba8be7 7262
Kojto 123:b0220dba8be7 7263 /* Calculation of x1 * (1-xfract ) * (1-yfract) and acc is in 3.29(q29) format */
Kojto 123:b0220dba8be7 7264 out = ((q31_t) (((q63_t) x1 * (0x7FFFFFFF - xfract)) >> 32));
Kojto 123:b0220dba8be7 7265 acc = ((q31_t) (((q63_t) out * (0x7FFFFFFF - yfract)) >> 32));
Kojto 123:b0220dba8be7 7266
Kojto 123:b0220dba8be7 7267 /* x2 * (xfract) * (1-yfract) in 3.29(q29) and adding to acc */
Kojto 123:b0220dba8be7 7268 out = ((q31_t) ((q63_t) x2 * (0x7FFFFFFF - yfract) >> 32));
Kojto 123:b0220dba8be7 7269 acc += ((q31_t) ((q63_t) out * (xfract) >> 32));
Kojto 123:b0220dba8be7 7270
Kojto 123:b0220dba8be7 7271 /* y1 * (1 - xfract) * (yfract) in 3.29(q29) and adding to acc */
Kojto 123:b0220dba8be7 7272 out = ((q31_t) ((q63_t) y1 * (0x7FFFFFFF - xfract) >> 32));
Kojto 123:b0220dba8be7 7273 acc += ((q31_t) ((q63_t) out * (yfract) >> 32));
Kojto 123:b0220dba8be7 7274
Kojto 123:b0220dba8be7 7275 /* y2 * (xfract) * (yfract) in 3.29(q29) and adding to acc */
Kojto 123:b0220dba8be7 7276 out = ((q31_t) ((q63_t) y2 * (xfract) >> 32));
Kojto 123:b0220dba8be7 7277 acc += ((q31_t) ((q63_t) out * (yfract) >> 32));
Kojto 123:b0220dba8be7 7278
Kojto 123:b0220dba8be7 7279 /* Convert acc to 1.31(q31) format */
Kojto 123:b0220dba8be7 7280 return (acc << 2u);
Kojto 123:b0220dba8be7 7281
Kojto 123:b0220dba8be7 7282 }
Kojto 123:b0220dba8be7 7283
Kojto 123:b0220dba8be7 7284 /**
Kojto 123:b0220dba8be7 7285 * @brief Q15 bilinear interpolation.
Kojto 123:b0220dba8be7 7286 * @param[in,out] *S points to an instance of the interpolation structure.
Kojto 123:b0220dba8be7 7287 * @param[in] X interpolation coordinate in 12.20 format.
Kojto 123:b0220dba8be7 7288 * @param[in] Y interpolation coordinate in 12.20 format.
Kojto 123:b0220dba8be7 7289 * @return out interpolated value.
Kojto 123:b0220dba8be7 7290 */
Kojto 123:b0220dba8be7 7291
Kojto 123:b0220dba8be7 7292 static __INLINE q15_t arm_bilinear_interp_q15(
Kojto 123:b0220dba8be7 7293 arm_bilinear_interp_instance_q15 * S,
Kojto 123:b0220dba8be7 7294 q31_t X,
Kojto 123:b0220dba8be7 7295 q31_t Y)
Kojto 123:b0220dba8be7 7296 {
Kojto 123:b0220dba8be7 7297 q63_t acc = 0; /* output */
Kojto 123:b0220dba8be7 7298 q31_t out; /* Temporary output */
Kojto 123:b0220dba8be7 7299 q15_t x1, x2, y1, y2; /* Nearest output values */
Kojto 123:b0220dba8be7 7300 q31_t xfract, yfract; /* X, Y fractional parts */
Kojto 123:b0220dba8be7 7301 int32_t rI, cI; /* Row and column indices */
Kojto 123:b0220dba8be7 7302 q15_t *pYData = S->pData; /* pointer to output table values */
Kojto 123:b0220dba8be7 7303 uint32_t nCols = S->numCols; /* num of rows */
Kojto 123:b0220dba8be7 7304
Kojto 123:b0220dba8be7 7305 /* Input is in 12.20 format */
Kojto 123:b0220dba8be7 7306 /* 12 bits for the table index */
Kojto 123:b0220dba8be7 7307 /* Index value calculation */
Kojto 123:b0220dba8be7 7308 rI = ((X & 0xFFF00000) >> 20);
Kojto 123:b0220dba8be7 7309
Kojto 123:b0220dba8be7 7310 /* Input is in 12.20 format */
Kojto 123:b0220dba8be7 7311 /* 12 bits for the table index */
Kojto 123:b0220dba8be7 7312 /* Index value calculation */
Kojto 123:b0220dba8be7 7313 cI = ((Y & 0xFFF00000) >> 20);
Kojto 123:b0220dba8be7 7314
Kojto 123:b0220dba8be7 7315 /* Care taken for table outside boundary */
Kojto 123:b0220dba8be7 7316 /* Returns zero output when values are outside table boundary */
Kojto 123:b0220dba8be7 7317 if(rI < 0 || rI > (S->numRows - 1) || cI < 0 || cI > (S->numCols - 1))
Kojto 123:b0220dba8be7 7318 {
Kojto 123:b0220dba8be7 7319 return (0);
Kojto 123:b0220dba8be7 7320 }
Kojto 123:b0220dba8be7 7321
Kojto 123:b0220dba8be7 7322 /* 20 bits for the fractional part */
Kojto 123:b0220dba8be7 7323 /* xfract should be in 12.20 format */
Kojto 123:b0220dba8be7 7324 xfract = (X & 0x000FFFFF);
Kojto 123:b0220dba8be7 7325
Kojto 123:b0220dba8be7 7326 /* Read two nearest output values from the index */
Kojto 123:b0220dba8be7 7327 x1 = pYData[(rI) + nCols * (cI)];
Kojto 123:b0220dba8be7 7328 x2 = pYData[(rI) + nCols * (cI) + 1u];
Kojto 123:b0220dba8be7 7329
Kojto 123:b0220dba8be7 7330
Kojto 123:b0220dba8be7 7331 /* 20 bits for the fractional part */
Kojto 123:b0220dba8be7 7332 /* yfract should be in 12.20 format */
Kojto 123:b0220dba8be7 7333 yfract = (Y & 0x000FFFFF);
Kojto 123:b0220dba8be7 7334
Kojto 123:b0220dba8be7 7335 /* Read two nearest output values from the index */
Kojto 123:b0220dba8be7 7336 y1 = pYData[(rI) + nCols * (cI + 1)];
Kojto 123:b0220dba8be7 7337 y2 = pYData[(rI) + nCols * (cI + 1) + 1u];
Kojto 123:b0220dba8be7 7338
Kojto 123:b0220dba8be7 7339 /* Calculation of x1 * (1-xfract ) * (1-yfract) and acc is in 13.51 format */
Kojto 123:b0220dba8be7 7340
Kojto 123:b0220dba8be7 7341 /* x1 is in 1.15(q15), xfract in 12.20 format and out is in 13.35 format */
Kojto 123:b0220dba8be7 7342 /* convert 13.35 to 13.31 by right shifting and out is in 1.31 */
Kojto 123:b0220dba8be7 7343 out = (q31_t) (((q63_t) x1 * (0xFFFFF - xfract)) >> 4u);
Kojto 123:b0220dba8be7 7344 acc = ((q63_t) out * (0xFFFFF - yfract));
Kojto 123:b0220dba8be7 7345
Kojto 123:b0220dba8be7 7346 /* x2 * (xfract) * (1-yfract) in 1.51 and adding to acc */
Kojto 123:b0220dba8be7 7347 out = (q31_t) (((q63_t) x2 * (0xFFFFF - yfract)) >> 4u);
Kojto 123:b0220dba8be7 7348 acc += ((q63_t) out * (xfract));
Kojto 123:b0220dba8be7 7349
Kojto 123:b0220dba8be7 7350 /* y1 * (1 - xfract) * (yfract) in 1.51 and adding to acc */
Kojto 123:b0220dba8be7 7351 out = (q31_t) (((q63_t) y1 * (0xFFFFF - xfract)) >> 4u);
Kojto 123:b0220dba8be7 7352 acc += ((q63_t) out * (yfract));
Kojto 123:b0220dba8be7 7353
Kojto 123:b0220dba8be7 7354 /* y2 * (xfract) * (yfract) in 1.51 and adding to acc */
Kojto 123:b0220dba8be7 7355 out = (q31_t) (((q63_t) y2 * (xfract)) >> 4u);
Kojto 123:b0220dba8be7 7356 acc += ((q63_t) out * (yfract));
Kojto 123:b0220dba8be7 7357
Kojto 123:b0220dba8be7 7358 /* acc is in 13.51 format and down shift acc by 36 times */
Kojto 123:b0220dba8be7 7359 /* Convert out to 1.15 format */
Kojto 123:b0220dba8be7 7360 return (acc >> 36);
Kojto 123:b0220dba8be7 7361
Kojto 123:b0220dba8be7 7362 }
Kojto 123:b0220dba8be7 7363
Kojto 123:b0220dba8be7 7364 /**
Kojto 123:b0220dba8be7 7365 * @brief Q7 bilinear interpolation.
Kojto 123:b0220dba8be7 7366 * @param[in,out] *S points to an instance of the interpolation structure.
Kojto 123:b0220dba8be7 7367 * @param[in] X interpolation coordinate in 12.20 format.
Kojto 123:b0220dba8be7 7368 * @param[in] Y interpolation coordinate in 12.20 format.
Kojto 123:b0220dba8be7 7369 * @return out interpolated value.
Kojto 123:b0220dba8be7 7370 */
Kojto 123:b0220dba8be7 7371
Kojto 123:b0220dba8be7 7372 static __INLINE q7_t arm_bilinear_interp_q7(
Kojto 123:b0220dba8be7 7373 arm_bilinear_interp_instance_q7 * S,
Kojto 123:b0220dba8be7 7374 q31_t X,
Kojto 123:b0220dba8be7 7375 q31_t Y)
Kojto 123:b0220dba8be7 7376 {
Kojto 123:b0220dba8be7 7377 q63_t acc = 0; /* output */
Kojto 123:b0220dba8be7 7378 q31_t out; /* Temporary output */
Kojto 123:b0220dba8be7 7379 q31_t xfract, yfract; /* X, Y fractional parts */
Kojto 123:b0220dba8be7 7380 q7_t x1, x2, y1, y2; /* Nearest output values */
Kojto 123:b0220dba8be7 7381 int32_t rI, cI; /* Row and column indices */
Kojto 123:b0220dba8be7 7382 q7_t *pYData = S->pData; /* pointer to output table values */
Kojto 123:b0220dba8be7 7383 uint32_t nCols = S->numCols; /* num of rows */
Kojto 123:b0220dba8be7 7384
Kojto 123:b0220dba8be7 7385 /* Input is in 12.20 format */
Kojto 123:b0220dba8be7 7386 /* 12 bits for the table index */
Kojto 123:b0220dba8be7 7387 /* Index value calculation */
Kojto 123:b0220dba8be7 7388 rI = ((X & 0xFFF00000) >> 20);
Kojto 123:b0220dba8be7 7389
Kojto 123:b0220dba8be7 7390 /* Input is in 12.20 format */
Kojto 123:b0220dba8be7 7391 /* 12 bits for the table index */
Kojto 123:b0220dba8be7 7392 /* Index value calculation */
Kojto 123:b0220dba8be7 7393 cI = ((Y & 0xFFF00000) >> 20);
Kojto 123:b0220dba8be7 7394
Kojto 123:b0220dba8be7 7395 /* Care taken for table outside boundary */
Kojto 123:b0220dba8be7 7396 /* Returns zero output when values are outside table boundary */
Kojto 123:b0220dba8be7 7397 if(rI < 0 || rI > (S->numRows - 1) || cI < 0 || cI > (S->numCols - 1))
Kojto 123:b0220dba8be7 7398 {
Kojto 123:b0220dba8be7 7399 return (0);
Kojto 123:b0220dba8be7 7400 }
Kojto 123:b0220dba8be7 7401
Kojto 123:b0220dba8be7 7402 /* 20 bits for the fractional part */
Kojto 123:b0220dba8be7 7403 /* xfract should be in 12.20 format */
Kojto 123:b0220dba8be7 7404 xfract = (X & 0x000FFFFF);
Kojto 123:b0220dba8be7 7405
Kojto 123:b0220dba8be7 7406 /* Read two nearest output values from the index */
Kojto 123:b0220dba8be7 7407 x1 = pYData[(rI) + nCols * (cI)];
Kojto 123:b0220dba8be7 7408 x2 = pYData[(rI) + nCols * (cI) + 1u];
Kojto 123:b0220dba8be7 7409
Kojto 123:b0220dba8be7 7410
Kojto 123:b0220dba8be7 7411 /* 20 bits for the fractional part */
Kojto 123:b0220dba8be7 7412 /* yfract should be in 12.20 format */
Kojto 123:b0220dba8be7 7413 yfract = (Y & 0x000FFFFF);
Kojto 123:b0220dba8be7 7414
Kojto 123:b0220dba8be7 7415 /* Read two nearest output values from the index */
Kojto 123:b0220dba8be7 7416 y1 = pYData[(rI) + nCols * (cI + 1)];
Kojto 123:b0220dba8be7 7417 y2 = pYData[(rI) + nCols * (cI + 1) + 1u];
Kojto 123:b0220dba8be7 7418
Kojto 123:b0220dba8be7 7419 /* Calculation of x1 * (1-xfract ) * (1-yfract) and acc is in 16.47 format */
Kojto 123:b0220dba8be7 7420 out = ((x1 * (0xFFFFF - xfract)));
Kojto 123:b0220dba8be7 7421 acc = (((q63_t) out * (0xFFFFF - yfract)));
Kojto 123:b0220dba8be7 7422
Kojto 123:b0220dba8be7 7423 /* x2 * (xfract) * (1-yfract) in 2.22 and adding to acc */
Kojto 123:b0220dba8be7 7424 out = ((x2 * (0xFFFFF - yfract)));
Kojto 123:b0220dba8be7 7425 acc += (((q63_t) out * (xfract)));
Kojto 123:b0220dba8be7 7426
Kojto 123:b0220dba8be7 7427 /* y1 * (1 - xfract) * (yfract) in 2.22 and adding to acc */
Kojto 123:b0220dba8be7 7428 out = ((y1 * (0xFFFFF - xfract)));
Kojto 123:b0220dba8be7 7429 acc += (((q63_t) out * (yfract)));
Kojto 123:b0220dba8be7 7430
Kojto 123:b0220dba8be7 7431 /* y2 * (xfract) * (yfract) in 2.22 and adding to acc */
Kojto 123:b0220dba8be7 7432 out = ((y2 * (yfract)));
Kojto 123:b0220dba8be7 7433 acc += (((q63_t) out * (xfract)));
Kojto 123:b0220dba8be7 7434
Kojto 123:b0220dba8be7 7435 /* acc in 16.47 format and down shift by 40 to convert to 1.7 format */
Kojto 123:b0220dba8be7 7436 return (acc >> 40);
Kojto 123:b0220dba8be7 7437
Kojto 123:b0220dba8be7 7438 }
Kojto 123:b0220dba8be7 7439
Kojto 123:b0220dba8be7 7440 /**
Kojto 123:b0220dba8be7 7441 * @} end of BilinearInterpolate group
Kojto 123:b0220dba8be7 7442 */
Kojto 123:b0220dba8be7 7443
Kojto 123:b0220dba8be7 7444
Kojto 123:b0220dba8be7 7445 //SMMLAR
Kojto 123:b0220dba8be7 7446 #define multAcc_32x32_keep32_R(a, x, y) \
Kojto 123:b0220dba8be7 7447 a = (q31_t) (((((q63_t) a) << 32) + ((q63_t) x * y) + 0x80000000LL ) >> 32)
Kojto 123:b0220dba8be7 7448
Kojto 123:b0220dba8be7 7449 //SMMLSR
Kojto 123:b0220dba8be7 7450 #define multSub_32x32_keep32_R(a, x, y) \
Kojto 123:b0220dba8be7 7451 a = (q31_t) (((((q63_t) a) << 32) - ((q63_t) x * y) + 0x80000000LL ) >> 32)
Kojto 123:b0220dba8be7 7452
Kojto 123:b0220dba8be7 7453 //SMMULR
Kojto 123:b0220dba8be7 7454 #define mult_32x32_keep32_R(a, x, y) \
Kojto 123:b0220dba8be7 7455 a = (q31_t) (((q63_t) x * y + 0x80000000LL ) >> 32)
Kojto 123:b0220dba8be7 7456
Kojto 123:b0220dba8be7 7457 //SMMLA
Kojto 123:b0220dba8be7 7458 #define multAcc_32x32_keep32(a, x, y) \
Kojto 123:b0220dba8be7 7459 a += (q31_t) (((q63_t) x * y) >> 32)
Kojto 123:b0220dba8be7 7460
Kojto 123:b0220dba8be7 7461 //SMMLS
Kojto 123:b0220dba8be7 7462 #define multSub_32x32_keep32(a, x, y) \
Kojto 123:b0220dba8be7 7463 a -= (q31_t) (((q63_t) x * y) >> 32)
Kojto 123:b0220dba8be7 7464
Kojto 123:b0220dba8be7 7465 //SMMUL
Kojto 123:b0220dba8be7 7466 #define mult_32x32_keep32(a, x, y) \
Kojto 123:b0220dba8be7 7467 a = (q31_t) (((q63_t) x * y ) >> 32)
Kojto 123:b0220dba8be7 7468
Kojto 123:b0220dba8be7 7469
Kojto 123:b0220dba8be7 7470 #if defined ( __CC_ARM ) //Keil
Kojto 123:b0220dba8be7 7471
Kojto 123:b0220dba8be7 7472 //Enter low optimization region - place directly above function definition
Kojto 123:b0220dba8be7 7473 #ifdef ARM_MATH_CM4
Kojto 123:b0220dba8be7 7474 #define LOW_OPTIMIZATION_ENTER \
Kojto 123:b0220dba8be7 7475 _Pragma ("push") \
Kojto 123:b0220dba8be7 7476 _Pragma ("O1")
Kojto 123:b0220dba8be7 7477 #else
Kojto 123:b0220dba8be7 7478 #define LOW_OPTIMIZATION_ENTER
Kojto 123:b0220dba8be7 7479 #endif
Kojto 123:b0220dba8be7 7480
Kojto 123:b0220dba8be7 7481 //Exit low optimization region - place directly after end of function definition
Kojto 123:b0220dba8be7 7482 #ifdef ARM_MATH_CM4
Kojto 123:b0220dba8be7 7483 #define LOW_OPTIMIZATION_EXIT \
Kojto 123:b0220dba8be7 7484 _Pragma ("pop")
Kojto 123:b0220dba8be7 7485 #else
Kojto 123:b0220dba8be7 7486 #define LOW_OPTIMIZATION_EXIT
Kojto 123:b0220dba8be7 7487 #endif
Kojto 123:b0220dba8be7 7488
Kojto 123:b0220dba8be7 7489 //Enter low optimization region - place directly above function definition
Kojto 123:b0220dba8be7 7490 #define IAR_ONLY_LOW_OPTIMIZATION_ENTER
Kojto 123:b0220dba8be7 7491
Kojto 123:b0220dba8be7 7492 //Exit low optimization region - place directly after end of function definition
Kojto 123:b0220dba8be7 7493 #define IAR_ONLY_LOW_OPTIMIZATION_EXIT
Kojto 123:b0220dba8be7 7494
Kojto 123:b0220dba8be7 7495 #elif defined(__ICCARM__) //IAR
Kojto 123:b0220dba8be7 7496
Kojto 123:b0220dba8be7 7497 //Enter low optimization region - place directly above function definition
Kojto 123:b0220dba8be7 7498 #ifdef ARM_MATH_CM4
Kojto 123:b0220dba8be7 7499 #define LOW_OPTIMIZATION_ENTER \
Kojto 123:b0220dba8be7 7500 _Pragma ("optimize=low")
Kojto 123:b0220dba8be7 7501 #else
Kojto 123:b0220dba8be7 7502 #define LOW_OPTIMIZATION_ENTER
Kojto 123:b0220dba8be7 7503 #endif
Kojto 123:b0220dba8be7 7504
Kojto 123:b0220dba8be7 7505 //Exit low optimization region - place directly after end of function definition
Kojto 123:b0220dba8be7 7506 #define LOW_OPTIMIZATION_EXIT
Kojto 123:b0220dba8be7 7507
Kojto 123:b0220dba8be7 7508 //Enter low optimization region - place directly above function definition
Kojto 123:b0220dba8be7 7509 #ifdef ARM_MATH_CM4
Kojto 123:b0220dba8be7 7510 #define IAR_ONLY_LOW_OPTIMIZATION_ENTER \
Kojto 123:b0220dba8be7 7511 _Pragma ("optimize=low")
Kojto 123:b0220dba8be7 7512 #else
Kojto 123:b0220dba8be7 7513 #define IAR_ONLY_LOW_OPTIMIZATION_ENTER
Kojto 123:b0220dba8be7 7514 #endif
Kojto 123:b0220dba8be7 7515
Kojto 123:b0220dba8be7 7516 //Exit low optimization region - place directly after end of function definition
Kojto 123:b0220dba8be7 7517 #define IAR_ONLY_LOW_OPTIMIZATION_EXIT
Kojto 123:b0220dba8be7 7518
Kojto 123:b0220dba8be7 7519 #elif defined(__GNUC__)
Kojto 123:b0220dba8be7 7520
Kojto 123:b0220dba8be7 7521 #define LOW_OPTIMIZATION_ENTER __attribute__(( optimize("-O1") ))
Kojto 123:b0220dba8be7 7522
Kojto 123:b0220dba8be7 7523 #define LOW_OPTIMIZATION_EXIT
Kojto 123:b0220dba8be7 7524
Kojto 123:b0220dba8be7 7525 #define IAR_ONLY_LOW_OPTIMIZATION_ENTER
Kojto 123:b0220dba8be7 7526
Kojto 123:b0220dba8be7 7527 #define IAR_ONLY_LOW_OPTIMIZATION_EXIT
Kojto 123:b0220dba8be7 7528
Kojto 123:b0220dba8be7 7529 #elif defined(__CSMC__) // Cosmic
Kojto 123:b0220dba8be7 7530
Kojto 123:b0220dba8be7 7531 #define LOW_OPTIMIZATION_ENTER
Kojto 123:b0220dba8be7 7532 #define LOW_OPTIMIZATION_EXIT
Kojto 123:b0220dba8be7 7533 #define IAR_ONLY_LOW_OPTIMIZATION_ENTER
Kojto 123:b0220dba8be7 7534 #define IAR_ONLY_LOW_OPTIMIZATION_EXIT
Kojto 123:b0220dba8be7 7535
Kojto 123:b0220dba8be7 7536 #elif defined(__TASKING__) // TASKING
Kojto 123:b0220dba8be7 7537
Kojto 123:b0220dba8be7 7538 #define LOW_OPTIMIZATION_ENTER
Kojto 123:b0220dba8be7 7539 #define LOW_OPTIMIZATION_EXIT
Kojto 123:b0220dba8be7 7540 #define IAR_ONLY_LOW_OPTIMIZATION_ENTER
Kojto 123:b0220dba8be7 7541 #define IAR_ONLY_LOW_OPTIMIZATION_EXIT
Kojto 123:b0220dba8be7 7542
Kojto 123:b0220dba8be7 7543 #endif
Kojto 123:b0220dba8be7 7544
Kojto 123:b0220dba8be7 7545
Kojto 123:b0220dba8be7 7546 #ifdef __cplusplus
Kojto 123:b0220dba8be7 7547 }
Kojto 123:b0220dba8be7 7548 #endif
Kojto 123:b0220dba8be7 7549
Kojto 123:b0220dba8be7 7550
Kojto 123:b0220dba8be7 7551 #endif /* _ARM_MATH_H */
Kojto 123:b0220dba8be7 7552
Kojto 123:b0220dba8be7 7553 /**
Kojto 123:b0220dba8be7 7554 *
Kojto 123:b0220dba8be7 7555 * End of file.
Kojto 123:b0220dba8be7 7556 */