contrib/tcpdump/print-bt.c

   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
  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