1999-12-16 13:44:30 +00:00
|
|
|
/*
|
2005-09-14 20:46:50 +00:00
|
|
|
* Asterisk -- An open source telephony toolkit.
|
1999-12-16 13:44:30 +00:00
|
|
|
*
|
2005-01-21 07:06:25 +00:00
|
|
|
* Copyright (C) 1999 - 2005, Digium, Inc.
|
1999-12-16 13:44:30 +00:00
|
|
|
*
|
2004-12-19 21:13:41 +00:00
|
|
|
* Mark Spencer <markster@digium.com>
|
1999-12-16 13:44:30 +00:00
|
|
|
*
|
2005-09-14 20:46:50 +00:00
|
|
|
* See http://www.asterisk.org for more information about
|
|
|
|
* the Asterisk project. Please do not directly contact
|
|
|
|
* any of the maintainers of this project for assistance;
|
|
|
|
* the project provides a web site, mailing lists and IRC
|
|
|
|
* channels for your use.
|
|
|
|
*
|
1999-12-16 13:44:30 +00:00
|
|
|
* This program is free software, distributed under the terms of
|
2005-09-14 20:46:50 +00:00
|
|
|
* the GNU General Public License Version 2. See the LICENSE file
|
|
|
|
* at the top of the source tree.
|
|
|
|
*/
|
|
|
|
|
2005-10-26 13:03:17 +00:00
|
|
|
/*! \file
|
2005-09-14 20:46:50 +00:00
|
|
|
*
|
2005-10-26 13:03:17 +00:00
|
|
|
* \brief Save to raw, headerless GSM data.
|
2005-11-06 15:09:47 +00:00
|
|
|
* \arg File name extension: gsm
|
|
|
|
* \ingroup formats
|
1999-12-16 13:44:30 +00:00
|
|
|
*/
|
|
|
|
|
2006-06-07 18:54:56 +00:00
|
|
|
#include "asterisk.h"
|
|
|
|
|
|
|
|
ASTERISK_FILE_VERSION(__FILE__, "$Revision$")
|
|
|
|
|
2005-06-07 17:06:33 +00:00
|
|
|
#include <unistd.h>
|
2003-09-08 16:48:07 +00:00
|
|
|
#include <netinet/in.h>
|
1999-12-16 13:44:30 +00:00
|
|
|
#include <arpa/inet.h>
|
|
|
|
#include <stdlib.h>
|
|
|
|
#include <sys/time.h>
|
|
|
|
#include <stdio.h>
|
|
|
|
#include <errno.h>
|
|
|
|
#include <string.h>
|
2005-06-06 22:12:19 +00:00
|
|
|
|
|
|
|
#include "asterisk/lock.h"
|
|
|
|
#include "asterisk/channel.h"
|
|
|
|
#include "asterisk/file.h"
|
|
|
|
#include "asterisk/logger.h"
|
|
|
|
#include "asterisk/sched.h"
|
|
|
|
#include "asterisk/module.h"
|
|
|
|
#include "asterisk/endian.h"
|
|
|
|
|
2003-04-26 16:06:23 +00:00
|
|
|
#include "msgsm.h"
|
|
|
|
|
2004-01-22 21:30:04 +00:00
|
|
|
/* Some Ideas for this code came from makegsme.c by Jeffrey Chilton */
|
1999-12-16 13:44:30 +00:00
|
|
|
|
|
|
|
/* Portions of the conversion code are by guido@sienanet.it */
|
|
|
|
|
2006-04-04 12:59:25 +00:00
|
|
|
#define GSM_FRAME_SIZE 33
|
|
|
|
#define GSM_SAMPLES 160
|
|
|
|
|
2004-02-03 16:57:00 +00:00
|
|
|
/* silent gsm frame */
|
|
|
|
/* begin binary data: */
|
|
|
|
char gsm_silence[] = /* 33 */
|
|
|
|
{0xD8,0x20,0xA2,0xE1,0x5A,0x50,0x00,0x49,0x24,0x92,0x49,0x24,0x50,0x00,0x49
|
|
|
|
,0x24,0x92,0x49,0x24,0x50,0x00,0x49,0x24,0x92,0x49,0x24,0x50,0x00,0x49,0x24
|
|
|
|
,0x92,0x49,0x24};
|
|
|
|
/* end binary data. size = 33 bytes */
|
|
|
|
|
2003-06-28 22:50:47 +00:00
|
|
|
static struct ast_frame *gsm_read(struct ast_filestream *s, int *whennext)
|
1999-12-16 13:44:30 +00:00
|
|
|
{
|
|
|
|
int res;
|
2006-04-04 12:59:25 +00:00
|
|
|
|
1999-12-16 13:44:30 +00:00
|
|
|
s->fr.frametype = AST_FRAME_VOICE;
|
|
|
|
s->fr.subclass = AST_FORMAT_GSM;
|
2006-04-09 22:31:38 +00:00
|
|
|
AST_FRAME_SET_BUFFER(&(s->fr), s->buf, AST_FRIENDLY_OFFSET, GSM_FRAME_SIZE)
|
1999-12-16 13:44:30 +00:00
|
|
|
s->fr.mallocd = 0;
|
2006-04-04 12:59:25 +00:00
|
|
|
if ((res = fread(s->fr.data, 1, GSM_FRAME_SIZE, s->f)) != GSM_FRAME_SIZE) {
|
1999-12-16 13:44:30 +00:00
|
|
|
if (res)
|
|
|
|
ast_log(LOG_WARNING, "Short read (%d) (%s)!\n", res, strerror(errno));
|
2003-06-28 22:50:47 +00:00
|
|
|
return NULL;
|
1999-12-16 13:44:30 +00:00
|
|
|
}
|
2006-04-04 12:59:25 +00:00
|
|
|
*whennext = s->fr.samples = GSM_SAMPLES;
|
2003-06-28 22:50:47 +00:00
|
|
|
return &s->fr;
|
1999-12-16 13:44:30 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
static int gsm_write(struct ast_filestream *fs, struct ast_frame *f)
|
|
|
|
{
|
|
|
|
int res;
|
2006-04-04 12:59:25 +00:00
|
|
|
unsigned char gsm[2*GSM_FRAME_SIZE];
|
|
|
|
|
1999-12-16 13:44:30 +00:00
|
|
|
if (f->frametype != AST_FRAME_VOICE) {
|
|
|
|
ast_log(LOG_WARNING, "Asked to write non-voice frame!\n");
|
|
|
|
return -1;
|
|
|
|
}
|
|
|
|
if (f->subclass != AST_FORMAT_GSM) {
|
|
|
|
ast_log(LOG_WARNING, "Asked to write non-GSM frame (%d)!\n", f->subclass);
|
|
|
|
return -1;
|
|
|
|
}
|
2003-04-26 16:06:23 +00:00
|
|
|
if (!(f->datalen % 65)) {
|
|
|
|
/* This is in MSGSM format, need to be converted */
|
|
|
|
int len=0;
|
|
|
|
while(len < f->datalen) {
|
|
|
|
conv65(f->data + len, gsm);
|
2006-04-04 12:59:25 +00:00
|
|
|
if ((res = fwrite(gsm, 1, 2*GSM_FRAME_SIZE, fs->f)) != 2*GSM_FRAME_SIZE) {
|
2003-04-26 16:06:23 +00:00
|
|
|
ast_log(LOG_WARNING, "Bad write (%d/66): %s\n", res, strerror(errno));
|
|
|
|
return -1;
|
|
|
|
}
|
|
|
|
len += 65;
|
|
|
|
}
|
|
|
|
} else {
|
2006-04-04 12:59:25 +00:00
|
|
|
if (f->datalen % GSM_FRAME_SIZE) {
|
2003-04-26 16:06:23 +00:00
|
|
|
ast_log(LOG_WARNING, "Invalid data length, %d, should be multiple of 33\n", f->datalen);
|
1999-12-16 13:44:30 +00:00
|
|
|
return -1;
|
2003-04-26 16:06:23 +00:00
|
|
|
}
|
2005-10-16 16:12:51 +00:00
|
|
|
if ((res = fwrite(f->data, 1, f->datalen, fs->f)) != f->datalen) {
|
2003-04-26 16:06:23 +00:00
|
|
|
ast_log(LOG_WARNING, "Bad write (%d/33): %s\n", res, strerror(errno));
|
|
|
|
return -1;
|
|
|
|
}
|
1999-12-16 13:44:30 +00:00
|
|
|
}
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2006-02-20 23:35:12 +00:00
|
|
|
static int gsm_seek(struct ast_filestream *fs, off_t sample_offset, int whence)
|
2003-02-06 22:11:43 +00:00
|
|
|
{
|
2003-04-26 16:06:23 +00:00
|
|
|
off_t offset=0,min,cur,max,distance;
|
2003-02-06 22:11:43 +00:00
|
|
|
|
|
|
|
min = 0;
|
2006-02-20 23:35:12 +00:00
|
|
|
cur = ftello(fs->f);
|
|
|
|
fseeko(fs->f, 0, SEEK_END);
|
|
|
|
max = ftello(fs->f);
|
2003-02-06 22:11:43 +00:00
|
|
|
/* have to fudge to frame here, so not fully to sample */
|
2006-04-04 12:59:25 +00:00
|
|
|
distance = (sample_offset/GSM_SAMPLES) * GSM_FRAME_SIZE;
|
2003-02-06 22:11:43 +00:00
|
|
|
if(whence == SEEK_SET)
|
|
|
|
offset = distance;
|
2003-08-28 20:02:10 +00:00
|
|
|
else if(whence == SEEK_CUR || whence == SEEK_FORCECUR)
|
2003-02-06 22:11:43 +00:00
|
|
|
offset = distance + cur;
|
2003-08-28 20:02:10 +00:00
|
|
|
else if(whence == SEEK_END)
|
2003-02-06 22:11:43 +00:00
|
|
|
offset = max - distance;
|
2004-12-19 21:13:41 +00:00
|
|
|
/* Always protect against seeking past the begining. */
|
2004-04-15 16:02:42 +00:00
|
|
|
offset = (offset < min)?min:offset;
|
2003-08-28 20:02:10 +00:00
|
|
|
if (whence != SEEK_FORCECUR) {
|
|
|
|
offset = (offset > max)?max:offset;
|
2004-02-03 16:57:00 +00:00
|
|
|
} else if (offset > max) {
|
|
|
|
int i;
|
2006-02-20 23:35:12 +00:00
|
|
|
fseeko(fs->f, 0, SEEK_END);
|
2006-04-04 12:59:25 +00:00
|
|
|
for (i=0; i< (offset - max) / GSM_FRAME_SIZE; i++) {
|
|
|
|
fwrite(gsm_silence, 1, GSM_FRAME_SIZE, fs->f);
|
2004-02-03 16:57:00 +00:00
|
|
|
}
|
2003-08-28 20:02:10 +00:00
|
|
|
}
|
2006-02-20 23:35:12 +00:00
|
|
|
return fseeko(fs->f, offset, SEEK_SET);
|
2003-02-06 22:11:43 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
static int gsm_trunc(struct ast_filestream *fs)
|
|
|
|
{
|
2006-02-20 23:35:12 +00:00
|
|
|
return ftruncate(fileno(fs->f), ftello(fs->f));
|
2003-02-06 22:11:43 +00:00
|
|
|
}
|
|
|
|
|
2006-02-20 23:35:12 +00:00
|
|
|
static off_t gsm_tell(struct ast_filestream *fs)
|
2003-02-06 22:11:43 +00:00
|
|
|
{
|
2006-04-04 12:59:25 +00:00
|
|
|
off_t offset = ftello(fs->f);
|
|
|
|
return (offset/GSM_FRAME_SIZE)*GSM_SAMPLES;
|
2003-02-06 22:11:43 +00:00
|
|
|
}
|
|
|
|
|
2006-04-04 12:59:25 +00:00
|
|
|
static const struct ast_format gsm_f = {
|
|
|
|
.name = "gsm",
|
|
|
|
.exts = "gsm",
|
|
|
|
.format = AST_FORMAT_GSM,
|
|
|
|
.write = gsm_write,
|
|
|
|
.seek = gsm_seek,
|
|
|
|
.trunc = gsm_trunc,
|
|
|
|
.tell = gsm_tell,
|
|
|
|
.read = gsm_read,
|
|
|
|
.buf_size = 2*GSM_FRAME_SIZE + AST_FRIENDLY_OFFSET, /* 2 gsm frames */
|
|
|
|
};
|
1999-12-16 13:44:30 +00:00
|
|
|
|
2006-08-21 02:11:39 +00:00
|
|
|
static int load_module(void)
|
1999-12-16 13:44:30 +00:00
|
|
|
{
|
2006-04-04 12:59:25 +00:00
|
|
|
return ast_format_register(&gsm_f);
|
1999-12-16 13:44:30 +00:00
|
|
|
}
|
|
|
|
|
2006-08-21 02:11:39 +00:00
|
|
|
static int unload_module(void)
|
1999-12-16 13:44:30 +00:00
|
|
|
{
|
2006-04-04 12:59:25 +00:00
|
|
|
return ast_format_unregister(gsm_f.name);
|
1999-12-16 13:44:30 +00:00
|
|
|
}
|
|
|
|
|
2006-08-21 02:11:39 +00:00
|
|
|
AST_MODULE_INFO_STANDARD(ASTERISK_GPL_KEY, "Raw GSM data");
|