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
00031 #include "asterisk.h"
00032
00033 ASTERISK_FILE_VERSION(__FILE__, "$Revision: 328259 $")
00034
00035 #include "asterisk/mod_format.h"
00036 #include "asterisk/module.h"
00037 #include "asterisk/endian.h"
00038
00039
00040
00041
00042
00043
00044 #define BUF_SIZE 4096
00045 struct h264_desc {
00046 unsigned int lastts;
00047 };
00048
00049 static int h264_open(struct ast_filestream *s)
00050 {
00051 unsigned int ts;
00052 int res;
00053 if ((res = fread(&ts, 1, sizeof(ts), s->f)) < sizeof(ts)) {
00054 ast_log(LOG_WARNING, "Empty file!\n");
00055 return -1;
00056 }
00057 return 0;
00058 }
00059
00060 static struct ast_frame *h264_read(struct ast_filestream *s, int *whennext)
00061 {
00062 int res;
00063 int mark = 0;
00064 unsigned short len;
00065 unsigned int ts;
00066 struct h264_desc *fs = (struct h264_desc *)s->_private;
00067
00068
00069 if ((res = fread(&len, 1, sizeof(len), s->f)) < 1)
00070 return NULL;
00071 len = ntohs(len);
00072 mark = (len & 0x8000) ? 1 : 0;
00073 len &= 0x7fff;
00074 if (len > BUF_SIZE) {
00075 ast_log(LOG_WARNING, "Length %d is too long\n", len);
00076 len = BUF_SIZE;
00077 }
00078 s->fr.frametype = AST_FRAME_VIDEO;
00079 ast_format_set(&s->fr.subclass.format, AST_FORMAT_H264, 0);
00080 s->fr.mallocd = 0;
00081 AST_FRAME_SET_BUFFER(&s->fr, s->buf, AST_FRIENDLY_OFFSET, len);
00082 if ((res = fread(s->fr.data.ptr, 1, s->fr.datalen, s->f)) != s->fr.datalen) {
00083 if (res)
00084 ast_log(LOG_WARNING, "Short read (%d of %d) (%s)!\n", res, len, strerror(errno));
00085 return NULL;
00086 }
00087 s->fr.samples = fs->lastts;
00088 s->fr.datalen = len;
00089 if (mark) {
00090 ast_format_set_video_mark(&s->fr.subclass.format);
00091 }
00092 s->fr.delivery.tv_sec = 0;
00093 s->fr.delivery.tv_usec = 0;
00094 if ((res = fread(&ts, 1, sizeof(ts), s->f)) == sizeof(ts)) {
00095 fs->lastts = ntohl(ts);
00096 *whennext = fs->lastts * 4/45;
00097 } else
00098 *whennext = 0;
00099 return &s->fr;
00100 }
00101
00102 static int h264_write(struct ast_filestream *s, struct ast_frame *f)
00103 {
00104 int res;
00105 unsigned int ts;
00106 unsigned short len;
00107 int mark;
00108
00109 if (f->frametype != AST_FRAME_VIDEO) {
00110 ast_log(LOG_WARNING, "Asked to write non-video frame!\n");
00111 return -1;
00112 }
00113 mark = ast_format_get_video_mark(&f->subclass.format) ? 0x8000 : 0;
00114 if (f->subclass.format.id != AST_FORMAT_H264) {
00115 ast_log(LOG_WARNING, "Asked to write non-h264 frame (%s)!\n", ast_getformatname(&f->subclass.format));
00116 return -1;
00117 }
00118 ts = htonl(f->samples);
00119 if ((res = fwrite(&ts, 1, sizeof(ts), s->f)) != sizeof(ts)) {
00120 ast_log(LOG_WARNING, "Bad write (%d/4): %s\n", res, strerror(errno));
00121 return -1;
00122 }
00123 len = htons(f->datalen | mark);
00124 if ((res = fwrite(&len, 1, sizeof(len), s->f)) != sizeof(len)) {
00125 ast_log(LOG_WARNING, "Bad write (%d/2): %s\n", res, strerror(errno));
00126 return -1;
00127 }
00128 if ((res = fwrite(f->data.ptr, 1, f->datalen, s->f)) != f->datalen) {
00129 ast_log(LOG_WARNING, "Bad write (%d/%d): %s\n", res, f->datalen, strerror(errno));
00130 return -1;
00131 }
00132 return 0;
00133 }
00134
00135 static int h264_seek(struct ast_filestream *fs, off_t sample_offset, int whence)
00136 {
00137
00138 return -1;
00139 }
00140
00141 static int h264_trunc(struct ast_filestream *fs)
00142 {
00143
00144 if (ftruncate(fileno(fs->f), ftell(fs->f)) < 0)
00145 return -1;
00146 return 0;
00147 }
00148
00149 static off_t h264_tell(struct ast_filestream *fs)
00150 {
00151 off_t offset = ftell(fs->f);
00152 return offset;
00153 }
00154
00155 static struct ast_format_def h264_f = {
00156 .name = "h264",
00157 .exts = "h264",
00158 .open = h264_open,
00159 .write = h264_write,
00160 .seek = h264_seek,
00161 .trunc = h264_trunc,
00162 .tell = h264_tell,
00163 .read = h264_read,
00164 .buf_size = BUF_SIZE + AST_FRIENDLY_OFFSET,
00165 .desc_size = sizeof(struct h264_desc),
00166 };
00167
00168 static int load_module(void)
00169 {
00170 ast_format_set(&h264_f.format, AST_FORMAT_H264, 0);
00171 if (ast_format_def_register(&h264_f))
00172 return AST_MODULE_LOAD_FAILURE;
00173 return AST_MODULE_LOAD_SUCCESS;
00174 }
00175
00176 static int unload_module(void)
00177 {
00178 return ast_format_def_unregister(h264_f.name);
00179 }
00180
00181 AST_MODULE_INFO(ASTERISK_GPL_KEY, AST_MODFLAG_LOAD_ORDER, "Raw H.264 data",
00182 .load = load_module,
00183 .unload = unload_module,
00184 .load_pri = AST_MODPRI_APP_DEPEND
00185 );