diff options
author | markster <markster@f38db490-d61c-443f-a65b-d21fe96a405b> | 2004-03-28 02:53:04 +0000 |
---|---|---|
committer | markster <markster@f38db490-d61c-443f-a65b-d21fe96a405b> | 2004-03-28 02:53:04 +0000 |
commit | 220819511bec63824ac61d3984e953fdac143ea4 (patch) | |
tree | 602e7dec85474b5d59fc9805a74dd429d0ea50f0 /dsp.c | |
parent | 301d109812345481ecefd837995bdb74df1157e6 (diff) |
Add support for Costa Rica to DSP
git-svn-id: http://svn.digium.com/svn/asterisk/trunk@2576 f38db490-d61c-443f-a65b-d21fe96a405b
Diffstat (limited to 'dsp.c')
-rwxr-xr-x | dsp.c | 169 |
1 files changed, 107 insertions, 62 deletions
@@ -43,6 +43,42 @@ #include <errno.h> #include <stdio.h> +/* Number of goertzels for progress detect */ +#define GSAMP_SIZE_NA 183 /* North America - 350, 440, 480, 620, 950, 1400, 1800 Hz */ +#define GSAMP_SIZE_CR 188 /* Costa Rica - Only care about 425 Hz */ + +#define PROG_MODE_NA 0 +#define PROG_MODE_CR 1 + +/* For US modes */ +#define HZ_350 0 +#define HZ_440 1 +#define HZ_480 2 +#define HZ_620 3 +#define HZ_950 4 +#define HZ_1400 5 +#define HZ_1800 6 + +/* For CR modes */ +#define HZ_425 0 + +static struct progalias { + char *name; + int mode; +} aliases[] = { + { "us", PROG_MODE_NA }, + { "ca", PROG_MODE_NA }, + { "cr", PROG_MODE_CR }, +}; + +static struct progress { + int size; + int freqs[7]; +} modes[] = { + { GSAMP_SIZE_NA, { 350, 440, 480, 620, 950, 1400, 1800 } }, /* North America */ + { GSAMP_SIZE_CR, { 425 } }, +}; + #define DEFAULT_THRESHOLD 1024 #define BUSY_PERCENT 10 /* The percentage diffrence between the two last silence periods */ @@ -53,20 +89,9 @@ /* Remember last 15 units */ #define DSP_HISTORY 15 -/* Number of goertzels for progress detect */ -#define GSAMP_SIZE 183 - /* Define if you want the fax detector -- NOT RECOMMENDED IN -STABLE */ #define FAX_DETECT -#define HZ_350 0 -#define HZ_440 1 -#define HZ_480 2 -#define HZ_620 3 -#define HZ_950 4 -#define HZ_1400 5 -#define HZ_1800 6 - #define TONE_THRESH 10.0 /* How much louder the tone should be than channel energy */ #define TONE_MIN_THRESH 1e8 /* How much tone there should be at least to attempt */ #define COUNT_THRESH 3 /* Need at least 50ms of stuff to count it */ @@ -270,7 +295,10 @@ struct ast_dsp { int historicnoise[DSP_HISTORY]; int historicsilence[DSP_HISTORY]; goertzel_state_t freqs[7]; + int freqcount; int gsamps; + int gsamp_size; + int progmode; int tstate; int tcount; int digitmode; @@ -1099,65 +1127,63 @@ int ast_dsp_getdigits (struct ast_dsp *dsp, static int __ast_dsp_call_progress(struct ast_dsp *dsp, short *s, int len) { int x; + int y; int pass; int newstate = TONE_STATE_SILENCE; int res = 0; while(len) { /* Take the lesser of the number of samples we need and what we have */ pass = len; - if (pass > GSAMP_SIZE - dsp->gsamps) - pass = GSAMP_SIZE - dsp->gsamps; + if (pass > dsp->gsamp_size - dsp->gsamps) + pass = dsp->gsamp_size - dsp->gsamps; for (x=0;x<pass;x++) { - goertzel_sample(&dsp->freqs[HZ_350], s[x]); - goertzel_sample(&dsp->freqs[HZ_440], s[x]); - goertzel_sample(&dsp->freqs[HZ_480], s[x]); - goertzel_sample(&dsp->freqs[HZ_620], s[x]); - goertzel_sample(&dsp->freqs[HZ_950], s[x]); - goertzel_sample(&dsp->freqs[HZ_1400], s[x]); - goertzel_sample(&dsp->freqs[HZ_1800], s[x]); + for (y=0;y<dsp->freqcount;y++) + goertzel_sample(&dsp->freqs[y], s[x]); dsp->genergy += s[x] * s[x]; } s += pass; dsp->gsamps += pass; len -= pass; - if (dsp->gsamps == GSAMP_SIZE) { - float hz_350; - float hz_440; - float hz_480; - float hz_620; - float hz_950; - float hz_1400; - float hz_1800; - hz_350 = goertzel_result(&dsp->freqs[HZ_350]); - hz_440 = goertzel_result(&dsp->freqs[HZ_440]); - hz_480 = goertzel_result(&dsp->freqs[HZ_480]); - hz_620 = goertzel_result(&dsp->freqs[HZ_620]); - hz_950 = goertzel_result(&dsp->freqs[HZ_950]); - hz_1400 = goertzel_result(&dsp->freqs[HZ_1400]); - hz_1800 = goertzel_result(&dsp->freqs[HZ_1800]); + if (dsp->gsamps == dsp->gsamp_size) { + float hz[7]; + for (y=0;y<7;y++) + hz[y] = goertzel_result(&dsp->freqs[y]); #if 0 printf("Got whole dsp state: 350: %e, 440: %e, 480: %e, 620: %e, 950: %e, 1400: %e, 1800: %e, Energy: %e\n", hz_350, hz_440, hz_480, hz_620, hz_950, hz_1400, hz_1800, dsp->genergy); #endif - if (pair_there(hz_480, hz_620, hz_350, hz_440, dsp->genergy)) { - newstate = TONE_STATE_BUSY; - } else if (pair_there(hz_440, hz_480, hz_350, hz_620, dsp->genergy)) { - newstate = TONE_STATE_RINGING; - } else if (pair_there(hz_350, hz_440, hz_480, hz_620, dsp->genergy)) { - newstate = TONE_STATE_DIALTONE; - } else if (hz_950 > TONE_MIN_THRESH * TONE_THRESH) { - newstate = TONE_STATE_SPECIAL1; - } else if (hz_1400 > TONE_MIN_THRESH * TONE_THRESH) { - if (dsp->tstate == TONE_STATE_SPECIAL1) - newstate = TONE_STATE_SPECIAL2; - } else if (hz_1800 > TONE_MIN_THRESH * TONE_THRESH) { - if (dsp->tstate == TONE_STATE_SPECIAL2) - newstate = TONE_STATE_SPECIAL3; - } else if (dsp->genergy > TONE_MIN_THRESH * TONE_THRESH) { - newstate = TONE_STATE_TALKING; - } else - newstate = TONE_STATE_SILENCE; - + switch(dsp->progmode) { + case PROG_MODE_NA: + if (pair_there(hz[HZ_480], hz[HZ_620], hz[HZ_350], hz[HZ_440], dsp->genergy)) { + newstate = TONE_STATE_BUSY; + } else if (pair_there(hz[HZ_440], hz[HZ_480], hz[HZ_350], hz[HZ_620], dsp->genergy)) { + newstate = TONE_STATE_RINGING; + } else if (pair_there(hz[HZ_350], hz[HZ_440], hz[HZ_480], hz[HZ_620], dsp->genergy)) { + newstate = TONE_STATE_DIALTONE; + } else if (hz[HZ_950] > TONE_MIN_THRESH * TONE_THRESH) { + newstate = TONE_STATE_SPECIAL1; + } else if (hz[HZ_1400] > TONE_MIN_THRESH * TONE_THRESH) { + if (dsp->tstate == TONE_STATE_SPECIAL1) + newstate = TONE_STATE_SPECIAL2; + } else if (hz[HZ_1800] > TONE_MIN_THRESH * TONE_THRESH) { + if (dsp->tstate == TONE_STATE_SPECIAL2) + newstate = TONE_STATE_SPECIAL3; + } else if (dsp->genergy > TONE_MIN_THRESH * TONE_THRESH) { + newstate = TONE_STATE_TALKING; + } else + newstate = TONE_STATE_SILENCE; + break; + case PROG_MODE_CR: + if (hz[HZ_425] > TONE_MIN_THRESH * TONE_THRESH) { + newstate = TONE_STATE_RINGING; + } else if (dsp->genergy > TONE_MIN_THRESH * TONE_THRESH) { + newstate = TONE_STATE_TALKING; + } else + newstate = TONE_STATE_SILENCE; + break; + default: + ast_log(LOG_WARNING, "Can't process in unknown prog mode '%d'\n", dsp->progmode); + } if (newstate == dsp->tstate) { dsp->tcount++; if (dsp->tcount == COUNT_THRESH) { @@ -1581,6 +1607,21 @@ struct ast_frame *ast_dsp_process(struct ast_channel *chan, struct ast_dsp *dsp, return af; } +static void ast_dsp_prog_reset(struct ast_dsp *dsp) +{ + int max = 0; + int x; + dsp->gsamp_size = modes[dsp->progmode].size; + dsp->gsamps = 0; + for (x=0;x<sizeof(modes[dsp->progmode].freqs) / sizeof(modes[dsp->progmode].freqs[0]);x++) { + if (modes[dsp->progmode].freqs[x]) { + goertzel_init(&dsp->freqs[x], (float)modes[dsp->progmode].freqs[x], dsp->gsamp_size); + max = x; + } + } + dsp->freqcount = max; +} + struct ast_dsp *ast_dsp_new(void) { struct ast_dsp *dsp; @@ -1590,14 +1631,6 @@ struct ast_dsp *ast_dsp_new(void) dsp->threshold = DEFAULT_THRESHOLD; dsp->features = DSP_FEATURE_SILENCE_SUPPRESS; dsp->busycount = DSP_HISTORY; - /* Initialize goertzels */ - goertzel_init(&dsp->freqs[HZ_350], 350.0, GSAMP_SIZE); - goertzel_init(&dsp->freqs[HZ_440], 440.0, GSAMP_SIZE); - goertzel_init(&dsp->freqs[HZ_480], 480.0, GSAMP_SIZE); - goertzel_init(&dsp->freqs[HZ_620], 620.0, GSAMP_SIZE); - goertzel_init(&dsp->freqs[HZ_950], 950.0, GSAMP_SIZE); - goertzel_init(&dsp->freqs[HZ_1400], 1400.0, GSAMP_SIZE); - goertzel_init(&dsp->freqs[HZ_1800], 1800.0, GSAMP_SIZE); /* Initialize DTMF detector */ ast_dtmf_detect_init(&dsp->td.dtmf); } @@ -1705,3 +1738,15 @@ int ast_dsp_digitmode(struct ast_dsp *dsp, int digitmode) return 0; } +int ast_dsp_set_call_progress_zone(struct ast_dsp *dsp, char *zone) +{ + int x; + for (x=0;x<sizeof(aliases) / sizeof(aliases[0]);x++) { + if (!strcasecmp(aliases[x].name, zone)) { + dsp->progmode = aliases[x].mode; + ast_dsp_prog_reset(dsp); + return 0; + } + } + return -1; +} |