Add a SAP demuxer
[ffmpeg.git] / libavformat / sapdec.c
1 /*
2  * Session Announcement Protocol (RFC 2974) demuxer
3  * Copyright (c) 2010 Martin Storsjo
4  *
5  * This file is part of FFmpeg.
6  *
7  * FFmpeg is free software; you can redistribute it and/or
8  * modify it under the terms of the GNU Lesser General Public
9  * License as published by the Free Software Foundation; either
10  * version 2.1 of the License, or (at your option) any later version.
11  *
12  * FFmpeg is distributed in the hope that it will be useful,
13  * but WITHOUT ANY WARRANTY; without even the implied warranty of
14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
15  * Lesser General Public License for more details.
16  *
17  * You should have received a copy of the GNU Lesser General Public
18  * License along with FFmpeg; if not, write to the Free Software
19  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
20  */
21
22 #include "avformat.h"
23 #include "libavutil/avstring.h"
24 #include "libavutil/intreadwrite.h"
25 #include "network.h"
26 #include "os_support.h"
27 #include "internal.h"
28 #if HAVE_SYS_SELECT_H
29 #include <sys/select.h>
30 #endif
31
32 struct SAPState {
33     URLContext *ann_fd;
34     AVFormatContext *sdp_ctx;
35     ByteIOContext sdp_pb;
36     uint16_t hash;
37     char *sdp;
38     int eof;
39 };
40
41 static int sap_probe(AVProbeData *p)
42 {
43     if (av_strstart(p->filename, "sap:", NULL))
44         return AVPROBE_SCORE_MAX;
45     return 0;
46 }
47
48 static int sap_read_close(AVFormatContext *s)
49 {
50     struct SAPState *sap = s->priv_data;
51     if (sap->sdp_ctx)
52         av_close_input_stream(sap->sdp_ctx);
53     if (sap->ann_fd)
54         url_close(sap->ann_fd);
55     av_freep(&sap->sdp);
56     ff_network_close();
57     return 0;
58 }
59
60 static int sap_read_header(AVFormatContext *s,
61                            AVFormatParameters *ap)
62 {
63     struct SAPState *sap = s->priv_data;
64     char host[1024], path[1024], url[1024];
65     uint8_t recvbuf[1500];
66     int port;
67     int ret, i;
68     AVInputFormat* infmt;
69
70     if (!ff_network_init())
71         return AVERROR(EIO);
72
73     av_url_split(NULL, 0, NULL, 0, host, sizeof(host), &port,
74                  path, sizeof(path), s->filename);
75     if (port < 0)
76         port = 9875;
77
78     if (!host[0]) {
79         /* Listen for announcements on sap.mcast.net if no host was specified */
80         av_strlcpy(host, "224.2.127.254", sizeof(host));
81     }
82
83     ff_url_join(url, sizeof(url), "udp", NULL, host, port, "?localport=%d",
84                 port);
85     ret = url_open(&sap->ann_fd, url, URL_RDONLY);
86     if (ret)
87         goto fail;
88
89     while (1) {
90         int addr_type, auth_len;
91         int pos;
92
93         ret = url_read(sap->ann_fd, recvbuf, sizeof(recvbuf) - 1);
94         if (ret == AVERROR(EAGAIN))
95             continue;
96         if (ret < 0)
97             goto fail;
98         recvbuf[ret] = '\0'; /* Null terminate for easier parsing */
99         if (ret < 8) {
100             av_log(s, AV_LOG_WARNING, "Received too short packet\n");
101             continue;
102         }
103
104         if ((recvbuf[0] & 0xe0) != 0x20) {
105             av_log(s, AV_LOG_WARNING, "Unsupported SAP version packet "
106                                       "received\n");
107             continue;
108         }
109
110         if (recvbuf[0] & 0x04) {
111             av_log(s, AV_LOG_WARNING, "Received stream deletion "
112                                       "announcement\n");
113             continue;
114         }
115         addr_type = recvbuf[0] & 0x10;
116         auth_len  = recvbuf[1];
117         sap->hash = AV_RB16(&recvbuf[2]);
118         pos = 4;
119         if (addr_type)
120             pos += 16; /* IPv6 */
121         else
122             pos += 4; /* IPv4 */
123         pos += auth_len * 4;
124         if (pos + 4 >= ret) {
125             av_log(s, AV_LOG_WARNING, "Received too short packet\n");
126             continue;
127         }
128 #define MIME "application/sdp"
129         if (strcmp(&recvbuf[pos], MIME) == 0) {
130             pos += strlen(MIME) + 1;
131         } else if (strncmp(&recvbuf[pos], "v=0\r\n", 5) == 0) {
132             // Direct SDP without a mime type
133         } else {
134             av_log(s, AV_LOG_WARNING, "Unsupported mime type %s\n",
135                                       &recvbuf[pos]);
136             continue;
137         }
138
139         sap->sdp = av_strdup(&recvbuf[pos]);
140         break;
141     }
142
143     av_log(s, AV_LOG_VERBOSE, "SDP:\n%s\n", sap->sdp);
144     init_put_byte(&sap->sdp_pb, sap->sdp, strlen(sap->sdp), 0, NULL, NULL,
145                   NULL, NULL);
146
147     infmt = av_find_input_format("sdp");
148     if (!infmt)
149         goto fail;
150     sap->sdp_ctx = avformat_alloc_context();
151     if (!sap->sdp_ctx) {
152         ret = AVERROR(ENOMEM);
153         goto fail;
154     }
155     sap->sdp_ctx->max_delay = s->max_delay;
156     ap->prealloced_context = 1;
157     ret = av_open_input_stream(&sap->sdp_ctx, &sap->sdp_pb, "temp.sdp",
158                                infmt, ap);
159     if (ret < 0)
160         goto fail;
161     if (sap->sdp_ctx->ctx_flags & AVFMTCTX_NOHEADER)
162         s->ctx_flags |= AVFMTCTX_NOHEADER;
163     for (i = 0; i < sap->sdp_ctx->nb_streams; i++) {
164         AVStream *st = av_new_stream(s, i);
165         if (!st) {
166             ret = AVERROR(ENOMEM);
167             goto fail;
168         }
169         avcodec_copy_context(st->codec, sap->sdp_ctx->streams[i]->codec);
170         st->time_base = sap->sdp_ctx->streams[i]->time_base;
171     }
172
173     return 0;
174
175 fail:
176     sap_read_close(s);
177     return ret;
178 }
179
180 static int sap_fetch_packet(AVFormatContext *s, AVPacket *pkt)
181 {
182     struct SAPState *sap = s->priv_data;
183     int fd = url_get_file_handle(sap->ann_fd);
184     int n, ret;
185     fd_set rfds;
186     struct timeval tv;
187     uint8_t recvbuf[1500];
188
189     if (sap->eof)
190         return AVERROR_EOF;
191
192     while (1) {
193         FD_ZERO(&rfds);
194         FD_SET(fd, &rfds);
195         tv.tv_sec = tv.tv_usec = 0;
196         n = select(fd + 1, &rfds, NULL, NULL, &tv);
197         if (n <= 0 || !FD_ISSET(fd, &rfds))
198             break;
199         ret = url_read(sap->ann_fd, recvbuf, sizeof(recvbuf));
200         if (ret >= 8) {
201             uint16_t hash = AV_RB16(&recvbuf[2]);
202             /* Should ideally check the source IP address, too */
203             if (recvbuf[0] & 0x04 && hash == sap->hash) {
204                 /* Stream deletion */
205                 sap->eof = 1;
206                 return AVERROR_EOF;
207             }
208         }
209     }
210     ret = av_read_frame(sap->sdp_ctx, pkt);
211     if (ret < 0)
212         return ret;
213     if (s->ctx_flags & AVFMTCTX_NOHEADER) {
214         while (sap->sdp_ctx->nb_streams > s->nb_streams) {
215             int i = s->nb_streams;
216             AVStream *st = av_new_stream(s, i);
217             if (!st) {
218                 av_free_packet(pkt);
219                 return AVERROR(ENOMEM);
220             }
221             avcodec_copy_context(st->codec, sap->sdp_ctx->streams[i]->codec);
222             st->time_base = sap->sdp_ctx->streams[i]->time_base;
223         }
224     }
225     return ret;
226 }
227
228 AVInputFormat sap_demuxer = {
229     "sap",
230     NULL_IF_CONFIG_SMALL("SAP input format"),
231     sizeof(struct SAPState),
232     sap_probe,
233     sap_read_header,
234     sap_fetch_packet,
235     sap_read_close,
236     .flags = AVFMT_NOFILE,
237 };
238