Don't reset the RTP address on a glare re-INVITE
[asterisk/asterisk.git] / formats / format_h264.c
1 /*
2  * Asterisk -- An open source telephony toolkit.
3  *
4  * Copyright (C) 1999 - 2005, Digium, Inc.
5  *
6  * Mark Spencer <markster@digium.com>
7  *
8  * See http://www.asterisk.org for more information about
9  * the Asterisk project. Please do not directly contact
10  * any of the maintainers of this project for assistance;
11  * the project provides a web site, mailing lists and IRC
12  * channels for your use.
13  *
14  * This program is free software, distributed under the terms of
15  * the GNU General Public License Version 2. See the LICENSE file
16  * at the top of the source tree.
17  */
18
19 /*! \file
20  *
21  * \brief Save to raw, headerless h264 data.
22  * \arg File name extension: h264
23  * \ingroup formats
24  * \arg See \ref AstVideo
25  */
26
27 /*** MODULEINFO
28         <support_level>core</support_level>
29  ***/
30  
31 #include "asterisk.h"
32
33 ASTERISK_FILE_VERSION(__FILE__, "$Revision$")
34
35 #include "asterisk/mod_format.h"
36 #include "asterisk/module.h"
37 #include "asterisk/endian.h"
38
39 /* Some Ideas for this code came from makeh264e.c by Jeffrey Chilton */
40
41 /* Portions of the conversion code are by guido@sienanet.it */
42 /*! \todo Check this buf size estimate, it may be totally wrong for large frame video */
43
44 #define BUF_SIZE        4096    /* Two Real h264 Frames */
45 struct h264_desc {
46         unsigned int lastts;
47 };
48
49 static int h264_open(struct ast_filestream *s)
50 {
51         unsigned int ts;
52         if (fread(&ts, 1, sizeof(ts), s->f) < sizeof(ts)) {
53                 ast_log(LOG_WARNING, "Empty file!\n");
54                 return -1;
55         }
56         return 0;
57 }
58
59 static struct ast_frame *h264_read(struct ast_filestream *s, int *whennext)
60 {
61         int res;
62         int mark = 0;
63         unsigned short len;
64         unsigned int ts;
65         struct h264_desc *fs = (struct h264_desc *)s->_private;
66
67         /* Send a frame from the file to the appropriate channel */
68         if ((res = fread(&len, 1, sizeof(len), s->f)) < 1)
69                 return NULL;
70         len = ntohs(len);
71         mark = (len & 0x8000) ? 1 : 0;
72         len &= 0x7fff;
73         if (len > BUF_SIZE) {
74                 ast_log(LOG_WARNING, "Length %d is too long\n", len);
75                 len = BUF_SIZE; /* XXX truncate */
76         }
77         s->fr.frametype = AST_FRAME_VIDEO;
78         ast_format_set(&s->fr.subclass.format, AST_FORMAT_H264, 0);
79         s->fr.mallocd = 0;
80         AST_FRAME_SET_BUFFER(&s->fr, s->buf, AST_FRIENDLY_OFFSET, len);
81         if ((res = fread(s->fr.data.ptr, 1, s->fr.datalen, s->f)) != s->fr.datalen) {
82                 if (res)
83                         ast_log(LOG_WARNING, "Short read (%d of %d) (%s)!\n", res, len, strerror(errno));
84                 return NULL;
85         }
86         s->fr.samples = fs->lastts;
87         s->fr.datalen = len;
88         if (mark) {
89                 ast_format_set_video_mark(&s->fr.subclass.format);
90         }
91         s->fr.delivery.tv_sec = 0;
92         s->fr.delivery.tv_usec = 0;
93         if ((res = fread(&ts, 1, sizeof(ts), s->f)) == sizeof(ts)) {
94                 fs->lastts = ntohl(ts);
95                 *whennext = fs->lastts * 4/45;
96         } else
97                 *whennext = 0;
98         return &s->fr;
99 }
100
101 static int h264_write(struct ast_filestream *s, struct ast_frame *f)
102 {
103         int res;
104         unsigned int ts;
105         unsigned short len;
106         int mark;
107
108         if (f->frametype != AST_FRAME_VIDEO) {
109                 ast_log(LOG_WARNING, "Asked to write non-video frame!\n");
110                 return -1;
111         }
112         mark = ast_format_get_video_mark(&f->subclass.format) ? 0x8000 : 0;
113         if (f->subclass.format.id != AST_FORMAT_H264) {
114                 ast_log(LOG_WARNING, "Asked to write non-h264 frame (%s)!\n", ast_getformatname(&f->subclass.format));
115                 return -1;
116         }
117         ts = htonl(f->samples);
118         if ((res = fwrite(&ts, 1, sizeof(ts), s->f)) != sizeof(ts)) {
119                 ast_log(LOG_WARNING, "Bad write (%d/4): %s\n", res, strerror(errno));
120                 return -1;
121         }
122         len = htons(f->datalen | mark);
123         if ((res = fwrite(&len, 1, sizeof(len), s->f)) != sizeof(len)) {
124                 ast_log(LOG_WARNING, "Bad write (%d/2): %s\n", res, strerror(errno));
125                 return -1;
126         }
127         if ((res = fwrite(f->data.ptr, 1, f->datalen, s->f)) != f->datalen) {
128                 ast_log(LOG_WARNING, "Bad write (%d/%d): %s\n", res, f->datalen, strerror(errno));
129                 return -1;
130         }
131         return 0;
132 }
133
134 static int h264_seek(struct ast_filestream *fs, off_t sample_offset, int whence)
135 {
136         /* No way Jose */
137         return -1;
138 }
139
140 static int h264_trunc(struct ast_filestream *fs)
141 {
142         int fd;
143         off_t cur;
144
145         if ((fd = fileno(fs->f)) < 0) {
146                 ast_log(AST_LOG_WARNING, "Unable to determine file descriptor for h264 filestream %p: %s\n", fs, strerror(errno));
147                 return -1;
148         }
149         if ((cur = ftello(fs->f)) < 0) {
150                 ast_log(AST_LOG_WARNING, "Unable to determine current position in h264 filestream %p: %s\n", fs, strerror(errno));
151                 return -1;
152         }
153         /* Truncate file to current length */
154         return ftruncate(fd, cur);
155 }
156
157 static off_t h264_tell(struct ast_filestream *fs)
158 {
159         off_t offset = ftell(fs->f);
160         return offset; /* XXX totally bogus, needs fixing */
161 }
162
163 static struct ast_format_def h264_f = {
164         .name = "h264",
165         .exts = "h264",
166         .open = h264_open,
167         .write = h264_write,
168         .seek = h264_seek,
169         .trunc = h264_trunc,
170         .tell = h264_tell,
171         .read = h264_read,
172         .buf_size = BUF_SIZE + AST_FRIENDLY_OFFSET,
173         .desc_size = sizeof(struct h264_desc),
174 };
175
176 static int load_module(void)
177 {
178         ast_format_set(&h264_f.format, AST_FORMAT_H264, 0);
179         if (ast_format_def_register(&h264_f))
180                 return AST_MODULE_LOAD_FAILURE;
181         return AST_MODULE_LOAD_SUCCESS;
182 }
183
184 static int unload_module(void)
185 {
186         return ast_format_def_unregister(h264_f.name);
187 }
188
189 AST_MODULE_INFO(ASTERISK_GPL_KEY, AST_MODFLAG_LOAD_ORDER, "Raw H.264 data",
190         .load = load_module,
191         .unload = unload_module,
192         .load_pri = AST_MODPRI_APP_DEPEND
193 );