00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00021
00022
00023
00024
00025
00026
00027
00028
00029
00030 #include "asterisk.h"
00031
00032 ASTERISK_FILE_VERSION(__FILE__, "$Revision: 364578 $")
00033
00034 #include "asterisk/mod_format.h"
00035 #include "asterisk/module.h"
00036 #include "asterisk/endian.h"
00037
00038 #include "msgsm.h"
00039
00040
00041
00042
00043
00044 #define GSM_FRAME_SIZE 33
00045 #define GSM_SAMPLES 160
00046
00047
00048
00049 static const char gsm_silence[] =
00050 {0xD8,0x20,0xA2,0xE1,0x5A,0x50,0x00,0x49,0x24,0x92,0x49,0x24,0x50,0x00,0x49
00051 ,0x24,0x92,0x49,0x24,0x50,0x00,0x49,0x24,0x92,0x49,0x24,0x50,0x00,0x49,0x24
00052 ,0x92,0x49,0x24};
00053
00054
00055 static struct ast_frame *gsm_read(struct ast_filestream *s, int *whennext)
00056 {
00057 int res;
00058
00059 s->fr.frametype = AST_FRAME_VOICE;
00060 s->fr.subclass.codec = AST_FORMAT_GSM;
00061 AST_FRAME_SET_BUFFER(&(s->fr), s->buf, AST_FRIENDLY_OFFSET, GSM_FRAME_SIZE)
00062 s->fr.mallocd = 0;
00063 if ((res = fread(s->fr.data.ptr, 1, GSM_FRAME_SIZE, s->f)) != GSM_FRAME_SIZE) {
00064 if (res)
00065 ast_log(LOG_WARNING, "Short read (%d) (%s)!\n", res, strerror(errno));
00066 return NULL;
00067 }
00068 *whennext = s->fr.samples = GSM_SAMPLES;
00069 return &s->fr;
00070 }
00071
00072 static int gsm_write(struct ast_filestream *fs, struct ast_frame *f)
00073 {
00074 int res;
00075 unsigned char gsm[2*GSM_FRAME_SIZE];
00076
00077 if (f->frametype != AST_FRAME_VOICE) {
00078 ast_log(LOG_WARNING, "Asked to write non-voice frame!\n");
00079 return -1;
00080 }
00081 if (f->subclass.codec != AST_FORMAT_GSM) {
00082 ast_log(LOG_WARNING, "Asked to write non-GSM frame (%s)!\n", ast_getformatname(f->subclass.codec));
00083 return -1;
00084 }
00085 if (!(f->datalen % 65)) {
00086
00087 int len=0;
00088 while(len < f->datalen) {
00089 conv65(f->data.ptr + len, gsm);
00090 if ((res = fwrite(gsm, 1, 2*GSM_FRAME_SIZE, fs->f)) != 2*GSM_FRAME_SIZE) {
00091 ast_log(LOG_WARNING, "Bad write (%d/66): %s\n", res, strerror(errno));
00092 return -1;
00093 }
00094 len += 65;
00095 }
00096 } else {
00097 if (f->datalen % GSM_FRAME_SIZE) {
00098 ast_log(LOG_WARNING, "Invalid data length, %d, should be multiple of 33\n", f->datalen);
00099 return -1;
00100 }
00101 if ((res = fwrite(f->data.ptr, 1, f->datalen, fs->f)) != f->datalen) {
00102 ast_log(LOG_WARNING, "Bad write (%d/33): %s\n", res, strerror(errno));
00103 return -1;
00104 }
00105 }
00106 return 0;
00107 }
00108
00109 static int gsm_seek(struct ast_filestream *fs, off_t sample_offset, int whence)
00110 {
00111 off_t offset = 0, min = 0, cur, max, distance;
00112
00113 if ((cur = ftello(fs->f)) < 0) {
00114 ast_log(AST_LOG_WARNING, "Unable to determine current position in g719 filestream %p: %s\n", fs, strerror(errno));
00115 return -1;
00116 }
00117
00118 if (fseeko(fs->f, 0, SEEK_END) < 0) {
00119 ast_log(AST_LOG_WARNING, "Unable to seek to end of g719 filestream %p: %s\n", fs, strerror(errno));
00120 return -1;
00121 }
00122
00123 if ((max = ftello(fs->f)) < 0) {
00124 ast_log(AST_LOG_WARNING, "Unable to determine max position in g719 filestream %p: %s\n", fs, strerror(errno));
00125 return -1;
00126 }
00127
00128
00129 distance = (sample_offset / GSM_SAMPLES) * GSM_FRAME_SIZE;
00130 if (whence == SEEK_SET) {
00131 offset = distance;
00132 } else if (whence == SEEK_CUR || whence == SEEK_FORCECUR) {
00133 offset = distance + cur;
00134 } else if (whence == SEEK_END) {
00135 offset = max - distance;
00136 }
00137
00138
00139 offset = (offset < min)?min:offset;
00140 if (whence != SEEK_FORCECUR) {
00141 offset = (offset > max)?max:offset;
00142 } else if (offset > max) {
00143 int i;
00144 fseeko(fs->f, 0, SEEK_END);
00145 for (i=0; i< (offset - max) / GSM_FRAME_SIZE; i++) {
00146 if (!fwrite(gsm_silence, 1, GSM_FRAME_SIZE, fs->f)) {
00147 ast_log(LOG_WARNING, "fwrite() failed: %s\n", strerror(errno));
00148 }
00149 }
00150 }
00151 return fseeko(fs->f, offset, SEEK_SET);
00152 }
00153
00154 static int gsm_trunc(struct ast_filestream *fs)
00155 {
00156 int fd;
00157 off_t cur;
00158
00159 if ((fd = fileno(fs->f)) < 0) {
00160 ast_log(AST_LOG_WARNING, "Unable to determine file descriptor for gsm filestream %p: %s\n", fs, strerror(errno));
00161 return -1;
00162 }
00163 if ((cur = ftello(fs->f)) < 0) {
00164 ast_log(AST_LOG_WARNING, "Unable to determine current position in gsm filestream %p: %s\n", fs, strerror(errno));
00165 return -1;
00166 }
00167
00168 return ftruncate(fd, cur);
00169 }
00170
00171 static off_t gsm_tell(struct ast_filestream *fs)
00172 {
00173 off_t offset = ftello(fs->f);
00174
00175 if (offset < 0) {
00176 ast_log(AST_LOG_WARNING, "Unable to determine offset for gsm filestream %p: %s\n", fs, strerror(errno));
00177 return 0;
00178 }
00179
00180 return (offset / GSM_FRAME_SIZE) * GSM_SAMPLES;
00181 }
00182
00183 static const struct ast_format gsm_f = {
00184 .name = "gsm",
00185 .exts = "gsm",
00186 .format = AST_FORMAT_GSM,
00187 .write = gsm_write,
00188 .seek = gsm_seek,
00189 .trunc = gsm_trunc,
00190 .tell = gsm_tell,
00191 .read = gsm_read,
00192 .buf_size = 2*GSM_FRAME_SIZE + AST_FRIENDLY_OFFSET,
00193 };
00194
00195 static int load_module(void)
00196 {
00197 if (ast_format_register(&gsm_f))
00198 return AST_MODULE_LOAD_FAILURE;
00199 return AST_MODULE_LOAD_SUCCESS;
00200 }
00201
00202 static int unload_module(void)
00203 {
00204 return ast_format_unregister(gsm_f.name);
00205 }
00206
00207 AST_MODULE_INFO(ASTERISK_GPL_KEY, AST_MODFLAG_LOAD_ORDER, "Raw GSM data",
00208 .load = load_module,
00209 .unload = unload_module,
00210 .load_pri = AST_MODPRI_APP_DEPEND
00211 );