1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
|
#include "stdio.h"
#ifndef mips
#include "stdlib.h"
#endif
#include "xlisp.h"
#include "sound.h"
#include "falloc.h"
#include "cext.h"
#include "atone.h"
void atone_free(snd_susp_type a_susp);
typedef struct atone_susp_struct {
snd_susp_node susp;
int64_t terminate_cnt;
boolean logically_stopped;
sound_type s;
int s_cnt;
sample_block_values_type s_ptr;
double cc;
double prev;
} atone_susp_node, *atone_susp_type;
void atone_n_fetch(snd_susp_type a_susp, snd_list_type snd_list)
{
atone_susp_type susp = (atone_susp_type) a_susp;
int cnt = 0; /* how many samples computed */
int togo;
int n;
sample_block_type out;
register sample_block_values_type out_ptr;
register sample_block_values_type out_ptr_reg;
register double cc_reg;
register double prev_reg;
register sample_block_values_type s_ptr_reg;
falloc_sample_block(out, "atone_n_fetch");
out_ptr = out->samples;
snd_list->block = out;
while (cnt < max_sample_block_len) { /* outer loop */
/* first compute how many samples to generate in inner loop: */
/* don't overflow the output sample block: */
togo = max_sample_block_len - cnt;
/* don't run past the s input sample block: */
susp_check_term_log_samples(s, s_ptr, s_cnt);
togo = min(togo, susp->s_cnt);
/* don't run past terminate time */
if (susp->terminate_cnt != UNKNOWN &&
susp->terminate_cnt <= susp->susp.current + cnt + togo) {
togo = (int) (susp->terminate_cnt - (susp->susp.current + cnt));
if (togo < 0) togo = 0; /* avoids rounding errros */
if (togo == 0) break;
}
/* don't run past logical stop time */
if (!susp->logically_stopped && susp->susp.log_stop_cnt != UNKNOWN) {
int64_t to_stop = susp->susp.log_stop_cnt - (susp->susp.current + cnt);
/* break if to_stop == 0 (we're at the logical stop)
* AND cnt > 0 (we're not at the beginning of the
* output block).
*/
if (to_stop < 0) to_stop = 0; /* avoids rounding errors */
if (to_stop < togo) {
if (to_stop == 0) {
if (cnt) {
togo = 0;
break;
} else /* keep togo as is: since cnt == 0, we
* can set the logical stop flag on this
* output block
*/
susp->logically_stopped = true;
} else /* limit togo so we can start a new
* block at the LST
*/
togo = (int) to_stop;
}
}
n = togo;
cc_reg = susp->cc;
prev_reg = susp->prev;
s_ptr_reg = susp->s_ptr;
out_ptr_reg = out_ptr;
if (n) do { /* the inner sample computation loop */
double current;
current = *s_ptr_reg++;
/* use prev_reg as temp variable ... */
prev_reg = cc_reg * (prev_reg + current);
/* ... so we can do proper type conversion */
*out_ptr_reg++ = (float) prev_reg;
prev_reg -= current;
} while (--n); /* inner loop */
susp->prev = prev_reg;
/* using s_ptr_reg is a bad idea on RS/6000: */
susp->s_ptr += togo;
out_ptr += togo;
susp_took(s_cnt, togo);
cnt += togo;
} /* outer loop */
/* test for termination */
if (togo == 0 && cnt == 0) {
snd_list_terminate(snd_list);
} else {
snd_list->block_len = cnt;
susp->susp.current += cnt;
}
/* test for logical stop */
if (susp->logically_stopped) {
snd_list->logically_stopped = true;
} else if (susp->susp.log_stop_cnt == susp->susp.current) {
susp->logically_stopped = true;
}
} /* atone_n_fetch */
void atone_s_fetch(snd_susp_type a_susp, snd_list_type snd_list)
{
atone_susp_type susp = (atone_susp_type) a_susp;
int cnt = 0; /* how many samples computed */
int togo;
int n;
sample_block_type out;
register sample_block_values_type out_ptr;
register sample_block_values_type out_ptr_reg;
register double cc_reg;
register double prev_reg;
register sample_type s_scale_reg = susp->s->scale;
register sample_block_values_type s_ptr_reg;
falloc_sample_block(out, "atone_s_fetch");
out_ptr = out->samples;
snd_list->block = out;
while (cnt < max_sample_block_len) { /* outer loop */
/* first compute how many samples to generate in inner loop: */
/* don't overflow the output sample block: */
togo = max_sample_block_len - cnt;
/* don't run past the s input sample block: */
susp_check_term_log_samples(s, s_ptr, s_cnt);
togo = min(togo, susp->s_cnt);
/* don't run past terminate time */
if (susp->terminate_cnt != UNKNOWN &&
susp->terminate_cnt <= susp->susp.current + cnt + togo) {
togo = (int) (susp->terminate_cnt - (susp->susp.current + cnt));
if (togo < 0) togo = 0; /* avoids rounding errros */
if (togo == 0) break;
}
/* don't run past logical stop time */
if (!susp->logically_stopped && susp->susp.log_stop_cnt != UNKNOWN) {
int64_t to_stop = susp->susp.log_stop_cnt - (susp->susp.current + cnt);
/* break if to_stop == 0 (we're at the logical stop)
* AND cnt > 0 (we're not at the beginning of the
* output block).
*/
if (to_stop < 0) to_stop = 0; /* avoids rounding errors */
if (to_stop < togo) {
if (to_stop == 0) {
if (cnt) {
togo = 0;
break;
} else /* keep togo as is: since cnt == 0, we
* can set the logical stop flag on this
* output block
*/
susp->logically_stopped = true;
} else /* limit togo so we can start a new
* block at the LST
*/
togo = (int) to_stop;
}
}
n = togo;
cc_reg = susp->cc;
prev_reg = susp->prev;
s_ptr_reg = susp->s_ptr;
out_ptr_reg = out_ptr;
if (n) do { /* the inner sample computation loop */
double current;
current = (s_scale_reg * *s_ptr_reg++);
/* use prev_reg as temp variable ... */
prev_reg = cc_reg * (prev_reg + current);
/* ... so we can do proper type conversion */
*out_ptr_reg++ = (float) prev_reg;
prev_reg -= current;
} while (--n); /* inner loop */
susp->prev = prev_reg;
/* using s_ptr_reg is a bad idea on RS/6000: */
susp->s_ptr += togo;
out_ptr += togo;
susp_took(s_cnt, togo);
cnt += togo;
} /* outer loop */
/* test for termination */
if (togo == 0 && cnt == 0) {
snd_list_terminate(snd_list);
} else {
snd_list->block_len = cnt;
susp->susp.current += cnt;
}
/* test for logical stop */
if (susp->logically_stopped) {
snd_list->logically_stopped = true;
} else if (susp->susp.log_stop_cnt == susp->susp.current) {
susp->logically_stopped = true;
}
} /* atone_s_fetch */
void atone_toss_fetch(snd_susp_type a_susp, snd_list_type snd_list)
{
atone_susp_type susp = (atone_susp_type) a_susp;
time_type final_time = susp->susp.t0;
int n;
/* fetch samples from s up to final_time for this block of zeros */
while ((ROUNDBIG((final_time - susp->s->t0) * susp->s->sr)) >=
susp->s->current)
susp_get_samples(s, s_ptr, s_cnt);
/* convert to normal processing when we hit final_count */
/* we want each signal positioned at final_time */
n = (int) ROUNDBIG((final_time - susp->s->t0) * susp->s->sr -
(susp->s->current - susp->s_cnt));
susp->s_ptr += n;
susp_took(s_cnt, n);
susp->susp.fetch = susp->susp.keep_fetch;
(*(susp->susp.fetch))(a_susp, snd_list);
}
void atone_mark(snd_susp_type a_susp)
{
atone_susp_type susp = (atone_susp_type) a_susp;
sound_xlmark(susp->s);
}
void atone_free(snd_susp_type a_susp)
{
atone_susp_type susp = (atone_susp_type) a_susp;
sound_unref(susp->s);
ffree_generic(susp, sizeof(atone_susp_node), "atone_free");
}
void atone_print_tree(snd_susp_type a_susp, int n)
{
atone_susp_type susp = (atone_susp_type) a_susp;
indent(n);
stdputstr("s:");
sound_print_tree_1(susp->s, n);
}
sound_type snd_make_atone(sound_type s, double hz)
{
register atone_susp_type susp;
double bb;
rate_type sr = s->sr;
time_type t0 = s->t0;
int interp_desc = 0;
sample_type scale_factor = 1.0F;
time_type t0_min = t0;
falloc_generic(susp, atone_susp_node, "snd_make_atone");
bb = 2.0 - cos(hz * PI2 / s->sr);
susp->cc = bb - sqrt((bb * bb) - 1.0);
susp->prev = 0.0;
/* select a susp fn based on sample rates */
interp_desc = (interp_desc << 2) + interp_style(s, sr);
switch (interp_desc) {
case INTERP_n: susp->susp.fetch = atone_n_fetch; break;
case INTERP_s: susp->susp.fetch = atone_s_fetch; break;
default: snd_badsr(); break;
}
susp->terminate_cnt = UNKNOWN;
/* handle unequal start times, if any */
if (t0 < s->t0) sound_prepend_zeros(s, t0);
/* minimum start time over all inputs: */
t0_min = min(s->t0, t0);
/* how many samples to toss before t0: */
susp->susp.toss_cnt = (long) ((t0 - t0_min) * sr + 0.5);
if (susp->susp.toss_cnt > 0) {
susp->susp.keep_fetch = susp->susp.fetch;
susp->susp.fetch = atone_toss_fetch;
}
/* initialize susp state */
susp->susp.free = atone_free;
susp->susp.sr = sr;
susp->susp.t0 = t0;
susp->susp.mark = atone_mark;
susp->susp.print_tree = atone_print_tree;
susp->susp.name = "atone";
susp->logically_stopped = false;
susp->susp.log_stop_cnt = logical_stop_cnt_cvt(s);
susp->susp.current = 0;
susp->s = s;
susp->s_cnt = 0;
return sound_create((snd_susp_type)susp, t0, sr, scale_factor);
}
sound_type snd_atone(sound_type s, double hz)
{
sound_type s_copy = sound_copy(s);
return snd_make_atone(s_copy, hz);
}
|
