X-Git-Url: http://git.eversberg.eu/gitweb.cgi?p=lcr.git;a=blobdiff_plain;f=port.cpp;h=32184a849a3e545d1d27d0b9f5f8ea352f7f309c;hp=5998bc668c7d95ad6dfa9d9543ad8785946e157f;hb=034d3a91404addedc1c7a3494862c79532b0b878;hpb=6db34c1dca5c3a2acd0af689319b583ff8271dbc diff --git a/port.cpp b/port.cpp index 5998bc6..32184a8 100644 --- a/port.cpp +++ b/port.cpp @@ -47,6 +47,9 @@ Functions: #include "main.h" +/* enable to test conference mixing, even if only two members are bridged */ +//#define TEST_CONFERENCE 1 + #define SHORT_MIN -32768 #define SHORT_MAX 32767 @@ -54,6 +57,9 @@ class Port *port_first = NULL; unsigned int port_serial = 1; /* must be 1, because 0== no port */ +struct port_bridge *p_bridge_first; + +static void remove_bridge(struct port_bridge *bridge, class Port *port); /* free epointlist relation */ @@ -142,12 +148,10 @@ struct epoint_list *Port::epointlist_new(unsigned int epoint_id) /* * port constructor */ -Port::Port(int type, const char *portname, struct port_settings *settings) +Port::Port(int type, const char *portname, struct port_settings *settings, struct interface *interface) { class Port *temp, **tempp; - PDEBUG(DEBUG_PORT, "new port of type %d, name '%s'\n", type, portname); - /* initialize object */ if (settings) memcpy(&p_settings, settings, sizeof(struct port_settings)); @@ -155,6 +159,8 @@ Port::Port(int type, const char *portname, struct port_settings *settings) memset(&p_settings, 0, sizeof(p_settings)); } SCPY(p_name, portname); + if (interface) + SCPY(p_interface_name, interface->name); p_tone_dir[0] = '\0'; p_type = type; p_serial = port_serial++; @@ -169,9 +175,11 @@ Port::Port(int type, const char *portname, struct port_settings *settings) memset(&p_redirinfo, 0, sizeof(p_redirinfo)); memset(&p_capainfo, 0, sizeof(p_capainfo)); p_echotest = 0; + p_bridge = 0; /* call recording */ p_record = NULL; + p_tap = 0; p_record_type = 0; p_record_length = 0; p_record_skip = 0; @@ -180,6 +188,13 @@ Port::Port(int type, const char *portname, struct port_settings *settings) p_record_buffer_writep = 0; p_record_buffer_dir = 0; + /* VoOTP */ +#ifdef WITH_VOOTP + p_vootp = NULL; +#endif + /* D-O-V */ + dov_init(); + /* append port to chain */ next = NULL; temp = port_first; @@ -191,6 +206,8 @@ Port::Port(int type, const char *portname, struct port_settings *settings) *tempp = this; classuse++; + + PDEBUG(DEBUG_PORT, "new port (%d) of type 0x%x, name '%s' interface '%s'\n", p_serial, type, portname, p_interface_name); } @@ -202,12 +219,26 @@ Port::~Port(void) class Port *temp, **tempp; struct lcr_msg *message; + PDEBUG(DEBUG_PORT, "removing port (%d) of type 0x%x, name '%s' interface '%s'\n", p_serial, p_type, p_name, p_interface_name); + +#ifdef WITH_VOOTP + if (p_vootp) { + vootp_destroy(p_vootp); + p_vootp = NULL; + } +#endif + + if (p_bridge) { + PDEBUG(DEBUG_PORT, "Removing us from bridge %u\n", p_bridge->bridge_id); + remove_bridge(p_bridge, this); + } + if (p_record) close_record(0, 0); - classuse--; + dov_exit(); - PDEBUG(DEBUG_PORT, "removing port of type %d, name '%s'\n", p_type, p_name); + classuse--; /* disconnect port from endpoint */ while(p_epointlist) { @@ -292,7 +323,7 @@ void Port::set_tone(const char *dir, const char *name) if (name == NULL) name = ""; - if (!dir && !dir[0]) + if (!dir || !dir[0]) dir = options.tones_dir; /* just in case we have no PmISDN instance */ /* no counter, no eof, normal speed */ @@ -316,6 +347,8 @@ void Port::set_tone(const char *dir, const char *name) SCPY(p_tone_dir, dir); SCPY(p_tone_name, name); } + /* trigger playback */ + update_load(); } else { p_tone_name[0]= '\0'; p_tone_dir[0]= '\0'; @@ -360,6 +393,10 @@ void Port::set_tone(const char *dir, const char *name) } +void Port::set_display(const char *text) +{ +} + /* * set the file in the tone directory for vbox playback * also set the play_eof-flag @@ -382,6 +419,8 @@ void Port::set_vbox_tone(const char *dir, const char *name) SPRINT(p_tone_dir, dir); SPRINT(p_tone_name, name); + /* trigger playback */ + update_load(); /* now we check if the cause exists, otherwhise we use error tone. */ if (p_tone_dir[0]) { @@ -585,45 +624,59 @@ try_loop: } -/* port handler: - * process transmission clock */ -int Port::handler(void) -{ - return(0); -} - -/* endpoint sends messages to the port - * this is called by the message_epoint inherited by child classes - * therefor a return=1 means: stop, no more processing +/* Endpoint sends messages to the port + * This is called by the message_epoint, inherited by child classes. + * Therefor a return 1 means: "already handled here" */ //extern struct lcr_msg *dddebug; int Port::message_epoint(unsigned int epoint_id, int message_id, union parameter *param) { /* check if we got audio data from one remote port */ switch(message_id) { - case MESSAGE_TONE: /* play tone */ - PDEBUG(DEBUG_PORT, "PORT(%s) isdn port with (caller id %s) setting tone '%s' dir '%s'\n", p_name, p_callerinfo.id, param->tone.name, param->tone.dir); + case MESSAGE_TONE: /* play tone */ + PDEBUG(DEBUG_PORT, "PORT(%s) setting tone '%s' dir '%s'\n", p_name, param->tone.name, param->tone.dir); set_tone(param->tone.dir,param->tone.name); - return(1); + return 1; - case MESSAGE_VBOX_TONE: /* play tone of answering machine */ + case MESSAGE_VBOX_TONE: /* play tone of answering machine */ PDEBUG(DEBUG_PORT, "PORT(%s) set answering machine tone '%s' '%s'\n", p_name, param->tone.dir, param->tone.name); set_vbox_tone(param->tone.dir, param->tone.name); - return(1); + return 1; - case MESSAGE_VBOX_PLAY: /* play recording of answering machine */ + case MESSAGE_VBOX_PLAY: /* play recording of answering machine */ PDEBUG(DEBUG_PORT, "PORT(%s) set answering machine file to play '%s' (offset %d seconds)\n", p_name, param->play.file, param->play.offset); set_vbox_play(param->play.file, param->play.offset); - return(1); + return 1; - case MESSAGE_VBOX_PLAY_SPEED: /* set speed of playback (recording of answering machine) */ + case MESSAGE_VBOX_PLAY_SPEED: /* set speed of playback (recording of answering machine) */ PDEBUG(DEBUG_PORT, "PORT(%s) set answering machine playback speed %d (times)\n", p_name, param->speed); set_vbox_speed(param->speed); - return(1); - + return 1; + + case MESSAGE_BRIDGE: /* create / join / leave / destroy bridge */ + PDEBUG(DEBUG_PORT, "PORT(%s) bridging to id %d\n", p_name, param->bridge_id); + bridge(param->bridge_id); + return 1; + +#ifdef WITH_VOOTP + case MESSAGE_VOOTP: /* enable / disable VoOTP */ + PDEBUG(DEBUG_PORT, "PORT(%s) VoOTP enabled: %d\n", p_name, param->vootp.enable); + set_vootp(¶m->vootp); + return 1; +#endif + + case MESSAGE_DOV_REQUEST: /* Data-Over-Voice message */ + PDEBUG(DEBUG_PORT, "PORT(%s) sending data over voice message (len=%d)\n", p_name, param->dov.length); + dov_sendmsg(param->dov.data, param->dov.length, (enum dov_type)param->dov.type, param->dov.level); + return 1; + + case MESSAGE_DOV_LISTEN: /* Data-Over-Voice listen order */ + PDEBUG(DEBUG_PORT, "PORT(%s) sending data over voice listen order\n", p_name); + dov_listen((enum dov_type)param->dov.type); + return 1; } - return(0); + return 0; } @@ -648,6 +701,9 @@ int Port::open_record(int type, int vbox, int skip, char *extension, int anon_ig /* RIFFxxxxWAVEfmt xxxx(fmt-size)dataxxxx... */ char dummyheader[8+4+8+sizeof(fmt)+8]; char filename[256]; + time_t now; + struct tm *now_tm; + int __attribute__((__unused__)) ret; if (!extension) { PERROR("Port(%d) not an extension\n", p_serial); @@ -676,8 +732,11 @@ int Port::open_record(int type, int vbox, int skip, char *extension, int anon_ig if (vbox == 1) UPRINT(strchr(filename,'\0'), "/announcement"); - else + else { + time(&now); + now_tm = localtime(&now); UPRINT(strchr(filename,'\0'), "/%04d-%02d-%02d_%02d%02d%02d", now_tm->tm_year+1900, now_tm->tm_mon+1, now_tm->tm_mday, now_tm->tm_hour, now_tm->tm_min, now_tm->tm_sec); + } if (vbox == 2) { p_record_vbox_year = now_tm->tm_year; p_record_vbox_mon = now_tm->tm_mon; @@ -698,6 +757,7 @@ int Port::open_record(int type, int vbox, int skip, char *extension, int anon_ig PERROR("Port(%d) cannot record because file cannot be opened '%s'\n", p_serial, filename); return(0); } + update_rxoff(); fduse++; p_record_type = type; @@ -708,7 +768,7 @@ int Port::open_record(int type, int vbox, int skip, char *extension, int anon_ig case CODEC_MONO: case CODEC_STEREO: case CODEC_8BIT: - fwrite(dummyheader, sizeof(dummyheader), 1, p_record); + ret = fwrite(dummyheader, sizeof(dummyheader), 1, p_record); break; case CODEC_LAW: @@ -736,6 +796,7 @@ void Port::close_record(int beep, int mute) char *p; struct caller_info callerinfo; const char *valid_chars = "abcdefghijklmnopqrstuvwxyzABCDEFGHIJKLMNOPQRSTUVWXYZ01234567890_.-!$%&/()=+*;~"; + int __attribute__((__unused__)) ret; if (!p_record) return; @@ -798,7 +859,7 @@ void Port::close_record(int beep, int mute) } i = 0; while(i < beep) { - fwrite(beep_mono, sizeof(beep_mono), 1, p_record); + ret = fwrite(beep_mono, sizeof(beep_mono), 1, p_record); i += sizeof(beep_mono); p_record_length += sizeof(beep_mono); } @@ -858,7 +919,7 @@ void Port::close_record(int beep, int mute) fmt.bits_sample = 8; /* one channel */ break; } - fwrite(&fmt, sizeof(fmt), 1, p_record); + ret = fwrite(&fmt, sizeof(fmt), 1, p_record); /* data */ fprintf(p_record, "data%c%c%c%c", (unsigned char)(size&0xff), (unsigned char)((size>>8)&0xff), (unsigned char)((size>>16)&0xff), (unsigned char)(size>>24)); @@ -882,6 +943,7 @@ void Port::close_record(int beep, int mute) fclose(p_record); fduse--; p_record = NULL; + update_rxoff(); if (rename(p_record_filename, filename) < 0) { PERROR("Port(%d) cannot rename from '%s' to '%s'\n", p_serial, p_record_filename, filename); @@ -935,6 +997,7 @@ void Port::record(unsigned char *data, int length, int dir_fromup) signed short *s; int free, i, ii; signed int sample; + int __attribute__((__unused__)) ret; /* no recording */ if (!p_record || !length) @@ -984,7 +1047,7 @@ same_again: p_record_buffer_readp = (p_record_buffer_readp + 1) & RECORD_BUFFER_MASK; i++; } - fwrite(write_buffer, 512, 1, p_record); + ret = fwrite(write_buffer, 512, 1, p_record); p_record_length += 512; break; @@ -1007,7 +1070,7 @@ same_again: i++; } } - fwrite(write_buffer, 1024, 1, p_record); + ret = fwrite(write_buffer, 1024, 1, p_record); p_record_length += 1024; break; @@ -1019,7 +1082,7 @@ same_again: p_record_buffer_readp = (p_record_buffer_readp + 1) & RECORD_BUFFER_MASK; i++; } - fwrite(write_buffer, 512, 1, p_record); + ret = fwrite(write_buffer, 512, 1, p_record); p_record_length += 512; break; @@ -1031,7 +1094,7 @@ same_again: p_record_buffer_readp = (p_record_buffer_readp + 1) & RECORD_BUFFER_MASK; i++; } - fwrite(write_buffer, 256, 1, p_record); + ret = fwrite(write_buffer, 256, 1, p_record); p_record_length += 256; break; } @@ -1071,7 +1134,7 @@ different_again: *s++ = sample; i++; } - fwrite(write_buffer, ii<<1, 1, p_record); + ret = fwrite(write_buffer, ii<<1, 1, p_record); p_record_length += (ii<<1); break; @@ -1094,7 +1157,7 @@ different_again: i++; } } - fwrite(write_buffer, ii<<2, 1, p_record); + ret = fwrite(write_buffer, ii<<2, 1, p_record); p_record_length += (ii<<2); break; @@ -1110,7 +1173,7 @@ different_again: *d++ = (sample+0x8000) >> 8; i++; } - fwrite(write_buffer, ii, 1, p_record); + ret = fwrite(write_buffer, ii, 1, p_record); p_record_length += ii; break; @@ -1126,7 +1189,7 @@ different_again: *d++ = audio_s16_to_law[sample & 0xffff]; i++; } - fwrite(write_buffer, ii, 1, p_record); + ret = fwrite(write_buffer, ii, 1, p_record); p_record_length += ii; break; } @@ -1139,4 +1202,314 @@ different_again: } +void Port::tap(unsigned char *data, int length, int dir_fromup) +{ +} + +void Port::update_rxoff(void) +{ +} + +void Port::update_load(void) +{ +} + + +/* + * bridge handling + */ + +int bridge_timeout(struct lcr_timer *timer, void *instance, int index); + +static void remove_bridge(struct port_bridge *bridge, class Port *port) +{ + struct port_bridge **temp = &p_bridge_first; + while (*temp) { + if (*temp == bridge) { + struct port_bridge_member **memberp = &bridge->first, *member; + + /* loop until we are found */ + while(*memberp) { + if ((*memberp)->port == port) { + member = *memberp; + *memberp = member->next; + FREE(member, sizeof(struct port_bridge_member)); + memuse--; +#ifndef TEST_CONFERENCE + if (bridge->first && bridge->first->next && !bridge->first->next->next) { +#else + if (bridge->first && !bridge->first->next) { +#endif + PDEBUG(DEBUG_PORT, "bridge %u is no conference anymore\n", bridge->bridge_id); + del_timer(&bridge->timer); + } + break; + } + memberp = &((*memberp)->next); + } + /* if bridge is empty, remove it */ + if (bridge->first == NULL) { + PDEBUG(DEBUG_PORT, "Remove bridge %u\n", bridge->bridge_id); + *temp = bridge->next; + FREE(bridge, sizeof(struct port_bridge)); + memuse--; + } + return; + } + temp = &((*temp)->next); + } + PERROR("Bridge %p not found in list\n", bridge); +} + +void Port::bridge(unsigned int bridge_id) +{ + struct port_bridge_member **memberp; + + /* Remove bridge, if we leave bridge or if we join a different bridge. */ + if (p_bridge && bridge_id != p_bridge->bridge_id) { + PDEBUG(DEBUG_PORT, "Remove port %u from bridge %u, because out new bridge is %u\n", p_serial, p_bridge->bridge_id, bridge_id); + remove_bridge(p_bridge, this); + p_bridge = NULL; + } + + /* if we leave bridge */ + if (!bridge_id) + return; + + /* find bridge */ + if (!p_bridge) { + struct port_bridge *temp = p_bridge_first; + + while (temp) { + if (temp->bridge_id == bridge_id) + break; + temp = temp->next; + } + p_bridge = temp; + if (p_bridge) + PDEBUG(DEBUG_PORT, "Port %d found existing bridge %u.\n", p_serial, p_bridge->bridge_id); + } + /* create bridge */ + if (!p_bridge) { + struct port_bridge **temp = &p_bridge_first; + + p_bridge = (struct port_bridge *) MALLOC(sizeof(struct port_bridge)); + memuse++; + p_bridge->bridge_id = bridge_id; + + /* attach bridge instance to list */ + while (*temp) + temp = &((*temp)->next); + *temp = p_bridge; + PDEBUG(DEBUG_PORT, "Port %d creating not existing bridge %u.\n", p_serial, p_bridge->bridge_id); + } + + /* attach to bridge */ + memberp = &p_bridge->first; + while(*memberp) { + if ((*memberp)->port == this) { + /* already joined */ + return; + } + memberp = &((*memberp)->next); + } + *memberp = (struct port_bridge_member *) MALLOC(sizeof(struct port_bridge_member)); + memuse++; + (*memberp)->port = this; + /* check if bridge becomes a conference */ +#ifndef TEST_CONFERENCE + if (p_bridge->first->next && p_bridge->first->next->next && !p_bridge->first->next->next->next) { + p_bridge->first->next->next->write_p = 0; + p_bridge->first->next->next->min_space = 0; + memset(p_bridge->first->next->next->buffer, silence, sizeof((*memberp)->buffer)); +#else + if (p_bridge->first->next && !p_bridge->first->next->next) { +#endif + p_bridge->first->next->write_p = 0; + p_bridge->first->next->min_space = 0; + memset(p_bridge->first->next->buffer, silence, sizeof((*memberp)->buffer)); + p_bridge->first->write_p = 0; + p_bridge->first->min_space = 0; + memset(p_bridge->first->buffer, silence, sizeof((*memberp)->buffer)); + memset(p_bridge->sum_buffer, 0, sizeof(p_bridge->sum_buffer)); + p_bridge->read_p = 0; + add_timer(&p_bridge->timer, bridge_timeout, p_bridge, 0); + schedule_timer(&p_bridge->timer, 0, 20000); /* 20 MS */ + p_bridge->sample_count = 0; + PDEBUG(DEBUG_PORT, "bridge %u became a conference\n", p_bridge->bridge_id); + } +} + +/* send data to remote Port or add to sum buffer */ +int Port::bridge_tx(unsigned char *data, int len) +{ + int write_p, space; + struct port_bridge_member *member; + signed long *sum; + unsigned char *buf; + +#ifdef WITH_VOOTP + if (p_vootp) + vootp_encrypt_stream(p_vootp, data, len); +#endif + + /* less than two ports, so drop */ + if (!p_bridge || !p_bridge->first || !p_bridge->first->next) + return -EIO; +#ifndef TEST_CONFERENCE + /* two ports, so bridge */ + if (!p_bridge->first->next->next) { + if (p_bridge->first->port == this) + return p_bridge->first->next->port->bridge_rx(data, len); + if (p_bridge->first->next->port == this) + return p_bridge->first->port->bridge_rx(data, len); + return -EINVAL; + } +#endif + /* more than two ports... */ + member = p_bridge->first; + while (member) { + if (member->port == this) + break; + member = member->next; + } + if (!member) + return -EINVAL; + write_p = member->write_p; + /* calculate space, so write pointer will not overrun (or reach) read pointer in ring buffer */ + space = (p_bridge->read_p - write_p - 1) & (BRIDGE_BUFFER - 1); + /* clip len, if it does not fit */ + if (space < len) + len = space; + /* apply audio samples to sum buffer */ + sum = p_bridge->sum_buffer; + buf = member->buffer; + while (len--) { + sum[write_p] += audio_law_to_s32[*data]; + buf[write_p] = *data++; + write_p = (write_p + 1) & (BRIDGE_BUFFER - 1); + } + /* raise write pointer */ + member->write_p = write_p; + + return 0; +} + +int bridge_timeout(struct lcr_timer *timer, void *instance, int index) +{ + struct port_bridge *bridge = (struct port_bridge *)instance; + struct port_bridge_member *member = bridge->first; + unsigned long long timer_time; + signed long *sum, sample; + unsigned char buffer[160], *buf, *d; + int i, read_p, space; + + bridge->sample_count += 160; + + /* schedule exactly 20ms from last schedule */ + timer_time = timer->timeout.tv_sec * MICRO_SECONDS + timer->timeout.tv_usec; + timer_time += 20000; /* 20 MS */ + timer->timeout.tv_sec = timer_time / MICRO_SECONDS; + timer->timeout.tv_usec = timer_time % MICRO_SECONDS; + timer->active = 1; + + while (member) { + /* calculate transmit data */ + read_p = bridge->read_p; + sum = bridge->sum_buffer; + buf = member->buffer; + d = buffer; + for (i = 0; i < 160; i++) { + sample = sum[read_p]; + sample -= audio_law_to_s32[buf[read_p]]; + buf[read_p] = silence; + if (sample < SHORT_MIN) sample = SHORT_MIN; + if (sample > SHORT_MAX) sample = SHORT_MAX; + *d++ = audio_s16_to_law[sample & 0xffff]; + read_p = (read_p + 1) & (BRIDGE_BUFFER - 1); + } + /* send data */ + member->port->bridge_rx(buffer, 160); + /* raise write pointer, if read pointer would overrun them */ + space = ((member->write_p - bridge->read_p) & (BRIDGE_BUFFER - 1)) - 160; + if (space < 0) { + space = 0; + member->write_p = read_p; +// PDEBUG(DEBUG_PORT, "bridge %u member %d has buffer underrun\n", bridge->bridge_id, member->port->p_serial); + } + /* find minimum delay */ + if (space < member->min_space) + member->min_space = space; + /* check if we should reduce buffer */ + if (bridge->sample_count >= 8000*5) { + /* reduce buffer by minimum delay */ +// PDEBUG(DEBUG_PORT, "bridge %u member %d has min space of %d samples\n", bridge->bridge_id, member->port->p_serial, member->min_space); + member->write_p = (member->write_p - member->min_space) & (BRIDGE_BUFFER - 1); + member->min_space = 1000000; /* infinite */ + } + member = member->next; + } + + /* clear sample data */ + read_p = bridge->read_p; + sum = bridge->sum_buffer; + for (i = 0; i < 160; i++) { + sum[read_p] = 0; + read_p = (read_p + 1) & (BRIDGE_BUFFER - 1); + } + + /* raise read pointer */ + bridge->read_p = read_p; + + if (bridge->sample_count >= 8000*5) + bridge->sample_count = 0; + + return 0; +} + + +/* receive data from remote Port */ +int Port::bridge_rx(unsigned char *data, int len) +{ + +#ifdef WITH_VOOTP + if (p_vootp) + vootp_decrypt_stream(p_vootp, data, len); +#endif + + return 0; +} + +#ifdef WITH_VOOTP +static void vootp_info(void *priv, const char *text) +{ + class Port *port = (class Port *)priv; + char display[strlen(text) + 1]; + + SCPY(display, text); + if (display[0]) + display[strlen(display) - 1] = '\0'; + + port->set_display(display); +} + +void Port::set_vootp(struct param_vootp *vootp) +{ + if (p_vootp) { + vootp_destroy(p_vootp); + p_vootp = NULL; + } + if (vootp->enable) { + p_vootp = vootp_create(this, (options.law=='a'), options.otp_dir, NULL, NULL, vootp->id, vootp_info); +// vootp_loglevel(VOOTP_LOGL_DEBUG); + if (!p_vootp) { + struct lcr_msg *message; + + message = message_create(p_serial, p_epointlist->epoint_id, PORT_TO_EPOINT, MESSAGE_VOOTP); + message->param.vootp.failed = 1; + message_put(message); + } + } +} +#endif