mbed-os 6.10 versione
dsp/Sine_f32.cpp@1:fdd22bb7aa52, 2012-11-28 (annotated)
- Committer:
- emilmont
- Date:
- Wed Nov 28 12:30:09 2012 +0000
- Revision:
- 1:fdd22bb7aa52
DSP library code
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
emilmont | 1:fdd22bb7aa52 | 1 | /* mbed Microcontroller Library |
emilmont | 1:fdd22bb7aa52 | 2 | * Copyright (c) 2006-2012 ARM Limited |
emilmont | 1:fdd22bb7aa52 | 3 | * |
emilmont | 1:fdd22bb7aa52 | 4 | * Permission is hereby granted, free of charge, to any person obtaining a copy |
emilmont | 1:fdd22bb7aa52 | 5 | * of this software and associated documentation files (the "Software"), to deal |
emilmont | 1:fdd22bb7aa52 | 6 | * in the Software without restriction, including without limitation the rights |
emilmont | 1:fdd22bb7aa52 | 7 | * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell |
emilmont | 1:fdd22bb7aa52 | 8 | * copies of the Software, and to permit persons to whom the Software is |
emilmont | 1:fdd22bb7aa52 | 9 | * furnished to do so, subject to the following conditions: |
emilmont | 1:fdd22bb7aa52 | 10 | * |
emilmont | 1:fdd22bb7aa52 | 11 | * The above copyright notice and this permission notice shall be included in |
emilmont | 1:fdd22bb7aa52 | 12 | * all copies or substantial portions of the Software. |
emilmont | 1:fdd22bb7aa52 | 13 | * |
emilmont | 1:fdd22bb7aa52 | 14 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR |
emilmont | 1:fdd22bb7aa52 | 15 | * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, |
emilmont | 1:fdd22bb7aa52 | 16 | * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE |
emilmont | 1:fdd22bb7aa52 | 17 | * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER |
emilmont | 1:fdd22bb7aa52 | 18 | * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, |
emilmont | 1:fdd22bb7aa52 | 19 | * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE |
emilmont | 1:fdd22bb7aa52 | 20 | * SOFTWARE. |
emilmont | 1:fdd22bb7aa52 | 21 | */ |
emilmont | 1:fdd22bb7aa52 | 22 | #include "Sine_f32.h" |
emilmont | 1:fdd22bb7aa52 | 23 | #include "math_helper.h" |
emilmont | 1:fdd22bb7aa52 | 24 | |
emilmont | 1:fdd22bb7aa52 | 25 | #define RAD_2PI (2. * PI) |
emilmont | 1:fdd22bb7aa52 | 26 | |
emilmont | 1:fdd22bb7aa52 | 27 | namespace dsp { |
emilmont | 1:fdd22bb7aa52 | 28 | |
emilmont | 1:fdd22bb7aa52 | 29 | Sine_f32::Sine_f32(uint32_t frequency, uint32_t sample_rate, float32_t amplitude, float32_t phase, uint32_t block_size) { |
emilmont | 1:fdd22bb7aa52 | 30 | _dx = RAD_2PI * ((float32_t)frequency / (float32_t)sample_rate); |
emilmont | 1:fdd22bb7aa52 | 31 | _amplitude = amplitude; |
emilmont | 1:fdd22bb7aa52 | 32 | _x = phase; |
emilmont | 1:fdd22bb7aa52 | 33 | _block_size = block_size; |
emilmont | 1:fdd22bb7aa52 | 34 | } |
emilmont | 1:fdd22bb7aa52 | 35 | |
emilmont | 1:fdd22bb7aa52 | 36 | void Sine_f32::process(float32_t *sgn_in, float32_t *sgn_out) { |
emilmont | 1:fdd22bb7aa52 | 37 | for (int i=0; i<_block_size; i++) { |
emilmont | 1:fdd22bb7aa52 | 38 | *sgn_out = *sgn_in + (_amplitude * arm_sin_f32(_x)); |
emilmont | 1:fdd22bb7aa52 | 39 | sgn_in++; sgn_out++; |
emilmont | 1:fdd22bb7aa52 | 40 | _x += _dx; |
emilmont | 1:fdd22bb7aa52 | 41 | } |
emilmont | 1:fdd22bb7aa52 | 42 | } |
emilmont | 1:fdd22bb7aa52 | 43 | |
emilmont | 1:fdd22bb7aa52 | 44 | void Sine_f32::generate(float32_t *sgn) { |
emilmont | 1:fdd22bb7aa52 | 45 | for (int i=0; i<_block_size; i++) { |
emilmont | 1:fdd22bb7aa52 | 46 | *sgn = (_amplitude * arm_sin_f32(_x)); |
emilmont | 1:fdd22bb7aa52 | 47 | sgn++; |
emilmont | 1:fdd22bb7aa52 | 48 | _x += _dx; |
emilmont | 1:fdd22bb7aa52 | 49 | } |
emilmont | 1:fdd22bb7aa52 | 50 | } |
emilmont | 1:fdd22bb7aa52 | 51 | |
emilmont | 1:fdd22bb7aa52 | 52 | void Sine_f32::reset(void) { |
emilmont | 1:fdd22bb7aa52 | 53 | _x = 0.0f; |
emilmont | 1:fdd22bb7aa52 | 54 | } |
emilmont | 1:fdd22bb7aa52 | 55 | |
emilmont | 1:fdd22bb7aa52 | 56 | } |