Laxmi Kant Tiwari
CMSIS DSP Lib
Fork of
mbed-dsp
by 
mbed official
cmsis_dsp/ControllerFunctions/arm_sin_cos_f32.c@4:9cee975aadce, 2014-06-23 (annotated)
- Committer:
- mbed_official
- Date:
- Mon Jun 23 09:30:09 2014 +0100
- Revision:
- 4:9cee975aadce
- Parent:
- 3:7a284390b0ce
Synchronized with git revision 6e7c7bcec41226f536474daae3c13d49e4c0e865
Full URL: https://github.com/mbedmicro/mbed/commit/6e7c7bcec41226f536474daae3c13d49e4c0e865/
Fix signed unsigned compare in dsp library
Who changed what in which revision?
| User | Revision | Line number | New contents of line |
|---|---|---|---|
| emilmont | 1:fdd22bb7aa52 | 1 | /* ---------------------------------------------------------------------- |
| mbed_official | 3:7a284390b0ce | 2 | * Copyright (C) 2010-2013 ARM Limited. All rights reserved. |
| emilmont | 1:fdd22bb7aa52 | 3 | * |
| mbed_official | 3:7a284390b0ce | 4 | * $Date: 17. January 2013 |
| mbed_official | 3:7a284390b0ce | 5 | * $Revision: V1.4.1 |
| emilmont | 1:fdd22bb7aa52 | 6 | * |
| emilmont | 2:da51fb522205 | 7 | * Project: CMSIS DSP Library |
| emilmont | 2:da51fb522205 | 8 | * Title: arm_sin_cos_f32.c |
| emilmont | 1:fdd22bb7aa52 | 9 | * |
| emilmont | 2:da51fb522205 | 10 | * Description: Sine and Cosine calculation for floating-point values. |
| emilmont | 1:fdd22bb7aa52 | 11 | * |
| emilmont | 1:fdd22bb7aa52 | 12 | * Target Processor: Cortex-M4/Cortex-M3/Cortex-M0 |
| emilmont | 1:fdd22bb7aa52 | 13 | * |
| mbed_official | 3:7a284390b0ce | 14 | * Redistribution and use in source and binary forms, with or without |
| mbed_official | 3:7a284390b0ce | 15 | * modification, are permitted provided that the following conditions |
| mbed_official | 3:7a284390b0ce | 16 | * are met: |
| mbed_official | 3:7a284390b0ce | 17 | * - Redistributions of source code must retain the above copyright |
| mbed_official | 3:7a284390b0ce | 18 | * notice, this list of conditions and the following disclaimer. |
| mbed_official | 3:7a284390b0ce | 19 | * - Redistributions in binary form must reproduce the above copyright |
| mbed_official | 3:7a284390b0ce | 20 | * notice, this list of conditions and the following disclaimer in |
| mbed_official | 3:7a284390b0ce | 21 | * the documentation and/or other materials provided with the |
| mbed_official | 3:7a284390b0ce | 22 | * distribution. |
| mbed_official | 3:7a284390b0ce | 23 | * - Neither the name of ARM LIMITED nor the names of its contributors |
| mbed_official | 3:7a284390b0ce | 24 | * may be used to endorse or promote products derived from this |
| mbed_official | 3:7a284390b0ce | 25 | * software without specific prior written permission. |
| mbed_official | 3:7a284390b0ce | 26 | * |
| mbed_official | 3:7a284390b0ce | 27 | * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS |
| mbed_official | 3:7a284390b0ce | 28 | * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT |
| mbed_official | 3:7a284390b0ce | 29 | * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS |
| mbed_official | 3:7a284390b0ce | 30 | * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE |
| mbed_official | 3:7a284390b0ce | 31 | * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, |
| mbed_official | 3:7a284390b0ce | 32 | * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, |
| mbed_official | 3:7a284390b0ce | 33 | * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; |
| mbed_official | 3:7a284390b0ce | 34 | * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER |
| mbed_official | 3:7a284390b0ce | 35 | * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT |
| mbed_official | 3:7a284390b0ce | 36 | * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN |
| mbed_official | 3:7a284390b0ce | 37 | * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE |
| mbed_official | 3:7a284390b0ce | 38 | * POSSIBILITY OF SUCH DAMAGE. |
| emilmont | 1:fdd22bb7aa52 | 39 | * -------------------------------------------------------------------- */ |
| emilmont | 1:fdd22bb7aa52 | 40 | |
| emilmont | 1:fdd22bb7aa52 | 41 | #include "arm_math.h" |
| emilmont | 1:fdd22bb7aa52 | 42 | |
| emilmont | 1:fdd22bb7aa52 | 43 | /** |
| emilmont | 1:fdd22bb7aa52 | 44 | * @ingroup groupController |
| emilmont | 1:fdd22bb7aa52 | 45 | */ |
| emilmont | 1:fdd22bb7aa52 | 46 | |
| emilmont | 1:fdd22bb7aa52 | 47 | /** |
| emilmont | 1:fdd22bb7aa52 | 48 | * @defgroup SinCos Sine Cosine |
| emilmont | 1:fdd22bb7aa52 | 49 | * |
| emilmont | 1:fdd22bb7aa52 | 50 | * Computes the trigonometric sine and cosine values using a combination of table lookup |
| emilmont | 1:fdd22bb7aa52 | 51 | * and linear interpolation. |
| emilmont | 1:fdd22bb7aa52 | 52 | * There are separate functions for Q31 and floating-point data types. |
| emilmont | 1:fdd22bb7aa52 | 53 | * The input to the floating-point version is in degrees while the |
| emilmont | 1:fdd22bb7aa52 | 54 | * fixed-point Q31 have a scaled input with the range |
| emilmont | 1:fdd22bb7aa52 | 55 | * [-1 0.9999] mapping to [-180 179] degrees. |
| emilmont | 1:fdd22bb7aa52 | 56 | * |
| emilmont | 1:fdd22bb7aa52 | 57 | * The implementation is based on table lookup using 360 values together with linear interpolation. |
| emilmont | 1:fdd22bb7aa52 | 58 | * The steps used are: |
| emilmont | 1:fdd22bb7aa52 | 59 | * -# Calculation of the nearest integer table index. |
| emilmont | 1:fdd22bb7aa52 | 60 | * -# Compute the fractional portion (fract) of the input. |
| emilmont | 1:fdd22bb7aa52 | 61 | * -# Fetch the value corresponding to \c index from sine table to \c y0 and also value from \c index+1 to \c y1. |
| emilmont | 1:fdd22bb7aa52 | 62 | * -# Sine value is computed as <code> *psinVal = y0 + (fract * (y1 - y0))</code>. |
| emilmont | 1:fdd22bb7aa52 | 63 | * -# Fetch the value corresponding to \c index from cosine table to \c y0 and also value from \c index+1 to \c y1. |
| emilmont | 1:fdd22bb7aa52 | 64 | * -# Cosine value is computed as <code> *pcosVal = y0 + (fract * (y1 - y0))</code>. |
| emilmont | 1:fdd22bb7aa52 | 65 | */ |
| emilmont | 1:fdd22bb7aa52 | 66 | |
| emilmont | 1:fdd22bb7aa52 | 67 | /** |
| emilmont | 1:fdd22bb7aa52 | 68 | * @addtogroup SinCos |
| emilmont | 1:fdd22bb7aa52 | 69 | * @{ |
| emilmont | 1:fdd22bb7aa52 | 70 | */ |
| emilmont | 1:fdd22bb7aa52 | 71 | |
| emilmont | 1:fdd22bb7aa52 | 72 | |
| emilmont | 1:fdd22bb7aa52 | 73 | /** |
| emilmont | 1:fdd22bb7aa52 | 74 | * \par |
| emilmont | 1:fdd22bb7aa52 | 75 | * Cosine Table is generated from following loop |
| emilmont | 1:fdd22bb7aa52 | 76 | * <pre>for(i = 0; i < 360; i++) |
| emilmont | 1:fdd22bb7aa52 | 77 | * { |
| emilmont | 1:fdd22bb7aa52 | 78 | * cosTable[i]= cos((i-180) * PI/180.0); |
| emilmont | 1:fdd22bb7aa52 | 79 | * } </pre> |
| emilmont | 1:fdd22bb7aa52 | 80 | */ |
| emilmont | 1:fdd22bb7aa52 | 81 | |
| emilmont | 1:fdd22bb7aa52 | 82 | static const float32_t cosTable[360] = { |
| emilmont | 1:fdd22bb7aa52 | 83 | -0.999847695156391270f, -0.999390827019095760f, -0.998629534754573830f, |
| emilmont | 1:fdd22bb7aa52 | 84 | -0.997564050259824200f, -0.996194698091745550f, -0.994521895368273290f, |
| emilmont | 1:fdd22bb7aa52 | 85 | -0.992546151641321980f, -0.990268068741570250f, |
| emilmont | 1:fdd22bb7aa52 | 86 | -0.987688340595137660f, -0.984807753012208020f, -0.981627183447663980f, |
| emilmont | 1:fdd22bb7aa52 | 87 | -0.978147600733805690f, -0.974370064785235250f, -0.970295726275996470f, |
| emilmont | 1:fdd22bb7aa52 | 88 | -0.965925826289068200f, -0.961261695938318670f, |
| emilmont | 1:fdd22bb7aa52 | 89 | -0.956304755963035440f, -0.951056516295153530f, -0.945518575599316740f, |
| emilmont | 1:fdd22bb7aa52 | 90 | -0.939692620785908320f, -0.933580426497201740f, -0.927183854566787310f, |
| emilmont | 1:fdd22bb7aa52 | 91 | -0.920504853452440150f, -0.913545457642600760f, |
| emilmont | 1:fdd22bb7aa52 | 92 | -0.906307787036649940f, -0.898794046299167040f, -0.891006524188367790f, |
| emilmont | 1:fdd22bb7aa52 | 93 | -0.882947592858926770f, -0.874619707139395740f, -0.866025403784438710f, |
| emilmont | 1:fdd22bb7aa52 | 94 | -0.857167300702112220f, -0.848048096156425960f, |
| emilmont | 1:fdd22bb7aa52 | 95 | -0.838670567945424160f, -0.829037572555041620f, -0.819152044288991580f, |
| emilmont | 1:fdd22bb7aa52 | 96 | -0.809016994374947340f, -0.798635510047292940f, -0.788010753606721900f, |
| emilmont | 1:fdd22bb7aa52 | 97 | -0.777145961456970680f, -0.766044443118977900f, |
| emilmont | 1:fdd22bb7aa52 | 98 | -0.754709580222772010f, -0.743144825477394130f, -0.731353701619170460f, |
| emilmont | 1:fdd22bb7aa52 | 99 | -0.719339800338651300f, -0.707106781186547460f, -0.694658370458997030f, |
| emilmont | 1:fdd22bb7aa52 | 100 | -0.681998360062498370f, -0.669130606358858240f, |
| emilmont | 1:fdd22bb7aa52 | 101 | -0.656059028990507500f, -0.642787609686539360f, -0.629320391049837280f, |
| emilmont | 1:fdd22bb7aa52 | 102 | -0.615661475325658290f, -0.601815023152048380f, -0.587785252292473030f, |
| emilmont | 1:fdd22bb7aa52 | 103 | -0.573576436351045830f, -0.559192903470746680f, |
| emilmont | 1:fdd22bb7aa52 | 104 | -0.544639035015027080f, -0.529919264233204790f, -0.515038074910054270f, |
| emilmont | 1:fdd22bb7aa52 | 105 | -0.499999999999999780f, -0.484809620246337000f, -0.469471562785890530f, |
| emilmont | 1:fdd22bb7aa52 | 106 | -0.453990499739546750f, -0.438371146789077510f, |
| emilmont | 1:fdd22bb7aa52 | 107 | -0.422618261740699330f, -0.406736643075800100f, -0.390731128489273600f, |
| emilmont | 1:fdd22bb7aa52 | 108 | -0.374606593415912070f, -0.358367949545300270f, -0.342020143325668710f, |
| emilmont | 1:fdd22bb7aa52 | 109 | -0.325568154457156420f, -0.309016994374947340f, |
| emilmont | 1:fdd22bb7aa52 | 110 | -0.292371704722736660f, -0.275637355816999050f, -0.258819045102520850f, |
| emilmont | 1:fdd22bb7aa52 | 111 | -0.241921895599667790f, -0.224951054343864810f, -0.207911690817759120f, |
| emilmont | 1:fdd22bb7aa52 | 112 | -0.190808995376544800f, -0.173648177666930300f, |
| emilmont | 1:fdd22bb7aa52 | 113 | -0.156434465040231040f, -0.139173100960065350f, -0.121869343405147370f, |
| emilmont | 1:fdd22bb7aa52 | 114 | -0.104528463267653330f, -0.087155742747658235f, -0.069756473744125330f, |
| emilmont | 1:fdd22bb7aa52 | 115 | -0.052335956242943620f, -0.034899496702500733f, |
| emilmont | 1:fdd22bb7aa52 | 116 | -0.017452406437283477f, 0.000000000000000061f, 0.017452406437283376f, |
| emilmont | 1:fdd22bb7aa52 | 117 | 0.034899496702501080f, 0.052335956242943966f, 0.069756473744125455f, |
| emilmont | 1:fdd22bb7aa52 | 118 | 0.087155742747658138f, 0.104528463267653460f, |
| emilmont | 1:fdd22bb7aa52 | 119 | 0.121869343405147490f, 0.139173100960065690f, 0.156434465040230920f, |
| emilmont | 1:fdd22bb7aa52 | 120 | 0.173648177666930410f, 0.190808995376544920f, 0.207911690817759450f, |
| emilmont | 1:fdd22bb7aa52 | 121 | 0.224951054343864920f, 0.241921895599667900f, |
| emilmont | 1:fdd22bb7aa52 | 122 | 0.258819045102520740f, 0.275637355816999160f, 0.292371704722736770f, |
| emilmont | 1:fdd22bb7aa52 | 123 | 0.309016994374947450f, 0.325568154457156760f, 0.342020143325668820f, |
| emilmont | 1:fdd22bb7aa52 | 124 | 0.358367949545300380f, 0.374606593415911960f, |
| emilmont | 1:fdd22bb7aa52 | 125 | 0.390731128489273940f, 0.406736643075800210f, 0.422618261740699440f, |
| emilmont | 1:fdd22bb7aa52 | 126 | 0.438371146789077460f, 0.453990499739546860f, 0.469471562785890860f, |
| emilmont | 1:fdd22bb7aa52 | 127 | 0.484809620246337110f, 0.500000000000000110f, |
| emilmont | 1:fdd22bb7aa52 | 128 | 0.515038074910054380f, 0.529919264233204900f, 0.544639035015027200f, |
| emilmont | 1:fdd22bb7aa52 | 129 | 0.559192903470746790f, 0.573576436351046050f, 0.587785252292473140f, |
| emilmont | 1:fdd22bb7aa52 | 130 | 0.601815023152048270f, 0.615661475325658290f, |
| emilmont | 1:fdd22bb7aa52 | 131 | 0.629320391049837500f, 0.642787609686539360f, 0.656059028990507280f, |
| emilmont | 1:fdd22bb7aa52 | 132 | 0.669130606358858240f, 0.681998360062498480f, 0.694658370458997370f, |
| emilmont | 1:fdd22bb7aa52 | 133 | 0.707106781186547570f, 0.719339800338651190f, |
| emilmont | 1:fdd22bb7aa52 | 134 | 0.731353701619170570f, 0.743144825477394240f, 0.754709580222772010f, |
| emilmont | 1:fdd22bb7aa52 | 135 | 0.766044443118978010f, 0.777145961456970900f, 0.788010753606722010f, |
| emilmont | 1:fdd22bb7aa52 | 136 | 0.798635510047292830f, 0.809016994374947450f, |
| emilmont | 1:fdd22bb7aa52 | 137 | 0.819152044288991800f, 0.829037572555041620f, 0.838670567945424050f, |
| emilmont | 1:fdd22bb7aa52 | 138 | 0.848048096156425960f, 0.857167300702112330f, 0.866025403784438710f, |
| emilmont | 1:fdd22bb7aa52 | 139 | 0.874619707139395740f, 0.882947592858926990f, |
| emilmont | 1:fdd22bb7aa52 | 140 | 0.891006524188367900f, 0.898794046299167040f, 0.906307787036649940f, |
| emilmont | 1:fdd22bb7aa52 | 141 | 0.913545457642600870f, 0.920504853452440370f, 0.927183854566787420f, |
| emilmont | 1:fdd22bb7aa52 | 142 | 0.933580426497201740f, 0.939692620785908430f, |
| emilmont | 1:fdd22bb7aa52 | 143 | 0.945518575599316850f, 0.951056516295153530f, 0.956304755963035440f, |
| emilmont | 1:fdd22bb7aa52 | 144 | 0.961261695938318890f, 0.965925826289068310f, 0.970295726275996470f, |
| emilmont | 1:fdd22bb7aa52 | 145 | 0.974370064785235250f, 0.978147600733805690f, |
| emilmont | 1:fdd22bb7aa52 | 146 | 0.981627183447663980f, 0.984807753012208020f, 0.987688340595137770f, |
| emilmont | 1:fdd22bb7aa52 | 147 | 0.990268068741570360f, 0.992546151641321980f, 0.994521895368273290f, |
| emilmont | 1:fdd22bb7aa52 | 148 | 0.996194698091745550f, 0.997564050259824200f, |
| emilmont | 1:fdd22bb7aa52 | 149 | 0.998629534754573830f, 0.999390827019095760f, 0.999847695156391270f, |
| emilmont | 1:fdd22bb7aa52 | 150 | 1.000000000000000000f, 0.999847695156391270f, 0.999390827019095760f, |
| emilmont | 1:fdd22bb7aa52 | 151 | 0.998629534754573830f, 0.997564050259824200f, |
| emilmont | 1:fdd22bb7aa52 | 152 | 0.996194698091745550f, 0.994521895368273290f, 0.992546151641321980f, |
| emilmont | 1:fdd22bb7aa52 | 153 | 0.990268068741570360f, 0.987688340595137770f, 0.984807753012208020f, |
| emilmont | 1:fdd22bb7aa52 | 154 | 0.981627183447663980f, 0.978147600733805690f, |
| emilmont | 1:fdd22bb7aa52 | 155 | 0.974370064785235250f, 0.970295726275996470f, 0.965925826289068310f, |
| emilmont | 1:fdd22bb7aa52 | 156 | 0.961261695938318890f, 0.956304755963035440f, 0.951056516295153530f, |
| emilmont | 1:fdd22bb7aa52 | 157 | 0.945518575599316850f, 0.939692620785908430f, |
| emilmont | 1:fdd22bb7aa52 | 158 | 0.933580426497201740f, 0.927183854566787420f, 0.920504853452440370f, |
| emilmont | 1:fdd22bb7aa52 | 159 | 0.913545457642600870f, 0.906307787036649940f, 0.898794046299167040f, |
| emilmont | 1:fdd22bb7aa52 | 160 | 0.891006524188367900f, 0.882947592858926990f, |
| emilmont | 1:fdd22bb7aa52 | 161 | 0.874619707139395740f, 0.866025403784438710f, 0.857167300702112330f, |
| emilmont | 1:fdd22bb7aa52 | 162 | 0.848048096156425960f, 0.838670567945424050f, 0.829037572555041620f, |
| emilmont | 1:fdd22bb7aa52 | 163 | 0.819152044288991800f, 0.809016994374947450f, |
| emilmont | 1:fdd22bb7aa52 | 164 | 0.798635510047292830f, 0.788010753606722010f, 0.777145961456970900f, |
| emilmont | 1:fdd22bb7aa52 | 165 | 0.766044443118978010f, 0.754709580222772010f, 0.743144825477394240f, |
| emilmont | 1:fdd22bb7aa52 | 166 | 0.731353701619170570f, 0.719339800338651190f, |
| emilmont | 1:fdd22bb7aa52 | 167 | 0.707106781186547570f, 0.694658370458997370f, 0.681998360062498480f, |
| emilmont | 1:fdd22bb7aa52 | 168 | 0.669130606358858240f, 0.656059028990507280f, 0.642787609686539360f, |
| emilmont | 1:fdd22bb7aa52 | 169 | 0.629320391049837500f, 0.615661475325658290f, |
| emilmont | 1:fdd22bb7aa52 | 170 | 0.601815023152048270f, 0.587785252292473140f, 0.573576436351046050f, |
| emilmont | 1:fdd22bb7aa52 | 171 | 0.559192903470746790f, 0.544639035015027200f, 0.529919264233204900f, |
| emilmont | 1:fdd22bb7aa52 | 172 | 0.515038074910054380f, 0.500000000000000110f, |
| emilmont | 1:fdd22bb7aa52 | 173 | 0.484809620246337110f, 0.469471562785890860f, 0.453990499739546860f, |
| emilmont | 1:fdd22bb7aa52 | 174 | 0.438371146789077460f, 0.422618261740699440f, 0.406736643075800210f, |
| emilmont | 1:fdd22bb7aa52 | 175 | 0.390731128489273940f, 0.374606593415911960f, |
| emilmont | 1:fdd22bb7aa52 | 176 | 0.358367949545300380f, 0.342020143325668820f, 0.325568154457156760f, |
| emilmont | 1:fdd22bb7aa52 | 177 | 0.309016994374947450f, 0.292371704722736770f, 0.275637355816999160f, |
| emilmont | 1:fdd22bb7aa52 | 178 | 0.258819045102520740f, 0.241921895599667900f, |
| emilmont | 1:fdd22bb7aa52 | 179 | 0.224951054343864920f, 0.207911690817759450f, 0.190808995376544920f, |
| emilmont | 1:fdd22bb7aa52 | 180 | 0.173648177666930410f, 0.156434465040230920f, 0.139173100960065690f, |
| emilmont | 1:fdd22bb7aa52 | 181 | 0.121869343405147490f, 0.104528463267653460f, |
| emilmont | 1:fdd22bb7aa52 | 182 | 0.087155742747658138f, 0.069756473744125455f, 0.052335956242943966f, |
| emilmont | 1:fdd22bb7aa52 | 183 | 0.034899496702501080f, 0.017452406437283376f, 0.000000000000000061f, |
| emilmont | 1:fdd22bb7aa52 | 184 | -0.017452406437283477f, -0.034899496702500733f, |
| emilmont | 1:fdd22bb7aa52 | 185 | -0.052335956242943620f, -0.069756473744125330f, -0.087155742747658235f, |
| emilmont | 1:fdd22bb7aa52 | 186 | -0.104528463267653330f, -0.121869343405147370f, -0.139173100960065350f, |
| emilmont | 1:fdd22bb7aa52 | 187 | -0.156434465040231040f, -0.173648177666930300f, |
| emilmont | 1:fdd22bb7aa52 | 188 | -0.190808995376544800f, -0.207911690817759120f, -0.224951054343864810f, |
| emilmont | 1:fdd22bb7aa52 | 189 | -0.241921895599667790f, -0.258819045102520850f, -0.275637355816999050f, |
| emilmont | 1:fdd22bb7aa52 | 190 | -0.292371704722736660f, -0.309016994374947340f, |
| emilmont | 1:fdd22bb7aa52 | 191 | -0.325568154457156420f, -0.342020143325668710f, -0.358367949545300270f, |
| emilmont | 1:fdd22bb7aa52 | 192 | -0.374606593415912070f, -0.390731128489273600f, -0.406736643075800100f, |
| emilmont | 1:fdd22bb7aa52 | 193 | -0.422618261740699330f, -0.438371146789077510f, |
| emilmont | 1:fdd22bb7aa52 | 194 | -0.453990499739546750f, -0.469471562785890530f, -0.484809620246337000f, |
| emilmont | 1:fdd22bb7aa52 | 195 | -0.499999999999999780f, -0.515038074910054270f, -0.529919264233204790f, |
| emilmont | 1:fdd22bb7aa52 | 196 | -0.544639035015027080f, -0.559192903470746680f, |
| emilmont | 1:fdd22bb7aa52 | 197 | -0.573576436351045830f, -0.587785252292473030f, -0.601815023152048380f, |
| emilmont | 1:fdd22bb7aa52 | 198 | -0.615661475325658290f, -0.629320391049837280f, -0.642787609686539360f, |
| emilmont | 1:fdd22bb7aa52 | 199 | -0.656059028990507500f, -0.669130606358858240f, |
| emilmont | 1:fdd22bb7aa52 | 200 | -0.681998360062498370f, -0.694658370458997030f, -0.707106781186547460f, |
| emilmont | 1:fdd22bb7aa52 | 201 | -0.719339800338651300f, -0.731353701619170460f, -0.743144825477394130f, |
| emilmont | 1:fdd22bb7aa52 | 202 | -0.754709580222772010f, -0.766044443118977900f, |
| emilmont | 1:fdd22bb7aa52 | 203 | -0.777145961456970680f, -0.788010753606721900f, -0.798635510047292940f, |
| emilmont | 1:fdd22bb7aa52 | 204 | -0.809016994374947340f, -0.819152044288991580f, -0.829037572555041620f, |
| emilmont | 1:fdd22bb7aa52 | 205 | -0.838670567945424160f, -0.848048096156425960f, |
| emilmont | 1:fdd22bb7aa52 | 206 | -0.857167300702112220f, -0.866025403784438710f, -0.874619707139395740f, |
| emilmont | 1:fdd22bb7aa52 | 207 | -0.882947592858926770f, -0.891006524188367790f, -0.898794046299167040f, |
| emilmont | 1:fdd22bb7aa52 | 208 | -0.906307787036649940f, -0.913545457642600760f, |
| emilmont | 1:fdd22bb7aa52 | 209 | -0.920504853452440150f, -0.927183854566787310f, -0.933580426497201740f, |
| emilmont | 1:fdd22bb7aa52 | 210 | -0.939692620785908320f, -0.945518575599316740f, -0.951056516295153530f, |
| emilmont | 1:fdd22bb7aa52 | 211 | -0.956304755963035440f, -0.961261695938318670f, |
| emilmont | 1:fdd22bb7aa52 | 212 | -0.965925826289068200f, -0.970295726275996470f, -0.974370064785235250f, |
| emilmont | 1:fdd22bb7aa52 | 213 | -0.978147600733805690f, -0.981627183447663980f, -0.984807753012208020f, |
| emilmont | 1:fdd22bb7aa52 | 214 | -0.987688340595137660f, -0.990268068741570250f, |
| emilmont | 1:fdd22bb7aa52 | 215 | -0.992546151641321980f, -0.994521895368273290f, -0.996194698091745550f, |
| emilmont | 1:fdd22bb7aa52 | 216 | -0.997564050259824200f, -0.998629534754573830f, -0.999390827019095760f, |
| emilmont | 1:fdd22bb7aa52 | 217 | -0.999847695156391270f, -1.000000000000000000f |
| emilmont | 1:fdd22bb7aa52 | 218 | }; |
| emilmont | 1:fdd22bb7aa52 | 219 | |
| emilmont | 1:fdd22bb7aa52 | 220 | /** |
| emilmont | 1:fdd22bb7aa52 | 221 | * \par |
| emilmont | 1:fdd22bb7aa52 | 222 | * Sine Table is generated from following loop |
| emilmont | 1:fdd22bb7aa52 | 223 | * <pre>for(i = 0; i < 360; i++) |
| emilmont | 1:fdd22bb7aa52 | 224 | * { |
| emilmont | 1:fdd22bb7aa52 | 225 | * sinTable[i]= sin((i-180) * PI/180.0); |
| emilmont | 1:fdd22bb7aa52 | 226 | * } </pre> |
| emilmont | 1:fdd22bb7aa52 | 227 | */ |
| emilmont | 1:fdd22bb7aa52 | 228 | |
| emilmont | 1:fdd22bb7aa52 | 229 | |
| emilmont | 1:fdd22bb7aa52 | 230 | static const float32_t sinTable[360] = { |
| emilmont | 1:fdd22bb7aa52 | 231 | -0.017452406437283439f, -0.034899496702500699f, -0.052335956242943807f, |
| emilmont | 1:fdd22bb7aa52 | 232 | -0.069756473744125524f, -0.087155742747658638f, -0.104528463267653730f, |
| emilmont | 1:fdd22bb7aa52 | 233 | -0.121869343405147550f, -0.139173100960065740f, |
| emilmont | 1:fdd22bb7aa52 | 234 | -0.156434465040230980f, -0.173648177666930280f, -0.190808995376544970f, |
| emilmont | 1:fdd22bb7aa52 | 235 | -0.207911690817759310f, -0.224951054343864780f, -0.241921895599667730f, |
| emilmont | 1:fdd22bb7aa52 | 236 | -0.258819045102521020f, -0.275637355816999660f, |
| emilmont | 1:fdd22bb7aa52 | 237 | -0.292371704722737050f, -0.309016994374947510f, -0.325568154457156980f, |
| emilmont | 1:fdd22bb7aa52 | 238 | -0.342020143325668880f, -0.358367949545300210f, -0.374606593415912240f, |
| emilmont | 1:fdd22bb7aa52 | 239 | -0.390731128489274160f, -0.406736643075800430f, |
| emilmont | 1:fdd22bb7aa52 | 240 | -0.422618261740699500f, -0.438371146789077290f, -0.453990499739546860f, |
| emilmont | 1:fdd22bb7aa52 | 241 | -0.469471562785891080f, -0.484809620246337170f, -0.499999999999999940f, |
| emilmont | 1:fdd22bb7aa52 | 242 | -0.515038074910054380f, -0.529919264233204900f, |
| emilmont | 1:fdd22bb7aa52 | 243 | -0.544639035015026860f, -0.559192903470746900f, -0.573576436351046380f, |
| emilmont | 1:fdd22bb7aa52 | 244 | -0.587785252292473250f, -0.601815023152048160f, -0.615661475325658400f, |
| emilmont | 1:fdd22bb7aa52 | 245 | -0.629320391049837720f, -0.642787609686539470f, |
| emilmont | 1:fdd22bb7aa52 | 246 | -0.656059028990507280f, -0.669130606358858350f, -0.681998360062498590f, |
| emilmont | 1:fdd22bb7aa52 | 247 | -0.694658370458997140f, -0.707106781186547570f, -0.719339800338651410f, |
| emilmont | 1:fdd22bb7aa52 | 248 | -0.731353701619170570f, -0.743144825477394240f, |
| emilmont | 1:fdd22bb7aa52 | 249 | -0.754709580222771790f, -0.766044443118978010f, -0.777145961456971010f, |
| emilmont | 1:fdd22bb7aa52 | 250 | -0.788010753606722010f, -0.798635510047292720f, -0.809016994374947450f, |
| emilmont | 1:fdd22bb7aa52 | 251 | -0.819152044288992020f, -0.829037572555041740f, |
| emilmont | 1:fdd22bb7aa52 | 252 | -0.838670567945424050f, -0.848048096156426070f, -0.857167300702112330f, |
| emilmont | 1:fdd22bb7aa52 | 253 | -0.866025403784438710f, -0.874619707139395850f, -0.882947592858927100f, |
| emilmont | 1:fdd22bb7aa52 | 254 | -0.891006524188367900f, -0.898794046299166930f, |
| emilmont | 1:fdd22bb7aa52 | 255 | -0.906307787036650050f, -0.913545457642600980f, -0.920504853452440370f, |
| emilmont | 1:fdd22bb7aa52 | 256 | -0.927183854566787420f, -0.933580426497201740f, -0.939692620785908430f, |
| emilmont | 1:fdd22bb7aa52 | 257 | -0.945518575599316850f, -0.951056516295153640f, |
| emilmont | 1:fdd22bb7aa52 | 258 | -0.956304755963035550f, -0.961261695938318890f, -0.965925826289068310f, |
| emilmont | 1:fdd22bb7aa52 | 259 | -0.970295726275996470f, -0.974370064785235250f, -0.978147600733805690f, |
| emilmont | 1:fdd22bb7aa52 | 260 | -0.981627183447663980f, -0.984807753012208020f, |
| emilmont | 1:fdd22bb7aa52 | 261 | -0.987688340595137660f, -0.990268068741570360f, -0.992546151641322090f, |
| emilmont | 1:fdd22bb7aa52 | 262 | -0.994521895368273400f, -0.996194698091745550f, -0.997564050259824200f, |
| emilmont | 1:fdd22bb7aa52 | 263 | -0.998629534754573830f, -0.999390827019095760f, |
| emilmont | 1:fdd22bb7aa52 | 264 | -0.999847695156391270f, -1.000000000000000000f, -0.999847695156391270f, |
| emilmont | 1:fdd22bb7aa52 | 265 | -0.999390827019095760f, -0.998629534754573830f, -0.997564050259824200f, |
| emilmont | 1:fdd22bb7aa52 | 266 | -0.996194698091745550f, -0.994521895368273290f, |
| emilmont | 1:fdd22bb7aa52 | 267 | -0.992546151641321980f, -0.990268068741570250f, -0.987688340595137770f, |
| emilmont | 1:fdd22bb7aa52 | 268 | -0.984807753012208020f, -0.981627183447663980f, -0.978147600733805580f, |
| emilmont | 1:fdd22bb7aa52 | 269 | -0.974370064785235250f, -0.970295726275996470f, |
| emilmont | 1:fdd22bb7aa52 | 270 | -0.965925826289068310f, -0.961261695938318890f, -0.956304755963035440f, |
| emilmont | 1:fdd22bb7aa52 | 271 | -0.951056516295153530f, -0.945518575599316740f, -0.939692620785908320f, |
| emilmont | 1:fdd22bb7aa52 | 272 | -0.933580426497201740f, -0.927183854566787420f, |
| emilmont | 1:fdd22bb7aa52 | 273 | -0.920504853452440260f, -0.913545457642600870f, -0.906307787036649940f, |
| emilmont | 1:fdd22bb7aa52 | 274 | -0.898794046299167040f, -0.891006524188367790f, -0.882947592858926880f, |
| emilmont | 1:fdd22bb7aa52 | 275 | -0.874619707139395740f, -0.866025403784438600f, |
| emilmont | 1:fdd22bb7aa52 | 276 | -0.857167300702112220f, -0.848048096156426070f, -0.838670567945423940f, |
| emilmont | 1:fdd22bb7aa52 | 277 | -0.829037572555041740f, -0.819152044288991800f, -0.809016994374947450f, |
| emilmont | 1:fdd22bb7aa52 | 278 | -0.798635510047292830f, -0.788010753606722010f, |
| emilmont | 1:fdd22bb7aa52 | 279 | -0.777145961456970790f, -0.766044443118978010f, -0.754709580222772010f, |
| emilmont | 1:fdd22bb7aa52 | 280 | -0.743144825477394240f, -0.731353701619170460f, -0.719339800338651080f, |
| emilmont | 1:fdd22bb7aa52 | 281 | -0.707106781186547460f, -0.694658370458997250f, |
| emilmont | 1:fdd22bb7aa52 | 282 | -0.681998360062498480f, -0.669130606358858240f, -0.656059028990507160f, |
| emilmont | 1:fdd22bb7aa52 | 283 | -0.642787609686539250f, -0.629320391049837390f, -0.615661475325658180f, |
| emilmont | 1:fdd22bb7aa52 | 284 | -0.601815023152048270f, -0.587785252292473140f, |
| emilmont | 1:fdd22bb7aa52 | 285 | -0.573576436351046050f, -0.559192903470746900f, -0.544639035015027080f, |
| emilmont | 1:fdd22bb7aa52 | 286 | -0.529919264233204900f, -0.515038074910054160f, -0.499999999999999940f, |
| emilmont | 1:fdd22bb7aa52 | 287 | -0.484809620246337060f, -0.469471562785890810f, |
| emilmont | 1:fdd22bb7aa52 | 288 | -0.453990499739546750f, -0.438371146789077400f, -0.422618261740699440f, |
| emilmont | 1:fdd22bb7aa52 | 289 | -0.406736643075800150f, -0.390731128489273720f, -0.374606593415912010f, |
| emilmont | 1:fdd22bb7aa52 | 290 | -0.358367949545300270f, -0.342020143325668710f, |
| emilmont | 1:fdd22bb7aa52 | 291 | -0.325568154457156640f, -0.309016994374947400f, -0.292371704722736770f, |
| emilmont | 1:fdd22bb7aa52 | 292 | -0.275637355816999160f, -0.258819045102520740f, -0.241921895599667730f, |
| emilmont | 1:fdd22bb7aa52 | 293 | -0.224951054343865000f, -0.207911690817759310f, |
| emilmont | 1:fdd22bb7aa52 | 294 | -0.190808995376544800f, -0.173648177666930330f, -0.156434465040230870f, |
| emilmont | 1:fdd22bb7aa52 | 295 | -0.139173100960065440f, -0.121869343405147480f, -0.104528463267653460f, |
| emilmont | 1:fdd22bb7aa52 | 296 | -0.087155742747658166f, -0.069756473744125302f, |
| emilmont | 1:fdd22bb7aa52 | 297 | -0.052335956242943828f, -0.034899496702500969f, -0.017452406437283512f, |
| emilmont | 1:fdd22bb7aa52 | 298 | 0.000000000000000000f, 0.017452406437283512f, 0.034899496702500969f, |
| emilmont | 1:fdd22bb7aa52 | 299 | 0.052335956242943828f, 0.069756473744125302f, |
| emilmont | 1:fdd22bb7aa52 | 300 | 0.087155742747658166f, 0.104528463267653460f, 0.121869343405147480f, |
| emilmont | 1:fdd22bb7aa52 | 301 | 0.139173100960065440f, 0.156434465040230870f, 0.173648177666930330f, |
| emilmont | 1:fdd22bb7aa52 | 302 | 0.190808995376544800f, 0.207911690817759310f, |
| emilmont | 1:fdd22bb7aa52 | 303 | 0.224951054343865000f, 0.241921895599667730f, 0.258819045102520740f, |
| emilmont | 1:fdd22bb7aa52 | 304 | 0.275637355816999160f, 0.292371704722736770f, 0.309016994374947400f, |
| emilmont | 1:fdd22bb7aa52 | 305 | 0.325568154457156640f, 0.342020143325668710f, |
| emilmont | 1:fdd22bb7aa52 | 306 | 0.358367949545300270f, 0.374606593415912010f, 0.390731128489273720f, |
| emilmont | 1:fdd22bb7aa52 | 307 | 0.406736643075800150f, 0.422618261740699440f, 0.438371146789077400f, |
| emilmont | 1:fdd22bb7aa52 | 308 | 0.453990499739546750f, 0.469471562785890810f, |
| emilmont | 1:fdd22bb7aa52 | 309 | 0.484809620246337060f, 0.499999999999999940f, 0.515038074910054160f, |
| emilmont | 1:fdd22bb7aa52 | 310 | 0.529919264233204900f, 0.544639035015027080f, 0.559192903470746900f, |
| emilmont | 1:fdd22bb7aa52 | 311 | 0.573576436351046050f, 0.587785252292473140f, |
| emilmont | 1:fdd22bb7aa52 | 312 | 0.601815023152048270f, 0.615661475325658180f, 0.629320391049837390f, |
| emilmont | 1:fdd22bb7aa52 | 313 | 0.642787609686539250f, 0.656059028990507160f, 0.669130606358858240f, |
| emilmont | 1:fdd22bb7aa52 | 314 | 0.681998360062498480f, 0.694658370458997250f, |
| emilmont | 1:fdd22bb7aa52 | 315 | 0.707106781186547460f, 0.719339800338651080f, 0.731353701619170460f, |
| emilmont | 1:fdd22bb7aa52 | 316 | 0.743144825477394240f, 0.754709580222772010f, 0.766044443118978010f, |
| emilmont | 1:fdd22bb7aa52 | 317 | 0.777145961456970790f, 0.788010753606722010f, |
| emilmont | 1:fdd22bb7aa52 | 318 | 0.798635510047292830f, 0.809016994374947450f, 0.819152044288991800f, |
| emilmont | 1:fdd22bb7aa52 | 319 | 0.829037572555041740f, 0.838670567945423940f, 0.848048096156426070f, |
| emilmont | 1:fdd22bb7aa52 | 320 | 0.857167300702112220f, 0.866025403784438600f, |
| emilmont | 1:fdd22bb7aa52 | 321 | 0.874619707139395740f, 0.882947592858926880f, 0.891006524188367790f, |
| emilmont | 1:fdd22bb7aa52 | 322 | 0.898794046299167040f, 0.906307787036649940f, 0.913545457642600870f, |
| emilmont | 1:fdd22bb7aa52 | 323 | 0.920504853452440260f, 0.927183854566787420f, |
| emilmont | 1:fdd22bb7aa52 | 324 | 0.933580426497201740f, 0.939692620785908320f, 0.945518575599316740f, |
| emilmont | 1:fdd22bb7aa52 | 325 | 0.951056516295153530f, 0.956304755963035440f, 0.961261695938318890f, |
| emilmont | 1:fdd22bb7aa52 | 326 | 0.965925826289068310f, 0.970295726275996470f, |
| emilmont | 1:fdd22bb7aa52 | 327 | 0.974370064785235250f, 0.978147600733805580f, 0.981627183447663980f, |
| emilmont | 1:fdd22bb7aa52 | 328 | 0.984807753012208020f, 0.987688340595137770f, 0.990268068741570250f, |
| emilmont | 1:fdd22bb7aa52 | 329 | 0.992546151641321980f, 0.994521895368273290f, |
| emilmont | 1:fdd22bb7aa52 | 330 | 0.996194698091745550f, 0.997564050259824200f, 0.998629534754573830f, |
| emilmont | 1:fdd22bb7aa52 | 331 | 0.999390827019095760f, 0.999847695156391270f, 1.000000000000000000f, |
| emilmont | 1:fdd22bb7aa52 | 332 | 0.999847695156391270f, 0.999390827019095760f, |
| emilmont | 1:fdd22bb7aa52 | 333 | 0.998629534754573830f, 0.997564050259824200f, 0.996194698091745550f, |
| emilmont | 1:fdd22bb7aa52 | 334 | 0.994521895368273400f, 0.992546151641322090f, 0.990268068741570360f, |
| emilmont | 1:fdd22bb7aa52 | 335 | 0.987688340595137660f, 0.984807753012208020f, |
| emilmont | 1:fdd22bb7aa52 | 336 | 0.981627183447663980f, 0.978147600733805690f, 0.974370064785235250f, |
| emilmont | 1:fdd22bb7aa52 | 337 | 0.970295726275996470f, 0.965925826289068310f, 0.961261695938318890f, |
| emilmont | 1:fdd22bb7aa52 | 338 | 0.956304755963035550f, 0.951056516295153640f, |
| emilmont | 1:fdd22bb7aa52 | 339 | 0.945518575599316850f, 0.939692620785908430f, 0.933580426497201740f, |
| emilmont | 1:fdd22bb7aa52 | 340 | 0.927183854566787420f, 0.920504853452440370f, 0.913545457642600980f, |
| emilmont | 1:fdd22bb7aa52 | 341 | 0.906307787036650050f, 0.898794046299166930f, |
| emilmont | 1:fdd22bb7aa52 | 342 | 0.891006524188367900f, 0.882947592858927100f, 0.874619707139395850f, |
| emilmont | 1:fdd22bb7aa52 | 343 | 0.866025403784438710f, 0.857167300702112330f, 0.848048096156426070f, |
| emilmont | 1:fdd22bb7aa52 | 344 | 0.838670567945424050f, 0.829037572555041740f, |
| emilmont | 1:fdd22bb7aa52 | 345 | 0.819152044288992020f, 0.809016994374947450f, 0.798635510047292720f, |
| emilmont | 1:fdd22bb7aa52 | 346 | 0.788010753606722010f, 0.777145961456971010f, 0.766044443118978010f, |
| emilmont | 1:fdd22bb7aa52 | 347 | 0.754709580222771790f, 0.743144825477394240f, |
| emilmont | 1:fdd22bb7aa52 | 348 | 0.731353701619170570f, 0.719339800338651410f, 0.707106781186547570f, |
| emilmont | 1:fdd22bb7aa52 | 349 | 0.694658370458997140f, 0.681998360062498590f, 0.669130606358858350f, |
| emilmont | 1:fdd22bb7aa52 | 350 | 0.656059028990507280f, 0.642787609686539470f, |
| emilmont | 1:fdd22bb7aa52 | 351 | 0.629320391049837720f, 0.615661475325658400f, 0.601815023152048160f, |
| emilmont | 1:fdd22bb7aa52 | 352 | 0.587785252292473250f, 0.573576436351046380f, 0.559192903470746900f, |
| emilmont | 1:fdd22bb7aa52 | 353 | 0.544639035015026860f, 0.529919264233204900f, |
| emilmont | 1:fdd22bb7aa52 | 354 | 0.515038074910054380f, 0.499999999999999940f, 0.484809620246337170f, |
| emilmont | 1:fdd22bb7aa52 | 355 | 0.469471562785891080f, 0.453990499739546860f, 0.438371146789077290f, |
| emilmont | 1:fdd22bb7aa52 | 356 | 0.422618261740699500f, 0.406736643075800430f, |
| emilmont | 1:fdd22bb7aa52 | 357 | 0.390731128489274160f, 0.374606593415912240f, 0.358367949545300210f, |
| emilmont | 1:fdd22bb7aa52 | 358 | 0.342020143325668880f, 0.325568154457156980f, 0.309016994374947510f, |
| emilmont | 1:fdd22bb7aa52 | 359 | 0.292371704722737050f, 0.275637355816999660f, |
| emilmont | 1:fdd22bb7aa52 | 360 | 0.258819045102521020f, 0.241921895599667730f, 0.224951054343864780f, |
| emilmont | 1:fdd22bb7aa52 | 361 | 0.207911690817759310f, 0.190808995376544970f, 0.173648177666930280f, |
| emilmont | 1:fdd22bb7aa52 | 362 | 0.156434465040230980f, 0.139173100960065740f, |
| emilmont | 1:fdd22bb7aa52 | 363 | 0.121869343405147550f, 0.104528463267653730f, 0.087155742747658638f, |
| emilmont | 1:fdd22bb7aa52 | 364 | 0.069756473744125524f, 0.052335956242943807f, 0.034899496702500699f, |
| emilmont | 1:fdd22bb7aa52 | 365 | 0.017452406437283439f, 0.000000000000000122f |
| emilmont | 1:fdd22bb7aa52 | 366 | }; |
| emilmont | 1:fdd22bb7aa52 | 367 | |
| emilmont | 1:fdd22bb7aa52 | 368 | |
| emilmont | 1:fdd22bb7aa52 | 369 | /** |
| emilmont | 1:fdd22bb7aa52 | 370 | * @brief Floating-point sin_cos function. |
| emilmont | 1:fdd22bb7aa52 | 371 | * @param[in] theta input value in degrees |
| emilmont | 1:fdd22bb7aa52 | 372 | * @param[out] *pSinVal points to the processed sine output. |
| emilmont | 1:fdd22bb7aa52 | 373 | * @param[out] *pCosVal points to the processed cos output. |
| emilmont | 1:fdd22bb7aa52 | 374 | * @return none. |
| emilmont | 1:fdd22bb7aa52 | 375 | */ |
| emilmont | 1:fdd22bb7aa52 | 376 | |
| emilmont | 1:fdd22bb7aa52 | 377 | |
| emilmont | 1:fdd22bb7aa52 | 378 | void arm_sin_cos_f32( |
| emilmont | 1:fdd22bb7aa52 | 379 | float32_t theta, |
| emilmont | 1:fdd22bb7aa52 | 380 | float32_t * pSinVal, |
| emilmont | 1:fdd22bb7aa52 | 381 | float32_t * pCosVal) |
| emilmont | 1:fdd22bb7aa52 | 382 | { |
| emilmont | 1:fdd22bb7aa52 | 383 | int32_t i; /* Index for reading nearwst output values */ |
| emilmont | 1:fdd22bb7aa52 | 384 | float32_t x1 = -179.0f; /* Initial input value */ |
| emilmont | 1:fdd22bb7aa52 | 385 | float32_t y0, y1; /* nearest output values */ |
| emilmont | 1:fdd22bb7aa52 | 386 | float32_t y2, y3; |
| emilmont | 1:fdd22bb7aa52 | 387 | float32_t fract; /* fractional part of input */ |
| emilmont | 1:fdd22bb7aa52 | 388 | |
| emilmont | 1:fdd22bb7aa52 | 389 | /* Calculation of fractional part */ |
| emilmont | 1:fdd22bb7aa52 | 390 | if(theta > 0.0f) |
| emilmont | 1:fdd22bb7aa52 | 391 | { |
| emilmont | 1:fdd22bb7aa52 | 392 | fract = theta - (float32_t) ((int32_t) theta); |
| emilmont | 1:fdd22bb7aa52 | 393 | } |
| emilmont | 1:fdd22bb7aa52 | 394 | else |
| emilmont | 1:fdd22bb7aa52 | 395 | { |
| emilmont | 1:fdd22bb7aa52 | 396 | fract = (theta - (float32_t) ((int32_t) theta)) + 1.0f; |
| emilmont | 1:fdd22bb7aa52 | 397 | } |
| emilmont | 1:fdd22bb7aa52 | 398 | |
| emilmont | 1:fdd22bb7aa52 | 399 | /* index calculation for reading nearest output values */ |
| emilmont | 1:fdd22bb7aa52 | 400 | i = (uint32_t) (theta - x1); |
| emilmont | 1:fdd22bb7aa52 | 401 | |
| emilmont | 1:fdd22bb7aa52 | 402 | /* Checking min and max index of table */ |
| emilmont | 1:fdd22bb7aa52 | 403 | if(i < 0) |
| emilmont | 1:fdd22bb7aa52 | 404 | { |
| emilmont | 1:fdd22bb7aa52 | 405 | i = 0; |
| emilmont | 1:fdd22bb7aa52 | 406 | } |
| emilmont | 1:fdd22bb7aa52 | 407 | else if(i >= 359) |
| emilmont | 1:fdd22bb7aa52 | 408 | { |
| emilmont | 1:fdd22bb7aa52 | 409 | i = 358; |
| emilmont | 1:fdd22bb7aa52 | 410 | } |
| emilmont | 1:fdd22bb7aa52 | 411 | |
| emilmont | 1:fdd22bb7aa52 | 412 | /* reading nearest sine output values */ |
| emilmont | 1:fdd22bb7aa52 | 413 | y0 = sinTable[i]; |
| emilmont | 1:fdd22bb7aa52 | 414 | y1 = sinTable[i + 1u]; |
| emilmont | 1:fdd22bb7aa52 | 415 | |
| emilmont | 1:fdd22bb7aa52 | 416 | /* reading nearest cosine output values */ |
| emilmont | 1:fdd22bb7aa52 | 417 | y2 = cosTable[i]; |
| emilmont | 1:fdd22bb7aa52 | 418 | y3 = cosTable[i + 1u]; |
| emilmont | 1:fdd22bb7aa52 | 419 | |
| emilmont | 1:fdd22bb7aa52 | 420 | y1 = y1 - y0; |
| emilmont | 1:fdd22bb7aa52 | 421 | y3 = y3 - y2; |
| emilmont | 1:fdd22bb7aa52 | 422 | |
| emilmont | 1:fdd22bb7aa52 | 423 | y1 = fract * y1; |
| emilmont | 1:fdd22bb7aa52 | 424 | y3 = fract * y3; |
| emilmont | 1:fdd22bb7aa52 | 425 | |
| emilmont | 1:fdd22bb7aa52 | 426 | /* Calculation of sine value */ |
| emilmont | 1:fdd22bb7aa52 | 427 | *pSinVal = y0 + y1; |
| emilmont | 1:fdd22bb7aa52 | 428 | |
| emilmont | 1:fdd22bb7aa52 | 429 | /* Calculation of cosine value */ |
| emilmont | 1:fdd22bb7aa52 | 430 | *pCosVal = y2 + y3; |
| emilmont | 1:fdd22bb7aa52 | 431 | |
| emilmont | 1:fdd22bb7aa52 | 432 | } |
| emilmont | 1:fdd22bb7aa52 | 433 | |
| emilmont | 1:fdd22bb7aa52 | 434 | /** |
| emilmont | 1:fdd22bb7aa52 | 435 | * @} end of SinCos group |
| emilmont | 1:fdd22bb7aa52 | 436 | */ |