git.gag.com Git - fw/stlink/blob - exampleF4/CMSIS/Documentation/DSP_Lib/html/arm__fir__q15_8c_source.html

   1 <!DOCTYPE html PUBLIC "-//W3C//DTD XHTML 1.0 Transitional//EN" "http://www.w3.org/TR/xhtml1/DTD/xhtml1-transitional.dtd">
   2 <html xmlns="http://www.w3.org/1999/xhtml">
   3 <head>
   4 <meta http-equiv="Content-Type" content="text/xhtml;charset=UTF-8"/>
   5 <title>CMSIS DSP Software Library: arm_fir_q15.c Source File</title>
   6 <link href="tabs.css" rel="stylesheet" type="text/css"/>
   7 <link href="search/search.css" rel="stylesheet" type="text/css"/>
   8 <script type="text/javaScript" src="search/search.js"></script>
   9 <link href="doxygen.css" rel="stylesheet" type="text/css"/>
  10 </head>
  11 <body onload='searchBox.OnSelectItem(0);'>
  12 <!-- Generated by Doxygen 1.7.2 -->
  13 <script type="text/javascript"><!--
  14 var searchBox = new SearchBox("searchBox", "search",false,'Search');
  15 --></script>
  16 <div class="navigation" id="top">
  17   <div class="tabs">
  18     <ul class="tablist">
  19       <li><a href="index.html"><span>Main&#160;Page</span></a></li>
  20       <li><a href="modules.html"><span>Modules</span></a></li>
  21       <li><a href="annotated.html"><span>Data&#160;Structures</span></a></li>
  22       <li class="current"><a href="files.html"><span>Files</span></a></li>
  23       <li><a href="examples.html"><span>Examples</span></a></li>
  24       <li id="searchli">
  25         <div id="MSearchBox" class="MSearchBoxInactive">
  26         <span class="left">
  27           <img id="MSearchSelect" src="search/mag_sel.png"
  28                onmouseover="return searchBox.OnSearchSelectShow()"
  29                onmouseout="return searchBox.OnSearchSelectHide()"
  30                alt=""/>
  31           <input type="text" id="MSearchField" value="Search" accesskey="S"
  32                onfocus="searchBox.OnSearchFieldFocus(true)"
  33                onblur="searchBox.OnSearchFieldFocus(false)"
  34                onkeyup="searchBox.OnSearchFieldChange(event)"/>
  35           </span><span class="right">
  36             <a id="MSearchClose" href="javascript:searchBox.CloseResultsWindow()"><img id="MSearchCloseImg" border="0" src="search/close.png" alt=""/></a>
  37           </span>
  38         </div>
  39       </li>
  40     </ul>
  41   </div>
  42   <div class="tabs2">
  43     <ul class="tablist">
  44       <li><a href="files.html"><span>File&#160;List</span></a></li>
  45       <li><a href="globals.html"><span>Globals</span></a></li>
  46     </ul>
  47   </div>
  48 <div class="header">
  49   <div class="headertitle">
  50 <h1>arm_fir_q15.c</h1>  </div>
  51 </div>
  52 <div class="contents">
  53 <a href="arm__fir__q15_8c.html">Go to the documentation of this file.</a><div class="fragment"><pre class="fragment"><a name="l00001"></a>00001 <span class="comment">/* ----------------------------------------------------------------------   </span>
  54 <a name="l00002"></a>00002 <span class="comment">* Copyright (C) 2010 ARM Limited. All rights reserved.   </span>
  55 <a name="l00003"></a>00003 <span class="comment">*   </span>
  56 <a name="l00004"></a>00004 <span class="comment">* $Date:        15. July 2011  </span>
  57 <a name="l00005"></a>00005 <span class="comment">* $Revision:    V1.0.10  </span>
  58 <a name="l00006"></a>00006 <span class="comment">*   </span>
  59 <a name="l00007"></a>00007 <span class="comment">* Project:      CMSIS DSP Library   </span>
  60 <a name="l00008"></a>00008 <span class="comment">* Title:        arm_fir_q15.c   </span>
  61 <a name="l00009"></a>00009 <span class="comment">*   </span>
  62 <a name="l00010"></a>00010 <span class="comment">* Description:  Q15 FIR filter processing function.   </span>
  63 <a name="l00011"></a>00011 <span class="comment">*   </span>
  64 <a name="l00012"></a>00012 <span class="comment">* Target Processor: Cortex-M4/Cortex-M3/Cortex-M0</span>
  65 <a name="l00013"></a>00013 <span class="comment">*  </span>
  66 <a name="l00014"></a>00014 <span class="comment">* Version 1.0.10 2011/7/15 </span>
  67 <a name="l00015"></a>00015 <span class="comment">*    Big Endian support added and Merged M0 and M3/M4 Source code.  </span>
  68 <a name="l00016"></a>00016 <span class="comment">*   </span>
  69 <a name="l00017"></a>00017 <span class="comment">* Version 1.0.3 2010/11/29  </span>
  70 <a name="l00018"></a>00018 <span class="comment">*    Re-organized the CMSIS folders and updated documentation.   </span>
  71 <a name="l00019"></a>00019 <span class="comment">*    </span>
  72 <a name="l00020"></a>00020 <span class="comment">* Version 1.0.2 2010/11/11   </span>
  73 <a name="l00021"></a>00021 <span class="comment">*    Documentation updated.    </span>
  74 <a name="l00022"></a>00022 <span class="comment">*   </span>
  75 <a name="l00023"></a>00023 <span class="comment">* Version 1.0.1 2010/10/05    </span>
  76 <a name="l00024"></a>00024 <span class="comment">*    Production release and review comments incorporated.   </span>
  77 <a name="l00025"></a>00025 <span class="comment">*   </span>
  78 <a name="l00026"></a>00026 <span class="comment">* Version 1.0.0 2010/09/20    </span>
  79 <a name="l00027"></a>00027 <span class="comment">*    Production release and review comments incorporated.   </span>
  80 <a name="l00028"></a>00028 <span class="comment">*   </span>
  81 <a name="l00029"></a>00029 <span class="comment">* Version 0.0.5  2010/04/26    </span>
  82 <a name="l00030"></a>00030 <span class="comment">*    incorporated review comments and updated with latest CMSIS layer   </span>
  83 <a name="l00031"></a>00031 <span class="comment">*   </span>
  84 <a name="l00032"></a>00032 <span class="comment">* Version 0.0.3  2010/03/10    </span>
  85 <a name="l00033"></a>00033 <span class="comment">*    Initial version   </span>
  86 <a name="l00034"></a>00034 <span class="comment">* -------------------------------------------------------------------- */</span>
  87 <a name="l00035"></a>00035
  88 <a name="l00036"></a>00036 <span class="preprocessor">#include &quot;<a class="code" href="arm__math_8h.html">arm_math.h</a>&quot;</span>
  89 <a name="l00037"></a>00037
  90 <a name="l00068"></a><a class="code" href="group___f_i_r.html#ga262d173058d6f80fdf60404ba262a8f5">00068</a> <span class="keywordtype">void</span> <a class="code" href="group___f_i_r.html#ga262d173058d6f80fdf60404ba262a8f5" title="Processing function for the Q15 FIR filter.">arm_fir_q15</a>(
  91 <a name="l00069"></a>00069   <span class="keyword">const</span> <a class="code" href="structarm__fir__instance__q15.html" title="Instance structure for the Q15 FIR filter.">arm_fir_instance_q15</a> * S,
  92 <a name="l00070"></a>00070   <a class="code" href="arm__math_8h.html#ab5a8fb21a5b3b983d5f54f31614052ea" title="16-bit fractional data type in 1.15 format.">q15_t</a> * pSrc,
  93 <a name="l00071"></a>00071   <a class="code" href="arm__math_8h.html#ab5a8fb21a5b3b983d5f54f31614052ea" title="16-bit fractional data type in 1.15 format.">q15_t</a> * pDst,
  94 <a name="l00072"></a>00072   uint32_t <a class="code" href="arm__fir__example__f32_8c.html#ab6558f40a619c2502fbc24c880fd4fb0">blockSize</a>)
  95 <a name="l00073"></a>00073 {
  96 <a name="l00074"></a>00074   <a class="code" href="arm__math_8h.html#ab5a8fb21a5b3b983d5f54f31614052ea" title="16-bit fractional data type in 1.15 format.">q15_t</a> *pState = S-&gt;<a class="code" href="structarm__fir__instance__q15.html#aa8d25f44f45b6a6c4cf38c31569b8a01">pState</a>;                     <span class="comment">/* State pointer */</span>
  97 <a name="l00075"></a>00075   <a class="code" href="arm__math_8h.html#ab5a8fb21a5b3b983d5f54f31614052ea" title="16-bit fractional data type in 1.15 format.">q15_t</a> *pCoeffs = S-&gt;<a class="code" href="structarm__fir__instance__q15.html#a6d16db16a5f8f0db54938f2967244d9e">pCoeffs</a>;                   <span class="comment">/* Coefficient pointer */</span>
  98 <a name="l00076"></a>00076   <a class="code" href="arm__math_8h.html#ab5a8fb21a5b3b983d5f54f31614052ea" title="16-bit fractional data type in 1.15 format.">q15_t</a> *pStateCurnt;                            <span class="comment">/* Points to the current sample of the state */</span>
  99 <a name="l00077"></a>00077
 100 <a name="l00078"></a>00078
 101 <a name="l00079"></a>00079 <span class="preprocessor">#ifndef ARM_MATH_CM0</span>
 102 <a name="l00080"></a>00080 <span class="preprocessor"></span>
 103 <a name="l00081"></a>00081   <span class="comment">/* Run the below code for Cortex-M4 and Cortex-M3 */</span>
 104 <a name="l00082"></a>00082
 105 <a name="l00083"></a>00083   <a class="code" href="arm__math_8h.html#ab5a8fb21a5b3b983d5f54f31614052ea" title="16-bit fractional data type in 1.15 format.">q15_t</a> *px1;                                    <span class="comment">/* Temporary q15 pointer for state buffer */</span>
 106 <a name="l00084"></a>00084   <a class="code" href="arm__math_8h.html#adc89a3547f5324b7b3b95adec3806bc0" title="32-bit fractional data type in 1.31 format.">q31_t</a> *pb;                                     <span class="comment">/* Temporary pointer for coefficient buffer */</span>
 107 <a name="l00085"></a>00085   <a class="code" href="arm__math_8h.html#adc89a3547f5324b7b3b95adec3806bc0" title="32-bit fractional data type in 1.31 format.">q31_t</a> *px2;                                    <span class="comment">/* Temporary q31 pointer for SIMD state buffer accesses */</span>
 108 <a name="l00086"></a>00086   <a class="code" href="arm__math_8h.html#adc89a3547f5324b7b3b95adec3806bc0" title="32-bit fractional data type in 1.31 format.">q31_t</a> x0, x1, x2, x3, c0;                      <span class="comment">/* Temporary variables to hold SIMD state and coefficient values */</span>
 109 <a name="l00087"></a>00087   <a class="code" href="arm__math_8h.html#a5aea1cb12fc02d9d44c8abf217eaa5c6" title="64-bit fractional data type in 1.63 format.">q63_t</a> acc0, acc1, acc2, acc3;                  <span class="comment">/* Accumulators */</span>
 110 <a name="l00088"></a>00088   uint32_t numTaps = S-&gt;<a class="code" href="structarm__fir__instance__q15.html#a0e46f93cf51bfb18b1be808be9c5bfc9">numTaps</a>;                 <span class="comment">/* Number of taps in the filter */</span>
 111 <a name="l00089"></a>00089   uint32_t tapCnt, blkCnt;                       <span class="comment">/* Loop counters */</span>
 112 <a name="l00090"></a>00090
 113 <a name="l00091"></a>00091   <span class="comment">/* S-&gt;pState points to state array which contains previous frame (numTaps - 1) samples */</span>
 114 <a name="l00092"></a>00092   <span class="comment">/* pStateCurnt points to the location where the new input data should be written */</span>
 115 <a name="l00093"></a>00093   pStateCurnt = &amp;(S-&gt;<a class="code" href="structarm__fir__instance__q15.html#aa8d25f44f45b6a6c4cf38c31569b8a01">pState</a>[(numTaps - 1u)]);
 116 <a name="l00094"></a>00094
 117 <a name="l00095"></a>00095   <span class="comment">/* Apply loop unrolling and compute 4 output values simultaneously.   </span>
 118 <a name="l00096"></a>00096 <span class="comment">   * The variables acc0 ... acc3 hold output values that are being computed:   </span>
 119 <a name="l00097"></a>00097 <span class="comment">   *   </span>
 120 <a name="l00098"></a>00098 <span class="comment">   *    acc0 =  b[numTaps-1] * x[n-numTaps-1] + b[numTaps-2] * x[n-numTaps-2] + b[numTaps-3] * x[n-numTaps-3] +...+ b[0] * x[0]   </span>
 121 <a name="l00099"></a>00099 <span class="comment">   *    acc1 =  b[numTaps-1] * x[n-numTaps] +   b[numTaps-2] * x[n-numTaps-1] + b[numTaps-3] * x[n-numTaps-2] +...+ b[0] * x[1]   </span>
 122 <a name="l00100"></a>00100 <span class="comment">   *    acc2 =  b[numTaps-1] * x[n-numTaps+1] + b[numTaps-2] * x[n-numTaps] +   b[numTaps-3] * x[n-numTaps-1] +...+ b[0] * x[2]   </span>
 123 <a name="l00101"></a>00101 <span class="comment">   *    acc3 =  b[numTaps-1] * x[n-numTaps+2] + b[numTaps-2] * x[n-numTaps+1] + b[numTaps-3] * x[n-numTaps]   +...+ b[0] * x[3]   </span>
 124 <a name="l00102"></a>00102 <span class="comment">   */</span>
 125 <a name="l00103"></a>00103   blkCnt = blockSize &gt;&gt; 2;
 126 <a name="l00104"></a>00104
 127 <a name="l00105"></a>00105   <span class="comment">/* First part of the processing with loop unrolling.  Compute 4 outputs at a time.   </span>
 128 <a name="l00106"></a>00106 <span class="comment">   ** a second loop below computes the remaining 1 to 3 samples. */</span>
 129 <a name="l00107"></a>00107   <span class="keywordflow">while</span>(blkCnt &gt; 0u)
 130 <a name="l00108"></a>00108   {
 131 <a name="l00109"></a>00109     <span class="comment">/* Copy four new input samples into the state buffer.   </span>
 132 <a name="l00110"></a>00110 <span class="comment">     ** Use 32-bit SIMD to move the 16-bit data.  Only requires two copies. */</span>
 133 <a name="l00111"></a>00111     *<a class="code" href="arm__math_8h.html#a9de2e0a5785be82866bcb96012282248" title="definition to read/write two 16 bit values.">__SIMD32</a>(pStateCurnt)++ = *<a class="code" href="arm__math_8h.html#a9de2e0a5785be82866bcb96012282248" title="definition to read/write two 16 bit values.">__SIMD32</a>(pSrc)++;
 134 <a name="l00112"></a>00112     *<a class="code" href="arm__math_8h.html#a9de2e0a5785be82866bcb96012282248" title="definition to read/write two 16 bit values.">__SIMD32</a>(pStateCurnt)++ = *<a class="code" href="arm__math_8h.html#a9de2e0a5785be82866bcb96012282248" title="definition to read/write two 16 bit values.">__SIMD32</a>(pSrc)++;
 135 <a name="l00113"></a>00113
 136 <a name="l00114"></a>00114     <span class="comment">/* Set all accumulators to zero */</span>
 137 <a name="l00115"></a>00115     acc0 = 0;
 138 <a name="l00116"></a>00116     acc1 = 0;
 139 <a name="l00117"></a>00117     acc2 = 0;
 140 <a name="l00118"></a>00118     acc3 = 0;
 141 <a name="l00119"></a>00119
 142 <a name="l00120"></a>00120     <span class="comment">/* Initialize state pointer of type q15 */</span>
 143 <a name="l00121"></a>00121     px1 = pState;
 144 <a name="l00122"></a>00122
 145 <a name="l00123"></a>00123     <span class="comment">/* Initialize coeff pointer of type q31 */</span>
 146 <a name="l00124"></a>00124     pb = (<a class="code" href="arm__math_8h.html#adc89a3547f5324b7b3b95adec3806bc0" title="32-bit fractional data type in 1.31 format.">q31_t</a> *) (pCoeffs);
 147 <a name="l00125"></a>00125
 148 <a name="l00126"></a>00126     <span class="comment">/* Read the first two samples from the state buffer:  x[n-N], x[n-N-1] */</span>
 149 <a name="l00127"></a>00127     x0 = *(<a class="code" href="arm__math_8h.html#adc89a3547f5324b7b3b95adec3806bc0" title="32-bit fractional data type in 1.31 format.">q31_t</a> *) (px1++);
 150 <a name="l00128"></a>00128
 151 <a name="l00129"></a>00129     <span class="comment">/* Read the third and forth samples from the state buffer: x[n-N-1], x[n-N-2] */</span>
 152 <a name="l00130"></a>00130     x1 = *(<a class="code" href="arm__math_8h.html#adc89a3547f5324b7b3b95adec3806bc0" title="32-bit fractional data type in 1.31 format.">q31_t</a> *) (px1++);
 153 <a name="l00131"></a>00131
 154 <a name="l00132"></a>00132     <span class="comment">/* Loop over the number of taps.  Unroll by a factor of 4.   </span>
 155 <a name="l00133"></a>00133 <span class="comment">     ** Repeat until we&#39;ve computed numTaps-4 coefficients. */</span>
 156 <a name="l00134"></a>00134     tapCnt = numTaps &gt;&gt; 2;
 157 <a name="l00135"></a>00135     <span class="keywordflow">do</span>
 158 <a name="l00136"></a>00136     {
 159 <a name="l00137"></a>00137       <span class="comment">/* Read the first two coefficients using SIMD:  b[N] and b[N-1] coefficients */</span>
 160 <a name="l00138"></a>00138       c0 = *(pb++);
 161 <a name="l00139"></a>00139
 162 <a name="l00140"></a>00140       <span class="comment">/* acc0 +=  b[N] * x[n-N] + b[N-1] * x[n-N-1] */</span>
 163 <a name="l00141"></a>00141       acc0 = __SMLALD(x0, c0, acc0);
 164 <a name="l00142"></a>00142
 165 <a name="l00143"></a>00143       <span class="comment">/* acc1 +=  b[N] * x[n-N-1] + b[N-1] * x[n-N-2] */</span>
 166 <a name="l00144"></a>00144       acc1 = __SMLALD(x1, c0, acc1);
 167 <a name="l00145"></a>00145
 168 <a name="l00146"></a>00146       <span class="comment">/* Read state x[n-N-2], x[n-N-3] */</span>
 169 <a name="l00147"></a>00147       x2 = *(<a class="code" href="arm__math_8h.html#adc89a3547f5324b7b3b95adec3806bc0" title="32-bit fractional data type in 1.31 format.">q31_t</a> *) (px1++);
 170 <a name="l00148"></a>00148
 171 <a name="l00149"></a>00149       <span class="comment">/* Read state x[n-N-3], x[n-N-4] */</span>
 172 <a name="l00150"></a>00150       x3 = *(<a class="code" href="arm__math_8h.html#adc89a3547f5324b7b3b95adec3806bc0" title="32-bit fractional data type in 1.31 format.">q31_t</a> *) (px1++);
 173 <a name="l00151"></a>00151
 174 <a name="l00152"></a>00152       <span class="comment">/* acc2 +=  b[N] * x[n-N-2] + b[N-1] * x[n-N-3] */</span>
 175 <a name="l00153"></a>00153       acc2 = __SMLALD(x2, c0, acc2);
 176 <a name="l00154"></a>00154
 177 <a name="l00155"></a>00155       <span class="comment">/* acc3 +=  b[N] * x[n-N-3] + b[N-1] * x[n-N-4] */</span>
 178 <a name="l00156"></a>00156       acc3 = __SMLALD(x3, c0, acc3);
 179 <a name="l00157"></a>00157
 180 <a name="l00158"></a>00158       <span class="comment">/* Read coefficients b[N-2], b[N-3] */</span>
 181 <a name="l00159"></a>00159       c0 = *(pb++);
 182 <a name="l00160"></a>00160
 183 <a name="l00161"></a>00161       <span class="comment">/* acc0 +=  b[N-2] * x[n-N-2] + b[N-3] * x[n-N-3] */</span>
 184 <a name="l00162"></a>00162       acc0 = __SMLALD(x2, c0, acc0);
 185 <a name="l00163"></a>00163
 186 <a name="l00164"></a>00164       <span class="comment">/* acc1 +=  b[N-2] * x[n-N-3] + b[N-3] * x[n-N-4] */</span>
 187 <a name="l00165"></a>00165       acc1 = __SMLALD(x3, c0, acc1);
 188 <a name="l00166"></a>00166
 189 <a name="l00167"></a>00167       <span class="comment">/* Read state x[n-N-4], x[n-N-5] */</span>
 190 <a name="l00168"></a>00168       x0 = *(<a class="code" href="arm__math_8h.html#adc89a3547f5324b7b3b95adec3806bc0" title="32-bit fractional data type in 1.31 format.">q31_t</a> *) (px1++);
 191 <a name="l00169"></a>00169
 192 <a name="l00170"></a>00170       <span class="comment">/* Read state x[n-N-5], x[n-N-6] */</span>
 193 <a name="l00171"></a>00171       x1 = *(<a class="code" href="arm__math_8h.html#adc89a3547f5324b7b3b95adec3806bc0" title="32-bit fractional data type in 1.31 format.">q31_t</a> *) (px1++);
 194 <a name="l00172"></a>00172
 195 <a name="l00173"></a>00173       <span class="comment">/* acc2 +=  b[N-2] * x[n-N-4] + b[N-3] * x[n-N-5] */</span>
 196 <a name="l00174"></a>00174       acc2 = __SMLALD(x0, c0, acc2);
 197 <a name="l00175"></a>00175
 198 <a name="l00176"></a>00176       <span class="comment">/* acc3 +=  b[N-2] * x[n-N-5] + b[N-3] * x[n-N-6] */</span>
 199 <a name="l00177"></a>00177       acc3 = __SMLALD(x1, c0, acc3);
 200 <a name="l00178"></a>00178       tapCnt--;
 201 <a name="l00179"></a>00179
 202 <a name="l00180"></a>00180     }
 203 <a name="l00181"></a>00181     <span class="keywordflow">while</span>(tapCnt &gt; 0u);
 204 <a name="l00182"></a>00182
 205 <a name="l00183"></a>00183     <span class="comment">/* If the filter length is not a multiple of 4, compute the remaining filter taps.   </span>
 206 <a name="l00184"></a>00184 <span class="comment">     ** This is always be 2 taps since the filter length is even. */</span>
 207 <a name="l00185"></a>00185     <span class="keywordflow">if</span>((numTaps &amp; 0x3u) != 0u)
 208 <a name="l00186"></a>00186     {
 209 <a name="l00187"></a>00187       <span class="comment">/* Read 2 coefficients */</span>
 210 <a name="l00188"></a>00188       c0 = *(pb++);
 211 <a name="l00189"></a>00189       <span class="comment">/* Fetch 4 state variables */</span>
 212 <a name="l00190"></a>00190       x2 = *(<a class="code" href="arm__math_8h.html#adc89a3547f5324b7b3b95adec3806bc0" title="32-bit fractional data type in 1.31 format.">q31_t</a> *) (px1++);
 213 <a name="l00191"></a>00191       x3 = *(<a class="code" href="arm__math_8h.html#adc89a3547f5324b7b3b95adec3806bc0" title="32-bit fractional data type in 1.31 format.">q31_t</a> *) (px1++);
 214 <a name="l00192"></a>00192
 215 <a name="l00193"></a>00193       <span class="comment">/* Perform the multiply-accumulates */</span>
 216 <a name="l00194"></a>00194       acc0 = __SMLALD(x0, c0, acc0);
 217 <a name="l00195"></a>00195       acc1 = __SMLALD(x1, c0, acc1);
 218 <a name="l00196"></a>00196       acc2 = __SMLALD(x2, c0, acc2);
 219 <a name="l00197"></a>00197       acc3 = __SMLALD(x3, c0, acc3);
 220 <a name="l00198"></a>00198     }
 221 <a name="l00199"></a>00199
 222 <a name="l00200"></a>00200     <span class="comment">/* The results in the 4 accumulators are in 2.30 format.  Convert to 1.15 with saturation.   </span>
 223 <a name="l00201"></a>00201 <span class="comment">     ** Then store the 4 outputs in the destination buffer. */</span>
 224 <a name="l00202"></a>00202
 225 <a name="l00203"></a>00203 <span class="preprocessor">#ifndef ARM_MATH_BIG_ENDIAN</span>
 226 <a name="l00204"></a>00204 <span class="preprocessor"></span>
 227 <a name="l00205"></a>00205     *<a class="code" href="arm__math_8h.html#a9de2e0a5785be82866bcb96012282248" title="definition to read/write two 16 bit values.">__SIMD32</a>(pDst)++ =
 228 <a name="l00206"></a>00206       __PKHBT(__SSAT((acc0 &gt;&gt; 15), 16), __SSAT((acc1 &gt;&gt; 15), 16), 16);
 229 <a name="l00207"></a>00207     *<a class="code" href="arm__math_8h.html#a9de2e0a5785be82866bcb96012282248" title="definition to read/write two 16 bit values.">__SIMD32</a>(pDst)++ =
 230 <a name="l00208"></a>00208       __PKHBT(__SSAT((acc2 &gt;&gt; 15), 16), __SSAT((acc3 &gt;&gt; 15), 16), 16);
 231 <a name="l00209"></a>00209
 232 <a name="l00210"></a>00210 <span class="preprocessor">#else</span>
 233 <a name="l00211"></a>00211 <span class="preprocessor"></span>
 234 <a name="l00212"></a>00212     *<a class="code" href="arm__math_8h.html#a9de2e0a5785be82866bcb96012282248" title="definition to read/write two 16 bit values.">__SIMD32</a>(pDst)++ =
 235 <a name="l00213"></a>00213       __PKHBT(__SSAT((acc1 &gt;&gt; 15), 16), __SSAT((acc0 &gt;&gt; 15), 16), 16);
 236 <a name="l00214"></a>00214     *<a class="code" href="arm__math_8h.html#a9de2e0a5785be82866bcb96012282248" title="definition to read/write two 16 bit values.">__SIMD32</a>(pDst)++ =
 237 <a name="l00215"></a>00215       __PKHBT(__SSAT((acc3 &gt;&gt; 15), 16), __SSAT((acc2 &gt;&gt; 15), 16), 16);
 238 <a name="l00216"></a>00216
 239 <a name="l00217"></a>00217 <span class="preprocessor">#endif </span><span class="comment">/*      #ifndef ARM_MATH_BIG_ENDIAN       */</span>
 240 <a name="l00218"></a>00218
 241 <a name="l00219"></a>00219     <span class="comment">/* Advance the state pointer by 4 to process the next group of 4 samples */</span>
 242 <a name="l00220"></a>00220     pState = pState + 4;
 243 <a name="l00221"></a>00221
 244 <a name="l00222"></a>00222     <span class="comment">/* Decrement the loop counter */</span>
 245 <a name="l00223"></a>00223     blkCnt--;
 246 <a name="l00224"></a>00224   }
 247 <a name="l00225"></a>00225
 248 <a name="l00226"></a>00226   <span class="comment">/* If the blockSize is not a multiple of 4, compute any remaining output samples here.   </span>
 249 <a name="l00227"></a>00227 <span class="comment">   ** No loop unrolling is used. */</span>
 250 <a name="l00228"></a>00228   blkCnt = blockSize % 0x4u;
 251 <a name="l00229"></a>00229   <span class="keywordflow">while</span>(blkCnt &gt; 0u)
 252 <a name="l00230"></a>00230   {
 253 <a name="l00231"></a>00231     <span class="comment">/* Copy two samples into state buffer */</span>
 254 <a name="l00232"></a>00232     *pStateCurnt++ = *pSrc++;
 255 <a name="l00233"></a>00233
 256 <a name="l00234"></a>00234     <span class="comment">/* Set the accumulator to zero */</span>
 257 <a name="l00235"></a>00235     acc0 = 0;
 258 <a name="l00236"></a>00236
 259 <a name="l00237"></a>00237     <span class="comment">/* Use SIMD to hold states and coefficients */</span>
 260 <a name="l00238"></a>00238     px2 = (<a class="code" href="arm__math_8h.html#adc89a3547f5324b7b3b95adec3806bc0" title="32-bit fractional data type in 1.31 format.">q31_t</a> *) pState;
 261 <a name="l00239"></a>00239     pb = (<a class="code" href="arm__math_8h.html#adc89a3547f5324b7b3b95adec3806bc0" title="32-bit fractional data type in 1.31 format.">q31_t</a> *) (pCoeffs);
 262 <a name="l00240"></a>00240     tapCnt = numTaps &gt;&gt; 1;
 263 <a name="l00241"></a>00241
 264 <a name="l00242"></a>00242     <span class="keywordflow">do</span>
 265 <a name="l00243"></a>00243     {
 266 <a name="l00244"></a>00244       acc0 = __SMLALD(*px2++, *(pb++), acc0);
 267 <a name="l00245"></a>00245       tapCnt--;
 268 <a name="l00246"></a>00246     }
 269 <a name="l00247"></a>00247     <span class="keywordflow">while</span>(tapCnt &gt; 0u);
 270 <a name="l00248"></a>00248
 271 <a name="l00249"></a>00249     <span class="comment">/* The result is in 2.30 format.  Convert to 1.15 with saturation.   </span>
 272 <a name="l00250"></a>00250 <span class="comment">     ** Then store the output in the destination buffer. */</span>
 273 <a name="l00251"></a>00251     *pDst++ = (<a class="code" href="arm__math_8h.html#ab5a8fb21a5b3b983d5f54f31614052ea" title="16-bit fractional data type in 1.15 format.">q15_t</a>) (__SSAT((acc0 &gt;&gt; 15), 16));
 274 <a name="l00252"></a>00252
 275 <a name="l00253"></a>00253     <span class="comment">/* Advance state pointer by 1 for the next sample */</span>
 276 <a name="l00254"></a>00254     pState = pState + 1;
 277 <a name="l00255"></a>00255
 278 <a name="l00256"></a>00256     <span class="comment">/* Decrement the loop counter */</span>
 279 <a name="l00257"></a>00257     blkCnt--;
 280 <a name="l00258"></a>00258   }
 281 <a name="l00259"></a>00259
 282 <a name="l00260"></a>00260   <span class="comment">/* Processing is complete.   </span>
 283 <a name="l00261"></a>00261 <span class="comment">   ** Now copy the last numTaps - 1 samples to the satrt of the state buffer.   </span>
 284 <a name="l00262"></a>00262 <span class="comment">   ** This prepares the state buffer for the next function call. */</span>
 285 <a name="l00263"></a>00263
 286 <a name="l00264"></a>00264   <span class="comment">/* Points to the start of the state buffer */</span>
 287 <a name="l00265"></a>00265   pStateCurnt = S-&gt;<a class="code" href="structarm__fir__instance__q15.html#aa8d25f44f45b6a6c4cf38c31569b8a01">pState</a>;
 288 <a name="l00266"></a>00266
 289 <a name="l00267"></a>00267   <span class="comment">/* Calculation of count for copying integer writes */</span>
 290 <a name="l00268"></a>00268   tapCnt = (numTaps - 1u) &gt;&gt; 2;
 291 <a name="l00269"></a>00269
 292 <a name="l00270"></a>00270   <span class="keywordflow">while</span>(tapCnt &gt; 0u)
 293 <a name="l00271"></a>00271   {
 294 <a name="l00272"></a>00272     *<a class="code" href="arm__math_8h.html#a9de2e0a5785be82866bcb96012282248" title="definition to read/write two 16 bit values.">__SIMD32</a>(pStateCurnt)++ = *<a class="code" href="arm__math_8h.html#a9de2e0a5785be82866bcb96012282248" title="definition to read/write two 16 bit values.">__SIMD32</a>(pState)++;
 295 <a name="l00273"></a>00273     *<a class="code" href="arm__math_8h.html#a9de2e0a5785be82866bcb96012282248" title="definition to read/write two 16 bit values.">__SIMD32</a>(pStateCurnt)++ = *<a class="code" href="arm__math_8h.html#a9de2e0a5785be82866bcb96012282248" title="definition to read/write two 16 bit values.">__SIMD32</a>(pState)++;
 296 <a name="l00274"></a>00274
 297 <a name="l00275"></a>00275     tapCnt--;
 298 <a name="l00276"></a>00276
 299 <a name="l00277"></a>00277   }
 300 <a name="l00278"></a>00278
 301 <a name="l00279"></a>00279   <span class="comment">/* Calculation of count for remaining q15_t data */</span>
 302 <a name="l00280"></a>00280   tapCnt = (numTaps - 1u) % 0x4u;
 303 <a name="l00281"></a>00281
 304 <a name="l00282"></a>00282   <span class="comment">/* copy remaining data */</span>
 305 <a name="l00283"></a>00283   <span class="keywordflow">while</span>(tapCnt &gt; 0u)
 306 <a name="l00284"></a>00284   {
 307 <a name="l00285"></a>00285     *pStateCurnt++ = *pState++;
 308 <a name="l00286"></a>00286
 309 <a name="l00287"></a>00287     <span class="comment">/* Decrement the loop counter */</span>
 310 <a name="l00288"></a>00288     tapCnt--;
 311 <a name="l00289"></a>00289   }
 312 <a name="l00290"></a>00290
 313 <a name="l00291"></a>00291 <span class="preprocessor">#else</span>
 314 <a name="l00292"></a>00292 <span class="preprocessor"></span>
 315 <a name="l00293"></a>00293   <span class="comment">/* Run the below code for Cortex-M0 */</span>
 316 <a name="l00294"></a>00294
 317 <a name="l00295"></a>00295   <a class="code" href="arm__math_8h.html#ab5a8fb21a5b3b983d5f54f31614052ea" title="16-bit fractional data type in 1.15 format.">q15_t</a> *px;                                     <span class="comment">/* Temporary pointer for state buffer */</span>
 318 <a name="l00296"></a>00296   <a class="code" href="arm__math_8h.html#ab5a8fb21a5b3b983d5f54f31614052ea" title="16-bit fractional data type in 1.15 format.">q15_t</a> *pb;                                     <span class="comment">/* Temporary pointer for coefficient buffer */</span>
 319 <a name="l00297"></a>00297   <a class="code" href="arm__math_8h.html#a5aea1cb12fc02d9d44c8abf217eaa5c6" title="64-bit fractional data type in 1.63 format.">q63_t</a> acc;                                     <span class="comment">/* Accumulator */</span>
 320 <a name="l00298"></a>00298   uint32_t numTaps = S-&gt;<a class="code" href="structarm__fir__instance__q15.html#a0e46f93cf51bfb18b1be808be9c5bfc9">numTaps</a>;                 <span class="comment">/* Number of nTaps in the filter */</span>
 321 <a name="l00299"></a>00299   uint32_t tapCnt, blkCnt;                       <span class="comment">/* Loop counters */</span>
 322 <a name="l00300"></a>00300
 323 <a name="l00301"></a>00301   <span class="comment">/* S-&gt;pState buffer contains previous frame (numTaps - 1) samples */</span>
 324 <a name="l00302"></a>00302   <span class="comment">/* pStateCurnt points to the location where the new input data should be written */</span>
 325 <a name="l00303"></a>00303   pStateCurnt = &amp;(S-&gt;<a class="code" href="structarm__fir__instance__q15.html#aa8d25f44f45b6a6c4cf38c31569b8a01">pState</a>[(numTaps - 1u)]);
 326 <a name="l00304"></a>00304
 327 <a name="l00305"></a>00305   <span class="comment">/* Initialize blkCnt with blockSize */</span>
 328 <a name="l00306"></a>00306   blkCnt = <a class="code" href="arm__fir__example__f32_8c.html#ab6558f40a619c2502fbc24c880fd4fb0">blockSize</a>;
 329 <a name="l00307"></a>00307
 330 <a name="l00308"></a>00308   <span class="keywordflow">while</span>(blkCnt &gt; 0u)
 331 <a name="l00309"></a>00309   {
 332 <a name="l00310"></a>00310     <span class="comment">/* Copy one sample at a time into state buffer */</span>
 333 <a name="l00311"></a>00311     *pStateCurnt++ = *pSrc++;
 334 <a name="l00312"></a>00312
 335 <a name="l00313"></a>00313     <span class="comment">/* Set the accumulator to zero */</span>
 336 <a name="l00314"></a>00314     acc = 0;
 337 <a name="l00315"></a>00315
 338 <a name="l00316"></a>00316     <span class="comment">/* Initialize state pointer */</span>
 339 <a name="l00317"></a>00317     px = pState;
 340 <a name="l00318"></a>00318
 341 <a name="l00319"></a>00319     <span class="comment">/* Initialize Coefficient pointer */</span>
 342 <a name="l00320"></a>00320     pb = pCoeffs;
 343 <a name="l00321"></a>00321
 344 <a name="l00322"></a>00322     tapCnt = numTaps;
 345 <a name="l00323"></a>00323
 346 <a name="l00324"></a>00324     <span class="comment">/* Perform the multiply-accumulates */</span>
 347 <a name="l00325"></a>00325     <span class="keywordflow">do</span>
 348 <a name="l00326"></a>00326     {
 349 <a name="l00327"></a>00327       <span class="comment">/* acc =  b[numTaps-1] * x[n-numTaps-1] + b[numTaps-2] * x[n-numTaps-2] + b[numTaps-3] * x[n-numTaps-3] +...+ b[0] * x[0] */</span>
 350 <a name="l00328"></a>00328       acc += (<a class="code" href="arm__math_8h.html#adc89a3547f5324b7b3b95adec3806bc0" title="32-bit fractional data type in 1.31 format.">q31_t</a>) * px++ * *pb++;
 351 <a name="l00329"></a>00329       tapCnt--;
 352 <a name="l00330"></a>00330     } <span class="keywordflow">while</span>(tapCnt &gt; 0u);
 353 <a name="l00331"></a>00331
 354 <a name="l00332"></a>00332     <span class="comment">/* The result is in 2.30 format.  Convert to 1.15        </span>
 355 <a name="l00333"></a>00333 <span class="comment">     ** Then store the output in the destination buffer. */</span>
 356 <a name="l00334"></a>00334     *pDst++ = (<a class="code" href="arm__math_8h.html#ab5a8fb21a5b3b983d5f54f31614052ea" title="16-bit fractional data type in 1.15 format.">q15_t</a>) __SSAT((acc &gt;&gt; 15u), 16);
 357 <a name="l00335"></a>00335
 358 <a name="l00336"></a>00336     <span class="comment">/* Advance state pointer by 1 for the next sample */</span>
 359 <a name="l00337"></a>00337     pState = pState + 1;
 360 <a name="l00338"></a>00338
 361 <a name="l00339"></a>00339     <span class="comment">/* Decrement the samples loop counter */</span>
 362 <a name="l00340"></a>00340     blkCnt--;
 363 <a name="l00341"></a>00341   }
 364 <a name="l00342"></a>00342
 365 <a name="l00343"></a>00343   <span class="comment">/* Processing is complete.        </span>
 366 <a name="l00344"></a>00344 <span class="comment">   ** Now copy the last numTaps - 1 samples to the satrt of the state buffer.      </span>
 367 <a name="l00345"></a>00345 <span class="comment">   ** This prepares the state buffer for the next function call. */</span>
 368 <a name="l00346"></a>00346
 369 <a name="l00347"></a>00347   <span class="comment">/* Points to the start of the state buffer */</span>
 370 <a name="l00348"></a>00348   pStateCurnt = S-&gt;<a class="code" href="structarm__fir__instance__q15.html#aa8d25f44f45b6a6c4cf38c31569b8a01">pState</a>;
 371 <a name="l00349"></a>00349
 372 <a name="l00350"></a>00350   <span class="comment">/* Copy numTaps number of values */</span>
 373 <a name="l00351"></a>00351   tapCnt = (numTaps - 1u);
 374 <a name="l00352"></a>00352
 375 <a name="l00353"></a>00353   <span class="comment">/* copy data */</span>
 376 <a name="l00354"></a>00354   <span class="keywordflow">while</span>(tapCnt &gt; 0u)
 377 <a name="l00355"></a>00355   {
 378 <a name="l00356"></a>00356     *pStateCurnt++ = *pState++;
 379 <a name="l00357"></a>00357
 380 <a name="l00358"></a>00358     <span class="comment">/* Decrement the loop counter */</span>
 381 <a name="l00359"></a>00359     tapCnt--;
 382 <a name="l00360"></a>00360   }
 383 <a name="l00361"></a>00361
 384 <a name="l00362"></a>00362 <span class="preprocessor">#endif </span><span class="comment">/* #ifndef ARM_MATH_CM0 */</span>
 385 <a name="l00363"></a>00363
 386 <a name="l00364"></a>00364 }
 387 <a name="l00365"></a>00365
 388 </pre></div></div>
 389 </div>
 390 <!--- window showing the filter options -->
 391 <div id="MSearchSelectWindow"
 392      onmouseover="return searchBox.OnSearchSelectShow()"
 393      onmouseout="return searchBox.OnSearchSelectHide()"
 394      onkeydown="return searchBox.OnSearchSelectKey(event)">
 395 <a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(0)"><span class="SelectionMark">&#160;</span>All</a><a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(1)"><span class="SelectionMark">&#160;</span>Data Structures</a><a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(2)"><span class="SelectionMark">&#160;</span>Files</a><a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(3)"><span class="SelectionMark">&#160;</span>Functions</a><a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(4)"><span class="SelectionMark">&#160;</span>Variables</a><a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(5)"><span class="SelectionMark">&#160;</span>Typedefs</a><a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(6)"><span class="SelectionMark">&#160;</span>Enumerations</a><a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(7)"><span class="SelectionMark">&#160;</span>Enumerator</a><a class="SelectItem" href="javascript:void(0)" onclick="searchBox.OnSelectItem(8)"><span class="SelectionMark">&#160;</span>Defines</a></div>
 396
 397 <!-- iframe showing the search results (closed by default) -->
 398 <div id="MSearchResultsWindow">
 399 <iframe src="" frameborder="0"
 400         name="MSearchResults" id="MSearchResults">
 401 </iframe>
 402 </div>
 403
 404 <hr class="footer"/><address class="footer"><small>Generated on Fri Jul 15 2011 13:16:16 for CMSIS DSP Software Library by&#160;
 405 <a href="http://www.doxygen.org/index.html">
 406 <img class="footer" src="doxygen.png" alt="doxygen"/></a> 1.7.2 </small></address>
 407 </body>
 408 </html>