format_g726: add support for seeking
[asterisk/asterisk.git] / formats / format_g726.c
index 366f85d..934f9c3 100644 (file)
@@ -19,7 +19,7 @@
 /*!\file
  *
  * \brief Headerless G.726 (16/24/32/40kbps) data format for Asterisk.
- * 
+ *
  * File name extensions:
  * \arg 40 kbps: g726-40
  * \arg 32 kbps: g726-32
@@ -31,7 +31,7 @@
 /*** MODULEINFO
        <support_level>core</support_level>
  ***/
+
 #include "asterisk.h"
 
 #include "asterisk/mod_format.h"
@@ -49,7 +49,7 @@
 
 #define        BUF_SIZE        (5*FRAME_TIME)  /* max frame size in bytes ? */
 /* Frame sizes in bytes */
-static int frame_size[4] = { 
+static int frame_size[4] = {
                FRAME_TIME * 5,
                FRAME_TIME * 4,
                FRAME_TIME * 3,
@@ -141,12 +141,12 @@ static int g726_write(struct ast_filestream *s, struct ast_frame *f)
        struct g726_desc *fs = (struct g726_desc *)s->_private;
 
        if (f->datalen % frame_size[fs->rate]) {
-               ast_log(LOG_WARNING, "Invalid data length %d, should be multiple of %d\n", 
+               ast_log(LOG_WARNING, "Invalid data length %d, should be multiple of %d\n",
                                                f->datalen, frame_size[fs->rate]);
                return -1;
        }
        if ((res = fwrite(f->data.ptr, 1, f->datalen, s->f)) != f->datalen) {
-               ast_log(LOG_WARNING, "Bad write (%d/%d): %s\n", 
+               ast_log(LOG_WARNING, "Bad write (%d/%d): %s\n",
                                res, frame_size[fs->rate], strerror(errno));
                        return -1;
        }
@@ -155,7 +155,38 @@ static int g726_write(struct ast_filestream *s, struct ast_frame *f)
 
 static int g726_seek(struct ast_filestream *fs, off_t sample_offset, int whence)
 {
-       return -1;
+       off_t offset = 0, min = 0, cur, max, distance;
+
+       if ((cur = ftello(fs->f)) < 0) {
+               ast_log(AST_LOG_WARNING, "Unable to determine current position in g726 filestream %p: %s\n", fs, strerror(errno));
+               return -1;
+       }
+
+       if (fseeko(fs->f, 0, SEEK_END) < 0) {
+               ast_log(AST_LOG_WARNING, "Unable to seek to end of g726 filestream %p: %s\n", fs, strerror(errno));
+               return -1;
+       }
+
+       if ((max = ftello(fs->f)) < 0) {
+               ast_log(AST_LOG_WARNING, "Unable to determine max position in g726 filestream %p: %s\n", fs, strerror(errno));
+               return -1;
+       }
+
+       /* have to fudge to frame here, so not fully to sample */
+       distance = sample_offset / 2;
+       if (whence == SEEK_SET) {
+               offset = distance;
+       } else if (whence == SEEK_CUR || whence == SEEK_FORCECUR) {
+               offset = distance + cur;
+       } else if (whence == SEEK_END) {
+               offset = max - distance;
+       }
+
+       if (whence != SEEK_FORCECUR) {
+               offset = offset > max ? max : offset;
+               offset = offset < min ? min : offset;
+       }
+       return fseeko(fs->f, offset, SEEK_SET);
 }
 
 static int g726_trunc(struct ast_filestream *fs)
@@ -165,7 +196,7 @@ static int g726_trunc(struct ast_filestream *fs)
 
 static off_t g726_tell(struct ast_filestream *fs)
 {
-       return -1;
+       return ftello(fs->f) << 1;
 }
 
 static struct ast_format_def f[] = {