Michele Riccio / mbed-dsp_F767ZI

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?

UserRevisionLine numberNew 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 }