278107a1a04f63eb2fcba1642d2a19c51d06a3f0
[metze/wireshark/wip.git] / wiretap / pcap-common.c
1 /* pcap-common.c
2  * Code common to libpcap and pcap-NG file formats
3  *
4  * $Id$
5  *
6  * Wiretap Library
7  * Copyright (c) 1998 by Gilbert Ramirez <gram@alumni.rice.edu>
8  *
9  * File format support for pcap-ng file format
10  * Copyright (c) 2007 by Ulf Lamping <ulf.lamping@web.de>
11  *
12  * This program is free software; you can redistribute it and/or
13  * modify it under the terms of the GNU General Public License
14  * as published by the Free Software Foundation; either version 2
15  * of the License, or (at your option) any later version.
16  *
17  * This program is distributed in the hope that it will be useful,
18  * but WITHOUT ANY WARRANTY; without even the implied warranty of
19  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
20  * GNU General Public License for more details.
21  *
22  * You should have received a copy of the GNU General Public License
23  * along with this program; if not, write to the Free Software
24  * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA  02111-1307, USA.
25  */
26
27 #ifdef HAVE_CONFIG_H
28 #include "config.h"
29 #endif
30
31 #include <stdlib.h>
32 #include <string.h>
33 #include <errno.h>
34 #include "wtap-int.h"
35 #include "file_wrappers.h"
36 #include "erf.h"
37 #include "pcap-encap.h"
38 #include "pcap-common.h"
39
40 /*
41  * Map link-layer types (LINKTYPE_ values) to Wiretap encapsulations.
42  */
43 /*
44  * Either LBL NRG wasn't an adequate central registry (e.g., because of
45  * the slow rate of releases from them), or nobody bothered using them
46  * as a central registry, as many different groups have patched libpcap
47  * (and BPF, on the BSDs) to add new encapsulation types, and have ended
48  * up using the same DLT_ values for different encapsulation types.
49  *
50  * For those numerical encapsulation type values that everybody uses for
51  * the same encapsulation type (which inclues those that some platforms
52  * specify different DLT_ names for but don't appear to use), we map
53  * those values to the appropriate Wiretap values.
54  *
55  * For those numerical encapsulation type values that different libpcap
56  * variants use for different encapsulation types, we check what
57  * <pcap.h> defined to determine how to interpret them, so that we
58  * interpret them the way the libpcap with which we're building
59  * Wireshark/Wiretap interprets them (which, if it doesn't support
60  * them at all, means we don't support them either - any capture files
61  * using them are foreign, and we don't hazard a guess as to which
62  * platform they came from; we could, I guess, choose the most likely
63  * platform).
64  *
65  * Note: if you need a new encapsulation type for libpcap files, do
66  * *N*O*T* use *ANY* of the values listed here!  I.e., do *NOT*
67  * add a new encapsulation type by changing an existing entry;
68  * leave the existing entries alone.
69  *
70  * Instead, send mail to tcpdump-workers@lists.tcpdump.org, asking for
71  * a new DLT_ value, and specifying the purpose of the new value.  When
72  * you get the new DLT_ value, use that numerical value in the "dlt_value"
73  * field of "pcap_to_wtap_map[]".
74  */
75
76 static const struct {
77         int     dlt_value;
78         int     wtap_encap_value;
79 } pcap_to_wtap_map[] = {
80         /*
81          * These are the values that are almost certainly the same
82          * in all libpcaps (I've yet to find one where the values
83          * in question are used for some purpose other than the
84          * one below, but...), and that Wiretap and Wireshark
85          * currently support.
86          */
87         { 0,            WTAP_ENCAP_NULL },      /* null encapsulation */
88         { 1,            WTAP_ENCAP_ETHERNET },
89         { 6,            WTAP_ENCAP_TOKEN_RING },        /* IEEE 802 Networks - assume token ring */
90         { 7,            WTAP_ENCAP_ARCNET },
91         { 8,            WTAP_ENCAP_SLIP },
92         { 9,            WTAP_ENCAP_PPP },
93 #ifdef BIT_SWAPPED_MAC_ADDRS
94         { 10,           WTAP_ENCAP_FDDI_BITSWAPPED },
95 #else
96         { 10,           WTAP_ENCAP_FDDI },
97 #endif
98
99         { 32,           WTAP_ENCAP_REDBACK },
100
101         /*
102          * 50 is DLT_PPP_SERIAL in NetBSD; it appears that DLT_PPP
103          * on BSD (at least according to standard tcpdump) has, as
104          * the first octet, an indication of whether the packet was
105          * transmitted or received (rather than having the standard
106          * PPP address value of 0xff), but that DLT_PPP_SERIAL puts
107          * a real live PPP header there, or perhaps a Cisco PPP header
108          * as per section 4.3.1 of RFC 1547 (implementations of this
109          * exist in various BSDs in "sys/net/if_spppsubr.c", and
110          * I think also exist either in standard Linux or in
111          * various Linux patches; the implementations show how to handle
112          * Cisco keepalive packets).
113          *
114          * However, I don't see any obvious place in FreeBSD "if_ppp.c"
115          * where anything other than the standard PPP header would be
116          * passed up.  I see some stuff that sets the first octet
117          * to 0 for incoming and 1 for outgoing packets before applying
118          * a BPF filter to see whether to drop packets whose protocol
119          * field has the 0x8000 bit set, i.e. network control protocols -
120          * those are handed up to userland - but that code puts the
121          * address field back before passing the packet up.
122          *
123          * I also don't see anything immediately obvious that munges
124          * the address field for sync PPP, either.
125          *
126          * Wireshark currently assumes that if the first octet of a
127          * PPP frame is 0xFF, it's the address field and is followed
128          * by a control field and a 2-byte protocol, otherwise the
129          * address and control fields are absent and the frame begins
130          * with a protocol field.  If we ever see a BSD/OS PPP
131          * capture, we'll have to handle it differently, and we may
132          * have to handle standard BSD captures differently if, in fact,
133          * they don't have 0xff 0x03 as the first two bytes - but, as per
134          * the two paragraphs preceding this, it's not clear that
135          * the address field *is* munged into an incoming/outgoing
136          * field when the packet is handed to the BPF device.
137          *
138          * For now, we just map DLT_PPP_SERIAL to WTAP_ENCAP_PPP, as
139          * we treat WTAP_ENCAP_PPP packets as if those beginning with
140          * 0xff have the standard RFC 1662 "PPP in HDLC-like Framing"
141          * 0xff 0x03 address/control header, and DLT_PPP_SERIAL frames
142          * appear to contain that unless they're Cisco frames (if we
143          * ever see a capture with them, we'd need to implement the
144          * RFC 1547 stuff, and the keepalive protocol stuff).
145          *
146          * We may have to distinguish between "PPP where if it doesn't
147          * begin with 0xff there's no HDLC encapsulation and the frame
148          * begins with the protocol field" (which is how we handle
149          * WTAP_ENCAP_PPP now) and "PPP where there's either HDLC
150          * encapsulation or Cisco PPP" (which is what DLT_PPP_SERIAL
151          * is) at some point.
152          *
153          * XXX - NetBSD has DLT_HDLC, which appears to be used for
154          * Cisco HDLC.  Ideally, they should use DLT_PPP_SERIAL
155          * only for real live HDLC-encapsulated PPP, not for Cisco
156          * HDLC.
157          */
158         { 50,           WTAP_ENCAP_PPP },
159
160         /*
161          * Apparently used by the Axent Raptor firewall (now Symantec
162          * Enterprise Firewall).
163          * Thanks, Axent, for not reserving that type with tcpdump.org
164          * and not telling anybody about it.
165          */
166         { 99,           WTAP_ENCAP_SYMANTEC },
167
168         /*
169          * These are the values that libpcap 0.5 and later use in
170          * capture file headers, in an attempt to work around the
171          * confusion decried above, and that Wiretap and Wireshark
172          * currently support.
173          */
174         { 100,          WTAP_ENCAP_ATM_RFC1483 },
175         { 101,          WTAP_ENCAP_RAW_IP },
176 #if 0
177         /*
178          * More values used by libpcap 0.5 as DLT_ values and used by the
179          * current CVS version of libpcap in capture file headers.
180          * They are not yet handled in Wireshark.
181          * If we get a capture that contains them, we'll implement them.
182          */
183         { 102,          WTAP_ENCAP_SLIP_BSDOS },
184         { 103,          WTAP_ENCAP_PPP_BSDOS },
185 #endif
186
187         /*
188          * These ones are handled in Wireshark, though.
189          */
190         { 104,          WTAP_ENCAP_CHDLC },     /* Cisco HDLC */
191         { 105,          WTAP_ENCAP_IEEE_802_11 }, /* IEEE 802.11 */
192         { 106,          WTAP_ENCAP_LINUX_ATM_CLIP },
193         { 107,          WTAP_ENCAP_FRELAY },    /* Frame Relay */
194         { 108,          WTAP_ENCAP_NULL },      /* OpenBSD loopback */
195         { 109,          WTAP_ENCAP_ENC },       /* OpenBSD IPSEC enc */
196 #if 0
197         { 110,          WTAP_ENCAP_LANE_802_3 },/* ATM LANE 802.3 */
198         { 111,          WTAP_ENCAP_HIPPI },     /* NetBSD HIPPI */
199 #endif
200         { 112,          WTAP_ENCAP_CHDLC },     /* NetBSD HDLC framing */
201
202         /*
203          * Linux "cooked mode" captures, used by the current CVS version
204          * of libpcap
205          * OR
206          * it could be a packet in Cisco's ERSPAN encapsulation which uses
207          * this number as well (why can't people stick to protocols when it
208          * comes to allocating/using DLT types).
209          */
210         { 113,          WTAP_ENCAP_SLL },       /* Linux cooked capture */
211
212         { 114,          WTAP_ENCAP_LOCALTALK }, /* Localtalk */
213
214         /*
215          * The tcpdump.org version of libpcap uses 117, rather than 17,
216          * for OpenBSD packet filter logging, so as to avoid conflicting
217          * with DLT_LANE8023 in SuSE 6.3 libpcap.
218          */
219         { 117,          WTAP_ENCAP_PFLOG },
220
221         { 118,          WTAP_ENCAP_CISCO_IOS },
222         { 119,          WTAP_ENCAP_PRISM_HEADER }, /* Prism monitor mode hdr */
223         { 121,          WTAP_ENCAP_HHDLC },     /* HiPath HDLC */
224         { 122,          WTAP_ENCAP_IP_OVER_FC },   /* RFC 2625 IP-over-FC */
225         { 123,          WTAP_ENCAP_ATM_PDUS },  /* SunATM */
226         { 127,          WTAP_ENCAP_IEEE_802_11_WLAN_RADIOTAP },  /* 802.11 plus radiotap WLAN header */
227         { 128,          WTAP_ENCAP_TZSP },      /* Tazmen Sniffer Protocol */
228         { 129,          WTAP_ENCAP_ARCNET_LINUX },
229         { 130,          WTAP_ENCAP_JUNIPER_MLPPP }, /* Juniper MLPPP on ML-, LS-, AS- PICs */
230         { 131,          WTAP_ENCAP_JUNIPER_MLFR }, /* Juniper MLFR (FRF.15) on ML-, LS-, AS- PICs */
231         { 133,          WTAP_ENCAP_JUNIPER_GGSN},
232         /*
233          * Values 132-134, 136 not listed here are reserved for use
234          * in Juniper hardware.
235          */
236         { 135,          WTAP_ENCAP_JUNIPER_ATM2 }, /* various encapsulations captured on the ATM2 PIC */
237         { 137,          WTAP_ENCAP_JUNIPER_ATM1 }, /* various encapsulations captured on the ATM1 PIC */
238
239         { 138,          WTAP_ENCAP_APPLE_IP_OVER_IEEE1394 },
240                                                 /* Apple IP-over-IEEE 1394 */
241
242         { 139,          WTAP_ENCAP_MTP2_WITH_PHDR },
243         { 140,          WTAP_ENCAP_MTP2 },
244         { 141,          WTAP_ENCAP_MTP3 },
245         { 142,          WTAP_ENCAP_SCCP },
246         { 143,          WTAP_ENCAP_DOCSIS },
247         { 144,          WTAP_ENCAP_IRDA },      /* IrDA capture */
248
249         /* Reserved for private use. */
250         { 147,          WTAP_ENCAP_USER0 },
251         { 148,          WTAP_ENCAP_USER1 },
252         { 149,          WTAP_ENCAP_USER2 },
253         { 150,          WTAP_ENCAP_USER3 },
254         { 151,          WTAP_ENCAP_USER4 },
255         { 152,          WTAP_ENCAP_USER5 },
256         { 153,          WTAP_ENCAP_USER6 },
257         { 154,          WTAP_ENCAP_USER7 },
258         { 155,          WTAP_ENCAP_USER8 },
259         { 156,          WTAP_ENCAP_USER9 },
260         { 157,          WTAP_ENCAP_USER10 },
261         { 158,          WTAP_ENCAP_USER11 },
262         { 159,          WTAP_ENCAP_USER12 },
263         { 160,          WTAP_ENCAP_USER13 },
264         { 161,          WTAP_ENCAP_USER14 },
265         { 162,          WTAP_ENCAP_USER15 },
266
267         { 163,          WTAP_ENCAP_IEEE_802_11_WLAN_AVS },  /* 802.11 plus AVS WLAN header */
268
269         /*
270          * 164 is reserved for Juniper-private chassis-internal
271          * meta-information such as QoS profiles, etc..
272          */
273
274         { 165,          WTAP_ENCAP_BACNET_MS_TP },
275
276         /*
277          * 166 is reserved for a PPP variant in which the first byte
278          * of the 0xff03 header, the 0xff, is replaced by a direction
279          * byte.  I don't know whether any captures look like that,
280          * but it is used for some Linux IP filtering (ipfilter?).
281          */
282
283         /* Ethernet PPPoE frames captured on a service PIC */
284         { 167,          WTAP_ENCAP_JUNIPER_PPPOE },
285
286         /*
287          * 168 is reserved for more Juniper private-chassis-
288          * internal meta-information.
289          */
290
291         { 169,          WTAP_ENCAP_GPRS_LLC },
292
293         /*
294          * 170 and 171 are reserved for ITU-T G.7041/Y.1303 Generic
295          * Framing Procedure.
296          */
297
298         /* Registered by Gcom, Inc. */
299         { 172,          WTAP_ENCAP_GCOM_TIE1 },
300         { 173,          WTAP_ENCAP_GCOM_SERIAL },
301
302         { 177,          WTAP_ENCAP_LINUX_LAPD },
303
304     /* Ethernet frames prepended with meta-information */
305         { 178,          WTAP_ENCAP_JUNIPER_ETHER },
306         /* PPP frames prepended with meta-information */
307         { 179,          WTAP_ENCAP_JUNIPER_PPP },
308         /* Frame-Relay frames prepended with meta-information */
309         { 180,          WTAP_ENCAP_JUNIPER_FRELAY },
310         /* C-HDLC frames prepended with meta-information */
311         { 181,          WTAP_ENCAP_JUNIPER_CHDLC },
312         /* VOIP Frames prepended with meta-information */
313         { 183,          WTAP_ENCAP_JUNIPER_VP },
314         /* raw USB packets */
315         { 186,          WTAP_ENCAP_USB },
316         /* Bluetooth HCI UART transport (part H:4) frames, like hcidump */
317         { 187,          WTAP_ENCAP_BLUETOOTH_H4 },
318         /* IEEE 802.16 MAC Common Part Sublayer */
319         { 188,          WTAP_ENCAP_IEEE802_16_MAC_CPS },
320         /* USB packets with Linux-specified header */
321         { 189,          WTAP_ENCAP_USB_LINUX },
322         /* CAN 2.0b frame */
323         { 190,          WTAP_ENCAP_CAN20B },
324         /* Per-Packet Information header */
325         { 192,          WTAP_ENCAP_PPI },
326         /* IEEE 802.15.4 Wireless PAN */
327         { 195,          WTAP_ENCAP_IEEE802_15_4 },
328         /* SITA File Encapsulation */
329         { 196,          WTAP_ENCAP_SITA },
330         /* Endace Record File Encapsulation */
331         { 197,          WTAP_ENCAP_ERF },
332         /* IPMB */
333         { 199,          WTAP_ENCAP_IPMB },
334         /* Bluetooth HCI UART transport (part H:4) frames, like hcidump */
335         { 201,          WTAP_ENCAP_BLUETOOTH_H4_WITH_PHDR },
336         { 204,          WTAP_ENCAP_PPP_WITH_PHDR },
337         /* IPMB/I2C */
338         { 209,          WTAP_ENCAP_I2C },
339         /* FlexRay frame */
340         { 210,          WTAP_ENCAP_FLEXRAY },
341         /* MOST frame */
342         { 211,          WTAP_ENCAP_MOST },
343         /* LIN frame */
344         { 212,          WTAP_ENCAP_LIN },
345         /* X2E Xoraya serial frame */
346         { 213,          WTAP_ENCAP_X2E_SERIAL },
347         /* X2E Xoraya frame */
348         { 214,          WTAP_ENCAP_X2E_XORAYA },
349         /* IEEE 802.15.4 Wireless PAN non-ASK PHY */
350         { 215,          WTAP_ENCAP_IEEE802_15_4_NONASK_PHY },
351         /* USB packets with padded Linux-specified header */
352         { 220,          WTAP_ENCAP_USB_LINUX_MMAPPED },
353         /* Fibre Channel FC-2 frame */
354         { 224,          WTAP_ENCAP_FIBRE_CHANNEL_FC2 },
355         /* Fibre Channel FC-2 frame with Delimiter */
356         { 225,          WTAP_ENCAP_FIBRE_CHANNEL_FC2_WITH_FRAME_DELIMS },
357         /* Solaris IPNET */
358         { 226,          WTAP_ENCAP_IPNET },
359         /* SocketCAN frame */
360         { 227,          WTAP_ENCAP_SOCKETCAN },
361         /* Raw IPv4 */
362         { 228,          WTAP_ENCAP_RAW_IP4 },
363         /* Raw IPv6 */
364         { 229,          WTAP_ENCAP_RAW_IP6 },
365         /* IEEE 802.15.4 Wireless PAN no fcs */
366         { 230,          WTAP_ENCAP_IEEE802_15_4_NOFCS },
367
368         /*
369          * To repeat:
370          *
371          * If you need a new encapsulation type for libpcap files, do
372          * *N*O*T* use *ANY* of the values listed here!  I.e., do *NOT*
373          * add a new encapsulation type by changing an existing entry;
374          * leave the existing entries alone.
375          *
376          * Instead, send mail to tcpdump-workers@lists.tcpdump.org, asking
377          * for a new DLT_ value, and specifying the purpose of the new value.
378          * When you get the new DLT_ value, use that numerical value in
379          * the "dlt_value" field of "pcap_to_wtap_map[]".
380          */
381
382         /*
383          * The following are entries for libpcap type values that have
384          * different meanings on different OSes.
385          *
386          * We put these *after* the entries for the platform-independent
387          * libpcap type values for those Wiretap encapsulation types, so
388          * that Wireshark chooses the platform-independent libpcap type
389          * value for those encapsulatioin types, not the platform-dependent
390          * one.
391          */
392
393         /*
394          * 11 is DLT_ATM_RFC1483 on most platforms; the only libpcaps I've
395          * seen that define anything other than DLT_ATM_RFC1483 as 11 are
396          * the BSD/OS one, which defines DLT_FR as 11, and libpcap 0.5,
397          * which define it as 100, mapping the kernel's value to 100, in
398          * an attempt to hide the different values used on different
399          * platforms.
400          *
401          * If this is a platform where DLT_FR is defined as 11, we
402          * don't handle 11 at all; otherwise, we handle it as
403          * DLT_ATM_RFC1483 (this means we'd misinterpret Frame Relay
404          * captures from BSD/OS if running on platforms other than BSD/OS,
405          * but
406          *
407          *      1) we don't yet support DLT_FR
408          *
409          * and
410          *
411          *      2) nothing short of a heuristic would let us interpret
412          *         them correctly).
413          */
414 #if defined(DLT_FR) && (DLT_FR == 11)
415         { 11,           WTAP_ENCAP_FRELAY },
416 #else
417         { 11,           WTAP_ENCAP_ATM_RFC1483 },
418 #endif
419
420         /*
421          * 12 is DLT_RAW on most platforms, but it's DLT_C_HDLC on
422          * BSD/OS, and DLT_LOOP on OpenBSD.
423          *
424          * We don't yet handle DLT_C_HDLC, but we can handle DLT_LOOP
425          * (it's just like DLT_NULL, only with the AF_ value in network
426          * rather than host byte order - Wireshark figures out the
427          * byte order from the data, so we don't care what byte order
428          * it's in), so if DLT_LOOP is defined as 12, interpret 12
429          * as WTAP_ENCAP_NULL, otherwise, unless DLT_C_HDLC is defined
430          * as 12, interpret it as WTAP_ENCAP_RAW_IP.
431          */
432 #if defined(DLT_LOOP) && (DLT_LOOP == 12)
433         { 12,           WTAP_ENCAP_NULL },
434 #elif defined(DLT_C_HDLC) && (DLT_C_HDLC == 12)
435         /*
436          * Put entry for Cisco HDLC here.
437          * XXX - is this just WTAP_ENCAP_CHDLC, i.e. does the frame
438          * start with a 4-byte Cisco HDLC header?
439          */
440 #else
441         { 12,           WTAP_ENCAP_RAW_IP },
442 #endif
443
444         /*
445          * 13 is DLT_SLIP_BSDOS on FreeBSD and NetBSD, but those OSes
446          * don't actually generate it.  I infer that BSD/OS translates
447          * DLT_SLIP from the kernel BPF code to DLT_SLIP_BSDOS in
448          * libpcap, as the BSD/OS link-layer header is different;
449          * however, in BSD/OS, DLT_SLIP_BSDOS is 15.
450          *
451          * From this, I infer that there's no point in handling 13
452          * as DLT_SLIP_BSDOS.
453          *
454          * 13 is DLT_ATM_RFC1483 on BSD/OS.
455          *
456          * 13 is DLT_ENC in OpenBSD, which is, I suspect, some kind
457          * of decrypted IPsec traffic.
458          *
459          * We treat 13 as WTAP_ENCAP_ENC on all systems except those
460          * that define DLT_ATM_RFC1483 as 13 - presumably only
461          * BSD/OS does so - so that, on BSD/OS systems, we still
462          * treate 13 as WTAP_ENCAP_ATM_RFC1483, but, on all other
463          * systems, we can read OpenBSD DLT_ENC captures.
464          */
465 #if defined(DLT_ATM_RFC1483) && (DLT_ATM_RFC1483 == 13)
466         { 13,           WTAP_ENCAP_ATM_RFC1483 },
467 #else
468         { 13,           WTAP_ENCAP_ENC },
469 #endif
470
471         /*
472          * 14 is DLT_PPP_BSDOS on FreeBSD and NetBSD, but those OSes
473          * don't actually generate it.  I infer that BSD/OS translates
474          * DLT_PPP from the kernel BPF code to DLT_PPP_BSDOS in
475          * libpcap, as the BSD/OS link-layer header is different;
476          * however, in BSD/OS, DLT_PPP_BSDOS is 16.
477          *
478          * From this, I infer that there's no point in handling 14
479          * as DLT_PPP_BSDOS.
480          *
481          * 14 is DLT_RAW on BSD/OS and OpenBSD.
482          */
483         { 14,           WTAP_ENCAP_RAW_IP },
484
485         /*
486          * 15 is:
487          *
488          *      DLT_SLIP_BSDOS on BSD/OS;
489          *
490          *      DLT_HIPPI on NetBSD;
491          *
492          *      DLT_LANE8023 with Alexey Kuznetzov's patches for
493          *      Linux libpcap;
494          *
495          *      DLT_I4L_RAWIP with the ISDN4Linux patches for libpcap
496          *      (and on SuSE 6.3);
497          *
498          * but we don't currently handle any of those.
499          */
500
501         /*
502          * 16 is:
503          *
504          *      DLT_PPP_BSDOS on BSD/OS;
505          *
506          *      DLT_HDLC on NetBSD (Cisco HDLC);
507          *
508          *      DLT_CIP with Alexey Kuznetzov's patches for
509          *      Linux libpcap - this is WTAP_ENCAP_LINUX_ATM_CLIP;
510          *
511          *      DLT_I4L_IP with the ISDN4Linux patches for libpcap
512          *      (and on SuSE 6.3).
513          */
514 #if defined(DLT_CIP) && (DLT_CIP == 16)
515         { 16,           WTAP_ENCAP_LINUX_ATM_CLIP },
516 #endif
517 #if defined(DLT_HDLC) && (DLT_HDLC == 16)
518         { 16,           WTAP_ENCAP_CHDLC },
519 #endif
520
521         /*
522          * 17 is DLT_LANE8023 in SuSE 6.3 libpcap; we don't currently
523          * handle it.
524          * It is also used as the PF (Packet Filter) logging format beginning
525          * with OpenBSD 3.0; we use 17 for PF logs unless DLT_LANE8023 is
526          * defined with the value 17.
527          */
528 #if !defined(DLT_LANE8023) || (DLT_LANE8023 != 17)
529         { 17,           WTAP_ENCAP_OLD_PFLOG },
530 #endif
531
532         /*
533          * 18 is DLT_CIP in SuSE 6.3 libpcap; if it's the same as the
534          * DLT_CIP of 16 that the Alexey Kuznetzov patches for
535          * libpcap/tcpdump define, it's WTAP_ENCAP_LINUX_ATM_CLIP.
536          * I've not found any libpcap that uses it for any other purpose -
537          * hopefully nobody will do so in the future.
538          */
539         { 18,           WTAP_ENCAP_LINUX_ATM_CLIP },
540
541         /*
542          * 19 is DLT_ATM_CLIP in the libpcap/tcpdump patches in the
543          * recent versions I've seen of the Linux ATM distribution;
544          * I've not yet found any libpcap that uses it for any other
545          * purpose - hopefully nobody will do so in the future.
546          */
547         { 19,           WTAP_ENCAP_LINUX_ATM_CLIP },
548
549         /*
550          * To repeat:
551          *
552          * If you need a new encapsulation type for libpcap files, do
553          * *N*O*T* use *ANY* of the values listed here!  I.e., do *NOT*
554          * add a new encapsulation type by changing an existing entry;
555          * leave the existing entries alone.
556          *
557          * Instead, send mail to tcpdump-workers@lists.tcpdump.org, asking
558          * for a new DLT_ value, and specifying the purpose of the new value.
559          * When you get the new DLT_ value, use that numerical value in
560          * the "dlt_value" field of "pcap_to_wtap_map[]".
561          */
562 };
563 #define NUM_PCAP_ENCAPS (sizeof pcap_to_wtap_map / sizeof pcap_to_wtap_map[0])
564
565 int
566 wtap_pcap_encap_to_wtap_encap(int encap)
567 {
568         unsigned int i;
569
570         for (i = 0; i < NUM_PCAP_ENCAPS; i++) {
571                 if (pcap_to_wtap_map[i].dlt_value == encap)
572                         return pcap_to_wtap_map[i].wtap_encap_value;
573         }
574         return WTAP_ENCAP_UNKNOWN;
575 }
576
577 int
578 wtap_wtap_encap_to_pcap_encap(int encap)
579 {
580         unsigned int i;
581
582         switch (encap) {
583
584         case WTAP_ENCAP_FDDI:
585         case WTAP_ENCAP_FDDI_BITSWAPPED:
586         case WTAP_ENCAP_NETTL_FDDI:
587                 /*
588                  * Special-case WTAP_ENCAP_FDDI and
589                  * WTAP_ENCAP_FDDI_BITSWAPPED; both of them get mapped
590                  * to DLT_FDDI (even though that may mean that the bit
591                  * order in the FDDI MAC addresses is wrong; so it goes
592                  * - libpcap format doesn't record the byte order,
593                  * so that's not fixable).
594                  */
595                 return 10;      /* that's DLT_FDDI */
596
597         case WTAP_ENCAP_FRELAY_WITH_PHDR:
598                 /*
599                  * Do the same with Frame Relay.
600                  */
601                 return 107;
602
603         case WTAP_ENCAP_IEEE_802_11_WITH_RADIO:
604                 /*
605                  * Map this to DLT_IEEE802_11, for now, even though
606                  * that means the radio information will be lost.
607                  * Once tcpdump support for the BSD radiotap header
608                  * is sufficiently widespread, we should probably
609                  * use that, instead - although we should probably
610                  * ultimately just have WTAP_ENCAP_IEEE_802_11
611                  * as the only Wiretap encapsulation for 802.11,
612                  * and have the pseudo-header include a radiotap-style
613                  * list of attributes.  If we do that, though, we
614                  * should probably bypass the regular Wiretap code
615                  * when writing out packets during a capture, and just
616                  * do the equivalent of a libpcap write (unfortunately,
617                  * libpcap doesn't have an "open dump by file descriptor"
618                  * function, so we can't just use "pcap_dump()"), so
619                  * that we don't spend cycles mapping from libpcap to
620                  * Wiretap and then back to libpcap.  (There are other
621                  * reasons to do that, e.g. to handle AIX libpcap better.)
622                  */
623                 return 105;
624         }
625
626         for (i = 0; i < NUM_PCAP_ENCAPS; i++) {
627                 if (pcap_to_wtap_map[i].wtap_encap_value == encap)
628                         return pcap_to_wtap_map[i].dlt_value;
629         }
630         return -1;
631 }
632
633 /*
634  * Various pseudo-headers that appear at the beginning of packet data.
635  *
636  * We represent them as sets of offsets, as they might not be aligned on
637  * an appropriate structure boundary in the buffer, and as that makes them
638  * independent of the way the compiler might align fields.
639  */
640
641 /*
642  * The link-layer header on SunATM packets.
643  */
644 #define SUNATM_FLAGS    0       /* destination and traffic type - 1 byte */
645 #define SUNATM_VPI      1       /* VPI - 1 byte */
646 #define SUNATM_VCI      2       /* VCI - 2 bytes */
647 #define SUNATM_LEN      4       /* length of the header */
648
649 /*
650  * The link-layer header on Nokia IPSO ATM packets.
651  */
652 #define NOKIAATM_FLAGS  0       /* destination - 1 byte */
653 #define NOKIAATM_VPI    1       /* VPI - 1 byte */
654 #define NOKIAATM_VCI    2       /* VCI - 2 bytes */
655 #define NOKIAATM_LEN    4       /* length of the header */
656
657 /*
658  * The fake link-layer header of IrDA packets as introduced by Jean Tourrilhes
659  * to libpcap.
660  */
661 #define IRDA_SLL_PKTTYPE_OFFSET         0       /* packet type - 2 bytes */
662 /* 12 unused bytes */
663 #define IRDA_SLL_PROTOCOL_OFFSET        14      /* protocol, should be ETH_P_LAPD - 2 bytes */
664 #define IRDA_SLL_LEN                    16      /* length of the header */
665
666 /*
667  * A header containing additional MTP information.
668  */
669 #define MTP2_SENT_OFFSET                0       /* 1 byte */
670 #define MTP2_ANNEX_A_USED_OFFSET        1       /* 1 byte */
671 #define MTP2_LINK_NUMBER_OFFSET         2       /* 2 bytes */
672 #define MTP2_HDR_LEN                    4       /* length of the header */
673
674 /*
675  * A header containing additional SITA WAN information.
676  */
677 #define SITA_FLAGS_OFFSET               0       /* 1 byte */
678 #define SITA_SIGNALS_OFFSET             1       /* 1 byte */
679 #define SITA_ERRORS1_OFFSET             2       /* 1 byte */
680 #define SITA_ERRORS2_OFFSET             3       /* 1 byte */
681 #define SITA_PROTO_OFFSET               4       /* 1 byte */
682 #define SITA_HDR_LEN                    5       /* length of the header */
683
684 /*
685  * The fake link-layer header of LAPD packets.
686  */
687 #ifndef ETH_P_LAPD
688 #define ETH_P_LAPD 0x0030
689 #endif
690
691 #define LAPD_SLL_PKTTYPE_OFFSET         0       /* packet type - 2 bytes */
692 #define LAPD_SLL_HATYPE_OFFSET          2       /* hardware address type - 2 bytes */
693 #define LAPD_SLL_HALEN_OFFSET           4       /* hardware address length - 2 bytes */
694 #define LAPD_SLL_ADDR_OFFSET            6       /* address - 8 bytes */
695 #define LAPD_SLL_PROTOCOL_OFFSET        14      /* protocol, should be ETH_P_LAPD - 2 bytes */
696 #define LAPD_SLL_LEN                    16      /* length of the header */
697
698 /*
699  * I2C link-layer on-disk format
700  */
701 struct i2c_file_hdr {
702     guint8 bus;
703     guint8 flags[4];
704 };
705
706 static gboolean
707 pcap_read_sunatm_pseudoheader(FILE_T fh,
708     union wtap_pseudo_header *pseudo_header, int *err)
709 {
710         guint8  atm_phdr[SUNATM_LEN];
711         int     bytes_read;
712         guint8  vpi;
713         guint16 vci;
714
715         errno = WTAP_ERR_CANT_READ;
716         bytes_read = file_read(atm_phdr, 1, SUNATM_LEN, fh);
717         if (bytes_read != SUNATM_LEN) {
718                 *err = file_error(fh);
719                 if (*err == 0)
720                         *err = WTAP_ERR_SHORT_READ;
721                 return FALSE;
722         }
723
724         vpi = atm_phdr[SUNATM_VPI];
725         vci = pntohs(&atm_phdr[SUNATM_VCI]);
726
727         switch (atm_phdr[SUNATM_FLAGS] & 0x0F) {
728
729         case 0x01:      /* LANE */
730                 pseudo_header->atm.aal = AAL_5;
731                 pseudo_header->atm.type = TRAF_LANE;
732                 break;
733
734         case 0x02:      /* RFC 1483 LLC multiplexed traffic */
735                 pseudo_header->atm.aal = AAL_5;
736                 pseudo_header->atm.type = TRAF_LLCMX;
737                 break;
738
739         case 0x05:      /* ILMI */
740                 pseudo_header->atm.aal = AAL_5;
741                 pseudo_header->atm.type = TRAF_ILMI;
742                 break;
743
744         case 0x06:      /* Q.2931 */
745                 pseudo_header->atm.aal = AAL_SIGNALLING;
746                 pseudo_header->atm.type = TRAF_UNKNOWN;
747                 break;
748
749         case 0x03:      /* MARS (RFC 2022) */
750                 pseudo_header->atm.aal = AAL_5;
751                 pseudo_header->atm.type = TRAF_UNKNOWN;
752                 break;
753
754         case 0x04:      /* IFMP (Ipsilon Flow Management Protocol; see RFC 1954) */
755                 pseudo_header->atm.aal = AAL_5;
756                 pseudo_header->atm.type = TRAF_UNKNOWN; /* XXX - TRAF_IPSILON? */
757                 break;
758
759         default:
760                 /*
761                  * Assume it's AAL5, unless it's VPI 0 and VCI 5, in which
762                  * case assume it's AAL_SIGNALLING; we know nothing more
763                  * about it.
764                  *
765                  * XXX - is this necessary?  Or are we guaranteed that
766                  * all signalling traffic has a type of 0x06?
767                  *
768                  * XXX - is this guaranteed to be AAL5?  Or, if the type is
769                  * 0x00 ("raw"), might it be non-AAL5 traffic?
770                  */
771                 if (vpi == 0 && vci == 5)
772                         pseudo_header->atm.aal = AAL_SIGNALLING;
773                 else
774                         pseudo_header->atm.aal = AAL_5;
775                 pseudo_header->atm.type = TRAF_UNKNOWN;
776                 break;
777         }
778         pseudo_header->atm.subtype = TRAF_ST_UNKNOWN;
779
780         pseudo_header->atm.vpi = vpi;
781         pseudo_header->atm.vci = vci;
782         pseudo_header->atm.channel = (atm_phdr[SUNATM_FLAGS] & 0x80) ? 0 : 1;
783
784         /* We don't have this information */
785         pseudo_header->atm.flags = 0;
786         pseudo_header->atm.cells = 0;
787         pseudo_header->atm.aal5t_u2u = 0;
788         pseudo_header->atm.aal5t_len = 0;
789         pseudo_header->atm.aal5t_chksum = 0;
790
791         return TRUE;
792 }
793
794 static gboolean
795 pcap_read_nokiaatm_pseudoheader(FILE_T fh,
796     union wtap_pseudo_header *pseudo_header, int *err)
797 {
798         guint8  atm_phdr[NOKIAATM_LEN];
799         int     bytes_read;
800         guint8  vpi;
801         guint16 vci;
802
803         errno = WTAP_ERR_CANT_READ;
804         bytes_read = file_read(atm_phdr, 1, NOKIAATM_LEN, fh);
805         if (bytes_read != NOKIAATM_LEN) {
806                 *err = file_error(fh);
807                 if (*err == 0)
808                         *err = WTAP_ERR_SHORT_READ;
809                 return FALSE;
810         }
811
812         vpi = atm_phdr[NOKIAATM_VPI];
813         vci = pntohs(&atm_phdr[NOKIAATM_VCI]);
814
815         pseudo_header->atm.vpi = vpi;
816         pseudo_header->atm.vci = vci;
817         pseudo_header->atm.channel = (atm_phdr[NOKIAATM_FLAGS] & 0x80) ? 0 : 1;
818
819         /* We don't have this information */
820         pseudo_header->atm.flags = 0;
821         pseudo_header->atm.cells = 0;
822         pseudo_header->atm.aal5t_u2u = 0;
823         pseudo_header->atm.aal5t_len = 0;
824         pseudo_header->atm.aal5t_chksum = 0;
825
826         return TRUE;
827 }
828
829 static gboolean
830 pcap_read_irda_pseudoheader(FILE_T fh, union wtap_pseudo_header *pseudo_header,
831     int *err, gchar **err_info)
832 {
833         guint8  irda_phdr[IRDA_SLL_LEN];
834         int     bytes_read;
835
836         errno = WTAP_ERR_CANT_READ;
837         bytes_read = file_read(irda_phdr, 1, IRDA_SLL_LEN, fh);
838         if (bytes_read != IRDA_SLL_LEN) {
839                 *err = file_error(fh);
840                 if (*err == 0)
841                         *err = WTAP_ERR_SHORT_READ;
842                 return FALSE;
843         }
844
845         if (pntohs(&irda_phdr[IRDA_SLL_PROTOCOL_OFFSET]) != 0x0017) {
846                 *err = WTAP_ERR_BAD_RECORD;
847                 if (err_info != NULL)
848                         *err_info = g_strdup("libpcap: IrDA capture has a packet with an invalid sll_protocol field");
849                 return FALSE;
850         }
851
852         pseudo_header->irda.pkttype = pntohs(&irda_phdr[IRDA_SLL_PKTTYPE_OFFSET]);
853
854         return TRUE;
855 }
856
857 static gboolean
858 pcap_read_mtp2_pseudoheader(FILE_T fh, union wtap_pseudo_header *pseudo_header, int *err, gchar **err_info _U_)
859 {
860         guint8 mtp2_hdr[MTP2_HDR_LEN];
861         int    bytes_read;
862
863         errno = WTAP_ERR_CANT_READ;
864         bytes_read = file_read(mtp2_hdr, 1, MTP2_HDR_LEN, fh);
865         if (bytes_read != MTP2_HDR_LEN) {
866                 *err = file_error(fh);
867                 if (*err == 0)
868                         *err = WTAP_ERR_SHORT_READ;
869                 return FALSE;
870         }
871
872         pseudo_header->mtp2.sent         = mtp2_hdr[MTP2_SENT_OFFSET];
873         pseudo_header->mtp2.annex_a_used = mtp2_hdr[MTP2_ANNEX_A_USED_OFFSET];
874         pseudo_header->mtp2.link_number  = pntohs(&mtp2_hdr[MTP2_LINK_NUMBER_OFFSET]);
875
876         return TRUE;
877 }
878
879 static gboolean
880 pcap_read_lapd_pseudoheader(FILE_T fh, union wtap_pseudo_header *pseudo_header,
881     int *err, gchar **err_info)
882 {
883         guint8  lapd_phdr[LAPD_SLL_LEN];
884         int     bytes_read;
885
886         errno = WTAP_ERR_CANT_READ;
887         bytes_read = file_read(lapd_phdr, 1, LAPD_SLL_LEN, fh);
888         if (bytes_read != LAPD_SLL_LEN) {
889                 *err = file_error(fh);
890                 if (*err == 0)
891                         *err = WTAP_ERR_SHORT_READ;
892                 return FALSE;
893         }
894
895         if (pntohs(&lapd_phdr[LAPD_SLL_PROTOCOL_OFFSET]) != ETH_P_LAPD) {
896                 *err = WTAP_ERR_BAD_RECORD;
897                 if (err_info != NULL)
898                         *err_info = g_strdup("libpcap: LAPD capture has a packet with an invalid sll_protocol field");
899                 return FALSE;
900         }
901
902         pseudo_header->lapd.pkttype = pntohs(&lapd_phdr[LAPD_SLL_PKTTYPE_OFFSET]);
903         pseudo_header->lapd.we_network = !!lapd_phdr[LAPD_SLL_ADDR_OFFSET+0];
904
905         return TRUE;
906 }
907
908 static gboolean
909 pcap_read_sita_pseudoheader(FILE_T fh, union wtap_pseudo_header *pseudo_header, int *err, gchar **err_info _U_)
910 {
911         guint8  sita_phdr[SITA_HDR_LEN];
912         int     bytes_read;
913
914         errno = WTAP_ERR_CANT_READ;
915         bytes_read = file_read(sita_phdr, 1, SITA_HDR_LEN, fh);
916         if (bytes_read != SITA_HDR_LEN) {
917                 *err = file_error(fh);
918                 if (*err == 0)
919                         *err = WTAP_ERR_SHORT_READ;
920                 return FALSE;
921         }
922
923         pseudo_header->sita.flags   = sita_phdr[SITA_FLAGS_OFFSET];
924         pseudo_header->sita.signals = sita_phdr[SITA_SIGNALS_OFFSET];
925         pseudo_header->sita.errors1 = sita_phdr[SITA_ERRORS1_OFFSET];
926         pseudo_header->sita.errors2 = sita_phdr[SITA_ERRORS2_OFFSET];
927         pseudo_header->sita.proto   = sita_phdr[SITA_PROTO_OFFSET];
928
929         return TRUE;
930 }
931
932 /*
933  * When not using the memory-mapped interface to capture USB events,
934  * code that reads those events can use the MON_IOCX_GET ioctl to
935  * read a 48-byte header consisting of a "struct linux_usb_phdr", as
936  * defined below, followed immediately by one of:
937  *
938  *      8 bytes of a "struct usb_device_setup_hdr", if "setup_flag"
939  *      in the preceding "struct linux_usb_phdr" is 0;
940  *
941  *      in Linux 2.6.30 or later, 8 bytes of a "struct iso_rec", if
942  *      this is an isochronous transfer;
943  *
944  *      8 bytes of junk, otherwise.
945  *
946  * In Linux 2.6.31 and later, it can also use the MON_IOCX_GETX ioctl
947  * to read a 64-byte header; that header consists of the 48 bytes
948  * above, followed immediately by 16 bytes of a "struct linux_usb_phdr_ext",
949  * as defined below.
950  *
951  * In Linux 2.6.21 and later, there's a memory-mapped interface to
952  * capture USB events.  In that interface, the events in the memory-mapped
953  * buffer have a 64-byte header, followed immediately by the data.
954  * In Linux 2.6.21 through 2.6.30.x, the 64-byte header is the 48-byte
955  * header described above, followed by 16 bytes of zeroes; in Linux
956  * 2.6.31 and later, the 64-byte header is the 64-byte header described
957  * above.
958  *
959  * See linux/Documentation/usb/usbmon.txt and libpcap/pcap/usb.h for details.
960  *
961  * With WTAP_ENCAP_USB_LINUX, packets have the 48-byte header; with
962  * WTAP_ENCAP_USB_LINUX_MMAPPED, they have the 64-byte header.  There
963  * is no indication of whether the header has the "struct iso_rec", or
964  * whether the last 16 bytes of a 64-byte header are all zeros or are
965  * a "struct linux_usb_phdr_ext".
966  */
967
968 /*
969  * URB transfer_type values
970  */
971 #define URB_ISOCHRONOUS   0x0
972 #define URB_INTERRUPT     0x1
973 #define URB_CONTROL       0x2
974 #define URB_BULK          0x3
975
976 /*
977  * Information from the URB for Isochronous transfers.
978  *
979  * This structure is 8 bytes long.
980  */
981 struct iso_rec {
982     gint32 error_count;
983     gint32 numdesc;
984 };
985
986 /*
987  * Header prepended by Linux kernel to each USB event.
988  *
989  * (Setup flag is '-', 'D', 'Z', or 0.  Data flag is '<', '>', 'Z', or 0.)
990  *
991  * The values are in *host* byte order.
992  */
993 struct linux_usb_phdr {
994     guint64 id;             /* urb id, to link submission and completion events */
995     guint8 event_type;      /* Submit ('S'), Completed ('C'), Error ('E') */
996     guint8 transfer_type;   /* ISO (0), Intr, Control, Bulk (3) */
997     guint8 endpoint_number; /* Endpoint number (0-15) and transfer direction */
998     guint8 device_address;  /* 0-127 */
999     guint16 bus_id;
1000     gint8 setup_flag;       /* 0, if the urb setup header is meaningful */
1001     gint8 data_flag;        /* 0, if urb data is present */
1002     gint64 ts_sec;
1003     gint32 ts_usec;
1004     gint32 status;
1005     guint32 urb_len;        /* whole len of urb this event refers to */
1006     guint32 data_len;       /* amount of urb data really present in this event */
1007
1008     /*
1009      * Packet-type-dependent data.
1010      * USB setup information of setup_flag is true.
1011      * Otherwise, some isochronous transfer information.
1012      */
1013     union {
1014         guint8 data[8];
1015         struct iso_rec iso;
1016     } s;
1017
1018     /*
1019      * This data is provided by Linux 2.6.31 and later kernels.
1020      *
1021      * For WTAP_ENCAP_USB_LINUX, it's not in the pseudo-header, so
1022      * the pseudo-header is always 48 bytes long, including the
1023      * packet-type-dependent data.
1024      *
1025      * For WTAP_ENCAP_USB_LINUX_MMAPPED, the pseudo-header is always
1026      * 64 bytes long, with the packet-type-dependent data preceding
1027      * these last 16 bytes.  In pre-2.6.31 kernels, it's zero padding;
1028      * in 2.6.31 and later, it's the following data.
1029      */
1030     gint32 interval;    /* only for Interrupt and Isochronous events */
1031     gint32 start_frame; /* for Isochronous */
1032     guint32 xfer_flags; /* copy of URB's transfer_flags */
1033     guint32 ndesc;      /* actual number of isochronous descriptors */
1034 };
1035
1036 struct linux_usb_isodesc {
1037     gint32 iso_status;
1038     guint32 iso_off;
1039     guint32 iso_len;
1040     guint32 _pad;
1041 };
1042
1043 /*
1044  * USB setup header as defined in USB specification
1045  * See usb_20.pdf, Chapter 9.3 'USB Device Requests' for details.
1046  * http://www.usb.org/developers/docs/usb_20_122909-2.zip
1047  *
1048  * This structure is 8 bytes long.
1049  */
1050 struct usb_device_setup_hdr {
1051     gint8 bmRequestType;
1052     guint8 bRequest;
1053     guint16 wValue;
1054     guint16 wIndex;
1055     guint16 wLength;
1056 };
1057
1058
1059 /*
1060  * Offset of the *end* of a field within a particular structure.
1061  */
1062 #define END_OFFSETOF(basep, fieldp) \
1063         (((char *)(void *)(fieldp)) - ((char *)(void *)(basep)) + \
1064             sizeof(*fieldp))
1065
1066 static void
1067 pcap_process_linux_usb_pseudoheader(guint packet_size, gboolean byte_swapped,
1068     gboolean header_len_64_bytes, guint8 *pd)
1069 {
1070         struct linux_usb_phdr *phdr;
1071         struct linux_usb_isodesc *pisodesc;
1072         gint32 iso_numdesc, i;
1073
1074         if (byte_swapped) {
1075                 phdr = (struct linux_usb_phdr *)pd;
1076
1077                 if (packet_size < END_OFFSETOF(phdr, &phdr->id))
1078                         return;
1079                 PBSWAP64((guint8 *)&phdr->id);
1080                 if (packet_size < END_OFFSETOF(phdr, &phdr->bus_id))
1081                         return;
1082                 PBSWAP16((guint8 *)&phdr->bus_id);
1083                 if (packet_size < END_OFFSETOF(phdr, &phdr->ts_sec))
1084                         return;
1085                 PBSWAP64((guint8 *)&phdr->ts_sec);
1086                 if (packet_size < END_OFFSETOF(phdr, &phdr->ts_usec))
1087                         return;
1088                 PBSWAP32((guint8 *)&phdr->ts_usec);
1089                 if (packet_size < END_OFFSETOF(phdr, &phdr->status))
1090                         return;
1091                 PBSWAP32((guint8 *)&phdr->status);
1092                 if (packet_size < END_OFFSETOF(phdr, &phdr->urb_len))
1093                         return;
1094                 PBSWAP32((guint8 *)&phdr->urb_len);
1095                 if (packet_size < END_OFFSETOF(phdr, &phdr->data_len))
1096                         return;
1097                 PBSWAP32((guint8 *)&phdr->data_len);
1098
1099                 if (phdr->transfer_type == URB_ISOCHRONOUS) {
1100                         if (packet_size < END_OFFSETOF(phdr, &phdr->s.iso.error_count))
1101                                 return;
1102                         PBSWAP32((guint8 *)&phdr->s.iso.error_count);
1103
1104                         if (packet_size < END_OFFSETOF(phdr, &phdr->s.iso.numdesc))
1105                                 return;
1106                         PBSWAP32((guint8 *)&phdr->s.iso.numdesc);
1107
1108                 }
1109
1110                 if (header_len_64_bytes) {
1111                         /*
1112                          * This is either the "version 1" header, with
1113                          * 16 bytes of additional fields at the end, or
1114                          * a "version 0" header from a memory-mapped
1115                          * capture, with 16 bytes of zeroed-out padding
1116                          * at the end.  Byte swap them as if this were
1117                          * a "version 1" header.
1118                          *
1119                          * Yes, the first argument to END_OFFSETOF() should
1120                          * be phdr, not phdr_ext; we want the offset of
1121                          * the additional fields from the beginning of
1122                          * the packet.
1123                          */
1124                         if (packet_size < END_OFFSETOF(phdr, &phdr->interval))
1125                                 return;
1126                         PBSWAP32((guint8 *)&phdr->interval);
1127                         if (packet_size < END_OFFSETOF(phdr, &phdr->start_frame))
1128                                 return;
1129                         PBSWAP32((guint8 *)&phdr->start_frame);
1130                         if (packet_size < END_OFFSETOF(phdr, &phdr->xfer_flags))
1131                                 return;
1132                         PBSWAP32((guint8 *)&phdr->xfer_flags);
1133                         if (packet_size < END_OFFSETOF(phdr, &phdr->ndesc))
1134                                 return;
1135                         PBSWAP32((guint8 *)&phdr->ndesc);
1136                 }
1137
1138                 if (phdr->transfer_type == URB_ISOCHRONOUS) {
1139                         /* swap the values in struct linux_usb_isodesc */
1140
1141                         if (header_len_64_bytes) {
1142                                 pisodesc = (struct linux_usb_isodesc*)(pd + 64);
1143                         } else {
1144                                 pisodesc = (struct linux_usb_isodesc*)(pd + 48);
1145                         }
1146                         iso_numdesc = phdr->s.iso.numdesc;
1147                         for (i = 0; i < iso_numdesc; i++) {
1148                                 /* always check if we have enough data from the
1149                                  * beginnig of the packet (phdr)
1150                                  */
1151                                 if (packet_size < END_OFFSETOF(phdr, &pisodesc->iso_status))
1152                                         return;
1153                                 PBSWAP32((guint8 *)&pisodesc->iso_status);
1154                                 if (packet_size < END_OFFSETOF(phdr, &pisodesc->iso_off))
1155                                         return;
1156                                 PBSWAP32((guint8 *)&pisodesc->iso_off);
1157                                 if (packet_size < END_OFFSETOF(phdr, &pisodesc->iso_len))
1158                                         return;
1159                                 PBSWAP32((guint8 *)&pisodesc->iso_len);
1160                                 if (packet_size < END_OFFSETOF(phdr, &pisodesc->_pad))
1161                                         return;
1162                                 PBSWAP32((guint8 *)&pisodesc->_pad);
1163
1164                                 pisodesc++;
1165                         }
1166                 }
1167         }
1168 }
1169
1170 static gboolean
1171 pcap_read_bt_pseudoheader(FILE_T fh,
1172     union wtap_pseudo_header *pseudo_header, int *err)
1173 {
1174         int     bytes_read;
1175         struct libpcap_bt_phdr phdr;
1176
1177         errno = WTAP_ERR_CANT_READ;
1178         bytes_read = file_read(&phdr, 1,
1179             sizeof (struct libpcap_bt_phdr), fh);
1180         if (bytes_read != sizeof (struct libpcap_bt_phdr)) {
1181                 *err = file_error(fh);
1182                 if (*err == 0)
1183                         *err = WTAP_ERR_SHORT_READ;
1184                 return FALSE;
1185         }
1186         pseudo_header->p2p.sent = ((g_ntohl(phdr.direction) & LIBPCAP_BT_PHDR_RECV) == 0)? TRUE: FALSE;
1187         return TRUE;
1188 }
1189
1190 static gboolean
1191 pcap_read_ppp_pseudoheader(FILE_T fh,
1192     union wtap_pseudo_header *pseudo_header, int *err)
1193 {
1194         int     bytes_read;
1195         struct libpcap_ppp_phdr phdr;
1196
1197         errno = WTAP_ERR_CANT_READ;
1198         bytes_read = file_read(&phdr, 1,
1199             sizeof (struct libpcap_ppp_phdr), fh);
1200         if (bytes_read != sizeof (struct libpcap_ppp_phdr)) {
1201                 *err = file_error(fh);
1202                 if (*err == 0)
1203                         *err = WTAP_ERR_SHORT_READ;
1204                 return FALSE;
1205         }
1206         pseudo_header->p2p.sent = (phdr.direction == LIBPCAP_PPP_PHDR_SENT) ? TRUE: FALSE;
1207         return TRUE;
1208 }
1209
1210 static gboolean
1211 pcap_read_erf_pseudoheader(FILE_T fh, struct wtap_pkthdr *whdr,
1212                               union wtap_pseudo_header *pseudo_header, int *err, gchar **err_info _U_)
1213 {
1214   guint8 erf_hdr[sizeof(struct erf_phdr)];
1215   int    bytes_read;
1216
1217   errno = WTAP_ERR_CANT_READ;
1218   bytes_read = file_read(erf_hdr, 1, sizeof(struct erf_phdr), fh);
1219   if (bytes_read != sizeof(struct erf_phdr)) {
1220     *err = file_error(fh);
1221     if (*err == 0)
1222       *err = WTAP_ERR_SHORT_READ;
1223     return FALSE;
1224   }
1225   pseudo_header->erf.phdr.ts = pletohll(&erf_hdr[0]); /* timestamp */
1226   pseudo_header->erf.phdr.type =  erf_hdr[8];
1227   pseudo_header->erf.phdr.flags = erf_hdr[9];
1228   pseudo_header->erf.phdr.rlen = pntohs(&erf_hdr[10]);
1229   pseudo_header->erf.phdr.lctr = pntohs(&erf_hdr[12]);
1230   pseudo_header->erf.phdr.wlen = pntohs(&erf_hdr[14]);
1231
1232   /* The high 32 bits of the timestamp contain the integer number of seconds
1233    * while the lower 32 bits contain the binary fraction of the second.
1234    * This allows an ultimate resolution of 1/(2^32) seconds, or approximately 233 picoseconds */
1235   if (whdr) {
1236     guint64 ts = pseudo_header->erf.phdr.ts;
1237     whdr->ts.secs = (guint32) (ts >> 32);
1238     ts = ((ts & 0xffffffff) * 1000 * 1000 * 1000);
1239     ts += (ts & 0x80000000) << 1; /* rounding */
1240     whdr->ts.nsecs = ((guint32) (ts >> 32));
1241     if ( whdr->ts.nsecs >= 1000000000) {
1242       whdr->ts.nsecs -= 1000000000;
1243       whdr->ts.secs += 1;
1244     }
1245   }
1246   return TRUE;
1247 }
1248
1249 /*
1250  * If the type of record given in the pseudo header indicate the presence of an extension
1251  * header then, read all the extension headers
1252  */
1253 static gboolean
1254 pcap_read_erf_exheader(FILE_T fh, union wtap_pseudo_header *pseudo_header,
1255                            int *err, gchar **err_info _U_, guint * psize)
1256 {
1257   int bytes_read = 0;
1258   guint8 erf_exhdr[8];
1259   guint64 erf_exhdr_sw;
1260   int i = 0, max = sizeof(pseudo_header->erf.ehdr_list)/sizeof(struct erf_ehdr);
1261   guint8 type = pseudo_header->erf.phdr.type;
1262   *psize = 0;
1263   if (pseudo_header->erf.phdr.type & 0x80){
1264     do{
1265       errno = WTAP_ERR_CANT_READ;
1266       bytes_read = file_read(erf_exhdr, 1, 8, fh);
1267       if (bytes_read != 8 ) {
1268         *err = file_error(fh);
1269         if (*err == 0)
1270           *err = WTAP_ERR_SHORT_READ;
1271         return FALSE;
1272       }
1273       type = erf_exhdr[0];
1274       erf_exhdr_sw = pntohll((guint64*) &(erf_exhdr[0]));
1275       if (i < max)
1276         memcpy(&pseudo_header->erf.ehdr_list[i].ehdr, &erf_exhdr_sw, sizeof(erf_exhdr_sw));
1277       *psize += 8;
1278       i++;
1279     } while (type & 0x80);
1280   }
1281   return TRUE;
1282 }
1283
1284 /*
1285  * If the type of record given in the pseudo header indicate the precense of a subheader
1286  * then, read this optional subheader
1287  */
1288 static gboolean
1289 pcap_read_erf_subheader(FILE_T fh, union wtap_pseudo_header *pseudo_header,
1290                            int *err, gchar **err_info _U_, guint * psize)
1291 {
1292   guint8 erf_subhdr[sizeof(union erf_subhdr)];
1293   int    bytes_read;
1294
1295   *psize=0;
1296   switch(pseudo_header->erf.phdr.type & 0x7F) {
1297   case ERF_TYPE_MC_HDLC:
1298   case ERF_TYPE_MC_RAW:
1299   case ERF_TYPE_MC_ATM:
1300   case ERF_TYPE_MC_RAW_CHANNEL:
1301   case ERF_TYPE_MC_AAL5:
1302   case ERF_TYPE_MC_AAL2:
1303   case ERF_TYPE_COLOR_MC_HDLC_POS:
1304     /* Extract the Multi Channel header to include it in the pseudo header part */
1305     errno = WTAP_ERR_CANT_READ;
1306     bytes_read = file_read(erf_subhdr, 1, sizeof(erf_mc_header_t), fh);
1307     if (bytes_read != sizeof(erf_mc_header_t) ) {
1308       *err = file_error(fh);
1309       if (*err == 0)
1310         *err = WTAP_ERR_SHORT_READ;
1311       return FALSE;
1312     }
1313     pseudo_header->erf.subhdr.mc_hdr = pntohl(&erf_subhdr[0]);
1314     *psize = sizeof(erf_mc_header_t);
1315     break;
1316   case ERF_TYPE_ETH:
1317   case ERF_TYPE_COLOR_ETH:
1318   case ERF_TYPE_DSM_COLOR_ETH:
1319     /* Extract the Ethernet additional header to include it in the pseudo header part */
1320     errno = WTAP_ERR_CANT_READ;
1321     bytes_read = file_read(erf_subhdr, 1, sizeof(erf_eth_header_t), fh);
1322     if (bytes_read != sizeof(erf_eth_header_t) ) {
1323       *err = file_error(fh);
1324       if (*err == 0)
1325         *err = WTAP_ERR_SHORT_READ;
1326       return FALSE;
1327     }
1328     pseudo_header->erf.subhdr.eth_hdr = pntohs(&erf_subhdr[0]);
1329     *psize = sizeof(erf_eth_header_t);
1330     break;
1331   default:
1332     /* No optional pseudo header for this ERF type */
1333     break;
1334   }
1335   return TRUE;
1336 }
1337
1338 static gboolean
1339 pcap_read_i2c_pseudoheader(FILE_T fh, union wtap_pseudo_header *pseudo_header, int *err, gchar **err_info _U_)
1340 {
1341         struct i2c_file_hdr i2c_hdr;
1342         int    bytes_read;
1343
1344         errno = WTAP_ERR_CANT_READ;
1345         bytes_read = file_read(&i2c_hdr, 1, sizeof (i2c_hdr), fh);
1346         if (bytes_read != sizeof (i2c_hdr)) {
1347                 *err = file_error(fh);
1348                 if (*err == 0)
1349                         *err = WTAP_ERR_SHORT_READ;
1350                 return FALSE;
1351         }
1352
1353         pseudo_header->i2c.is_event = i2c_hdr.bus & 0x80 ? 1 : 0;
1354         pseudo_header->i2c.bus = i2c_hdr.bus & 0x7f;
1355         pseudo_header->i2c.flags = pntohl(&i2c_hdr.flags);
1356
1357         return TRUE;
1358 }
1359
1360 int
1361 pcap_process_pseudo_header(FILE_T fh, int file_type, int wtap_encap,
1362     guint packet_size, gboolean check_packet_size, struct wtap_pkthdr *phdr,
1363     union wtap_pseudo_header *pseudo_header, int *err, gchar **err_info)
1364 {
1365         int phdr_len = 0;
1366         guint size;
1367
1368         switch (wtap_encap) {
1369
1370         case WTAP_ENCAP_ATM_PDUS:
1371                 if (file_type == WTAP_FILE_PCAP_NOKIA) {
1372                         /*
1373                          * Nokia IPSO ATM.
1374                          */
1375                         if (check_packet_size && packet_size < NOKIAATM_LEN) {
1376                                 /*
1377                                  * Uh-oh, the packet isn't big enough to even
1378                                  * have a pseudo-header.
1379                                  */
1380                                 *err = WTAP_ERR_BAD_RECORD;
1381                                 *err_info = g_strdup_printf("pcap: Nokia IPSO ATM file has a %u-byte packet, too small to have even an ATM pseudo-header",
1382                                     packet_size);
1383                                 return -1;
1384                         }
1385                         if (!pcap_read_nokiaatm_pseudoheader(fh,
1386                             pseudo_header, err))
1387                                 return -1;      /* Read error */
1388
1389                         phdr_len = NOKIAATM_LEN;
1390                 } else {
1391                         /*
1392                          * SunATM.
1393                          */
1394                         if (check_packet_size && packet_size < SUNATM_LEN) {
1395                                 /*
1396                                  * Uh-oh, the packet isn't big enough to even
1397                                  * have a pseudo-header.
1398                                  */
1399                                 *err = WTAP_ERR_BAD_RECORD;
1400                                 *err_info = g_strdup_printf("pcap: SunATM file has a %u-byte packet, too small to have even an ATM pseudo-header",
1401                                     packet_size);
1402                                 return -1;
1403                         }
1404                         if (!pcap_read_sunatm_pseudoheader(fh,
1405                             pseudo_header, err))
1406                                 return -1;      /* Read error */
1407
1408                         phdr_len = SUNATM_LEN;
1409                 }
1410                 break;
1411
1412         case WTAP_ENCAP_ETHERNET:
1413                 /*
1414                  * We don't know whether there's an FCS in this frame or not.
1415                  */
1416                 pseudo_header->eth.fcs_len = -1;
1417                 break;
1418
1419         case WTAP_ENCAP_IEEE_802_11:
1420         case WTAP_ENCAP_PRISM_HEADER:
1421         case WTAP_ENCAP_IEEE_802_11_WLAN_RADIOTAP:
1422         case WTAP_ENCAP_IEEE_802_11_WLAN_AVS:
1423                 /*
1424                  * We don't know whether there's an FCS in this frame or not.
1425                  * XXX - are there any OSes where the capture mechanism
1426                  * supplies an FCS?
1427                  */
1428                 pseudo_header->ieee_802_11.fcs_len = -1;
1429                 pseudo_header->ieee_802_11.channel = 0;
1430                 pseudo_header->ieee_802_11.data_rate = 0;
1431                 pseudo_header->ieee_802_11.signal_level = 0;
1432                 break;
1433
1434         case WTAP_ENCAP_IRDA:
1435                 if (check_packet_size && packet_size < IRDA_SLL_LEN) {
1436                         /*
1437                          * Uh-oh, the packet isn't big enough to even
1438                          * have a pseudo-header.
1439                          */
1440                         *err = WTAP_ERR_BAD_RECORD;
1441                         *err_info = g_strdup_printf("pcap: IrDA file has a %u-byte packet, too small to have even an IrDA pseudo-header",
1442                             packet_size);
1443                         return -1;
1444                 }
1445                 if (!pcap_read_irda_pseudoheader(fh, pseudo_header,
1446                     err, err_info))
1447                         return -1;      /* Read error */
1448
1449                 phdr_len = IRDA_SLL_LEN;
1450                 break;
1451
1452         case WTAP_ENCAP_MTP2_WITH_PHDR:
1453                 if (check_packet_size && packet_size < MTP2_HDR_LEN) {
1454                         /*
1455                          * Uh-oh, the packet isn't big enough to even
1456                          * have a pseudo-header.
1457                          */
1458                         *err = WTAP_ERR_BAD_RECORD;
1459                         *err_info = g_strdup_printf("pcap: MTP2 file has a %u-byte packet, too small to have even an MTP2 pseudo-header",
1460                             packet_size);
1461                         return -1;
1462                 }
1463                 if (!pcap_read_mtp2_pseudoheader(fh, pseudo_header,
1464                     err, err_info))
1465                         return -1;      /* Read error */
1466
1467                 phdr_len = MTP2_HDR_LEN;
1468                 break;
1469
1470         case WTAP_ENCAP_LINUX_LAPD:
1471                 if (check_packet_size && packet_size < LAPD_SLL_LEN) {
1472                         /*
1473                          * Uh-oh, the packet isn't big enough to even
1474                          * have a pseudo-header.
1475                          */
1476                         *err = WTAP_ERR_BAD_RECORD;
1477                         *err_info = g_strdup_printf("pcap: LAPD file has a %u-byte packet, too small to have even a LAPD pseudo-header",
1478                             packet_size);
1479                         return -1;
1480                 }
1481                 if (!pcap_read_lapd_pseudoheader(fh, pseudo_header,
1482                     err, err_info))
1483                         return -1;      /* Read error */
1484
1485                 phdr_len = LAPD_SLL_LEN;
1486                 break;
1487
1488         case WTAP_ENCAP_SITA:
1489                 if (check_packet_size && packet_size < SITA_HDR_LEN) {
1490                         /*
1491                          * Uh-oh, the packet isn't big enough to even
1492                          * have a pseudo-header.
1493                          */
1494                         *err = WTAP_ERR_BAD_RECORD;
1495                         *err_info = g_strdup_printf("pcap: SITA file has a %u-byte packet, too small to have even a SITA pseudo-header",
1496                             packet_size);
1497                         return -1;
1498                 }
1499                 if (!pcap_read_sita_pseudoheader(fh, pseudo_header,
1500                     err, err_info))
1501                         return -1;      /* Read error */
1502
1503                 phdr_len = SITA_HDR_LEN;
1504                 break;
1505
1506         case WTAP_ENCAP_BLUETOOTH_H4:
1507                 /* We don't have pseudoheader, so just pretend we received everything. */
1508                 pseudo_header->p2p.sent = FALSE;
1509                 break;
1510
1511         case WTAP_ENCAP_BLUETOOTH_H4_WITH_PHDR:
1512                 if (check_packet_size &&
1513                     packet_size < sizeof (struct libpcap_bt_phdr)) {
1514                         /*
1515                          * Uh-oh, the packet isn't big enough to even
1516                          * have a pseudo-header.
1517                          */
1518                         *err = WTAP_ERR_BAD_RECORD;
1519                         *err_info = g_strdup_printf("pcap: libpcap bluetooth file has a %u-byte packet, too small to have even a pseudo-header",
1520                             packet_size);
1521                         return -1;
1522                 }
1523                 if (!pcap_read_bt_pseudoheader(fh,
1524                     pseudo_header, err))
1525                         return -1;      /* Read error */
1526
1527                 phdr_len = (int)sizeof (struct libpcap_bt_phdr);
1528                 break;
1529
1530         case WTAP_ENCAP_PPP_WITH_PHDR:
1531                 if (check_packet_size &&
1532                     packet_size < sizeof (struct libpcap_ppp_phdr)) {
1533                         /*
1534                          * Uh-oh, the packet isn't big enough to even
1535                          * have a pseudo-header.
1536                          */
1537                         *err = WTAP_ERR_BAD_RECORD;
1538                         *err_info = g_strdup_printf("pcap: libpcap ppp file has a %u-byte packet, too small to have even a pseudo-header",
1539                             packet_size);
1540                         return -1;
1541                 }
1542                 if (!pcap_read_ppp_pseudoheader(fh,
1543                     pseudo_header, err))
1544                         return -1;      /* Read error */
1545
1546                 phdr_len = (int)sizeof (struct libpcap_ppp_phdr);
1547                 break;
1548
1549         case WTAP_ENCAP_ERF:
1550                 if (check_packet_size &&
1551                     packet_size < sizeof(struct erf_phdr) ) {
1552                         /*
1553                          * Uh-oh, the packet isn't big enough to even
1554                          * have a pseudo-header.
1555                          */
1556                         *err = WTAP_ERR_BAD_RECORD;
1557                         *err_info = g_strdup_printf("pcap: ERF file has a %u-byte packet, too small to have even an ERF pseudo-header",
1558                             packet_size);
1559                         return -1;
1560                 }
1561
1562                 if (!pcap_read_erf_pseudoheader(fh, phdr, pseudo_header,
1563                     err, err_info))
1564                         return -1;      /* Read error */
1565
1566                 phdr_len = (int)sizeof(struct erf_phdr);
1567
1568                 /* check the optional Extension header */
1569                 if (!pcap_read_erf_exheader(fh, pseudo_header, err, err_info,
1570                     &size))
1571                         return -1;      /* Read error */
1572
1573                 phdr_len += size;
1574
1575                 /* check the optional Multi Channel header */
1576                 if (!pcap_read_erf_subheader(fh, pseudo_header, err, err_info,
1577                     &size))
1578                         return -1;      /* Read error */
1579
1580                 phdr_len += size;
1581                 break;
1582
1583         case WTAP_ENCAP_I2C:
1584                 if (check_packet_size &&
1585                     packet_size < sizeof (struct i2c_file_hdr)) {
1586                         /*
1587                          * Uh-oh, the packet isn't big enough to even
1588                          * have a pseudo-header.
1589                          */
1590                         *err = WTAP_ERR_BAD_RECORD;
1591                         *err_info = g_strdup_printf("pcap: I2C file has a %u-byte packet, too small to have even a I2C pseudo-header",
1592                             packet_size);
1593                         return -1;
1594                 }
1595                 if (!pcap_read_i2c_pseudoheader(fh, pseudo_header,
1596                     err, err_info))
1597                         return -1;      /* Read error */
1598
1599                 /*
1600                  * Don't count the pseudo-header as part of the packet.
1601                  */
1602                 phdr_len = (int)sizeof (struct i2c_file_hdr);
1603                 break;
1604         }
1605
1606         return phdr_len;
1607 }
1608
1609 void
1610 pcap_read_post_process(int wtap_encap, guint packet_size,
1611     gboolean bytes_swapped, guchar *pd)
1612 {
1613         switch (wtap_encap) {
1614
1615         case WTAP_ENCAP_USB_LINUX:
1616                 pcap_process_linux_usb_pseudoheader(packet_size,
1617                     bytes_swapped, FALSE, pd);
1618                 break;
1619
1620         case WTAP_ENCAP_USB_LINUX_MMAPPED:
1621                 pcap_process_linux_usb_pseudoheader(packet_size,
1622                     bytes_swapped, TRUE, pd);
1623                 break;
1624
1625         default:
1626                 break;
1627         }
1628 }
1629
1630 int
1631 pcap_get_phdr_size(int encap, const union wtap_pseudo_header *pseudo_header)
1632 {
1633         int hdrsize;
1634
1635         switch (encap) {
1636
1637         case WTAP_ENCAP_ATM_PDUS:
1638                 hdrsize = SUNATM_LEN;
1639                 break;
1640
1641         case WTAP_ENCAP_IRDA:
1642                 hdrsize = IRDA_SLL_LEN;
1643                 break;
1644
1645         case WTAP_ENCAP_MTP2_WITH_PHDR:
1646                 hdrsize = MTP2_HDR_LEN;
1647                 break;
1648
1649         case WTAP_ENCAP_LINUX_LAPD:
1650                 hdrsize = LAPD_SLL_LEN;
1651                 break;
1652
1653         case WTAP_ENCAP_SITA:
1654                 hdrsize = SITA_HDR_LEN;
1655                 break;
1656
1657         case WTAP_ENCAP_ERF:
1658                 hdrsize = (int)sizeof (struct erf_phdr);
1659                 if (pseudo_header->erf.phdr.type & 0x80)
1660                         hdrsize += 8;
1661                 switch (pseudo_header->erf.phdr.type & 0x7F) {
1662
1663                 case ERF_TYPE_MC_HDLC:
1664                 case ERF_TYPE_MC_RAW:
1665                 case ERF_TYPE_MC_ATM:
1666                 case ERF_TYPE_MC_RAW_CHANNEL:
1667                 case ERF_TYPE_MC_AAL5:
1668                 case ERF_TYPE_MC_AAL2:
1669                 case ERF_TYPE_COLOR_MC_HDLC_POS:
1670                         hdrsize += (int)sizeof(struct erf_mc_hdr);
1671                         break;
1672
1673                 case ERF_TYPE_ETH:
1674                 case ERF_TYPE_COLOR_ETH:
1675                 case ERF_TYPE_DSM_COLOR_ETH:
1676                         hdrsize += (int)sizeof(struct erf_eth_hdr);
1677                         break;
1678
1679                 default:
1680                         break;
1681                 }
1682                 break;
1683
1684         case WTAP_ENCAP_I2C:
1685                 hdrsize = (int)sizeof (struct i2c_file_hdr);
1686                 break;
1687
1688         case WTAP_ENCAP_BLUETOOTH_H4_WITH_PHDR:
1689                 hdrsize = (int)sizeof (struct libpcap_bt_phdr);
1690                 break;
1691
1692         case WTAP_ENCAP_PPP_WITH_PHDR:
1693                 hdrsize = (int)sizeof (struct libpcap_ppp_phdr);
1694                 break;
1695
1696         default:
1697                 hdrsize = 0;
1698                 break;
1699         }
1700
1701         return hdrsize;
1702 }
1703
1704 gboolean
1705 pcap_write_phdr(wtap_dumper *wdh, int encap, const union wtap_pseudo_header *pseudo_header,
1706     int *err)
1707 {
1708         guint8 atm_hdr[SUNATM_LEN];
1709         guint8 irda_hdr[IRDA_SLL_LEN];
1710         guint8 lapd_hdr[LAPD_SLL_LEN];
1711         guint8 mtp2_hdr[MTP2_HDR_LEN];
1712         guint8 sita_hdr[SITA_HDR_LEN];
1713         guint8 erf_hdr[ sizeof(struct erf_mc_phdr)];
1714         struct i2c_file_hdr i2c_hdr;
1715         struct libpcap_bt_phdr bt_hdr;
1716         struct libpcap_ppp_phdr ppp_hdr;
1717         size_t size;
1718
1719         switch (encap) {
1720
1721         case WTAP_ENCAP_ATM_PDUS:
1722                 /*
1723                  * Write the ATM header.
1724                  */
1725                 atm_hdr[SUNATM_FLAGS] =
1726                     (pseudo_header->atm.channel == 0) ? 0x80 : 0x00;
1727                 switch (pseudo_header->atm.aal) {
1728
1729                 case AAL_SIGNALLING:
1730                         /* Q.2931 */
1731                         atm_hdr[SUNATM_FLAGS] |= 0x06;
1732                         break;
1733
1734                 case AAL_5:
1735                         switch (pseudo_header->atm.type) {
1736
1737                         case TRAF_LANE:
1738                                 /* LANE */
1739                                 atm_hdr[SUNATM_FLAGS] |= 0x01;
1740                                 break;
1741
1742                         case TRAF_LLCMX:
1743                                 /* RFC 1483 LLC multiplexed traffic */
1744                                 atm_hdr[SUNATM_FLAGS] |= 0x02;
1745                                 break;
1746
1747                         case TRAF_ILMI:
1748                                 /* ILMI */
1749                                 atm_hdr[SUNATM_FLAGS] |= 0x05;
1750                                 break;
1751                         }
1752                         break;
1753                 }
1754                 atm_hdr[SUNATM_VPI] = (guint8)pseudo_header->atm.vpi;
1755                 phtons(&atm_hdr[SUNATM_VCI], pseudo_header->atm.vci);
1756                 if (!wtap_dump_file_write(wdh, atm_hdr, sizeof(atm_hdr), err))
1757                         return FALSE;
1758                 wdh->bytes_dumped += sizeof(atm_hdr);
1759                 break;
1760
1761         case WTAP_ENCAP_IRDA:
1762                 /*
1763                  * Write the IrDA header.
1764                  */
1765                 memset(irda_hdr, 0, sizeof(irda_hdr));
1766                 phtons(&irda_hdr[IRDA_SLL_PKTTYPE_OFFSET],
1767                     pseudo_header->irda.pkttype);
1768                 phtons(&irda_hdr[IRDA_SLL_PROTOCOL_OFFSET], 0x0017);
1769                 if (!wtap_dump_file_write(wdh, irda_hdr, sizeof(irda_hdr), err))
1770                         return FALSE;
1771                 wdh->bytes_dumped += sizeof(irda_hdr);
1772                 break;
1773
1774         case WTAP_ENCAP_MTP2_WITH_PHDR:
1775                 /*
1776                  * Write the MTP2 header.
1777                  */
1778                 memset(&mtp2_hdr, 0, sizeof(mtp2_hdr));
1779                 mtp2_hdr[MTP2_SENT_OFFSET] = pseudo_header->mtp2.sent;
1780                 mtp2_hdr[MTP2_ANNEX_A_USED_OFFSET] = pseudo_header->mtp2.annex_a_used;
1781                 phtons(&mtp2_hdr[MTP2_LINK_NUMBER_OFFSET],
1782                     pseudo_header->mtp2.link_number);
1783                 if (!wtap_dump_file_write(wdh, mtp2_hdr, sizeof(mtp2_hdr), err))
1784                         return FALSE;
1785                 wdh->bytes_dumped += sizeof(mtp2_hdr);
1786                 break;
1787
1788         case WTAP_ENCAP_LINUX_LAPD:
1789                 /*
1790                  * Write the LAPD header.
1791                  */
1792                 memset(&lapd_hdr, 0, sizeof(lapd_hdr));
1793                 phtons(&lapd_hdr[LAPD_SLL_PKTTYPE_OFFSET],
1794                     pseudo_header->lapd.pkttype);
1795                 phtons(&lapd_hdr[LAPD_SLL_PROTOCOL_OFFSET], ETH_P_LAPD);
1796                 lapd_hdr[LAPD_SLL_ADDR_OFFSET + 0] =
1797                     pseudo_header->lapd.we_network?0x01:0x00;
1798                 if (!wtap_dump_file_write(wdh, lapd_hdr, sizeof(lapd_hdr), err))
1799                         return FALSE;
1800                 wdh->bytes_dumped += sizeof(lapd_hdr);
1801                 break;
1802
1803         case WTAP_ENCAP_SITA:
1804                 /*
1805                  * Write the SITA header.
1806                  */
1807                 memset(&sita_hdr, 0, sizeof(sita_hdr));
1808                 sita_hdr[SITA_FLAGS_OFFSET]   = pseudo_header->sita.flags;
1809                 sita_hdr[SITA_SIGNALS_OFFSET] = pseudo_header->sita.signals;
1810                 sita_hdr[SITA_ERRORS1_OFFSET] = pseudo_header->sita.errors1;
1811                 sita_hdr[SITA_ERRORS2_OFFSET] = pseudo_header->sita.errors2;
1812                 sita_hdr[SITA_PROTO_OFFSET]   = pseudo_header->sita.proto;
1813                 if (!wtap_dump_file_write(wdh, sita_hdr, sizeof(sita_hdr), err))
1814                         return FALSE;
1815                 wdh->bytes_dumped += sizeof(sita_hdr);
1816                 break;
1817
1818         case WTAP_ENCAP_ERF:
1819                  /*
1820                  * Write the ERF header.
1821                  */
1822                 memset(&erf_hdr, 0, sizeof(erf_hdr));
1823                 pletonll(&erf_hdr[0], pseudo_header->erf.phdr.ts);
1824                 erf_hdr[8] = pseudo_header->erf.phdr.type;
1825                 erf_hdr[9] = pseudo_header->erf.phdr.flags;
1826                 phtons(&erf_hdr[10], pseudo_header->erf.phdr.rlen);
1827                 phtons(&erf_hdr[12], pseudo_header->erf.phdr.lctr);
1828                 phtons(&erf_hdr[14], pseudo_header->erf.phdr.wlen);
1829                 size = sizeof(struct erf_phdr);
1830
1831                 switch(pseudo_header->erf.phdr.type & 0x7F) {
1832                 case ERF_TYPE_MC_HDLC:
1833                 case ERF_TYPE_MC_RAW:
1834                 case ERF_TYPE_MC_ATM:
1835                 case ERF_TYPE_MC_RAW_CHANNEL:
1836                 case ERF_TYPE_MC_AAL5:
1837                 case ERF_TYPE_MC_AAL2:
1838                 case ERF_TYPE_COLOR_MC_HDLC_POS:
1839                   phtonl(&erf_hdr[16], pseudo_header->erf.subhdr.mc_hdr);
1840                   size += (int)sizeof(struct erf_mc_hdr);
1841                   break;
1842                 case ERF_TYPE_ETH:
1843                 case ERF_TYPE_COLOR_ETH:
1844                 case ERF_TYPE_DSM_COLOR_ETH:
1845                   phtons(&erf_hdr[16], pseudo_header->erf.subhdr.eth_hdr);
1846                   size += (int)sizeof(struct erf_eth_hdr);
1847                   break;
1848                 default:
1849                   break;
1850                 }
1851                 if (!wtap_dump_file_write(wdh, erf_hdr, size, err))
1852                         return FALSE;
1853                 wdh->bytes_dumped += size;
1854                 break;
1855
1856         case WTAP_ENCAP_I2C:
1857                 /*
1858                  * Write the I2C header.
1859                  */
1860                 memset(&i2c_hdr, 0, sizeof(i2c_hdr));
1861                 i2c_hdr.bus = pseudo_header->i2c.bus |
1862                         (pseudo_header->i2c.is_event ? 0x80 : 0x00);
1863                 phtonl((guint8 *)&i2c_hdr.flags, pseudo_header->i2c.flags);
1864                 if (!wtap_dump_file_write(wdh, &i2c_hdr, sizeof(i2c_hdr), err))
1865                         return FALSE;
1866                 wdh->bytes_dumped += sizeof(i2c_hdr);
1867                 break;
1868
1869         case WTAP_ENCAP_BLUETOOTH_H4_WITH_PHDR:
1870                 bt_hdr.direction = GUINT32_TO_BE(pseudo_header->p2p.sent ? LIBPCAP_BT_PHDR_SENT : LIBPCAP_BT_PHDR_RECV);
1871                 if (!wtap_dump_file_write(wdh, &bt_hdr, sizeof bt_hdr, err))
1872                         return FALSE;
1873                 wdh->bytes_dumped += sizeof bt_hdr;
1874                 break;
1875
1876         case WTAP_ENCAP_PPP_WITH_PHDR:
1877                 ppp_hdr.direction = (pseudo_header->p2p.sent ? LIBPCAP_PPP_PHDR_SENT : LIBPCAP_PPP_PHDR_RECV);
1878                 if (!wtap_dump_file_write(wdh, &ppp_hdr, sizeof ppp_hdr, err))
1879                         return FALSE;
1880                 wdh->bytes_dumped += sizeof ppp_hdr;
1881                 break;
1882         }
1883         return TRUE;
1884 }