Asterisk
/
asterisk
mirror of https://github.com/asterisk/asterisk
1
0
Fork 0
Code Issues Releases Wiki Activity

Make tonepair generated through fixed point

Browse Source 
git-svn-id: https://origsvn.digium.com/svn/asterisk/trunk@39886 65c4cc65-6c06-0410-ace0-fbb531ad65f3
1.4
Mark Spencer 19 years ago
parent 7de6ec3337
commit 5b5220fb77
1 changed files with 37 additions and 14 deletions
Show Stats Download Patch File Download Diff File

51
channel.c
Unescape View File

@ -3807,12 +3807,18 @@ struct tonepair_def {
}; };
struct tonepair_state { struct tonepair_state {
float freq1; int fac1;
float freq2; int fac2;
float vol; int v1_1;
int duration; int v2_1;
int pos; int v3_1;
int v1_2;
int v2_2;
int v3_2;
int origwfmt; int origwfmt;
int pos;
int duration;
int modulate;
struct ast_frame f; struct ast_frame f;
unsigned char offset[AST_FRIENDLY_OFFSET]; unsigned char offset[AST_FRIENDLY_OFFSET];
short data[4000]; short data[4000];
@ -3840,10 +3846,16 @@ static void *tonepair_alloc(struct ast_channel *chan, void *params)
tonepair_release(NULL, ts); tonepair_release(NULL, ts);
ts = NULL; ts = NULL;
} else { } else {
ts->freq1 = td->freq1; ts->fac1 = 2.0 * cos(2.0 * M_PI * (td->freq1 / 8000.0)) * 32768.0;
ts->freq2 = td->freq2; ts->v1_1 = 0;
ts->v2_1 = sin(-4.0 * M_PI * (td->freq1 / 8000.0)) * td->vol;
ts->v3_1 = sin(-2.0 * M_PI * (td->freq1 / 8000.0)) * td->vol;
ts->v2_1 = 0;
ts->fac2 = 2.0 * cos(2.0 * M_PI * (td->freq2 / 8000.0)) * 32768.0;
ts->v2_2 = sin(-4.0 * M_PI * (td->freq2 / 8000.0)) * td->vol;
ts->v3_2 = sin(-2.0 * M_PI * (td->freq2 / 8000.0)) * td->vol;
ts->duration = td->duration; ts->duration = td->duration;
ts->vol = td->vol; ts->modulate = 0;
} }
/* Let interrupts interrupt :) */ /* Let interrupts interrupt :) */
ast_set_flag(chan, AST_FLAG_WRITE_INT); ast_set_flag(chan, AST_FLAG_WRITE_INT);
@ -3865,12 +3877,23 @@ static int tonepair_generator(struct ast_channel *chan, void *data, int len, int
return -1; return -1;
} }
memset(&ts->f, 0, sizeof(ts->f)); memset(&ts->f, 0, sizeof(ts->f));
for (x = 0; x < (len / 2); x++) { for (x=0;x<len/2;x++) {
ts->data[x] = ts->vol * ( ts->v1_1 = ts->v2_1;
sin((ts->freq1 * 2.0 * M_PI / 8000.0) * (ts->pos + x)) + ts->v2_1 = ts->v3_1;
sin((ts->freq2 * 2.0 * M_PI / 8000.0) * (ts->pos + x)) ts->v3_1 = (ts->fac1 * ts->v2_1 >> 15) - ts->v1_1;
);
} ts->v1_2 = ts->v2_2;
ts->v2_2 = ts->v3_2;
ts->v3_2 = (ts->fac2 * ts->v2_2 >> 15) - ts->v1_2;
if (ts->modulate) {
int p;
p = ts->v3_2 - 32768;
if (p < 0) p = -p;
p = ((p * 9) / 10) + 1;
ts->data[x] = (ts->v3_1 * p) >> 15;
} else
ts->data[x] = ts->v3_1 + ts->v3_2;
}
ts->f.frametype = AST_FRAME_VOICE; ts->f.frametype = AST_FRAME_VOICE;
ts->f.subclass = AST_FORMAT_SLINEAR; ts->f.subclass = AST_FORMAT_SLINEAR;
ts->f.datalen = len; ts->f.datalen = len;

Write Preview
Loading…
Cancel
Save