mirror of
https://github.com/signalwire/freeswitch.git
synced 2025-08-13 17:38:59 +00:00
Add in new tone detection/generation library "libteletone"
Thanks to coppice, trixter, mikej and bkw for research, hints and or code examples. git-svn-id: http://svn.freeswitch.org/svn/freeswitch/trunk@629 d0543943-73ff-0310-b7d9-9358b9ac24b2
This commit is contained in:
Anthony Minessale
363
libs/libteletone/src/libteletone_generate.c
Normal file
363
libs/libteletone/src/libteletone_generate.c
Normal file
@@ -0,0 +1,363 @@
|
||||
/*
|
||||
* libteletone
|
||||
* Copyright (C) 2005/2006, Anthony Minessale II <anthmct@yahoo.com>
|
||||
*
|
||||
* Version: MPL 1.1
|
||||
*
|
||||
* The contents of this file are subject to the Mozilla Public License Version
|
||||
* 1.1 (the "License"); you may not use this file except in compliance with
|
||||
* the License. You may obtain a copy of the License at
|
||||
* http://www.mozilla.org/MPL/
|
||||
*
|
||||
* Software distributed under the License is distributed on an "AS IS" basis,
|
||||
* WITHOUT WARRANTY OF ANY KIND, either express or implied. See the License
|
||||
* for the specific language governing rights and limitations under the
|
||||
* License.
|
||||
*
|
||||
* The Original Code is libteletone
|
||||
*
|
||||
* The Initial Developer of the Original Code is
|
||||
* Anthony Minessale II <anthmct@yahoo.com>
|
||||
* Portions created by the Initial Developer are Copyright (C)
|
||||
* the Initial Developer. All Rights Reserved.
|
||||
*
|
||||
* Contributor(s):
|
||||
*
|
||||
* Anthony Minessale II <anthmct@yahoo.com>
|
||||
*
|
||||
*
|
||||
* libteletone.c -- Tone Generator
|
||||
*
|
||||
*/
|
||||
#include <libteletone.h>
|
||||
|
||||
|
||||
|
||||
int teletone_set_tone(teletone_generation_session_t *ts, int index, ...)
|
||||
{
|
||||
va_list ap;
|
||||
int i = 0;
|
||||
double x = 0;
|
||||
|
||||
va_start(ap, index);
|
||||
while (i <= TELETONE_MAX_TONES && (x = va_arg(ap, double))) {
|
||||
ts->TONES[index].freqs[i++] = x;
|
||||
}
|
||||
va_end(ap);
|
||||
|
||||
return (i > TELETONE_MAX_TONES) ? -1 : 0;
|
||||
|
||||
}
|
||||
|
||||
int teletone_set_map(teletone_tone_map_t *map, ...)
|
||||
{
|
||||
va_list ap;
|
||||
int i = 0;
|
||||
double x = 0;
|
||||
|
||||
va_start(ap, map);
|
||||
while (i <= TELETONE_MAX_TONES && (x = va_arg(ap, double))) {
|
||||
map->freqs[i++] = x;
|
||||
}
|
||||
va_end(ap);
|
||||
|
||||
return (i > TELETONE_MAX_TONES) ? -1 : 0;
|
||||
|
||||
}
|
||||
|
||||
int teletone_init_session(teletone_generation_session_t *ts, int buflen, tone_handler handler, void *user_data)
|
||||
{
|
||||
memset(ts, 0, sizeof(*ts));
|
||||
ts->rate = 8000;
|
||||
ts->channels = 1;
|
||||
ts->duration = 2000;
|
||||
ts->wait = 500;
|
||||
ts->handler = handler;
|
||||
ts->user_data = user_data;
|
||||
ts->volume = 1500;
|
||||
ts->decay_step = 0;
|
||||
if (!(ts->buffer = calloc(buflen, sizeof(teletone_audio_t)))) {
|
||||
return -1;
|
||||
}
|
||||
ts->datalen = buflen;
|
||||
|
||||
/* Add Standard DTMF Tones */
|
||||
teletone_set_tone(ts, '1', 697.0, 1209.0, 0.0);
|
||||
teletone_set_tone(ts, '2', 697.0, 1336.0, 0.0);
|
||||
teletone_set_tone(ts, '3', 697.0, 1477.0, 0.0);
|
||||
teletone_set_tone(ts, 'A', 697.0, 1633.0, 0.0);
|
||||
teletone_set_tone(ts, '4', 770.0, 1209.0, 0.0);
|
||||
teletone_set_tone(ts, '5', 770.0, 1336.0, 0.0);
|
||||
teletone_set_tone(ts, '6', 770.0, 1477.0, 0.0);
|
||||
teletone_set_tone(ts, 'B', 770.0, 1633.0, 0.0);
|
||||
teletone_set_tone(ts, '7', 859.0, 1209.0, 0.0);
|
||||
teletone_set_tone(ts, '8', 859.0, 1336.0, 0.0);
|
||||
teletone_set_tone(ts, '9', 859.0, 1477.0, 0.0);
|
||||
teletone_set_tone(ts, 'C', 859.0, 1633.0, 0.0);
|
||||
teletone_set_tone(ts, '*', 941.0, 1209.0, 0.0);
|
||||
teletone_set_tone(ts, '0', 941.0, 1336.0, 0.0);
|
||||
teletone_set_tone(ts, '#', 941.0, 1477.0, 0.0);
|
||||
teletone_set_tone(ts, 'D', 941.0, 1633.0, 0.0);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int teletone_destroy_session(teletone_generation_session_t *ts)
|
||||
{
|
||||
if (ts->buffer) {
|
||||
free(ts->buffer);
|
||||
ts->buffer = NULL;
|
||||
ts->samples = 0;
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
/** Generate a specified number of samples containing the three specified
|
||||
* frequencies (in hertz) and dump to the file descriptor audio_fd. */
|
||||
|
||||
int teletone_mux_tones(teletone_generation_session_t *ts, teletone_tone_map_t *map)
|
||||
{
|
||||
double period = (1.0 / ts->rate) / ts->channels;
|
||||
int i, c;
|
||||
int freqlen = 0;
|
||||
double tones[TELETONE_MAX_TONES];
|
||||
int decay = 0;
|
||||
int duration;
|
||||
int wait = 0;
|
||||
teletone_process_t sample;
|
||||
|
||||
ts->samples = 0;
|
||||
|
||||
duration = (ts->tmp_duration > -1) ? ts->tmp_duration : ts->duration;
|
||||
wait = (ts->tmp_wait > -1) ? ts->tmp_wait : ts->wait;
|
||||
|
||||
if (map->freqs[0] > 0) {
|
||||
if (ts->decay_step) {
|
||||
if (ts->decay_factor) {
|
||||
decay = (duration - (duration / ts->decay_factor));
|
||||
} else {
|
||||
decay = 0;
|
||||
}
|
||||
}
|
||||
if (ts->volume < 0) {
|
||||
ts->volume = 0;
|
||||
}
|
||||
|
||||
for (freqlen = 0; map->freqs[freqlen] && freqlen < TELETONE_MAX_TONES; freqlen++) {
|
||||
tones[freqlen] = (double) map->freqs[freqlen] * (2 * M_PI);
|
||||
}
|
||||
|
||||
if (ts->channels > 1) {
|
||||
duration *= ts->channels;
|
||||
}
|
||||
|
||||
for (ts->samples = 0; ts->samples < ts->datalen && ts->samples < duration; ts->samples++) {
|
||||
if (ts->decay_step && !(ts->samples % ts->decay_step) && ts->volume > 0 && ts->samples > decay) {
|
||||
ts->volume += ts->decay_direction;
|
||||
}
|
||||
|
||||
sample = (teletone_process_t) 128;
|
||||
|
||||
for (i = 0; i < freqlen; i++) {
|
||||
sample += ((teletone_process_t) 2 * (ts->volume > 0 ? ts->volume : 1) * cos(tones[i] * ts->samples * period));
|
||||
}
|
||||
ts->buffer[ts->samples] = sample;
|
||||
|
||||
for (c = 1; c < ts->channels; c++) {
|
||||
ts->buffer[ts->samples+1] = ts->buffer[ts->samples];
|
||||
ts->samples++;
|
||||
}
|
||||
|
||||
}
|
||||
}
|
||||
for (c = 0; c < ts->channels; c++) {
|
||||
for (i = 0; i < wait && ts->samples < ts->datalen; i++) {
|
||||
ts->buffer[ts->samples++] = 0;
|
||||
}
|
||||
}
|
||||
|
||||
if (ts->debug && ts->debug_stream) {
|
||||
if (map->freqs[0] <= 0) {
|
||||
fprintf(ts->debug_stream, "wait %d (%dms)\n", wait, wait / (ts->rate / 1000));
|
||||
} else {
|
||||
fprintf(ts->debug_stream, "Generate: (");
|
||||
|
||||
for (i = 0; i < TELETONE_MAX_TONES && map->freqs[i]; i++) {
|
||||
fprintf(ts->debug_stream, "%s%0.2f", i == 0 ? "" : "+",map->freqs[i]);
|
||||
}
|
||||
|
||||
fprintf(ts->debug_stream, ") [volume %d; samples %d(%dms) x %d channel%s; wait %d(%dms); decay_factor %d; decay_step %d; wrote %d bytes]\n",
|
||||
ts->volume,
|
||||
duration,
|
||||
duration / (ts->rate / 1000),
|
||||
ts->channels,
|
||||
ts->channels == 1 ? "" : "s",
|
||||
wait,
|
||||
wait / (ts->rate / 1000),
|
||||
ts->decay_factor,
|
||||
ts->decay_step,
|
||||
ts->samples * 2);
|
||||
}
|
||||
}
|
||||
return ts->samples;
|
||||
}
|
||||
|
||||
|
||||
int teletone_run(teletone_generation_session_t *ts, char *cmd)
|
||||
{
|
||||
char *data, *cur, *end;
|
||||
int var = 0, LOOPING = 0;
|
||||
|
||||
do {
|
||||
data = strdup(cmd);
|
||||
cur = data;
|
||||
|
||||
while (*cur) {
|
||||
var = 0;
|
||||
|
||||
if (*cur == ' ' || *cur == '\r' || *cur == '\n') {
|
||||
cur++;
|
||||
continue;
|
||||
}
|
||||
|
||||
if ((end = strchr(cur, ';'))) {
|
||||
*end++ = '\0';
|
||||
}
|
||||
|
||||
if (*(cur + 1) == '=') {
|
||||
var = 1;
|
||||
switch(*cur) {
|
||||
case 'c':
|
||||
ts->channels = atoi(cur + 2);
|
||||
break;
|
||||
case 'r':
|
||||
ts->rate = atoi(cur + 2);
|
||||
break;
|
||||
case 'd':
|
||||
ts->duration = atoi(cur + 2) * (ts->rate / 1000);
|
||||
break;
|
||||
case 'v':
|
||||
ts->volume = atoi(cur + 2);
|
||||
break;
|
||||
case '>':
|
||||
ts->decay_factor = atoi(cur + 2);
|
||||
ts->decay_direction = -1;
|
||||
break;
|
||||
case '<':
|
||||
ts->decay_factor = atoi(cur + 2);
|
||||
ts->decay_direction = 1;
|
||||
break;
|
||||
case '+':
|
||||
ts->decay_step = atoi(cur + 2);
|
||||
break;
|
||||
case 'w':
|
||||
ts->wait = atoi(cur + 2) * (ts->rate / 1000);
|
||||
break;
|
||||
case 'l':
|
||||
ts->loops = atoi(cur + 2);
|
||||
break;
|
||||
case 'L':
|
||||
if (!LOOPING) {
|
||||
ts->LOOPS = atoi(cur + 2);
|
||||
}
|
||||
LOOPING++;
|
||||
break;
|
||||
}
|
||||
} else {
|
||||
while (*cur) {
|
||||
char *p = NULL, *e = NULL;
|
||||
teletone_tone_map_t mymap, *mapp = NULL;
|
||||
|
||||
if (*cur == ' ' || *cur == '\r' || *cur == '\n') {
|
||||
cur++;
|
||||
continue;
|
||||
}
|
||||
|
||||
ts->tmp_duration = -1;
|
||||
ts->tmp_wait = -1;
|
||||
|
||||
memset(&mymap, 0, sizeof(mymap));
|
||||
|
||||
if (*(cur + 1) == '(') {
|
||||
p = cur + 2;
|
||||
if (*cur) {
|
||||
char *next;
|
||||
int i = 0;
|
||||
if ((e = strchr(p, ')'))) {
|
||||
*e++ = '\0';
|
||||
}
|
||||
do {
|
||||
if ((next = strchr(p, ','))) {
|
||||
*next++ = '\0';
|
||||
}
|
||||
if (i == 0) {
|
||||
ts->tmp_duration = atoi(p) * (ts->rate / 1000);
|
||||
i++;
|
||||
} else if (i == 1) {
|
||||
ts->tmp_wait = atoi(p) * (ts->rate / 1000);
|
||||
i++;
|
||||
} else {
|
||||
mymap.freqs[i++ - 2] = atof(p);
|
||||
}
|
||||
p = next;
|
||||
|
||||
} while (next && (i-2) < TELETONE_MAX_TONES);
|
||||
if (i > 2 && *cur == '%') {
|
||||
mapp = &mymap;
|
||||
} else if ((i != 2 || *cur == '%')) {
|
||||
if (ts->debug && ts->debug_stream) {
|
||||
fprintf(ts->debug_stream, "Syntax Error!\n");
|
||||
}
|
||||
goto bottom;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
if (*cur && !mapp) {
|
||||
if (*cur > 0 && *cur < TELETONE_TONE_RANGE) {
|
||||
mapp = &ts->TONES[(int)*cur];
|
||||
} else if (ts->debug && ts->debug_stream) {
|
||||
fprintf(ts->debug_stream, "Map [%c] Out Of Range!\n", *cur);
|
||||
}
|
||||
}
|
||||
|
||||
if (mapp) {
|
||||
if (mapp->freqs[0]) {
|
||||
if (ts->handler) {
|
||||
do {
|
||||
ts->handler(ts, mapp);
|
||||
if (ts->loops > 0) {
|
||||
ts->loops--;
|
||||
}
|
||||
} while (ts->loops);
|
||||
}
|
||||
} else if (ts->debug && ts->debug_stream) {
|
||||
fprintf(ts->debug_stream, "Ignoring Empty Map [%c]!\n", *cur);
|
||||
}
|
||||
}
|
||||
|
||||
if (e) {
|
||||
cur = e;
|
||||
} else {
|
||||
cur++;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
if (end) {
|
||||
cur = end;
|
||||
} else if (*cur){
|
||||
cur++;
|
||||
}
|
||||
}
|
||||
bottom:
|
||||
free(data);
|
||||
data = NULL;
|
||||
if (ts->LOOPS > 0) {
|
||||
ts->LOOPS--;
|
||||
}
|
||||
|
||||
} while (ts->LOOPS);
|
||||
|
||||
return 0;
|
||||
}
|
||||
Reference in New Issue
Block a user