Version 0.1.8 from FTP
[asterisk/asterisk.git] / codecs / codec_gsm.c
index 05ef8d6..35ef9e2 100755 (executable)
@@ -6,7 +6,7 @@
  * The GSM code is from TOAST.  Copyright information for that package is available
  * in  the GSM directory.
  * 
  * The GSM code is from TOAST.  Copyright information for that package is available
  * in  the GSM directory.
  * 
- * Copyright (C) 1999, Adtran Inc. and Linux Support Services, LLC
+ * Copyright (C) 1999, Mark Spencer
  *
  * Mark Spencer <markster@linux-support.net>
  *
  *
  * Mark Spencer <markster@linux-support.net>
  *
@@ -22,6 +22,7 @@
 #include <asterisk/translate.h>
 #include <asterisk/module.h>
 #include <asterisk/logger.h>
 #include <asterisk/translate.h>
 #include <asterisk/module.h>
 #include <asterisk/logger.h>
+#include <asterisk/channel.h>
 #include <pthread.h>
 #include <fcntl.h>
 #include <stdlib.h>
 #include <pthread.h>
 #include <fcntl.h>
 #include <stdlib.h>
@@ -47,7 +48,7 @@ struct ast_translator_pvt {
        /* Space to build offset */
        char offset[AST_FRIENDLY_OFFSET];
        /* Buffer for our outgoing frame */
        /* Space to build offset */
        char offset[AST_FRIENDLY_OFFSET];
        /* Buffer for our outgoing frame */
-       gsm_frame outbuf;
+       short outbuf[8000];
        /* Enough to store a full second */
        short buf[8000];
        int tail;
        /* Enough to store a full second */
        short buf[8000];
        int tail;
@@ -65,6 +66,7 @@ static struct ast_translator_pvt *gsm_new()
                        tmp = NULL;
                }
                tmp->tail = 0;
                        tmp = NULL;
                }
                tmp->tail = 0;
+               localusecnt++;
        }
        return tmp;
 }
        }
        return tmp;
 }
@@ -90,8 +92,8 @@ static struct ast_frame *gsmtolin_sample()
        f.frametype = AST_FRAME_VOICE;
        f.subclass = AST_FORMAT_GSM;
        f.datalen = sizeof(gsm_slin_ex);
        f.frametype = AST_FRAME_VOICE;
        f.subclass = AST_FORMAT_GSM;
        f.datalen = sizeof(gsm_slin_ex);
-       /* All frames are 30 ms long */
-       f.timelen = 30;
+       /* All frames are 20 ms long */
+       f.timelen = 20;
        f.mallocd = 0;
        f.offset = 0;
        f.src = __PRETTY_FUNCTION__;
        f.mallocd = 0;
        f.offset = 0;
        f.src = __PRETTY_FUNCTION__;
@@ -117,34 +119,29 @@ static struct ast_frame *gsmtolin_frameout(struct ast_translator_pvt *tmp)
        /* Reset tail pointer */
        tmp->tail = 0;
 
        /* Reset tail pointer */
        tmp->tail = 0;
 
-#if 0
-       /* Save a sample frame */
-       { static int samplefr = 0;
-       if (samplefr == 80) {
-               int fd;
-               fd = open("gsm.example", O_WRONLY | O_CREAT, 0644);
-               write(fd, tmp->f.data, tmp->f.datalen);
-               close(fd);
-       }               
-       samplefr++;
-       }
-#endif
        return &tmp->f; 
 }
 
 static int gsmtolin_framein(struct ast_translator_pvt *tmp, struct ast_frame *f)
 {
        /* Assuming there's space left, decode into the current buffer at
        return &tmp->f; 
 }
 
 static int gsmtolin_framein(struct ast_translator_pvt *tmp, struct ast_frame *f)
 {
        /* Assuming there's space left, decode into the current buffer at
-          the tail location */
-       if (tmp->tail + 160 < sizeof(tmp->buf)/2) {     
-               if (gsm_decode(tmp->gsm, f->data, tmp->buf + tmp->tail)) {
-                       ast_log(LOG_WARNING, "Invalid GSM data\n");
+          the tail location.  Read in as many frames as there are */
+       int x;
+       if (f->datalen % 33) {
+               ast_log(LOG_WARNING, "Huh?  A GSM frame that isn't a multiple of 33 bytes long from %s (%d)?\n", f->src, f->datalen);
+               return -1;
+       }
+       for (x=0;x<f->datalen;x+=33) {
+               if (tmp->tail + 160 < sizeof(tmp->buf)/2) {     
+                       if (gsm_decode(tmp->gsm, f->data + x, tmp->buf + tmp->tail)) {
+                               ast_log(LOG_WARNING, "Invalid GSM data\n");
+                               return -1;
+                       }
+                       tmp->tail+=160;
+               } else {
+                       ast_log(LOG_WARNING, "Out of buffer space\n");
                        return -1;
                }
                        return -1;
                }
-               tmp->tail+=160;
-       } else {
-               ast_log(LOG_WARNING, "Out of buffer space\n");
-               return -1;
        }
        return 0;
 }
        }
        return 0;
 }
@@ -155,8 +152,8 @@ static int lintogsm_framein(struct ast_translator_pvt *tmp, struct ast_frame *f)
        /* XXX We should look at how old the rest of our stream is, and if it
           is too old, then we should overwrite it entirely, otherwise we can
           get artifacts of earlier talk that do not belong */
        /* XXX We should look at how old the rest of our stream is, and if it
           is too old, then we should overwrite it entirely, otherwise we can
           get artifacts of earlier talk that do not belong */
-       if (tmp->tail + f->datalen < sizeof(tmp->buf) / 2) {
-               memcpy(tmp->buf + tmp->tail, f->data, f->datalen);
+       if (tmp->tail + f->datalen/2 < sizeof(tmp->buf) / 2) {
+               memcpy((tmp->buf + tmp->tail), f->data, f->datalen);
                tmp->tail += f->datalen/2;
        } else {
                ast_log(LOG_WARNING, "Out of buffer space\n");
                tmp->tail += f->datalen/2;
        } else {
                ast_log(LOG_WARNING, "Out of buffer space\n");
@@ -167,42 +164,39 @@ static int lintogsm_framein(struct ast_translator_pvt *tmp, struct ast_frame *f)
 
 static struct ast_frame *lintogsm_frameout(struct ast_translator_pvt *tmp)
 {
 
 static struct ast_frame *lintogsm_frameout(struct ast_translator_pvt *tmp)
 {
+       int x=0;
        /* We can't work on anything less than a frame in size */
        if (tmp->tail < 160)
                return NULL;
        /* We can't work on anything less than a frame in size */
        if (tmp->tail < 160)
                return NULL;
-       /* Encode a frame of data */
-       gsm_encode(tmp->gsm, tmp->buf, tmp->outbuf);
        tmp->f.frametype = AST_FRAME_VOICE;
        tmp->f.subclass = AST_FORMAT_GSM;
        tmp->f.frametype = AST_FRAME_VOICE;
        tmp->f.subclass = AST_FORMAT_GSM;
-       tmp->f.datalen = 33;
-       /* Assume 8000 Hz -- 20 ms */
-       tmp->f.timelen = 20;
        tmp->f.mallocd = 0;
        tmp->f.offset = AST_FRIENDLY_OFFSET;
        tmp->f.src = __PRETTY_FUNCTION__;
        tmp->f.data = tmp->outbuf;
        tmp->f.mallocd = 0;
        tmp->f.offset = AST_FRIENDLY_OFFSET;
        tmp->f.src = __PRETTY_FUNCTION__;
        tmp->f.data = tmp->outbuf;
-       tmp->tail -= 160;
-       /* Move the data at the end of the buffer to the front */
-       if (tmp->tail)
-               memmove(tmp->buf, tmp->buf + 160 * 2, tmp->tail * 2);
-#if 0
-       /* Save a sample frame */
-       { static int samplefr = 0;
-       if (samplefr == 0) {
-               int fd;
-               fd = open("gsm.example", O_WRONLY | O_CREAT, 0644);
-               write(fd, tmp->f.data, tmp->f.datalen);
-               close(fd);
-       }               
-       samplefr++;
+       while(tmp->tail >= 160) {
+               if ((x+1) * 33 >= sizeof(tmp->outbuf)) {
+                       ast_log(LOG_WARNING, "Out of buffer space\n");
+                       return NULL;
+               }
+               /* Encode a frame of data */
+               gsm_encode(tmp->gsm, tmp->buf, (gsm_byte *) tmp->outbuf + (x * 33));
+               /* Assume 8000 Hz -- 20 ms */
+               tmp->tail -= 160;
+               /* Move the data at the end of the buffer to the front */
+               if (tmp->tail)
+                       memmove(tmp->buf, tmp->buf + 160, tmp->tail * 2);
+               x++;
        }
        }
-#endif
+       tmp->f.datalen = x * 33;
+       tmp->f.timelen = x * 20;
        return &tmp->f; 
 }
 
 static void gsm_destroy_stuff(struct ast_translator_pvt *pvt)
 {
        free(pvt);
        return &tmp->f; 
 }
 
 static void gsm_destroy_stuff(struct ast_translator_pvt *pvt)
 {
        free(pvt);
+       localusecnt--;
 }
 
 static struct ast_translator gsmtolin =
 }
 
 static struct ast_translator gsmtolin =
@@ -228,13 +222,13 @@ static struct ast_translator lintogsm =
 int unload_module(void)
 {
        int res;
 int unload_module(void)
 {
        int res;
-       pthread_mutex_lock(&localuser_lock);
+       ast_pthread_mutex_lock(&localuser_lock);
        res = ast_unregister_translator(&lintogsm);
        if (!res)
                res = ast_unregister_translator(&gsmtolin);
        if (localusecnt)
                res = -1;
        res = ast_unregister_translator(&lintogsm);
        if (!res)
                res = ast_unregister_translator(&gsmtolin);
        if (localusecnt)
                res = -1;
-       pthread_mutex_unlock(&localuser_lock);
+       ast_pthread_mutex_unlock(&localuser_lock);
        return res;
 }
 
        return res;
 }
 
@@ -260,3 +254,8 @@ int usecount(void)
        STANDARD_USECOUNT(res);
        return res;
 }
        STANDARD_USECOUNT(res);
        return res;
 }
+
+char *key()
+{
+       return ASTERISK_GPL_KEY;
+}