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