Debian Codegraph @

src/mpeg2.c

raw
1 /*
2 * libiec61883 - Linux IEEE 1394 streaming media library.
3 * Copyright (C) 2004 Kristian Hogsberg, Dan Dennedy, and Dan Maas.
4 * This file written by Dan Dennedy.
5 *
6 * This library is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU Lesser General Public
8 * License as published by the Free Software Foundation; either
9 * version 2.1 of the License, or (at your option) any later version.
10 *
11 * This library is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
14 * Lesser General Public License for more details.
15 *
16 * You should have received a copy of the GNU Lesser General Public
17 * License along with this library; if not, write to the Free Software
18 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
19 */
20
21 #ifdef HAVE_CONFIG_H
22 #include <config.h>
23 #endif
24
25 #include "iec61883.h"
26 #include "iec61883-private.h"
27 #include "tsbuffer.h"
28
29 #include <errno.h>
30 #include <stdio.h>
31 #include <netinet/in.h>
32 #include <stdlib.h>
33 #include <assert.h>
34
35 #define MAX_PACKET_SIZE 2048 /* max 1394 iso packet size */
36 #define TSP_SPH_SIZE 192 /* size of transport stream packet plus source packet header */
37
38 iec61883_mpeg2_t
39 iec61883_mpeg2_xmit_init(raw1394handle_t handle,
40 iec61883_mpeg2_xmit_t get_data,
41 void *callback_data)
42 {
43 struct iec61883_mpeg2 *mpeg;
44
45 assert (handle != NULL);
46 mpeg = malloc(sizeof(struct iec61883_mpeg2));
47 if (!mpeg) {
48 errno = ENOMEM;
49 return NULL;
50 }
51
52 mpeg->tsbuffer = NULL;
53 mpeg->handle = handle;
54 mpeg->put_data = NULL;
55 mpeg->get_data = get_data;
56 mpeg->callback_data = callback_data;
57 mpeg->buffer_packets = 1000;
58 mpeg->prebuffer_packets = 1000;
59 mpeg->irq_interval = 250;
60 mpeg->synch = 0;
61 mpeg->speed = RAW1394_ISO_SPEED_200;
62
63 raw1394_set_userdata (handle, mpeg);
64
65 return mpeg;
66 }
67
68 iec61883_mpeg2_t
69 iec61883_mpeg2_recv_init(raw1394handle_t handle,
70 iec61883_mpeg2_recv_t put_data,
71 void *callback_data)
72 {
73 struct iec61883_mpeg2 *mpeg;
74
75 mpeg = malloc(sizeof(struct iec61883_mpeg2));
76 if (!mpeg) {
77 errno = ENOMEM;
78 return NULL;
79 }
80
81 mpeg->tsbuffer = NULL;
82 mpeg->handle = handle;
83 mpeg->put_data = put_data;
84 mpeg->get_data = NULL;
85 mpeg->callback_data = callback_data;
86 mpeg->buffer_packets = 1000;
87 mpeg->irq_interval = 250;
88 mpeg->synch = 0;
89 mpeg->speed = RAW1394_ISO_SPEED_200;
90
91 raw1394_set_userdata (handle, mpeg);
92
93 return mpeg;
94 }
95
96 static enum raw1394_iso_disposition
97 mpeg2_recv_handler (raw1394handle_t handle,
98 unsigned char *data,
99 unsigned int len,
100 unsigned char channel,
101 unsigned char tag,
102 unsigned char sy,
103 unsigned int cycle,
104 unsigned int dropped)
105 {
106 struct iec61883_mpeg2 *mpeg = raw1394_get_userdata (handle);
107 enum raw1394_iso_disposition result = RAW1394_ISO_OK;
108
109 /* check fields of CIP header for valid packet */
110 unsigned short dbs_fn_qpc_sph = (htonl (* (unsigned long*) (data)) >> 10) & 0x3fff;
111 unsigned char fmt = (htonl (* (unsigned long*) (data + 4)) >> 24) & 0x3f;
112
113 assert (mpeg != NULL);
114 mpeg->total_dropped += dropped;
115
116 if (mpeg->put_data != NULL && /* only if callback registered */
117 channel == mpeg->channel && /* only for selected channel */
118 len >= TSP_SPH_SIZE + 8 && /* no empty packets */
119 dbs_fn_qpc_sph == 0x01b1 && /* valid CIP header */
120 fmt == 0x20 )
121 {
122 /* skip over CIP header and SPH */
123 data += 12;
124
125 /* write each TSP in the iso packet minus SPH */
126 for (; len > IEC61883_MPEG2_TSP_SIZE; len -= TSP_SPH_SIZE, data += TSP_SPH_SIZE) {
127 if (mpeg->put_data (data, IEC61883_MPEG2_TSP_SIZE, dropped, mpeg->callback_data) < 0) {
128 result = RAW1394_ISO_ERROR;
129 break;
130 }
131 dropped = 0; /* do not repeatedly report dropped */
132 }
133 }
134 if (result == RAW1394_ISO_OK && dropped)
135 result = RAW1394_ISO_DEFER;
136
137 return result;
138 }
139
140 int
141 iec61883_mpeg2_recv_start(struct iec61883_mpeg2 *mpeg, int channel)
142 {
143 int result = 0;
144
145 assert (mpeg != NULL);
146 result = raw1394_iso_recv_init (mpeg->handle,
147 mpeg2_recv_handler,
148 mpeg->buffer_packets,
149 MAX_PACKET_SIZE + 8,
150 channel,
151 RAW1394_DMA_PACKET_PER_BUFFER,
152 mpeg->irq_interval);
153
154 if (result == 0) {
155 mpeg->total_dropped = 0;
156 mpeg->channel = channel;
157 result = raw1394_iso_recv_start (mpeg->handle, -1, -1, 0);
158 }
159 return result;
160 }
161
162 static enum raw1394_iso_disposition
163 mpeg2_xmit_handler (raw1394handle_t handle, unsigned char *data,
164 unsigned int *len, unsigned char *tag,
165 unsigned char *sy, int cycle,
166 unsigned int dropped )
167 {
168 struct iec61883_mpeg2 *mpeg = raw1394_get_userdata (handle);
169 enum raw1394_iso_disposition result = RAW1394_ISO_OK;
170
171 assert (mpeg != NULL);
172 mpeg->total_dropped += dropped;
173
174 if ( mpeg->tsbuffer != NULL ) {
175 *len = tsbuffer_send_iso_cycle (mpeg->tsbuffer, data, cycle,
176 (raw1394_get_local_id (handle) & 0x3f), dropped);
177 if (*len == 0)
178 result = RAW1394_ISO_ERROR;
179 }
180 else
181 result = RAW1394_ISO_ERROR;
182
183 *tag = IEC61883_TAG_WITH_CIP;
184 *sy = 0;
185
186 return result;
187 }
188
189
190 int
191 iec61883_mpeg2_xmit_start (struct iec61883_mpeg2 *mpeg, int pid, int channel)
192 {
193 int result = 0;
194
195 assert (mpeg != NULL);
196 if (mpeg->get_data != NULL) {
197 mpeg->tsbuffer = tsbuffer_init (mpeg->get_data, mpeg->callback_data, pid);
198 if (mpeg->tsbuffer != NULL) {
199 if (raw1394_iso_xmit_init (mpeg->handle,
200 mpeg2_xmit_handler,
201 mpeg->buffer_packets,
202 968, /* max packets size = 5 * 192 + 8 */
203 channel,
204 mpeg->speed,
205 mpeg->irq_interval) == 0) {
206 mpeg->total_dropped = 0;
207 result = raw1394_iso_xmit_start (mpeg->handle, -1, mpeg->prebuffer_packets);
208 } else
209 result = -1;
210 } else
211 result = -1;
212 } else
213 result = -1;
214
215 return result;
216 }
217
218 void
219 iec61883_mpeg2_xmit_stop (struct iec61883_mpeg2 *mpeg)
220 {
221 assert (mpeg != NULL);
222 if (mpeg->synch)
223 raw1394_iso_xmit_sync (mpeg->handle);
224 raw1394_iso_shutdown (mpeg->handle);
225 tsbuffer_close (mpeg->tsbuffer);
226 mpeg->tsbuffer = NULL;
227 }
228
229 void
230 iec61883_mpeg2_recv_stop (struct iec61883_mpeg2 *mpeg)
231 {
232 assert (mpeg != NULL);
233 if (mpeg->synch)
234 raw1394_iso_recv_flush (mpeg->handle);
235 raw1394_iso_shutdown (mpeg->handle);
236 }
237
238 void
239 iec61883_mpeg2_close (struct iec61883_mpeg2 *mpeg)
240 {
241 assert (mpeg != NULL);
242 if (mpeg->put_data)
243 iec61883_mpeg2_recv_stop (mpeg);
244 else if (mpeg->get_data)
245 iec61883_mpeg2_xmit_stop (mpeg);
246 free (mpeg);
247 }
248
249 unsigned int
250 iec61883_mpeg2_get_buffers(iec61883_mpeg2_t mpeg2)
251 {
252 assert (mpeg2 != NULL);
253 return mpeg2->buffer_packets;
254 }
255
256 void
257 iec61883_mpeg2_set_buffers(iec61883_mpeg2_t mpeg2, unsigned int packets)
258 {
259 assert (mpeg2 != NULL);
260 mpeg2->buffer_packets = packets;
261 }
262
263 unsigned int
264 iec61883_mpeg2_get_prebuffers(iec61883_mpeg2_t mpeg2)
265 {
266 assert (mpeg2 != NULL);
267 return mpeg2->prebuffer_packets;
268 }
269
270 void
271 iec61883_mpeg2_set_prebuffers(iec61883_mpeg2_t mpeg2, unsigned int packets)
272 {
273 assert (mpeg2 != NULL);
274 mpeg2->prebuffer_packets = packets;
275 }
276
277 unsigned int
278 iec61883_mpeg2_get_irq_interval(iec61883_mpeg2_t mpeg2)
279 {
280 assert (mpeg2 != NULL);
281 return mpeg2->irq_interval;
282 }
283
284 void
285 iec61883_mpeg2_set_irq_interval(iec61883_mpeg2_t mpeg2, unsigned int packets)
286 {
287 assert (mpeg2 != NULL);
288 mpeg2->irq_interval = packets;
289 }
290
291 int
292 iec61883_mpeg2_get_synch(iec61883_mpeg2_t mpeg2)
293 {
294 assert (mpeg2 != NULL);
295 return mpeg2->synch;
296 }
297
298 void
299 iec61883_mpeg2_set_synch(iec61883_mpeg2_t mpeg2, int synch)
300 {
301 assert (mpeg2 != NULL);
302 mpeg2->synch = synch;
303 }
304
305 int
306 iec61883_mpeg2_get_speed(iec61883_mpeg2_t mpeg2)
307 {
308 assert (mpeg2 != NULL);
309 return mpeg2->speed;
310 }
311
312 void
313 iec61883_mpeg2_set_speed(iec61883_mpeg2_t mpeg2, int speed)
314 {
315 assert (mpeg2 != NULL);
316 mpeg2->speed = speed;
317 }
318
319 unsigned int
320 iec61883_mpeg2_get_dropped(iec61883_mpeg2_t mpeg2)
321 {
322 assert (mpeg2 != NULL);
323 return mpeg2->total_dropped;
324 }
325
326 void *
327 iec61883_mpeg2_get_callback_data (iec61883_mpeg2_t mpeg2)
328 {
329 assert (mpeg2 != NULL);
330 return mpeg2->callback_data;
331 }