3 * Petr Holub, Hidetoshi Shimokawa. All rights reserved.
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
8 * 1. Redistributions of source code must retain the above copyright
9 * notice, this list of conditions and the following disclaimer.
10 * 2. Redistributions in binary form must reproduce the above copyright
11 * notice, this list of conditions and the following disclaimer in the
12 * documentation and/or other materials provided with the distribution.
13 * 3. All advertising materials mentioning features or use of this software
14 * must display the following acknowledgement:
16 * This product includes software developed by Hidetoshi Shimokawa.
18 * 4. Neither the name of the author nor the names of its contributors
19 * may be used to endorse or promote products derived from this software
20 * without specific prior written permission.
22 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
23 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
24 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
25 * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
26 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
27 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
28 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
29 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
30 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
31 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
36 #include <sys/param.h>
37 #include <sys/ioctl.h>
39 #include <sys/types.h>
42 #if __FreeBSD_version >= 500000
43 #include <arpa/inet.h>
55 #include <dev/firewire/firewire.h>
56 #include <dev/firewire/iec68113.h>
58 #include "fwmethods.h"
62 /*****************************************************************************
64 MPEG-2 Transport Stream (MPEG TS) packet format according to IEC 61883:
67 +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ --------
68 | len |tag| channel | tcode | sy |
69 +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ 1394
71 +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ --------
72 |0|0| sid | dbs |fn | qpc |S|RSV| dbc |
73 +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ CIP
74 |1|0| fmt | fdf | fdf/syt |
75 +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ --------
76 | reserved | cycle_count | cycle_offset |
77 +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
80 . MPEG TS payload 188 bytes .
83 +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ --------
85 +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
87 N.b. that CRCs are removed by firewire layer!
89 The following fiels are fixed for IEEE-1394:
92 The length is payload length, i.e. includes CIP header and data size.
94 The following fields are constant for MPEG TS:
95 sph = 1 (denoted as S in CIP header above)
99 In the supported streams we also require
102 and thus the payload is divided in 8 blocks as follows:
104 +-----+-----+-----+-----+-----+-----+-----+-----+
105 | db0 | db1 | db2 | db3 | db4 | db5 | db6 | db7 |
106 +-----+-----+-----+-----+-----+-----+-----+-----+
108 We have several cases of payload distribution based on stream
110 1) R < 1.5 Mbps: any of db0..db7 may be payload,
111 2) 1.5 < R < 3 Mbps: db0/db1 or db2/db3 or db4/db5 or db6/db7 is payload,
112 3) 3 < R < 6 Mbps: db0/db1/db2/db3 or db4/db5/db6/db7 is payload,
113 4) R > 6 Mbps: all db0..db7 contain the payload.
114 Curently, only case (4) is supported in fwmpegts.c
116 Each packet may contain N MPEG TS data blocks with timestamp header,
117 which are (4+188)B long. Experimentally, the N ranges from 0 through 3.
119 *****************************************************************************/
122 typedef uint8_t mpeg_ts_pld[188];
125 #if BYTE_ORDER == BIG_ENDIAN
129 #else /* BYTE_ORDER != BIG_ENDIAN */
130 uint32_t c_offset:12,
133 #endif /* BYTE_ORDER == BIG_ENDIAN */
140 #define NPACKET_R 4096
141 #define RBUFSIZE (PSIZE * NPACKET_R)
144 mpegtsrecv(int d, const char *filename, char ich, int count)
147 struct fw_isochreq isoreq;
148 struct fw_isobufreq bufreq;
150 struct mpeg_pldt *pld;
152 int fd, k, len, m, pkt_size, startwr, tlen;
157 if (strcmp(filename, "-") == 0)
160 fd = open(filename, O_CREAT | O_WRONLY | O_TRUNC, 0660);
162 err(EX_NOINPUT, filename);
164 buf = malloc(RBUFSIZE);
166 bufreq.rx.nchunk = NCHUNK;
167 bufreq.rx.npacket = NPACKET_R;
168 bufreq.rx.psize = PSIZE;
169 bufreq.tx.nchunk = 0;
170 bufreq.tx.npacket = 0;
172 if (ioctl(d, FW_SSTBUF, &bufreq) < 0)
175 isoreq.ch = ich & 0x3f;
176 isoreq.tag = (ich >> 6) & 3;
178 if (ioctl(d, FW_SRSTREAM, &isoreq) < 0)
182 while (count <= 0 || k <= count) {
183 len = tlen = read(d, buf, RBUFSIZE);
185 fprintf(stderr, "Read %d bytes.\n", len);
188 if (errno == EAGAIN) {
189 fprintf(stderr, "(EAGAIN) - push 'Play'?\n");
193 err(1, "read failed");
195 ptr = (uint32_t *) buf;
198 pkt = (struct fw_pkt *) ptr;
200 fprintf(stderr, "\nReading new packet.\n");
201 fprintf(stderr, "%08x %08x %08x %08x\n",
202 htonl(ptr[0]), htonl(ptr[1]),
203 htonl(ptr[2]), htonl(ptr[3]));
205 /* there is no CRC in the 1394 header */
206 ciph = (struct ciphdr *)(ptr + 1); /* skip iso header */
207 if (ciph->fmt != CIP_FMT_MPEG)
208 errx(1, "unknown format 0x%x", ciph->fmt);
211 "unsupported MPEG TS stream, fn=%d (only fn=3 is supported)",
214 ptr = (uint32_t *) (ciph + 1); /* skip cip header */
216 if (pkt->mode.stream.len <= sizeof(struct ciphdr)) {
218 /* tlen needs to be decremented before end of the loop */
224 "Packet net payload length (IEEE1394 header): %d\n",
225 pkt->mode.stream.len - sizeof(struct ciphdr));
226 fprintf(stderr, "Data block size (CIP header): %d [q], %d [B]\n",
227 ciph->len, ciph->len * 4);
229 "Data fraction number (CIP header): %d => DBC increments with %d\n",
230 ciph->fn, (1<<ciph->fn) );
231 fprintf(stderr, "QCP (CIP header): %d\n", ciph->qpc );
232 fprintf(stderr, "DBC counter (CIP header): %d\n", ciph->dbc );
233 fprintf(stderr, "MPEG payload type size: %d\n",
234 sizeof(struct mpeg_pldt));
238 /* This is a condition that needs to be satisfied to start
240 if (ciph->dbc % (1<<ciph->fn) == 0)
242 /* Read out all the MPEG TS data blocks from current packet */
243 for (pld = (struct mpeg_pldt *)ptr;
244 (intptr_t)pld < (intptr_t)((char *)ptr +
245 pkt->mode.stream.len - sizeof(struct ciphdr));
248 write(fd, pld->payload,
249 sizeof(pld->payload));
253 /* CRCs are removed from both header and trailer
254 so that only 4 bytes of 1394 header remains */
255 pkt_size = pkt->mode.stream.len + 4;
256 ptr = (uint32_t *)((intptr_t)pkt + pkt_size);
260 fprintf(stderr, "\nReading a data from firewire.\n");
264 if (fd != STDOUT_FILENO)
266 fprintf(stderr, "\n");