1 | //vio_rtp.c: |
---|
2 | |
---|
3 | /* |
---|
4 | * Copyright (C) Philipp 'ph3-der-loewe' Schafft - 2010 |
---|
5 | * |
---|
6 | * This file is part of libroar a part of RoarAudio, |
---|
7 | * a cross-platform sound system for both, home and professional use. |
---|
8 | * See README for details. |
---|
9 | * |
---|
10 | * This file is free software; you can redistribute it and/or modify |
---|
11 | * it under the terms of the GNU General Public License version 3 |
---|
12 | * as published by the Free Software Foundation. |
---|
13 | * |
---|
14 | * libroar is distributed in the hope that it will be useful, |
---|
15 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
---|
16 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
---|
17 | * GNU General Public License for more details. |
---|
18 | * |
---|
19 | * You should have received a copy of the GNU General Public License |
---|
20 | * along with this software; see the file COPYING. If not, write to |
---|
21 | * the Free Software Foundation, 51 Franklin Street, Fifth Floor, |
---|
22 | * Boston, MA 02110-1301, USA. |
---|
23 | * |
---|
24 | * NOTE for everyone want's to change something and send patches: |
---|
25 | * read README and HACKING! There a addition information on |
---|
26 | * the license of this document you need to read before you send |
---|
27 | * any patches. |
---|
28 | * |
---|
29 | * NOTE for uses of non-GPL (LGPL,...) software using libesd, libartsc |
---|
30 | * or libpulse*: |
---|
31 | * The libs libroaresd, libroararts and libroarpulse link this lib |
---|
32 | * and are therefore GPL. Because of this it may be illigal to use |
---|
33 | * them with any software that uses libesd, libartsc or libpulse*. |
---|
34 | */ |
---|
35 | |
---|
36 | #include "libroar.h" |
---|
37 | |
---|
38 | static const struct { |
---|
39 | int pt; |
---|
40 | struct roar_audio_info info; |
---|
41 | } _g_rtp_pt[] = { |
---|
42 | {ROAR_RTP_PT_A_PCMU, {.codec = ROAR_CODEC_MULAW, .bits = 8, .rate = 8000, .channels = 1}}, |
---|
43 | {ROAR_RTP_PT_A_PCMA, {.codec = ROAR_CODEC_ALAW, .bits = 8, .rate = 8000, .channels = 1}}, |
---|
44 | {ROAR_RTP_PT_A_L16_441_2, {.codec = ROAR_CODEC_PCM_S_BE, .bits = 16, .rate = 44100, .channels = 2}}, |
---|
45 | {ROAR_RTP_PT_A_L16_441_1, {.codec = ROAR_CODEC_PCM_S_BE, .bits = 16, .rate = 44100, .channels = 1}}, |
---|
46 | {-1, {-1, -1, -1}} |
---|
47 | }; |
---|
48 | |
---|
49 | static int _info2pt (struct roar_audio_info * info) { |
---|
50 | int i; |
---|
51 | |
---|
52 | ROAR_DBG("_info2pt(info=%p{.codec=%s(%i), .bits=%i, .rate=%i, .channels=%i}) = ?", info, roar_codec2str(info->codec), info->codec, info->bits, info->rate, info->channels); |
---|
53 | |
---|
54 | for (i = 0; _g_rtp_pt[i].pt != -1; i++) { |
---|
55 | if ( info->codec == _g_rtp_pt[i].info.codec && |
---|
56 | info->bits == _g_rtp_pt[i].info.bits && |
---|
57 | info->rate == _g_rtp_pt[i].info.rate && |
---|
58 | info->channels == _g_rtp_pt[i].info.channels ) { |
---|
59 | return _g_rtp_pt[i].pt; |
---|
60 | } |
---|
61 | } |
---|
62 | |
---|
63 | ROAR_DBG("_info2pt(info=%p{.codec=%s(%i), .bits=%i, .rate=%i, .channels=%i}) = -1", info, roar_codec2str(info->codec), info->codec, info->bits, info->rate, info->channels); |
---|
64 | return -1; |
---|
65 | } |
---|
66 | |
---|
67 | #if 0 |
---|
68 | static const struct roar_audio_info * _pt2info (int pt) { |
---|
69 | int i; |
---|
70 | |
---|
71 | for (i = 0; _g_rtp_pt[i].pt != -1; i++) { |
---|
72 | if ( _g_rtp_pt[i].pt == pt ) { |
---|
73 | return &(_g_rtp_pt[i].info); |
---|
74 | } |
---|
75 | } |
---|
76 | |
---|
77 | return NULL; |
---|
78 | } |
---|
79 | #endif |
---|
80 | |
---|
81 | int roar_vio_open_rtp (struct roar_vio_calls * calls, struct roar_vio_calls * dst, |
---|
82 | char * dstr, struct roar_vio_defaults * odef) { |
---|
83 | struct roar_rtp_inst * self = NULL; |
---|
84 | |
---|
85 | ROAR_DBG("roar_vio_open_rtp(calls=%p, dst=%p, dstr='%s', odef=%p) = ?", calls, dst, dstr, odef); |
---|
86 | |
---|
87 | if ( calls == NULL || dst == NULL ) |
---|
88 | return -1; |
---|
89 | |
---|
90 | if ( (self = roar_mm_malloc(sizeof(struct roar_rtp_inst))) == NULL ) |
---|
91 | return -1; |
---|
92 | |
---|
93 | ROAR_DBG("roar_vio_open_rtp(calls=%p, dst=%p, dstr='%s', odef=%p) = ?", calls, dst, dstr, odef); |
---|
94 | |
---|
95 | memset(self, 0, sizeof(struct roar_rtp_inst)); |
---|
96 | |
---|
97 | self->vio = dst; |
---|
98 | self->bpf = 0; |
---|
99 | self->mtu = 768; |
---|
100 | |
---|
101 | memset(&(self->info), 0, sizeof(struct roar_audio_info)); |
---|
102 | |
---|
103 | self->header.version = 2; |
---|
104 | self->header.payload_type = ROAR_RTP_PT_UNKNOWN; |
---|
105 | |
---|
106 | // TODO: init with random values: |
---|
107 | // Sequence Number |
---|
108 | // ts |
---|
109 | // SSRC |
---|
110 | |
---|
111 | memset(calls, 0, sizeof(struct roar_vio_calls)); |
---|
112 | |
---|
113 | calls->inst = self; |
---|
114 | calls->read = roar_vio_rtp_read; |
---|
115 | calls->write = roar_vio_rtp_write; |
---|
116 | // calls->lseek = roar_vio_rtp_lseek; |
---|
117 | calls->nonblock = roar_vio_rtp_nonblock; |
---|
118 | calls->sync = roar_vio_rtp_sync; |
---|
119 | calls->ctl = roar_vio_rtp_ctl; |
---|
120 | calls->close = roar_vio_rtp_close; |
---|
121 | |
---|
122 | ROAR_DBG("roar_vio_open_rtp(calls=%p, dst=%p, dstr='%s', odef=%p) = 0", calls, dst, dstr, odef); |
---|
123 | |
---|
124 | return 0; |
---|
125 | } |
---|
126 | |
---|
127 | ssize_t roar_vio_rtp_read (struct roar_vio_calls * vio, void *buf, size_t count) { |
---|
128 | struct roar_rtp_inst * self = vio->inst; |
---|
129 | size_t len_need = self->mtu * 4 + sizeof(struct roar_rtp_header); // we hope to never get pkgs with size > 4*mtu |
---|
130 | size_t len_have; |
---|
131 | size_t have = 0; |
---|
132 | ssize_t ret; |
---|
133 | union { |
---|
134 | void * vp; |
---|
135 | char * cp; |
---|
136 | uint16_t * u16; |
---|
137 | uint32_t * u32; |
---|
138 | } data; |
---|
139 | size_t dataoffset; |
---|
140 | int i; |
---|
141 | |
---|
142 | ROAR_DBG("roar_vio_rtp_read(vio=%p, buf=%p, count=%llu) = ?", vio, buf, (long long unsigned)count); |
---|
143 | |
---|
144 | if ( self->rx_decoded != NULL ) { |
---|
145 | // handle this case and set to NULL if the buffer is empty |
---|
146 | // set have; |
---|
147 | // increment buf, decrement count |
---|
148 | } |
---|
149 | |
---|
150 | if ( count == 0 ) |
---|
151 | return have; |
---|
152 | |
---|
153 | if ( self->io == NULL ) { |
---|
154 | if ( roar_buffer_new(&(self->io), len_need) == -1 ) |
---|
155 | return have ? have : -1; |
---|
156 | |
---|
157 | len_have = len_need; |
---|
158 | } else { |
---|
159 | if ( roar_buffer_get_len(self->io, &len_have) == -1 ) |
---|
160 | return have ? have : -1; |
---|
161 | |
---|
162 | if ( len_have < len_need ) { |
---|
163 | if ( roar_buffer_set_len(self->io, len_need) == -1 ) { |
---|
164 | if ( roar_buffer_free(self->io) == -1 ) |
---|
165 | return have ? have : -1; |
---|
166 | |
---|
167 | self->io = NULL; |
---|
168 | if ( have != 0 ) { |
---|
169 | return have; |
---|
170 | } else { |
---|
171 | return roar_vio_rtp_read(vio, buf, count); // restart ower self from the beginning with no buffer |
---|
172 | } |
---|
173 | } |
---|
174 | } |
---|
175 | } |
---|
176 | |
---|
177 | if ( roar_buffer_get_data(self->io, &(data.vp)) == -1 ) |
---|
178 | return have ? have : -1; |
---|
179 | |
---|
180 | if ( (ret = roar_vio_read(self->vio, data.vp, len_need)) == -1 ) |
---|
181 | return have ? have : -1; |
---|
182 | |
---|
183 | if ( (data.cp[0] && 0x02) == 0x02 ) /* version check */ |
---|
184 | return have ? have : -1; |
---|
185 | |
---|
186 | self->header.csrc_count = (data.cp[0] & 0xF0) >> 4; |
---|
187 | self->header.payload_type = (data.cp[1] & 0xFE) >> 1; |
---|
188 | |
---|
189 | // TODO: check old seqnum < new seqnum |
---|
190 | self->header.seq_num = ROAR_NET2HOST16(data.u16[1]); |
---|
191 | |
---|
192 | // TODO: check timestamp: |
---|
193 | self->header.ts = ROAR_NET2HOST32(data.u32[1]); |
---|
194 | |
---|
195 | self->header.ssrc = ROAR_NET2HOST32(data.u32[2]); |
---|
196 | |
---|
197 | for (i = 0; i < self->header.csrc_count; i++) { |
---|
198 | self->header.csrc[i] = ROAR_NET2HOST16(data.u32[3+i]); |
---|
199 | } |
---|
200 | |
---|
201 | dataoffset = 3*4 + self->header.csrc_count*4; |
---|
202 | |
---|
203 | ret -= dataoffset; |
---|
204 | data.vp += dataoffset; |
---|
205 | |
---|
206 | if ( ret <= count ) { |
---|
207 | memcpy(buf, data.vp, ret); |
---|
208 | ROAR_DBG("roar_vio_rtp_read(vio=%p, buf=%p, count=?) = %llu", vio, buf, (long long unsigned)(have+ret)); |
---|
209 | return have + ret; |
---|
210 | } else { |
---|
211 | } |
---|
212 | |
---|
213 | ROAR_DBG("roar_vio_rtp_read(vio=%p, buf=%p, count=?) = -1", vio, buf); |
---|
214 | return -1; |
---|
215 | } |
---|
216 | |
---|
217 | ssize_t roar_vio_rtp_write (struct roar_vio_calls * vio, void *buf, size_t count) { |
---|
218 | struct roar_rtp_inst * self = vio->inst; |
---|
219 | size_t len_need = count + sizeof(struct roar_rtp_header); // this is a bit more than we need |
---|
220 | // we ignore this at the moment |
---|
221 | size_t len_have; |
---|
222 | union { |
---|
223 | void * vp; |
---|
224 | char * cp; |
---|
225 | uint16_t * u16; |
---|
226 | uint32_t * u32; |
---|
227 | } data; |
---|
228 | size_t dataoffset; |
---|
229 | ssize_t ret; |
---|
230 | int i; |
---|
231 | |
---|
232 | ROAR_DBG("roar_vio_rtp_write(vio=%p, buf=%p, count=%llu) = ?", vio, buf, (long long unsigned)count); |
---|
233 | |
---|
234 | if ( self->mtu < (sizeof(struct roar_rtp_header) + self->bpf) ) |
---|
235 | return -1; |
---|
236 | |
---|
237 | if ( len_need > self->mtu ) { |
---|
238 | len_have = 0; |
---|
239 | ret = 0; |
---|
240 | |
---|
241 | while (count) { |
---|
242 | len_need = self->mtu - sizeof(struct roar_rtp_header); |
---|
243 | |
---|
244 | if ( count < len_need ) |
---|
245 | len_need = count; |
---|
246 | |
---|
247 | if ( (ret = roar_vio_rtp_write(vio, buf, len_need)) == -1 ) |
---|
248 | break; |
---|
249 | |
---|
250 | len_have += ret; |
---|
251 | buf += ret; |
---|
252 | count -= ret; |
---|
253 | } |
---|
254 | |
---|
255 | return len_have ? len_have : ret; |
---|
256 | } |
---|
257 | |
---|
258 | if ( self->io == NULL ) { |
---|
259 | if ( roar_buffer_new(&(self->io), len_need) == -1 ) |
---|
260 | return -1; |
---|
261 | |
---|
262 | len_have = len_need; |
---|
263 | } else { |
---|
264 | if ( roar_buffer_get_len(self->io, &len_have) == -1 ) |
---|
265 | return -1; |
---|
266 | |
---|
267 | if ( len_have < len_need ) { |
---|
268 | if ( roar_buffer_set_len(self->io, len_need) == -1 ) { |
---|
269 | if ( roar_buffer_free(self->io) == -1 ) |
---|
270 | return -1; |
---|
271 | |
---|
272 | self->io = NULL; |
---|
273 | return roar_vio_rtp_write(vio, buf, count); // restart ower self from the beginning with no buffer |
---|
274 | } |
---|
275 | } |
---|
276 | } |
---|
277 | |
---|
278 | ROAR_DBG("roar_vio_rtp_write(vio=%p, buf=%p, count=%llu) = ?", vio, buf, (long long unsigned)count); |
---|
279 | |
---|
280 | if ( roar_buffer_get_data(self->io, &(data.vp)) == -1 ) |
---|
281 | return -1; |
---|
282 | |
---|
283 | memset(data.vp, 0, len_need); |
---|
284 | |
---|
285 | self->header.seq_num++; |
---|
286 | |
---|
287 | data.cp[0] = 2; |
---|
288 | data.cp[0] |= self->header.csrc_count << 4; |
---|
289 | data.cp[1] |= self->header.payload_type << 1; |
---|
290 | |
---|
291 | data.u16[1] = ROAR_HOST2NET16(self->header.seq_num); |
---|
292 | |
---|
293 | data.u32[1] = ROAR_HOST2NET32(self->header.ts); |
---|
294 | data.u32[2] = ROAR_HOST2NET32(self->header.ssrc); |
---|
295 | |
---|
296 | for (i = 0; i < self->header.csrc_count; i++) { |
---|
297 | data.u32[3+i] = ROAR_HOST2NET32(self->header.csrc[i]); |
---|
298 | } |
---|
299 | |
---|
300 | dataoffset = 3*4 + self->header.csrc_count*4; |
---|
301 | |
---|
302 | memcpy(data.vp + dataoffset, buf, count); |
---|
303 | |
---|
304 | ROAR_DBG("roar_vio_rtp_write(vio=%p, buf=%p, count=%llu) = ?", vio, buf, (long long unsigned)count); |
---|
305 | |
---|
306 | if ( (ret = roar_vio_write(self->vio, data.vp, count+dataoffset)) == -1 ) |
---|
307 | return -1; |
---|
308 | |
---|
309 | len_have = ret - dataoffset; |
---|
310 | |
---|
311 | self->header.ts += len_have / self->bpf; |
---|
312 | |
---|
313 | return len_have; |
---|
314 | } |
---|
315 | |
---|
316 | off_t roar_vio_rtp_lseek (struct roar_vio_calls * vio, off_t offset, int whence); |
---|
317 | |
---|
318 | int roar_vio_rtp_nonblock(struct roar_vio_calls * vio, int state) { |
---|
319 | struct roar_rtp_inst * self = vio->inst; |
---|
320 | |
---|
321 | ROAR_DBG("roar_vio_rtp_nonblock(vio=%p, state=%i) = ?", vio, state); |
---|
322 | |
---|
323 | return roar_vio_nonblock(self->vio, state); |
---|
324 | } |
---|
325 | |
---|
326 | int roar_vio_rtp_sync (struct roar_vio_calls * vio) { |
---|
327 | struct roar_rtp_inst * self = vio->inst; |
---|
328 | |
---|
329 | ROAR_DBG("roar_vio_rtp_sync(vio=%p) = ?", vio); |
---|
330 | |
---|
331 | return roar_vio_sync(self->vio); |
---|
332 | } |
---|
333 | |
---|
334 | int roar_vio_rtp_ctl (struct roar_vio_calls * vio, int cmd, void * data) { |
---|
335 | struct roar_rtp_inst * self = vio->inst; |
---|
336 | struct roar_stream * s = NULL; |
---|
337 | struct roar_stream_server * ss = NULL; |
---|
338 | struct roar_audio_info * info = NULL; |
---|
339 | |
---|
340 | ROAR_DBG("roar_vio_rtp_ctl(vio=%p, cmd=%i, data=%p) = ?", vio, cmd, data); |
---|
341 | |
---|
342 | if (vio == NULL || cmd == -1) |
---|
343 | return -1; |
---|
344 | |
---|
345 | ROAR_DBG("roar_vio_rtp_ctl(vio=%p, cmd=%i, data=%p) = ?", vio, cmd, data); |
---|
346 | |
---|
347 | switch (cmd) { |
---|
348 | case ROAR_VIO_CTL_SET_SSTREAM: |
---|
349 | s = ROAR_STREAM(ss = data); |
---|
350 | info = &(s->info); |
---|
351 | break; |
---|
352 | case ROAR_VIO_CTL_SET_STREAM: |
---|
353 | s = ROAR_STREAM(data); |
---|
354 | info = &(s->info); |
---|
355 | break; |
---|
356 | case ROAR_VIO_CTL_SET_AUINFO: |
---|
357 | info = data; |
---|
358 | break; |
---|
359 | case ROAR_VIO_CTL_GET_NEXT: |
---|
360 | *(struct roar_vio_calls **)data = self->vio; |
---|
361 | return 0; |
---|
362 | break; |
---|
363 | case ROAR_VIO_CTL_SET_NEXT: |
---|
364 | self->vio = *(struct roar_vio_calls **)data; |
---|
365 | return 0; |
---|
366 | break; |
---|
367 | } |
---|
368 | |
---|
369 | ROAR_DBG("roar_vio_rtp_ctl(vio=%p, cmd=%i, data=%p) = ?", vio, cmd, data); |
---|
370 | |
---|
371 | if ( info != NULL ) { |
---|
372 | switch (info->codec) { |
---|
373 | case ROAR_CODEC_PCM_S_LE: |
---|
374 | case ROAR_CODEC_PCM_S_PDP: |
---|
375 | info->codec = ROAR_CODEC_PCM_S_BE; |
---|
376 | break; |
---|
377 | case ROAR_CODEC_PCM_U_LE: |
---|
378 | case ROAR_CODEC_PCM_U_PDP: |
---|
379 | info->codec = ROAR_CODEC_PCM_U_BE; |
---|
380 | break; |
---|
381 | } |
---|
382 | |
---|
383 | memcpy(&(self->info), info, sizeof(struct roar_audio_info)); |
---|
384 | |
---|
385 | self->header.payload_type = _info2pt(info); |
---|
386 | |
---|
387 | self->bpf = info->channels * info->bits / 8; |
---|
388 | |
---|
389 | roar_vio_ctl(self->vio, cmd, data); |
---|
390 | return 0; |
---|
391 | } |
---|
392 | |
---|
393 | return roar_vio_ctl(self->vio, cmd, data); |
---|
394 | } |
---|
395 | |
---|
396 | int roar_vio_rtp_close (struct roar_vio_calls * vio) { |
---|
397 | struct roar_rtp_inst * self = vio->inst; |
---|
398 | int ret; |
---|
399 | |
---|
400 | ROAR_DBG("roar_vio_rtp_close(vio=%p) = ?", vio); |
---|
401 | |
---|
402 | ret = roar_vio_close(self->vio); |
---|
403 | |
---|
404 | if ( self->io != NULL ) |
---|
405 | if ( roar_buffer_free(self->io) == -1 ) |
---|
406 | ret = -1; |
---|
407 | |
---|
408 | roar_mm_free(self); |
---|
409 | |
---|
410 | ROAR_DBG("roar_vio_rtp_close(vio=%p) = %i", vio, ret); |
---|
411 | |
---|
412 | return ret; |
---|
413 | } |
---|
414 | |
---|
415 | //ll |
---|