Data-Over-Voice
[lcr.git] / port.cpp
index e88175b..32184a8 100644 (file)
--- 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 */
@@ -362,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
@@ -589,38 +624,59 @@ try_loop:
 }
 
 
-/* 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(&param->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;
 }
 
 
@@ -647,6 +703,7 @@ int Port::open_record(int type, int vbox, int skip, char *extension, int anon_ig
        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);
@@ -711,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:
@@ -739,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;
@@ -801,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);
                }
@@ -861,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));
@@ -939,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)
@@ -988,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;
 
@@ -1011,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;
 
@@ -1023,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;
 
@@ -1035,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;
                }
@@ -1075,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;
                
@@ -1098,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;
                
@@ -1114,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;
                
@@ -1130,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;
        }
@@ -1143,6 +1202,10 @@ different_again:
 
 }
 
+void Port::tap(unsigned char *data, int length, int dir_fromup)
+{
+}
+
 void Port::update_rxoff(void)
 {
 }
@@ -1151,3 +1214,302 @@ 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