1 /*
2 * Copyright (c) 2007
3 * paolo.abeni@email.it All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that: (1) source code distributions
7 * retain the above copyright notice and this paragraph in its entirety, (2)
8 * distributions including binary code include the above copyright notice and
9 * this paragraph in its entirety in the documentation or other materials
10 * provided with the distribution, and (3) all advertising materials mentioning
11 * features or use of this software display the following acknowledgement:
12 * ``This product includes software developed by Paolo Abeni.''
13 * The name of author may not be used to endorse or promote products derived
14 * from this software without specific prior written permission.
15 * THIS SOFTWARE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR IMPLIED
16 * WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED WARRANTIES OF
17 * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
18 */
19
20 /* \summary: Bluetooth printer */
21
22 #ifdef HAVE_CONFIG_H
23 #include <config.h>
24 #endif
25
26 #include "netdissect-stdinc.h"
27
28 #define ND_LONGJMP_FROM_TCHECK
29 #include "netdissect.h"
30 #include "extract.h"
31
32 #ifdef DLT_BLUETOOTH_HCI_H4_WITH_PHDR
33
34 /*
35 * Header prepended by libpcap to each bluetooth h4 frame;
36 * the direction field is in network byte order.
37 */
38 typedef struct _bluetooth_h4_header {
39 nd_uint32_t direction; /* if first bit is set direction is incoming */
40 } bluetooth_h4_header;
41
42 #define BT_HDRLEN sizeof(bluetooth_h4_header)
43
44 /*
45 * This is the top level routine of the printer. 'p' points
46 * to the bluetooth header of the packet, 'h->ts' is the timestamp,
47 * 'h->len' is the length of the packet off the wire, and 'h->caplen'
48 * is the number of bytes actually captured.
49 */
50 void
bt_if_print(netdissect_options * ndo,const struct pcap_pkthdr * h,const u_char * p)51 bt_if_print(netdissect_options *ndo, const struct pcap_pkthdr *h, const u_char *p)
52 {
53 u_int length = h->len;
54 u_int caplen = h->caplen;
55 const bluetooth_h4_header* hdr = (const bluetooth_h4_header*)p;
56
57 ndo->ndo_protocol = "bluetooth";
58 nd_print_protocol(ndo);
59 ND_TCHECK_LEN(p, BT_HDRLEN);
60 ndo->ndo_ll_hdr_len += BT_HDRLEN;
61 caplen -= BT_HDRLEN;
62 length -= BT_HDRLEN;
63 p += BT_HDRLEN;
64 if (ndo->ndo_eflag)
65 ND_PRINT(", hci length %u, direction %s", length,
66 (GET_BE_U_4(hdr->direction)&0x1) ? "in" : "out");
67
68 if (!ndo->ndo_suppress_default_print)
69 ND_DEFAULTPRINT(p, caplen);
70 }
71 #endif
72