1 | //fader.c: |
---|
2 | |
---|
3 | /* |
---|
4 | * Copyright (C) Philipp 'ph3-der-loewe' Schafft - 2009 |
---|
5 | * |
---|
6 | * This file is part of libroardsp a part of RoarAudio, |
---|
7 | * a cross-platform sound system for both, home and professional use. |
---|
8 | * See README for details. |
---|
9 | * |
---|
10 | * This file is free software; you can redistribute it and/or modify |
---|
11 | * it under the terms of the GNU General Public License version 3 |
---|
12 | * as published by the Free Software Foundation. |
---|
13 | * |
---|
14 | * libroardsp is distributed in the hope that it will be useful, |
---|
15 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
---|
16 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
---|
17 | * GNU General Public License for more details. |
---|
18 | * |
---|
19 | * You should have received a copy of the GNU General Public License |
---|
20 | * along with this software; see the file COPYING. If not, write to |
---|
21 | * the Free Software Foundation, 51 Franklin Street, Fifth Floor, |
---|
22 | * Boston, MA 02110-1301, USA. |
---|
23 | * |
---|
24 | */ |
---|
25 | |
---|
26 | #include "libroardsp.h" |
---|
27 | |
---|
28 | #define _CHECK_BASIC() if ( state == NULL ) return -1 |
---|
29 | #define _CHECK_CALCPCM() _CHECK_BASIC(); if ( frames == 0 ) return 0; if ( data == NULL ) return -1; |
---|
30 | |
---|
31 | int roar_fader_init (struct roar_fader_state * state, float * poly, int coeff) { |
---|
32 | _CHECK_BASIC(); |
---|
33 | |
---|
34 | if ( poly == NULL ) |
---|
35 | return -1; |
---|
36 | |
---|
37 | if ( coeff < 2 ) |
---|
38 | return -1; |
---|
39 | |
---|
40 | if ( coeff > ROAR_FADER_MAX_COEFF ) |
---|
41 | return -1; |
---|
42 | |
---|
43 | memset(state, 0, sizeof(struct roar_fader_state)); |
---|
44 | |
---|
45 | state->rate = -1; |
---|
46 | state->coeff = coeff; |
---|
47 | |
---|
48 | state->start = -1; |
---|
49 | state->stop = -1; |
---|
50 | |
---|
51 | memcpy(state->poly, poly, sizeof(float)*coeff); |
---|
52 | |
---|
53 | return 0; |
---|
54 | } |
---|
55 | |
---|
56 | int roar_fader_set_rate (struct roar_fader_state * state, int rate) { |
---|
57 | _CHECK_BASIC(); |
---|
58 | |
---|
59 | state->rate = rate; |
---|
60 | |
---|
61 | return 0; |
---|
62 | } |
---|
63 | |
---|
64 | int roar_fader_set_startstop(struct roar_fader_state * state, ssize_t start, ssize_t stop) { |
---|
65 | _CHECK_BASIC(); |
---|
66 | |
---|
67 | if ( start >= 0 ) |
---|
68 | state->start = start; |
---|
69 | |
---|
70 | if ( stop >= 0 ) |
---|
71 | state->stop = stop; |
---|
72 | |
---|
73 | return 0; |
---|
74 | } |
---|
75 | |
---|
76 | int roar_fader_calcpcm_i16n(struct roar_fader_state * state, int16_t * data, size_t frames, int channels) { |
---|
77 | _CHECK_CALCPCM(); |
---|
78 | |
---|
79 | switch (channels) { |
---|
80 | case 1: return roar_fader_calcpcm_i161(state, data, frames); |
---|
81 | } |
---|
82 | |
---|
83 | return -1; |
---|
84 | } |
---|
85 | |
---|
86 | int roar_fader_calcpcm_i161(struct roar_fader_state * state, int16_t * data, size_t frames) { |
---|
87 | size_t start, stop, cur; |
---|
88 | int i, i_s, i_e; |
---|
89 | float t_cur, t_step; |
---|
90 | float g_cur; |
---|
91 | |
---|
92 | _CHECK_BASIC(); |
---|
93 | |
---|
94 | if ( state->start == -1 ) { |
---|
95 | start = state->pcmoffset; |
---|
96 | } else { |
---|
97 | start = state->start; |
---|
98 | } |
---|
99 | |
---|
100 | if ( state->stop == -1 ) { |
---|
101 | stop = state->pcmoffset + frames; |
---|
102 | } else { |
---|
103 | stop = state->stop; |
---|
104 | } |
---|
105 | |
---|
106 | cur = state->pcmoffset; |
---|
107 | |
---|
108 | i_s = 0; |
---|
109 | i_e = frames; |
---|
110 | |
---|
111 | if ( start > cur ) |
---|
112 | i_s = start - cur; |
---|
113 | |
---|
114 | if ( stop < (cur + frames) ) |
---|
115 | i_e = stop - cur; |
---|
116 | |
---|
117 | t_step = (float)(state->coeff - 1)/(float)(stop - start); |
---|
118 | |
---|
119 | if ( start < cur ) { |
---|
120 | t_cur = (cur - start)*t_step; |
---|
121 | } else { |
---|
122 | t_cur = 0; |
---|
123 | } |
---|
124 | |
---|
125 | ROAR_DBG("roar_fader_calcpcm_i161(*): i_s->i_e: %i->%i", i_s, i_e); |
---|
126 | |
---|
127 | for (i = i_s; i < i_e; i++, cur++) { |
---|
128 | t_cur += t_step; |
---|
129 | g_cur = roar_math_cvpoly(state->poly, t_cur, state->coeff); |
---|
130 | // ROAR_DBG("roar_fader_calcpcm_i161(*): i=%i, g_cur=%f", i, g_cur); |
---|
131 | data[i] = (float)data[i] * g_cur; |
---|
132 | } |
---|
133 | |
---|
134 | state->pcmoffset = cur; |
---|
135 | |
---|
136 | return -1; |
---|
137 | } |
---|
138 | |
---|
139 | //ll |
---|