kenmirrors
/
freeswitch
mirror of https://github.com/signalwire/freeswitch.git
1
0
Fork 0
Code Issues Projects Releases Wiki Activity

whitespace 

git-svn-id: http://svn.freeswitch.org/svn/freeswitch/trunk@10631 d0543943-73ff-0310-b7d9-9358b9ac24b2
This commit is contained in:
Michael Jerris 2008-12-05 20:43:17 +00:00
parent 8f152febe6
commit 6d0e598ee8
1 changed files with 125 additions and 158 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

283
src/mod/applications/mod_vmd/mod_vmd.c
View File

@ -40,7 +40,6 @@
#define ISNAN(x) ((x)== NAN) #define ISNAN(x) ((x)== NAN)
#endif #endif
/* Number of points for beep detection */ /* Number of points for beep detection */
#define POINTS 32 #define POINTS 32
@ -102,7 +101,6 @@
/* Prototypes */ /* Prototypes */
SWITCH_MODULE_SHUTDOWN_FUNCTION(mod_vmd_shutdown); SWITCH_MODULE_SHUTDOWN_FUNCTION(mod_vmd_shutdown);
/* SWITCH_MODULE_RUNTIME_FUNCTION(mod_vmd_runtime); */
SWITCH_STANDARD_API(vmd_api_main); SWITCH_STANDARD_API(vmd_api_main);
SWITCH_MODULE_LOAD_FUNCTION(mod_vmd_load); SWITCH_MODULE_LOAD_FUNCTION(mod_vmd_load);
@ -143,16 +141,10 @@ typedef struct vmd_session_info{
/* A count of how long a distinct beep was detected by /* A count of how long a distinct beep was detected by
* by the discreet energy separation algorithm */ * by the discreet energy separation algorithm */
switch_size_t timestamp; switch_size_t timestamp;
/*
int16_t *data;
ssize_t data_len;
*/
} vmd_session_info_t; } vmd_session_info_t;
static switch_bool_t process_data(vmd_session_info_t *vmd_info, static switch_bool_t process_data(vmd_session_info_t *vmd_info, switch_frame_t *frame);
switch_frame_t *frame); static switch_bool_t vmd_callback(switch_media_bug_t *bug, void *user_data, switch_abc_type_t type);
static switch_bool_t vmd_callback(switch_media_bug_t *bug,
void *user_data, switch_abc_type_t type);
static double freq_estimator(double *x); static double freq_estimator(double *x);
static double ampl_estimator(double *x); static double ampl_estimator(double *x);
static void convert_pts(int16_t *i_pts, double *d_pts, int16_t max); static void convert_pts(int16_t *i_pts, double *d_pts, int16_t max);
@ -165,58 +157,60 @@ static double median(double *m, int n);
*/ */
static switch_bool_t vmd_callback(switch_media_bug_t *bug, static switch_bool_t vmd_callback(switch_media_bug_t *bug,
void *user_data, switch_abc_type_t type) void *user_data,
switch_abc_type_t type)
{ {
vmd_session_info_t *vmd_info; vmd_session_info_t *vmd_info;
switch_codec_t *read_codec; switch_codec_t *read_codec;
switch_frame_t *frame; switch_frame_t *frame;
vmd_info = (vmd_session_info_t *)user_data;
if(vmd_info == NULL) return SWITCH_FALSE;
switch(type){ vmd_info = (vmd_session_info_t *)user_data;
if(vmd_info == NULL) {
return SWITCH_FALSE;
}
case SWITCH_ABC_TYPE_INIT: switch(type){
read_codec =
switch_core_session_get_read_codec(vmd_info->session);
vmd_info->vmd_codec.rate =
read_codec->implementation->samples_per_second;
vmd_info->vmd_codec.channels =
read_codec->implementation->number_of_channels;
break;
case SWITCH_ABC_TYPE_CLOSE: case SWITCH_ABC_TYPE_INIT:
case SWITCH_ABC_TYPE_READ: read_codec = switch_core_session_get_read_codec(vmd_info->session);
case SWITCH_ABC_TYPE_WRITE: vmd_info->vmd_codec.rate = read_codec->implementation->samples_per_second;
break; vmd_info->vmd_codec.channels = read_codec->implementation->number_of_channels;
break;
case SWITCH_ABC_TYPE_READ_REPLACE: case SWITCH_ABC_TYPE_CLOSE:
frame = switch_core_media_bug_get_read_replace_frame(bug); case SWITCH_ABC_TYPE_READ:
return process_data(vmd_info, frame); case SWITCH_ABC_TYPE_WRITE:
break;
case SWITCH_ABC_TYPE_WRITE_REPLACE: case SWITCH_ABC_TYPE_READ_REPLACE:
break; frame = switch_core_media_bug_get_read_replace_frame(bug);
} return process_data(vmd_info, frame);
return SWITCH_TRUE; case SWITCH_ABC_TYPE_WRITE_REPLACE:
break;
}
return SWITCH_TRUE;
} }
static switch_bool_t process_data(vmd_session_info_t *vmd_info, static switch_bool_t process_data(vmd_session_info_t *vmd_info,
switch_frame_t *frame) switch_frame_t *frame)
{ {
uint32_t i; uint32_t i;
unsigned int j; unsigned int j;
double pts[P]; double pts[P];
int16_t *data; int16_t *data;
int16_t max; int16_t max;
switch_ssize_t len; switch_ssize_t len;
len = frame->samples * sizeof(int16_t); len = frame->samples * sizeof(int16_t);
data = (int16_t *)frame->data; data = (int16_t *)frame->data;
for(max = (int16_t)abs(data[0]), i = 1; i < frame->samples; i++){ for(max = (int16_t)abs(data[0]), i = 1; i < frame->samples; i++) {
if((int16_t)abs(data[i]) > max) max = (int16_t)abs(data[i]); if ((int16_t)abs(data[i]) > max) {
} max = (int16_t)abs(data[i]);
}
}
/* /*
if(vmd_info->data_len != len){ if(vmd_info->data_len != len){
@ -239,13 +233,13 @@ static switch_bool_t process_data(vmd_session_info_t *vmd_info,
} }
*/ */
for(i = 0, j = vmd_info->pos; i < frame->samples; j++, j %= POINTS, i += 5){ for(i = 0, j = vmd_info->pos; i < frame->samples; j++, j %= POINTS, i += 5) {
/* convert_pts(vmd_info->data + i, pts); */ /* convert_pts(vmd_info->data + i, pts); */
convert_pts(data + i, pts, max); convert_pts(data + i, pts, max);
vmd_info->points[j].freq = TO_HZ(freq_estimator(pts)); vmd_info->points[j].freq = TO_HZ(freq_estimator(pts));
vmd_info->points[j].ampl = ampl_estimator(pts); vmd_info->points[j].ampl = ampl_estimator(pts);
vmd_info->pos = j % POINTS; vmd_info->pos = j % POINTS;
find_beep(vmd_info, frame); find_beep(vmd_info, frame);
} }
return SWITCH_TRUE; return SWITCH_TRUE;
@ -259,66 +253,42 @@ static void find_beep(vmd_session_info_t *vmd_info, switch_frame_t *frame)
double med; double med;
unsigned int j = (vmd_info->pos + 1) % POINTS; unsigned int j = (vmd_info->pos + 1) % POINTS;
unsigned int k = j; unsigned int k = j;
switch_status_t status;
switch_event_t *event; switch_event_t *event;
switch_status_t status;
switch_event_t *event_copy; switch_event_t *event_copy;
switch(vmd_info->state){ switch(vmd_info->state){
case BEEP_DETECTED: case BEEP_DETECTED:
for(c = 0, i = 0; i < POINTS; j++, j %= POINTS, i++){ for(c = 0, i = 0; i < POINTS; j++, j %= POINTS, i++){
vmd_info->timestamp++; vmd_info->timestamp++;
if(vmd_info->points[j].freq < TOLERANCE_T(vmd_info->beep_freq) && if (vmd_info->points[j].freq < TOLERANCE_T(vmd_info->beep_freq) &&
vmd_info->points[j].freq > TOLERANCE_B(vmd_info->beep_freq)){ vmd_info->points[j].freq > TOLERANCE_B(vmd_info->beep_freq)) {
c++; c++;
vmd_info->beep_freq = (vmd_info->beep_freq * 0.95) + (vmd_info->points[j].freq * 0.05); vmd_info->beep_freq = (vmd_info->beep_freq * 0.95) + (vmd_info->points[j].freq * 0.05);
} }
} }
if(c < (POINTS - MAX_CHIRP)){ if (c < (POINTS - MAX_CHIRP)) {
vmd_info->state = BEEP_NOT_DETECTED; vmd_info->state = BEEP_NOT_DETECTED;
if(vmd_info->timestamp < MIN_TIME) break; if (vmd_info->timestamp < MIN_TIME) {
break;
}
status = switch_event_create_subclass(&event, status = switch_event_create_subclass(&event, SWITCH_EVENT_CUSTOM, VMD_EVENT_BEEP);
SWITCH_EVENT_CUSTOM, VMD_EVENT_BEEP); if (status != SWITCH_STATUS_SUCCESS) {
if(status != SWITCH_STATUS_SUCCESS) return; return;
}
switch_event_add_header_string( switch_event_add_header_string(event, SWITCH_STACK_BOTTOM, "Beep-Status", "stop");
event, switch_event_add_header(event, SWITCH_STACK_BOTTOM, "Beep-Time", "%d", vmd_info->timestamp / POINTS);
SWITCH_STACK_BOTTOM, switch_event_add_header(event, SWITCH_STACK_BOTTOM, "Unique-ID",
"Beep-Status", "%s", switch_core_session_get_uuid(vmd_info->session));
"stop" switch_event_add_header(event, SWITCH_STACK_BOTTOM, "Frequency", "%6.4lf", vmd_info->beep_freq);
); switch_event_add_header_string(event, SWITCH_STACK_BOTTOM, "call-command", "vmd");
switch_event_add_header( if ((switch_event_dup(&event_copy, event)) != SWITCH_STATUS_SUCCESS) {
event, return;
SWITCH_STACK_BOTTOM, }
"Beep-Time",
"%d", vmd_info->timestamp / POINTS
);
switch_event_add_header(
event,
SWITCH_STACK_BOTTOM,
"Unique-ID",
"%s", switch_core_session_get_uuid(vmd_info->session)
);
switch_event_add_header(
event,
SWITCH_STACK_BOTTOM,
"Frequency",
"%6.4lf", vmd_info->beep_freq
);
switch_event_add_header_string(
event,
SWITCH_STACK_BOTTOM,
"call-command",
"vmd"
);
status = switch_event_dup(&event_copy, event);
if(status != SWITCH_STATUS_SUCCESS) return;
switch_core_session_queue_event(vmd_info->session, &event); switch_core_session_queue_event(vmd_info->session, &event);
switch_event_fire(&event_copy); switch_event_fire(&event_copy);
@ -332,13 +302,15 @@ static void find_beep(vmd_session_info_t *vmd_info, switch_frame_t *frame)
for(i = 0; i < POINTS; k++, k %= POINTS, i++){ for(i = 0; i < POINTS; k++, k %= POINTS, i++){
m[i] = vmd_info->points[k].freq; m[i] = vmd_info->points[k].freq;
if(ISNAN(m[i])) m[i] = 0.0; if (ISNAN(m[i])) {
m[i] = 0.0;
}
} }
med = median(m, POINTS); med = median(m, POINTS);
if(ISNAN(med)){ if (ISNAN(med)){
for(i = 0; i < POINTS; i++){ for(i = 0; i < POINTS; i++){
if(!ISNAN(m[i])){ if (!ISNAN(m[i])){
med = m[i]; med = m[i];
break; break;
} }
@ -346,9 +318,9 @@ static void find_beep(vmd_session_info_t *vmd_info, switch_frame_t *frame)
} }
for(c = 0, i = 0; i < POINTS; j++, j %= POINTS, i++){ for(c = 0, i = 0; i < POINTS; j++, j %= POINTS, i++){
if(vmd_info->points[j].freq < TOLERANCE_T(med) && if (vmd_info->points[j].freq < TOLERANCE_T(med) &&
vmd_info->points[j].freq > TOLERANCE_B(med)){ vmd_info->points[j].freq > TOLERANCE_B(med)){
if(vmd_info->points[j].ampl > MIN_AMPL && if (vmd_info->points[j].ampl > MIN_AMPL &&
vmd_info->points[j].freq > MIN_FREQ && vmd_info->points[j].freq > MIN_FREQ &&
vmd_info->points[j].freq < MAX_FREQ){ vmd_info->points[j].freq < MAX_FREQ){
c++; c++;
@ -395,22 +367,35 @@ static double median(double *m, int n)
mingtguess = max; mingtguess = max;
for(i = 0; i < n; i++) { for(i = 0; i < n; i++) {
if(m[i] < guess){ if (m[i] < guess) {
less++; less++;
if(m[i] > maxltguess) maxltguess = m[i]; if(m[i] > maxltguess) {
}else if (m[i] > guess) { maxltguess = m[i];
}
} else if (m[i] > guess) {
greater++; greater++;
if(m[i] < mingtguess) mingtguess = m[i]; if(m[i] < mingtguess) {
}else equal++; mingtguess = m[i];
}
} else {
equal++;
}
} }
if (less <= ( n + 1 ) / 2 && greater <= ( n + 1 ) / 2) break; if (less <= ( n + 1 ) / 2 && greater <= ( n + 1 ) / 2) {
else if (less > greater) max = maxltguess; break;
else min = mingtguess; } else if (less > greater) {
max = maxltguess;
} else {
min = mingtguess;
}
} }
if(less >= ( n + 1 ) / 2) return maxltguess; if (less >= ( n + 1 ) / 2) {
else if(less + equal >= ( n + 1 ) / 2) return guess; return maxltguess;
} else if (less + equal >= ( n + 1 ) / 2) {
return guess;
}
return mingtguess; return mingtguess;
} }
@ -485,14 +470,14 @@ SWITCH_STANDARD_APP(vmd_start_function)
vmd_session_info_t *vmd_info; vmd_session_info_t *vmd_info;
int i; int i;
if(session == NULL) return; if (session == NULL) return;
channel = switch_core_session_get_channel(session); channel = switch_core_session_get_channel(session);
/* Is this channel already set? */ /* Is this channel already set? */
bug = (switch_media_bug_t *) switch_channel_get_private(channel, "_vmd_"); bug = (switch_media_bug_t *) switch_channel_get_private(channel, "_vmd_");
/* If yes */ /* If yes */
if(bug != NULL){ if (bug != NULL){
/* If we have a stop remove audio bug */ /* If we have a stop remove audio bug */
if(strcasecmp(data, "stop") == 0){ if(strcasecmp(data, "stop") == 0){
switch_channel_set_private(channel, "_vmd_", NULL); switch_channel_set_private(channel, "_vmd_", NULL);
@ -567,7 +552,6 @@ SWITCH_STANDARD_API(vmd_api_main)
switch_media_bug_t *bug; switch_media_bug_t *bug;
vmd_session_info_t *vmd_info; vmd_session_info_t *vmd_info;
switch_channel_t *channel; switch_channel_t *channel;
// switch_event_t *event;
switch_status_t status; switch_status_t status;
int argc; int argc;
char *argv[VMD_PARAMS]; char *argv[VMD_PARAMS];
@ -589,10 +573,10 @@ SWITCH_STANDARD_API(vmd_api_main)
/* If we don't have the expected number of parameters /* If we don't have the expected number of parameters
* display usage */ * display usage */
if(argc != VMD_PARAMS){ if (argc != VMD_PARAMS){
stream->write_function(stream, "-USAGE: %s\n", VMD_SYNTAX); stream->write_function(stream, "-USAGE: %s\n", VMD_SYNTAX);
switch_safe_free(ccmd); switch_safe_free(ccmd);
return SWITCH_STATUS_SUCCESS; return SWITCH_STATUS_SUCCESS;
} }
uuid = argv[0]; uuid = argv[0];
@ -602,10 +586,10 @@ SWITCH_STANDARD_API(vmd_api_main)
vmd_session = switch_core_session_locate(uuid); vmd_session = switch_core_session_locate(uuid);
/* If the session was not found exit */ /* If the session was not found exit */
if(vmd_session == NULL){ if (vmd_session == NULL) {
switch_safe_free(ccmd); switch_safe_free(ccmd);
stream->write_function(stream, "-USAGE: %s\n", VMD_SYNTAX); stream->write_function(stream, "-USAGE: %s\n", VMD_SYNTAX);
return SWITCH_STATUS_FALSE; return SWITCH_STATUS_FALSE;
} }
/* Get current channel of the session to tag the session /* Get current channel of the session to tag the session
@ -615,9 +599,9 @@ SWITCH_STANDARD_API(vmd_api_main)
/* Is this channel already set? */ /* Is this channel already set? */
bug = (switch_media_bug_t *) switch_channel_get_private(channel, "_vmd_"); bug = (switch_media_bug_t *) switch_channel_get_private(channel, "_vmd_");
/* If yes */ /* If yes */
if(bug != NULL){ if (bug != NULL){
/* If we have a stop remove audio bug */ /* If we have a stop remove audio bug */
if(strcasecmp(command, "stop") == 0){ if(strcasecmp(command, "stop") == 0) {
switch_channel_set_private(channel, "_vmd_", NULL); switch_channel_set_private(channel, "_vmd_", NULL);
switch_core_media_bug_remove(vmd_session, &bug); switch_core_media_bug_remove(vmd_session, &bug);
switch_safe_free(ccmd); switch_safe_free(ccmd);
@ -637,10 +621,10 @@ SWITCH_STANDARD_API(vmd_api_main)
} }
/* If we don't see the expected start exit */ /* If we don't see the expected start exit */
if(strcasecmp(command, "start") != 0){ if(strcasecmp(command, "start") != 0) {
switch_safe_free(ccmd); switch_safe_free(ccmd);
stream->write_function(stream, "-USAGE: %s\n", VMD_SYNTAX); stream->write_function(stream, "-USAGE: %s\n", VMD_SYNTAX);
return SWITCH_STATUS_FALSE; return SWITCH_STATUS_FALSE;
} }
/* Allocate memory attached to this FreeSWITCH session for /* Allocate memory attached to this FreeSWITCH session for
@ -659,9 +643,9 @@ SWITCH_STANDARD_API(vmd_api_main)
vmd_info->data_len = 0; vmd_info->data_len = 0;
*/ */
for(i = 0; i < POINTS; i++){ for(i = 0; i < POINTS; i++) {
vmd_info->points[i].freq = 0.0; vmd_info->points[i].freq = 0.0;
vmd_info->points[i].ampl = 0.0; vmd_info->points[i].ampl = 0.0;
} }
/* Add a media bug that allows me to intercept the /* Add a media bug that allows me to intercept the
@ -676,11 +660,11 @@ SWITCH_STANDARD_API(vmd_api_main)
); );
/* If adding a media bug fails exit */ /* If adding a media bug fails exit */
if(status != SWITCH_STATUS_SUCCESS){ if (status != SWITCH_STATUS_SUCCESS) {
switch_log_printf( switch_log_printf(
SWITCH_CHANNEL_LOG, SWITCH_CHANNEL_LOG,
SWITCH_LOG_ERROR, SWITCH_LOG_ERROR,
"Failure hooking to stream\n" "Failure hooking to stream\n"
); );
switch_safe_free(ccmd); switch_safe_free(ccmd);
@ -697,23 +681,6 @@ SWITCH_STANDARD_API(vmd_api_main)
return SWITCH_STATUS_SUCCESS; return SWITCH_STATUS_SUCCESS;
} }
/*
If it exists, this is called in it's own thread
when the module-load completes. If it returns anything
but SWITCH_STATUS_TERM it will be called again automatically
*/
/*
SWITCH_MODULE_RUNTIME_FUNCTION(mod_vmd_runtime)
{
while(looping){
switch_yield(1000);
}
return SWITCH_STATUS_TERM;
}
*/
/* For Emacs: /* For Emacs:
* Local Variables: * Local Variables: