xref: /freebsd/contrib/tcpdump/print-bt.c (revision 0a7e5f1f02aad2ff5fff1c60f44c6975fd07e1d9)
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 #include <config.h>
23 
24 #include "netdissect-stdinc.h"
25 
26 #define ND_LONGJMP_FROM_TCHECK
27 #include "netdissect.h"
28 #include "extract.h"
29 
30 #ifdef DLT_BLUETOOTH_HCI_H4_WITH_PHDR
31 
32 /*
33  * Header prepended by libpcap to each bluetooth h4 frame;
34  * the direction field is in network byte order.
35  */
36 typedef struct _bluetooth_h4_header {
37 	nd_uint32_t direction; /* if first bit is set direction is incoming */
38 } bluetooth_h4_header;
39 
40 #define	BT_HDRLEN sizeof(bluetooth_h4_header)
41 
42 /*
43  * This is the top level routine of the printer.  'p' points
44  * to the bluetooth header of the packet, 'h->ts' is the timestamp,
45  * 'h->len' is the length of the packet off the wire, and 'h->caplen'
46  * is the number of bytes actually captured.
47  */
48 void
bt_if_print(netdissect_options * ndo,const struct pcap_pkthdr * h,const u_char * p)49 bt_if_print(netdissect_options *ndo, const struct pcap_pkthdr *h, const u_char *p)
50 {
51 	u_int length = h->len;
52 	u_int caplen = h->caplen;
53 	const bluetooth_h4_header *hdr = (const bluetooth_h4_header *)p;
54 
55 	ndo->ndo_protocol = "bluetooth";
56 	nd_print_protocol(ndo);
57 	ND_TCHECK_LEN(p, BT_HDRLEN);
58 	ndo->ndo_ll_hdr_len += BT_HDRLEN;
59 	caplen -= BT_HDRLEN;
60 	length -= BT_HDRLEN;
61 	p += BT_HDRLEN;
62 	if (ndo->ndo_eflag)
63 		ND_PRINT(", hci length %u, direction %s", length,
64 			 (GET_BE_U_4(hdr->direction)&0x1) ? "in" : "out");
65 
66 	if (!ndo->ndo_suppress_default_print)
67 		ND_DEFAULTPRINT(p, caplen);
68 }
69 #endif
70